الدروس ولعبة التعلّم

مقاييس التسارع، الجيروسكوبات ووحدات IMU

ما يقيسه حساس الحركة فعلاً، محوّلاً إلى إمالة واتجاه وخطوات ونقرات، وينتهي بميزان وبوصلة تبقى صادقة عند الإمالة.

ماذا يعلّمك المسار

مقاييس التسارع والجيروسكوبات ووحدات IMU سبعة دروس على لوحة Uno، موزعة على أربعة فصول:

  • أين يكون الأسفل: الجاذبية كمتجه على حساس MPU6050 يُقرأ مباشرة من سجلاته، والقيم الخام والنطاقات، والميل بحساب asin و atan2 على ميزان ميل ADXL345.
  • الدوران والانحراف: جمع قراءات الجيروسكوب في زاوية، والانحراف الذي يسببه إزاحته، ومعايرته في حالة السكون، والمرشح التكميلي مع ثابته الزمني.
  • الشمال والخطوات والنقرات: بوصلة بمقياس مغناطيسية، ولماذا يميلها الميل عن الصواب بعشرات الدرجات، والانحراف المغناطيسي، وعدّاد خطوات وكاشف نقرات مبنيان على العتبات والتخلف والتوقيت.
  • بناء الزعيم: ميزان ميل للبنّائين بـ LED أخضر وآخر أحمر، وبوصلة معوّضة عن الميل على MPU-9250.

ينتهي كل فصل باختبار قصير. افتحه من /learn.

الدوائر

يفتح درسان أعمالاً من المعرض: ميزان الميل (حساس ADXL345 على لوحة GY-291) و تسعة محاور (حساس LSM6DSOX وحساس LIS3MDL على ناقل I2C واحد). أما بقية الدروس فتشغّل أكوادًا كُتبت خصيصًا للمسار، وكلها على طرفي A4 و A5 في Uno:

الكود قطعة ما يفعله
imugravity MPU6050 المحاور الثلاثة بوحدة g، وطول المتجه، والقيم الخام، ودفعة يكتبها المستخدم
imugyro MPU6050 قراءات الجيروسكوب مجمّعة بجانب مقياس التسارع، وأمر cal لإزالة الإزاحة
imucomp MPU6050 مرشح تكميلي مقارَن بالقراءة النظيفة، ودفعة يكتبها المستخدم
imustep ADXL345 عدّاد خطوات مع وتيرة المشي، ونقرة واحدة ونقرتان
imuboss MPU-9250، و LED اثنان ميزان الميل، واتجاهات البوصلة، وزاوية معوّضة عن الميل

لماذا تضيف بعض الأكواد ضوضاء

الحساسات المحاكاة مثالية: لا ضوضاء ولا إزاحة ولا انحراف. جيروسكوب MPU6050 حقيقي يقرأ جزءاً من الدرجة في الثانية وهو ساكن، ومقياس تسارعه يهتز. درسا الانحراف والمرشح يضيفان هذه العيوب في الكود، بالقيم الموجودة في أعلاه (BIAS_DPS، NOISE_DPS، ACCEL_NOISE_G)، فما تراه هو ما تفعله لوحة حقيقية. الضوضاء ثابتة البذرة، فكل تشغيل يعطي الأرقام نفسها.

كذلك تستشعر مقاييس التسارع المحاكاة الجاذبية من خلال ميلها فقط، لا الدفع. عدّاد الخطوات يمشي بتأرجح زاوية الميل، وأوامر الدفعة تضيف الدفع في الكود.

حل المشكلات

  • كل القراءات تساوي 0. يدخل MPU6050 في وضع النوم عند التشغيل. يكتب كوده القيمة 0 في السجل 0x6B أولا؛ احتفظ بهذا السطر.
  • قيم g أصغر أربع مرات من الصحيح. تغيّر المدى في السجل 0x1C ولم يتغيّر معه ثابت العدّات لكل g.
  • البوصلة منحرفة كثيرا. إنها مائلة: الصيغة المسطحة تعمل فقط عندما تكون مسطحة. استخدم تعويض الميل الموجود في بناء الزعيم.
  • لا تُحتسب أي خطوات. يجب أن يتجاوز التأرجح STEP_HIGH ثم يعود تحت STEP_LOW في كل مرة. تأرجح أكثر، أو اخفض العتبة.

The next course, دمج الحساسات ومرشح كالمان، يختار الخلطة من أرقام الضجيج ويتعلّم انحياز الجيروسكوب أثناء عمله.