Öğren

Bir Arduino çizgi izleyen robot, sensörden direksiyona

Orta

Ya da tüm dersleri gör.

  • 526parça tezgahta
  • 46kart şu an çalışıyor
  • 1.00xgerçek zamanlı, her kartta
Arduino Uno: çizgi takip eden arabacanlı0.000 s 0.00x
Düzenleyicide açmak için tıkla
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.

Çizgi izleyen robot, çoğu robot araba kitinin ilk yaptığı robottur. Öndeki bir sıra sensör zemine bakar, Arduino siyah bandın nerede olduğunu hesaplar ve bandı ortada tutmak için bir tekerleği yavaşlatıp diğerini hızlandırır. Bu, algılama, karar verme ve sürme konularında küçük ama eksiksiz bir derstir.

Yukarıdaki devre, A0 ile A4 arasında beş kanallı bir çizgi sensörü, bir TB6612FNG motor sürücüsü, iki redüktörlü motor ve iki 18650 hücreden oluşan bir batarya takımı içeren bir Uno'dur. Araba ekranda hareket etmez, bu yüzden zemin hareket eder: bandı sola veya sağa kaydırmak için sensörün üzerindeki kaydırıcıyı sürükle ve iki tekerleğin hız değiştirdiğini izle. Renk örneğine tıklayarak pistin üzerine siyah bir çubuk ser, araba bitiş çizgisinde durur.

Neye ihtiyacın var?

  • Bir Arduino Uno
  • A 5-channel line tracking sensor board (five TCRT5000 sensors)
  • Bir TB6612FNG motor sürücüsü
  • İki tekerlekli şaside iki 6 V redüktörlü motor
  • Motorlar için batarya takımı (burada iki 18650 hücre, doluyken 8.4 V)
  • Jumper kablolar ve açık renk zeminde siyah elektrik bandı

Kablolama

Parça ve pinGittiği yerNot
Sensör S1 (sol) ile S5 (sağ)A4, A3, A2, A1, A0Siyah çizginin üzerindeyken yüksek
Sensör VCC ve GND5 V (IOREF) ve GND
TB6612 PWMA, AIN1, AIN2Pin 5, 2 ve 4Sol motor
TB6612 PWMB, BIN1, BIN2Pin 6, 7, 8Sağ motor
TB6612 STBYPin 9Düşük seviye sürücüyü uykuya alır
TB6612 VCC5 VMantık beslemesi
TB6612 VMPil +Motor beslemesi
Tüm topraklarGNDPil, sürücü ve Uno birleştirildi

Çizgiyi beş sensörle okumak

Her sensör aşağı bakan bir kızılötesi LED ve bir ışık sensöründen oluşur. Beyaz zemin ışığı yansıtır, siyah bant emer ve karttaki bir karşılaştırıcı bunu sade bir dijital sinyale çevirir: siyah çizginin üzerinde yüksek, beyaz üzerinde düşük. Böylece kod, analog pinlere bağlı olsalar bile beş kanalı digitalRead() ile okur.

Sensörler 15 mm arayla dizilidir. Kod her birine bir konum verir: soldaki S1 için -30 mm'den sağdaki S5 için +30 mm'ye kadar, ve bandı gören sensörlerin konumlarının ortalamasını alır. Orta sensörün altında çizgi 0 mm'dedir. S3 ile S4 arasında ikisi de görür ve ortalama 7 mm olur. Bu, sensör aralığından daha ince bir konum verir.

Direksiyon: P ve D

Konum hata değeridir: çizginin ortadan ne kadar uzak olduğu. İki tekerlek 255 üzerinden 120 temel hızla başlar. Kod sol tekerleğe dönüş ekler, sağından çıkarır. Dönüş, KP ile hatanın ve KD ile hatanın son seferden beri ne kadar değiştiğinin çarpımlarının toplamıdır. KP arabayı çizgiye geri çeker; KD salınımı söndürür ki araba sallanmasın.

Çizgi orta sensörün altındayken seri monitör "line 0 mm left 120 right 120" yazar. Bandı 15 mm sağa kaydır ve "line 15 mm left 165 right 75" değerine oturur: sol tekerlek daha hızlı, yani araba sağa, çizginin üzerine geri döner. Bandı S1'in altına kaydır ve "line -30 mm left 30 right 180" yazar.

Çizgi izleyen arabadan ana döngü
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);
}

Çizgiyi kaybetmek ve bitiş çubuğu

