تعلّم

روبوت Arduino متتبع للخط، من الحساس إلى التوجيه

متوسط

أو تصفّح كل الدروس.

  • 526قطعة على المنضدة
  • 46لوحة تعمل الآن
  • 1.00xزمن حقيقي، على كل لوحة
Arduino Uno: عربة متتبعة للخطمباشر0.000 s 0.00x
اضغط لفتحه في المحرر
A 5-channel line sensor on A0 to A4 and two motors on a TB6612FNG, on a simulated ATmega328P. Drag the tape across under the sensor.

الروبوت متتبع الخط هو أول روبوت تصنعه معظم مجموعات سيارات الروبوت. صفٌّ من الحساسات في الأمام ينظر إلى الأرض، ولوحة Arduino تحسب موضع الشريط الأسود، ثم تبطئ عجلة وتسرّع الأخرى ليبقى الشريط في المنتصف. إنه درس صغير كامل في الاستشعار واتخاذ القرار والقيادة.

الدائرة أعلاه هي لوحة Uno مع حساس خط بخمس قنوات على A0 إلى A4، ودرايفر المحركات TB6612FNG، ومحركين بعلبة تروس، وحزمة بطاريتين 18650. لا تتحرك العربة على الشاشة، لذا تتحرك الأرض بدلًا منها: اسحب المنزلق على الحساس لتحريك الشريط يمينًا أو يسارًا، وراقب تغيّر سرعة العجلتين. اضغط على المربّع الملون لوضع شريط أسود عبر المسار، فتتوقف العربة عند خط النهاية.

ما تحتاجه

  • Arduino Uno
  • A 5-channel line tracking sensor board (five TCRT5000 sensors)
  • مشغّل محركات TB6612FNG
  • محركان بعلبة تروس بجهد 6 V على هيكل بعجلتين
  • حزمة بطاريات للمحركات (بطاريتا 18650 هنا، بجهد 8.4 V عند الشحن الكامل)
  • أسلاك توصيل وشريط كهربائي أسود على أرضية فاتحة

التوصيل

القطعة والطرفيتصل بـملاحظة
الحساسات من S1 (يسار) إلى S5 (يمين)A4, A3, A2, A1, A0مستوى عالٍ فوق الخط الأسود
طرفا VCC وGND في الحساسطرفا 5 V (IOREF) وGND
أطراف TB6612: PWMA وAIN1 وAIN2الأطراف 5 و2 و4المحرك الأيسر
أطراف TB6612: PWMB وBIN1 وBIN2الأطراف 6 و7 و8المحرك الأيمن
طرف STBY في TB6612الطرف 9المستوى المنخفض يضع المشغّل في وضع النوم
طرف VCC في TB66125 Vالتغذية المنطقية
طرف VM في TB6612طرف البطارية الموجبمصدر تغذية المحركات
جميع الأطراف الأرضيةGNDالبطارية والمشغّل ولوحة Uno متصلة معًا

قراءة الخط بخمسة حساسات

كل حساس هو LED بالأشعة تحت الحمراء وحساس ضوء موجّهان نحو الأسفل. الأرضية البيضاء تعكس الضوء والشريط الأسود يمتصه، ومقارن على اللوحة يحوّل ذلك إلى إشارة رقمية بسيطة: مستوى عالٍ فوق الخط الأسود، ومستوى منخفض فوق الأبيض. لذا يقرأ الكود القنوات الخمس باستخدام digitalRead()، رغم أنها موصلة بالأطراف التناظرية.

المسافة بين كل حساسين 15 mm. يمنح الكود كل حساس موضعًا، من -30 mm للحساس S1 في اليسار إلى +30 mm للحساس S5 في اليمين، ثم يحسب متوسط مواضع الحساسات التي ترى الشريط. عندما يكون الخط تحت الحساس الأوسط يكون موضعه 0 mm. وبين S3 وS4 يراه كلاهما، فيكون المتوسط 7 mm. هذا يعطي موضعًا أدق من المسافة بين الحساسات.

التوجيه: P وD

الموضع هو الخطأ: كم يبعد الخط عن المنتصف. تبدأ العجلتان بسرعة أساس 120 من 255. يضيف الكود انعطافًا إلى العجلة اليسرى ويطرحه من اليمنى. الانعطاف يساوي KP مضروبًا في الخطأ زائد KD مضروبًا في مقدار تغيّر الخطأ منذ آخر مرة. المعامل KP يعيد العربة نحو الخط، والمعامل KD يخمد التأرجح فلا تتمايل.

عندما يكون الخط تحت الحساس الأوسط، تعرض الشاشة التسلسلية "line 0 mm left 120 right 120". اسحب الشريط إلى 15 mm يمينًا فتستقر عند "line 15 mm left 165 right 75": العجلة اليسرى أسرع، فتنعطف العربة يمينًا، عائدةً فوق الخط. اسحبه تحت S1 فتعرض "line -30 mm left 30 right 180".

