قِس الميلان باستخدام MPU6050 ولوحة Arduino
متوسط
أو تصفّح كل الدروس.
- 526قطعة على المنضدة
- 46لوحة تعمل الآن
- 1.00xزمن حقيقي، على كل لوحة
MPU6050 هو مقياس تسارع ثلاثي المحاور وجيروسكوب ثلاثي المحاور على شريحة واحدة، ويُباع عادة على اللوحة الزرقاء الصغيرة GY-521. الدائرة أعلاه تستخدمه كمقياس ميلان: تقرأه لوحة Arduino Uno عبر I2C، وتضيء مصباحًا أخضر وهو مستوٍ، ومصباحًا أحمر أو أزرق عند ميله يمينًا أو يسارًا. تطبع الشاشة التسلسلية التسارع الخام وزاويتي الميلان (roll و pitch) ومعدلات الجيروسكوب ودرجة حرارة الشريحة نفسها.
افتحه في المحرر واسحب لوحة الحساس لتمييلها. تتبع القراءات الجاذبية، ويتبع الجيروسكوب سرعة تحريكك له.
ما تحتاجه
- Arduino Uno
- MPU6050 على لوحة GY-521
- LEDs أحمر وأخضر وأزرق مع مقاومة 220 أوم لكل واحد
- لوحة تجارب وأسلاك توصيل
التوصيل
| القطعة والطرف | يتصل بـ | ملاحظة |
|---|---|---|
| SCL في MPU6050 | A5 | لوحة GY-521 تحمل مقاومات السحب الخاصة بها |
| SDA في MPU6050 | A4 | |
| VCC و GND في MPU6050 | 5 V وGND | |
| LED أحمر، عبر مقاومة 220 أوم | الطرف 7 | مائل إلى اليسار |
| LED أخضر عبر مقاومة 220 ohm | الطرف 8 | مستوٍ |
| LED أزرق، عبر مقاومة 220 أوم | الطرف 9 | مائل إلى اليمين |
يبدأ العمل نائمًا
بعد إعادة التعيين، يقرأ سجل إدارة الطاقة في MPU6050 القيمة 0x40: أي أن بت النوم مضبوط. حتى يمسحه الكود، تقرأ كل سجلات القياس صفرًا. لا يوجد خطأ ولا شكوى، بل لا شيء ثابت تمامًا، وهذا أسوأ من الانهيار لأنه يشبه حساسًا يعمل مستوٍ وساكن. أول فعل يقوم به كل تعريف هو كتابة 0x00 في السجل 0x6B، ويطبع المثال ما إذا كان ذلك قد نجح.
الشريحة المحاكاة تبدأ نائمة أيضًا، لذا فإن نسيان هذا يعطي نفس الأصفار الثابتة هنا كما على المنضدة.
#include <Wire.h>
void setup() {
Serial.begin(9600);
Wire.begin();
Wire.beginTransmission(0x68);
Wire.write(0x6B); // PWR_MGMT_1
Wire.write(0x00); // clear SLEEP
Wire.endTransmission();
}تحويل الجاذبية إلى زاوية
An accelerometer sitting still measures gravity and nothing else. Flat on a table, all of gravity is on the Z axis, so the reading is 0, 0 and plus 1 g. Tip it to one side and some of gravity moves onto Y; tip it forward and some moves onto X. The tilt angle is the arctangent of the two components, which is the whole trick behind every spirit level app.
يقرأ المثال جميع البايتات الأربعة عشر من البيانات دفعة واحدة، ويحوّل الأرقام الخام إلى جزء من ألف من عجلة الجاذبية (g)، ثم يحسب زاوية الميلان الجانبي (roll) من المحورين Y وZ وزاوية الميلان الأمامي (pitch) من المحورين X وZ. أما دالة الظل العكسي فتأتي من جدول بحث دقته تبلغ نحو درجة واحدة، وهو أسرع وأصغر حجمًا على لوحة Uno من دالة atan2() في مكتبة الرياضيات، مع أن دالة atan2() تعمل أيضًا. وعند تجاوز 12 درجة في أي اتجاه، تتولى إحدى المصابيح الخارجية المهمة بدلًا من المصباح الأخضر.
يقيس الجيروسكوب شيئًا مختلفًا: مدى سرعة دوران اللوحة، بالدرجات في الثانية، لا إلى أين تشير. يبقى قريبًا من الصفر ما دامت اللوحة ساكنة، ولا يتحرك إلا أثناء ميلك لها.
WHO_AM_I والعنوان
عنوان الشريحة هو 0x68، أو 0x69 عندما يُسحب الطرف AD0 إلى المستوى العالي. يعطي سجل WHO_AM_I القيمة 0x68 في الحالتين، لأنه يحمل بتات العنوان بدون AD0. لذا فإن أي مشغّل يقارن WHO_AM_I بالعنوان الذي يستخدمه سيفشل بالضبط مع اللوحة التي ربطها أحدهم على 0x69. المثال يطبع القيمتين معًا ليكون الفرق واضحًا.
جرّبه في المحرر
افتح الدائرة في المحرر واسحب لوحة الحساس لتميلها ببطء حتى تتجاوز 12 درجة. يسلّم المصباح الأخضر مكانه إلى الأحمر أو الأزرق. غيّر FLAT_DEGREES إلى 3 ويصبح المقياس ميزانًا متوترًا؛ غيّره إلى 30 فلن يشكو إلا من ميل حقيقي.
Watch the gyro numbers in the serial monitor while you drag. They rise while the board is moving and fall back to zero the moment you stop, even though the tilt stays. That is the difference between a rate and a position, and it is why a gyro on its own cannot tell you which way up something is.
ثم اكتب بضعة أسطر بنفسك باستخدام Wire.h: إرسال إلى 0x68 مع السجل 0x75، وهو WHO_AM_I، ثم قراءة بايت واحد. سيطبع 68، تمامًا كالشريحة الحقيقية.
أخطاء شائعة
Forgetting to wake it, and getting zeros.
قراءة السجلات واحدًا واحدًا. بايتات التسارع الستة قد تتغير بين قراءتين منفصلتين، فتحصل على قيمة مكوّنة من نصف عيّنة ونصف العيّنة التالية. اقرأ الكتلة كلها في نقل واحد.
توقّع الحصول على زاوية من الجايرو وحده. تكامل الدرجات في الثانية مع الوقت يتراكم خطؤه. المشاريع الحقيقية تجمع المقياس التسارعي والجايرو مع مرشّح تكميلي أو مرشّح Kalman.
توقّع أرقام مثالية من العتاد الحقيقي. لكل MPU6050 حقيقي انزياح على كل محور حتى يُعايَر. المحاكى يقرأ نظيفًا، وهذا مفيد لتعلّم الرياضيات وأرحم من المنضدة.
افتح هذه الدائرة في المحرر. Arduino Uno: مقياس ميل MPU6050، موصّلًا كما يعمل في أعلى هذه الصفحة. غيّر قطعة أو قيمة وشغّله مرة أخرى.
افتح الدائرةالأسئلة
هل أحتاج إلى مكتبة من أجل MPU6050؟
لا. تُترجم Wire.h هنا كما هي، وإيقاظ الشريحة وقراءتها هو بضعة كتابات في السجلات وقراءة واحدة متتالية. يستخدم المثال مساعد MPU6050 الخاص بـ Mokxi، وهو يغلّف هذه العمليات بالضبط.
هل يمكنني استخدام MPU6050 مع ESP32؟
نعم. تعمل الشريحة على 3.3 فولت، وقراءات السجلات نفسها تنجح على أطراف I2C في ESP32.
هل يحتوي المحاكي على DMP؟
لا. معالج الحركة داخل الشريحة الحقيقية، الذي يشغّل برنامجه الثابت الخاص بالدمج، غير مُنمذج. أما سجلات المقياس التسارعي والجايرو ودرجة الحرارة الخام فمنمذجة.
ابنِ هذا على أرض الواقع
افتح المحرر وغيّر قيمة وشاهد الرقم يتحرك معها. لا شيء لتثبّته ولا حاجة إلى حساب.