ذراع روبوت بأربعة محركات سيرفو على مشغّل سيرفو PCA9685
متقدم
أو تصفّح كل الدروس.
- 526قطعة على المنضدة
- 46لوحة تعمل الآن
- 1.00xزمن حقيقي، على كل لوحة
لوحة PCA9685 هي اللوحة الزرقاء التي تحمل ستة عشر رأس سيرفو على أحد حوافها. تولّد نبضات السيرفو بنفسها، فلا يبقى على Arduino سوى إخبارها بموضع كل سيرفو. تحتاج فقط إلى سلكين من اللوحة، طرفا I2C، سواء شغّلت سيرفو واحدًا أم ستة عشر. لهذا تستخدمه مجموعات أذرع الروبوتات والحشرات سداسية الأرجل.
الدائرة أعلاه عبارة عن Arduino Uno يقود ذراع روبوت مكتبيًا بأربعة محركات سيرفو عبر PCA9685. يلتقط الذراع قطعة على اليسار، ويدور، ويضعها على اليمين ثم يعود إلى موضعه، مرارًا وتكرارًا. تُطبع كل حركة في الشاشة التسلسلية. تعمل في متصفحك بالكود أدناه.
ما تحتاجه
- Arduino Uno
- لوحة مشغّل سيرفو PCA9685 بقنوات عددها 16
- Up to sixteen hobby servos (four SG90s in a robot arm here)
- مصدر طاقة 5 فولت منفصل لمحركات السيرفو
- أسلاك التوصيل
التوصيل
| القطعة والطرف | يتصل بـ | ملاحظة |
|---|---|---|
| طرف SDA في PCA9685 | A4 | بيانات I2C في لوحة Uno |
| طرف SCL في PCA9685 | A5 | ساعة I2C في Uno، للوحة مقاومات سحب خاصة بها |
| PCA9685 VCC | 5 V | طاقة المنطق للشريحة فقط |
| PCA9685 GND | GND | مشترك مع Uno ومصدر تغذية محركات السيرفو |
| PCA9685 V+ | مصدر 5 فولت منفصل | طاقة محركات السيرفو، لا تأتي من Uno |
| القناة 0 | محرك سيرفو القاعدة | يُدير الذراع كاملة |
| القناة 1 | محرك سيرفو الكتف | يميل بالذراع العلوية |
| القناة 2 | محرك سيرفو المرفق | يميل بالذراع السفلية |
| القناة 3 | محرك سيرفو المخلب | يفتح الفكّين ويغلقهما |
مصدرا طاقة، وأرضية واحدة
لدى PCA9685 مصدرا تغذية منفصلان. VCC يغذّي الشريحة ويأتي من طرف 5 فولت في Uno. أما V+ فيغذّي محركات السيرفو وينبغي أن يأتي من مصدر 5 فولت خاص به. تسحب محركات السيرفو تيارًا كبيرًا عند حركتها، أكبر بكثير مما يجب أن يعطيه طرف 5 فولت في Uno. وتتصل كل الأطراف الأرضية معًا.
هذا هو أكبر سبب للمشكلات في المشاريع الحقيقية. محرك سيرفو يرتجف، أو Uno يعيد التشغيل عند حركة الذراع، يعني في الغالب أن المحركات تعمل من طرف 5 فولت في اللوحة نفسها.
الكود: من الزوايا إلى النبضات
يستخدم الكود مكتبة Adafruit PWM Servo Driver، وهي مضمّنة في Mokxi. pwm.begin() يوقظ الشريحة. وpwm.setPWMFreq(50) يضبط معدل النبضات الذي تتوقعه محركات السيرفو: خمسون نبضة في الثانية.
ثم يحوّل setAngle() الزاوية إلى عرض نبضة. يستخدم الكود نطاق مكتبة Servo في Arduino، وهو 544 ميكروثانية لزاوية 0 درجة و2400 ميكروثانية لزاوية 180، لذا يحوّل map() بينهما، ثم يرسل writeMicroseconds() النتيجة إلى قناة واحدة.
تنقل glide() المفاصل الأربعة إلى وضعية جديدة معًا، في 25 خطوة صغيرة بين كل منها 30 ms. هكذا تتفادى الذراع الحقيقية إتلاف التروس والاندفاع بما تحمله.
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
const int MIN_US = 544;
const int MAX_US = 2400;
void setAngle(int channel, int degrees) {
pwm.writeMicroseconds(channel, map(degrees, 0, 180, MIN_US, MAX_US));
}
void setup() {
Serial.begin(115200);
pwm.begin();
pwm.setPWMFreq(50);
setAngle(0, 90); // the base to the middle
}setPWM والعدّادات
تستخدم دروس كثيرة pwm.setPWM(channel, 0, count) بدلًا من writeMicroseconds(). تقسّم الشريحة كل دورة إلى 4096 عدّادًا. عند 50 هرتز، يساوي العدّاد الواحد نحو 4.9 ميكروثانية، فتكون نبضة سيرفو من 544 إلى 2400 ميكروثانية حوالي 111 إلى 492 عدّادًا. كلتا الطريقتين تعمل هنا.
سطر المذبذب في مثال Adafruit
يتضمن كود المثال من Adafruit السطر pwm.setOscillatorFrequency(27000000). هذا السطر يضبط المكتبة على شريحة حقيقية بعينها، لأن الشرائح الحقيقية تنحرف بنسبة قليلة عن تردد 25 MHz المقدّر لها.
الشريحة المحاكاة تعمل عند 25 MHz بالضبط. انسخ ذلك السطر إلى Mokxi وستخرج كل نبضة أقصر بنحو 8 بالمئة مما طلبت. اتركه هنا. أما على لوحتك الحقيقية، فقِس واضبطه إذا كانت محركات سيرفوك تصل قليلًا خارج المدى.
جرّبه في المحرر
غيّر الزوايا في الحلقة لتعلّم الذراع حركة جديدة. وغيّر 25 خطوة إلى 50 في glide() فتصبح كل حركة أنعم وأبطأ.
قارنه بمشروع الذراع الآلية بعصي التحكم. ذاك يشغّل الذراع نفسها من أربعة أطراف في Uno بمكتبة Servo وبدون PCA9685. أربعة محركات سيرفو تناسب Uno بأي طريقة، أما PCA9685 فهو ما يتيح لك الوصول إلى ستة عشر على سلكين.
راقب PCA9685 أثناء عمله. تحت كل قناة، تعرض اللوحة عرض النبضة التي ترسلها بالميكروثانية.
أخطاء شائعة
تغذية محركات السيرفو من طرف 5 فولت في Uno. أعطِ V+ مصدره الخاص واصلِ الأطراف الأرضية معًا.
نسيان setPWMFreq(50). تتوقع محركات السيرفو نبضة خمسين مرة في الثانية.
حدود نبضة لا تناسب محرك سيرفوك. محركات السيرفو تختلف: بعضها يريد من 1000 إلى 2000 ميكروثانية، وبعضها من 500 إلى 2500. تحقّق من محركك، واضبط قيمتي min_pulse وmax_pulse هنا لتطابقه، وإلا فلن تصل إلى المدى الكامل.
لوحتان على العنوان نفسه. كل شريحة PCA9685 تبدأ على 0x40. لتوصيل المزيد، اُلحم جمبرات العنوان على اللوحات الإضافية بحيث يكون لكل واحدة عنوانها الخاص.
افتح هذه الدائرة في المحرر. Arduino Uno: ذراع آلية على PCA9685، موصولة كما تعمل في أعلى هذه الصفحة. غيّر قطعة أو قيمة وشغّلها مرة أخرى.
افتح الدائرةالأسئلة
كم محرك سيرفو يمكن لشريحة PCA9685 التحكم بها؟
ستة عشر لكل لوحة. يمكن للوحات مشاركة سلكي I2C نفسيهما إذا كان لكل واحدة عنوانها الخاص، يُضبط بجمبرات اللحام.
أي أطراف تستخدمها PCA9685 على Arduino Uno؟
SDA إلى A4 وSCL إلى A5، مع 5 فولت وتأريض للشريحة. أما محركات السيرفو فتأخذ طاقتها من V+.
لماذا ترتجف محركات سيرفو على PCA9685؟
غالبًا لأن مصدر تغذية المحركات ضعيف أو مشترك مع Arduino. أعطِ V+ مصدر 5 فولت خاصًا يستطيع تحمّل تحرك كل المحركات في الوقت نفسه.
ما الذي لا تحاكيه Mokxi في PCA9685؟
اختلاف المذبذبات الحقيقية، ومدخل الساعة الخارجي، والعناوين الفرعية، ونداء إعادة التعيين البرمجي. تعمل الشريحة عند 25 MHz بالضبط.
واصل
ابنِ هذا على أرض الواقع
افتح المحرر وغيّر قيمة وشاهد الرقم يتحرك معها. لا شيء لتثبّته ولا حاجة إلى حساب.