الحلقة الرئيسية، من عربة تتبع الخط
void loop() {
  if (finished) return;

  int seen = 0;
  int sum = 0;
  for (int i = 0; i < 5; i++) {
    if (digitalRead(SENSORS[i]) == HIGH) {
      seen++;
      sum += (i - 2) * 15;
    }
  }

  if (seen == 5) {
    brake(leftMotor, rightMotor);
    finished = true;
    Serial.println("finish bar: stopped");
    return;
  }

  int left;
  int right;
  if (seen == 0) {
    // Lost it: turn toward where it was last.
    left = lastError >= 0 ? SEARCH : -SEARCH;
    right = -left;
    leftMotor.drive(left);
    rightMotor.drive(right);
    report("searching, last", lastError, left, right);
    delay(10);
    return;
  }

  int error = sum / seen;
  int turn = KP * error + KD * (error - lastError);
  lastError = error;
  left = clampSpeed(BASE + turn);
  right = clampSpeed(BASE - turn);
  leftMotor.drive(left);
  rightMotor.drive(right);
  report("line", error, left, right);
  delay(10);
}

فقدان الخط، وشريط النهاية

في منعطف حاد قد يفلت الشريط من الحساس الخارجي، فلا يرى أي حساس شيئًا. يتذكّر الكود آخر خطأ ويدور نحوه: عجلة إلى الأمام بسرعة 110 والأخرى إلى الخلف بسرعة 110، حتى يجد حساس الشريط من جديد. اسحب الشريط خارج الحافة اليسرى فتعرض الشاشة التسلسلية "searching, last -30 mm left -110 right 110".

اسوداد الحساسات الخمسة كلها في آن واحد يعني وجود شريط عبر المسار. يستدعي الكود brake() على المحركين ويطبع "finish bar: stopped".

المحركات والتغذية

مشغّل TB6612FNG هو جسر H لمحركين. لكل محرك، يحدد طرفان الاتجاه ويحدد طرف PWM السرعة، ويجب أن يكون STBY في مستوى عالٍ وإلا لن يتحرك شيء. مكتبة SparkFun TB6612 تغلّف ذلك: drive(150) يشغّل المحرك إلى الأمام بسرعة 150، وdrive(-150) إلى الخلف، وbrake() يوقفه.

بطاريتا 18650 مشحونتان تمامًا تعطيان 8.4 V وهذان المحركان مصنّفان لجهد 6 V، لذا لا يطلب الكود أبدًا أكثر من 180 من 255، أي نحو 5.9 V في المتوسط. في هذه الدائرة تعمل لوحة Uno من USB؛ وفي عربة حقيقية كانت الحزمة نفسها ستغذي طرف VIN في Uno عبر مفتاح.

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

أخطاء شائعة

التوجيه في الاتجاه الخاطئ. عندما يكون الخط إلى اليمين، يجب أن تدور العجلة اليسرى أسرع. إذا انعطفت عربتك بعيدًا عن الخط، بدّل الإشارة الموجبة والسالبة في سطري السرعة، أو بدّل أسلاك أحد المحركين.

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

تركيب الحساسات في موضع مرتفع جدًا. يحتاج الحساس TCRT5000 إلى أن يبعد بضعة ملّيمترات عن الأرض. وعلى مسافة تتجاوز السنتيمتر تقريبًا لا يستطيع التمييز بين الأسود والأبيض.

نسيان طرف STBY. إذا كان STBY منخفضًا أو غير موصول فإن المشغّل ينام ولا تدور المحركات أبدًا.

عدم وجود أرضية مشتركة بين البطارية والمشغّل واللوحة Uno.

سرعة كبيرة جدًا. عربة تتجاوز كل منعطف تحتاج إلى سرعة أساسية أقل أو قيمة KD أكبر قبل أن تحتاج إلى حساس أفضل.

افتح هذه الدائرة في المحرر. لوحة Arduino Uno: عربة تتبع خط، موصّلة كما تعمل في أعلى هذه الصفحة. غيّر قطعة أو قيمة ثم شغّلها مرة أخرى.

افتح الدائرة

الأسئلة

كيف يعمل روبوت متتبع الخط؟

حساسات تحت المقدمة تميّز الشريط الأسود عن أرضية فاتحة. تحسب لوحة Arduino مسافة بُعد الشريط عن المنتصف وتبطئ العجلة في الجهة التي يوجد فيها الشريط، فيعود الروبوت إلى الانعطاف فوقه.

كم حساسًا يحتاج متتبع الخط؟

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

ما هو التحكم PID في متتبع الخط؟

التناسبي والتكاملي والتفاضلي: ثلاث طرق لتحويل الخطأ إلى تصحيح في التوجيه. يستخدم هذا الروبوت P وD. الحد P يزيد قوة الانعطاف كلما ابتعد الخط، والحد D يخمد الانعطاف عندما يكون الخطأ يتقلص بالفعل.

هل يمكنني استخدام L298N بدلًا من TB6612FNG؟

نعم، التوصيلات والكود متطابقان تقريبًا: طرفا اتجاه وطرف PWM لكل محرك. يفقد L298N نحو 2 فولت في ترانزستوراته، فتصل إلى المحركات كمية أقل من طاقة البطارية. يوفّر Mokxi كلا المشغّلين.

ابنِ هذا على أرض الواقع

افتح المحرر وغيّر قيمة وشاهد الرقم يتحرك معها. لا شيء لتثبّته ولا حاجة إلى حساب.