روبوت ذو توازن ذاتي على لوحة Arduino
متقدم
أو تصفّح كل الدروس.
- 526قطعة على المنضدة
- 46لوحة تعمل الآن
- 1.00xزمن حقيقي، على كل لوحة
يقف الروبوت ذو التوازن الذاتي على عجلتين، مثل بندول مقلوب، ولا يبقى واقفًا إلا لأنه يواصل دفع عجلاته تحت جسمه. إنه مشروع Arduino كلاسيكي لأنه يجمع فكرتين كبيرتين في بناء واحد: تحويل حساس مشوّش إلى زاوية جيدة، ومتحكم PID يتصرّف بناءً عليها مئات المرات في الثانية.
الدائرة أعلاه هي Uno يشغّل روبوتًا بعجلتين مع MPU6050 خاص به ودراجة محركات TB6612. ثلاثة مقابض تضبط كسبات PID أثناء العمل، وشاشة OLED تعرض الزاوية والكسبات. اضغط «تشغيل»: يُمسك الروبوت منتصبًا للحظة ثم يُترك ليتوازن بنفسه. ثم ادفعه بأزرار الأسهم على الروبوت، وأدر المقابض لترى ما يفعله كل كسب.
ما تحتاجه
- Arduino Uno
- هيكل روبوت بعجلتين مع محركي DC مسننين
- حساس تسارع وجيروسكوب MPU6050
- مشغّل محركات TB6612FNG
- ثلاث مقاومات متغيرة 10k
- شاشة OLED من نوع SSD1306، بدقة 128x64، عبر I2C (اختيارية)
- حزمة بطاريات للمحركات
التوصيل
| القطعة والطرف | يتصل بـ | ملاحظة |
|---|---|---|
| طرفا SCL وSDA في الروبوت | الطرفان 12 و2 | حساس MPU6050 في الروبوت على العنوان 0x68، عبر ناقل I2C برمجي خاص به |
| AIN1 وAIN2 وPWMA | الأطراف 10 و9 و6 | المحرك الأيسر |
| BIN1 وBIN2 وPWMB | الأطراف 5 و4 و3 | المحرك الأيمن |
| STBY | 5 V | المشغّل يعمل متى وصلته الطاقة |
| مقاومات ضبط Kp وKi وKd | A0 وA1 وA2 | طرفان إلى 5 V وGND |
| طرفا SCL وSDA في شاشة OLED | A5 و A4 | الزاوية والمكاسب |
الخطوة 1: احسب الميل
يضم حساس MPU6050 حساسين، ولا يكفي أي منهما وحده. حساس التسارع يعرف اتجاه الأسفل، لذا تعطي الدالة atan2(-ax, az) الميل بالنسبة إلى الجاذبية. لكنه يشعر أيضًا بكل دفعة تعطيها العجلات للجسم، فبينما يتحرك الروبوت تكون قراءته مشوشة وغير صحيحة. أما الجيروسكوب فيقيس سرعة دوران الجسم بسلاسة، لكن عليك جمع تلك السرعة للحصول على الزاوية، وتتراكم الأخطاء الصغيرة أيضًا، فتنحرف الزاوية تدريجيًا.
يأخذ المرشح التكميلي أفضل ما في كل منهما: angle = 0.98 * (angle + rate * dt) + 0.02 * accelAngle. لحظة بلحظة يحرّك الجيروسكوب الزاوية، ويجذبها حساس التسارع بلطف نحو الحقيقة، بنسبة 2% في كل خطوة. إنه سطر واحد من الكود، وهو ما تستخدمه معظم روبوتات التوازن.
الخطوة 2: متحكم PID على الزاوية
كل 10 ms يحسب الكود مقدار ميل الجسم عن الوضع العمودي ويحرّك العجلات لتصحيحه. المخرج هو ثلاثة حدود تُجمع معًا. الحد P (التناسبي) هو الميل مضروبًا في Kp: كلما زاد الميل زادت قوة الدفع. والحد D (التفاضلي) هو سرعة الجيروسكوب مضروبة في Kd: يقاوم تأرجح الجسم السريع، فيمنعه من تجاوز الهدف. والحد I (التكاملي) يجمع الميل عبر الزمن مضروبًا في Ki: يمنح الدفعة الثابتة التي يحتاجها المحرك لمجرد الحفاظ على سرعة.
يُقيَّد المجموع بين -255 و255، وتحدد إشارته الاتجاه (AIN1 وAIN2) بينما تذهب قيمته إلى analogWrite على PWMA وPWMB. عند الميل للأمام، تتقدم العجلات للأمام لتعود تحت الجسم.
تضبط المقاومات الثلاث قيمة Kp من 0 إلى 80، وKi من 0 إلى 600، وKd من 0 إلى 2. مع وضع كل مقاومة في المنتصف (40 و300 و1) يتوازن الروبوت: اتركه عند الثانية الأولى فيقف، وبعد نحو أربع ثوان من الضغط على «تشغيل» تعرض الشاشة التسلسلية "Balanced for 3 s". ادفعه بالسهم فيقول "Caught it: upright again" بعد لحظات.
const float ALPHA = 0.98;
const float FALLEN = 45.0;
const float I_LIMIT = 150.0;
void loop() {
unsigned long now = micros();
if (now - lastUs < PERIOD_US) return; // every 10 ms
float dt = (now - lastUs) / 1000000.0;
lastUs = now;
Mpu6050Reading r;
if (!imu.read(r)) return;
float accelAngle = atan2(-(float)r.ax, (float)r.az) * 57.29578;
float rate = r.gy / 131.0;
angle = ALPHA * (angle + rate * dt) + (1 - ALPHA) * accelAngle;
if (fabs(angle) > FALLEN) {
fallen = true;
integral = 0;
brake();
Serial.println("FALLEN");
} else {
integral += angle * dt;
if (ki > 0.01) {
float limit = I_LIMIT / ki;
if (integral > limit) integral = limit;
if (integral < -limit) integral = -limit;
}
float pid = kp * angle + ki * integral + kd * rate;
output = (int)constrain(pid, -255, 255);
drive(output);
}
readKnob();
}ماذا يفعل كل معامل كسب؟ جرّب بنفسك
أنزل Ki إلى الصفر تمامًا. بدون المكامل لا يستطيع الروبوت الحفاظ على الدفع الذي يحتاجه المحرك عند السرعة، فينزلق ببطء ويميل أكثر فأكثر ليكافح، ثم يسقط: الشاشة التسلسلية تعرض "FALLEN". هذا هو حد I الذي يستحق مكانه.
أنزل Kd إلى الصفر تمامًا، ثم اضغط زر الوقوف على الروبوت. بدون التخميد، كل تأرجح يتجاوز سابقه: يتأرجح أقوى فأقوى حتى يسقط. أما مع رفع Kd من جديد، فالدفع نفسه يتلاشى في تأرجحة أو اثنتين.
يحدد Kp شدة مقاومة الميل. إذا كان منخفضًا جدًا صار الروبوت كسولًا ومتذبذبًا، وإذا كان مرتفعًا جدًا بدأ يرتجف. يضبط الناس روبوتًا حقيقيًا بهذا الترتيب: Kp حتى يقف تقريبًا ويبدأ بالارتجاف، ثم Kd حتى يتوقف الارتجاف، ثم Ki حتى يتوقف الانزلاق.
مُمسَك، مُترَك، ساقط
A real robot is held upright while it powers up. If the PID ran during that time, the integral would fill up with a lean the wheels cannot fix (your hand is holding it), and the stored push would throw it over the moment you let go. So the sketch keeps the motors braked while the gyro says the body is still, and starts balancing when the rate goes over 1 degree a second: the hand has let go.
بعد تجاوز 45 درجة يكون قد سقط. تتوقف العجلات على الفرملة، ويُصفَّر المكامل، وعلى الروبوت يستلقي على الأرض عند نحو 80 درجة. أنصِبه بالزر فيُمسَك من جديد، جاهزًا للمحاولة التالية.
النموذج هو نواس حقيقي على عجلات، يُحسب كل مللي ثانية، مع محركات تدفع الجسم إلى الخلف بينما تقود العجلات إلى الأمام. ما يتركه خارج الحساب هو مطبات الأرضية، والخلوص في علب التروس الرخيصة، والبطارية التي يهب جهدها، وهي الأشياء التي تجعل الروبوت الحقيقي أصعب في الضبط.
أخطاء شائعة
العجلات تدور في الاتجاه المعاكس. إذا سار الروبوت بعيدًا عن ميله سقط فورًا. بدّل سلكي أحد المحركين، أو اعكس إشارة الخرج.
الزاوية بإشارة خاطئة، لأن MPU6050 مثَّبت باتجاه مختلف. أمِله إلى الأمام بيدك وتأكد أن الزاوية تصبح موجبة قبل تشغيل المحركات إطلاقًا.
الاعتماد على المقياس التسارعي وحده. فهو يقرأ دفعات العجلات كأنها ميل. امزجه بالجيروسكوب.
ترك STBY في TB6612 دون توصيل. له مقاومة سحب إلى الأرض، فيبقى المشغّل مطفأ ولا تدور المحركات أبدًا. وصّل STBY في الدائرة أعلاه ليسقط الروبوت فور تركه.
حلقة بطيئة. الطباعة إلى الشاشة التسلسلية في كل حلقة، أو رسم شاشة OLED كاملة دفعة واحدة، يسرق الوقت الذي تحتاجه الـ PID. الكود يطبع أربع مرات في الثانية ويرسم صفًا واحدًا من OLED في كل استدعاء.
امتلاء المكامل بلا حد. بدون حد يستمر حد I في النمو أثناء إمساك الروبوت أو تعطّله. الكود يضع له سقفًا ويصفّره عند السقوط.
افتح هذه الدائرة في المحرر. Arduino Uno: روبوت ذاتي الموازنة، موصول كما يعمل في أعلى هذه الصفحة. غيّر قطعة أو قيمة وشغّله من جديد.
افتح الدائرةالأسئلة
أي حساس يحتاج الروبوت ذاتي الموازنة؟
مقياس تسارع وجيروسكوب معًا، مثل MPU6050. يعطي المقياس التسارعي الزاوية من الجاذبية، والجيروسكوب سرعة الدوران، ويمزجهما مرشّح تكميلي أو مرشّح كالمان.
كيف أضبط الـ PID في روبوت الموازنة؟
ابدأ بجعل Ki و Kd صفرًا. ارفع Kp حتى يقف تقريبًا ويبدأ بالارتجاف، ثم ارفع Kd حتى يتوقف الارتجاف، ثم أضف قليلًا من Ki ليتوقف الانزلاق.
أي مشغّل محركات هو الأفضل لروبوت الموازنة؟
TB6612FNG خيار جيد للمحركات المسنَّنة الصغيرة: كفاءته عالية وتبديله سريع. أما L298N فيعمل لكنه يهدر طاقة أكبر على شكل حرارة.
لماذا ينزلق روبوت الموازنة ويسقط؟
غالبًا لأن المكامل صغير جدًا، فلا يستطيع الحفاظ على الدفع الذي يحتاجه عند السرعة، أو لأن نقطة الموازنة ليست منتصبة تمامًا. أضف بعض Ki، أو اضبط زاوية الصفر.
واصل
ابنِ هذا على أرض الواقع
افتح المحرر وغيّر قيمة وشاهد الرقم يتحرك معها. لا شيء لتثبّته ولا حاجة إلى حساب.