Keskin bir virajda bant dıştaki sensörün yanından kaçabilir ve o zaman hiçbir sensör bir şey görmez. Kod son hatayı hatırlar ve o yöne doğru döner: bir tekerlek 110 hızıyla ileri, diğeri 110 hızıyla geri gider, ta ki bir sensör bandı yeniden bulana kadar. Bandı sol kenardan çek ve seri monitör "searching, last -30 mm left -110 right 110" yazar.

Beş sensörün aynı anda siyah görmesi pistin üzerinde bir çubuk olduğu demektir. Kod her iki motorda brake() çağırır ve "finish bar: stopped" yazdırır.

Motorlar ve güç

TB6612FNG iki motor için bir H-köprüsüdür. Her motor için iki pin yönü, bir PWM pin hızı belirler ve STBY'nin yüksek olması gerekir, yoksa hiçbir şey kıpırdamaz. SparkFun TB6612 kütüphanesi tüm bunları kolaylaştırır: drive(150) motoru 150 hızıyla ileri çalıştırır, drive(-150) geri çalıştırır ve brake() durdurur.

İki dolu 18650 hücre 8.4 V verir ve bu motorlar 6 V içindir, bu yüzden kod hiçbir zaman 255 üzerinden 180'den fazlasını istemez, ortalama yaklaşık 5.9 V. Bu devrede Uno USB ile çalışır; gerçek bir arabada aynı pil takımı bir anahtar üzerinden Uno'nun VIN pinini besler.

Mokxi sürücüyü ve motorları modeller ama zeminde hareket eden arabayı modellemez, yani virajdan savuran bir momentum ya da kaybedilecek bir tutuş yoktur. Gerçek bir pistte KP, KD ve temel hızı tam bunlar için ayarlarsın.

Sık yapılan hatalar

Yanlış yöne dönme. Çizgi sağdaysa sol tekerlek daha hızlı dönmelidir. Araban çizgiden uzaklaşıyorsa iki hız satırındaki artı ve eksi işaretlerini yer değiştir, ya da bir motorun kablolarını ters çevir.

Sensörü ters okumak. Bu kartta yüksek seviye siyah demektir. Bazı kartlar tam tersidir; önce beş okumayı yazdır ve kontrol et.

Sensörleri çok yükseğe takmak. Bir TCRT5000'nin zeminden birkaç milimetre yukarıda olması gerekir. Yaklaşık bir santimetreden fazlasında siyah ile beyazı ayırt edemez.

STBY'yi unutmak. STBY düşük seviyede veya bağlı değilse sürücü uyur ve motorlar hiç dönmez.

Pil, sürücü ve Uno arasında ortak toprak olmaması.

Fazla hız. Her virajı kaçan bir araba, daha iyi bir sensörden önce daha düşük bir temel hıza veya daha fazla KD'ye ihtiyaç duyar.

Bu devreyi düzenleyicide aç. Arduino Uno: bu sayfanın üstünde çalıştığı haliyle kablolanmış bir çizgi izleyen araba. Bir parçayı veya değeri değiştir ve yeniden çalıştır.

Devreyi aç

Sorular

Çizgi takip robotu nasıl çalışır?

Öndeki sensörler siyah bandı açık bir zeminden ayırır. Arduino, bandın ortadan ne kadar uzakta olduğunu hesaplar ve bandın bulunduğu taraftaki tekerleği yavaşlatır, böylece robot üzerinde geri döner.

Bir çizgi takip robotu kaç sensöre ihtiyaç duyar?

İki sensör hafif bir çizgiyi izleyebilir. Buradaki gibi beşi, sadece sol veya sağ yerine bir konum verir; bu da yumuşak direksiyona izin verir ve robotun pistin üzerinden geçen bitiş çizgisini görmesini sağlar.

Çizgi izleyende PID nedir?

Oransal, integral ve türev: hatayı bir direksiyon düzeltmesine çevirmenin üç yolu. Bu robot P ve D kullanır. P terimi çizgi uzaklaştıkça daha sert döner; D terimi ise hata zaten küçülürken dönüşü söndürür.

TB6612FNG yerine L298N kullanabilir miyim?

Evet, kablolama ve kod neredeyse aynıdır: motor başına iki yön pini ve bir PWM pini. L298N transistörlerinde yaklaşık 2 volt kaybolur, yani motorlar pilin daha azını alır. Mokxi'de her iki sürücü de var.

Bunu gerçekten kur

Düzenleyiciyi aç, bir değeri değiştir ve sayının onunla birlikte değiştiğini izle. Kurulacak bir şey yok, hesaba da gerek yok.