Belajar

Robot line follower Arduino, dari sensor ke kemudi

Menengah

Atau lihat semua pelajaran.

  • 526komponen di meja kerja
  • 46board sedang berjalan
  • 1.00xwaktu nyata, di semua board
Arduino Uno: kereta pengikut garislive0.000 s 0.00x
Klik untuk membukanya di editor
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.

Line follower adalah robot pertama yang dibuat oleh sebagian besar kit mobil robot. Barisan sensor di bagian depan bawah melihat lantai, Arduino menghitung posisi strip pita hitam, lalu memperlambat satu roda dan mempercepat roda lainnya agar pita tetap di tengah. Ini pelajaran kecil dan lengkap tentang membaca, memutuskan, dan menggerakkan.

Rangkaian di atas adalah Uno dengan sensor garis lima kanal di A0 sampai A4, driver motor TB6612FNG, dua motor gearbox, dan satu paket dua sel 18650. Gerobaknya tidak bergerak di layar, jadi lantainya yang bergerak: seret slider pada sensor untuk menggeser pita ke kiri atau kanan, dan lihat kedua roda berubah kecepatan. Klik swatch untuk memasang palang hitam melintang lintasan, dan gerobak akan berhenti di garis finis.

Yang kamu butuhkan

  • Arduino Uno
  • A 5-channel line tracking sensor board (five TCRT5000 sensors)
  • Driver motor TB6612FNG
  • Dua motor gearbox 6 V pada sasis dua roda
  • Paket baterai untuk motor (dua sel 18650 di sini, 8,4 V saat penuh)
  • Kabel jumper dan pita isolasi hitam di lantai terang

Pengkabelan

Komponen dan pinDisambung keCatatan
Sensor S1 (kiri) sampai S5 (kanan)A4, A3, A2, A1, A0High di atas garis hitam
VCC dan GND sensor5 V (IOREF) dan GND
TB6612 PWMA, AIN1, AIN2Pin 5, 2, 4Motor kiri
TB6612 PWMB, BIN1, BIN2Pin 6, 7, 8Motor kanan
TB6612 STBYPin 9Low membuat driver tidur
TB6612 VCC5 VCatu daya logika
TB6612 VMBaterai +Catu daya motor
Semua groundGNDBaterai, driver, dan Uno disatukan

Membaca garis dengan lima sensor

Setiap sensor adalah LED inframerah dan sensor cahaya yang mengarah ke bawah. Lantai putih memantulkan cahaya dan pita hitam menyerapnya, lalu komparator di board mengubahnya menjadi sinyal digital biasa: high di atas garis hitam, low di atas putih. Jadi sketch membaca lima kanal itu dengan digitalRead(), meskipun tersambung ke pin analog.

Sensor dipasang dengan jarak 15 mm. Sketch memberi setiap sensor sebuah posisi, dari -30 mm untuk S1 di kiri sampai +30 mm untuk S5 di kanan, lalu merata-ratakan posisi sensor yang melihat pita. Tepat di bawah sensor tengah, garisnya ada di 0 mm. Antara S3 dan S4, keduanya melihatnya, dan rata-ratanya 7 mm. Itu memberi posisi yang lebih halus daripada jarak antar sensor.

Kemudi: P dan D

Posisi itulah errornya: seberapa jauh garis dari tengah. Kedua roda mulai dengan kecepatan dasar 120 dari 255. Sketch menambah belokan ke roda kiri dan menguranginya dari roda kanan. Belokan itu KP dikali error ditambah KD dikali perubahan error sejak terakhir kali. KP menarik gerobak kembali ke garis; KD meredam ayunan agar tidak zig-zag.

Saat garis di bawah sensor tengah, serial monitor menampilkan "line 0 mm left 120 right 120". Geser pita ke 15 mm kanan dan ia stabil di "line 15 mm left 165 right 75": roda kiri lebih cepat, jadi gerobak berbelok ke kanan, kembali ke garis. Geser ke bawah S1 dan ia menampilkan "line -30 mm left 30 right 180".

Loop utama, dari gerobak pengikut garis
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);
}

Kehilangan garis, dan palang finis

Di tikungan tajam pita bisa lolos dari sensor paling luar, lalu tidak ada sensor yang melihat apa pun. Sketch mengingat error terakhir dan berputar ke arah itu: satu roda maju di 110, yang lain mundur di 110, sampai sensor menemukan pita lagi. Seret pita keluar dari tepi kiri dan serial monitor menampilkan "searching, last -30 mm left -110 right 110".

Kelima sensor hitam sekaligus berarti ada palang melintang di lintasan. Sketch memanggil brake() pada kedua motor dan mencetak "finish bar: stopped".

Motor dan daya

TB6612FNG adalah H-bridge untuk dua motor. Untuk setiap motor, dua pin mengatur arah dan satu pin PWM mengatur kecepatan, dan STBY harus high atau tidak ada yang bergerak. Library SparkFun TB6612 membungkus semuanya: drive(150) menjalankan motor maju di 150, drive(-150) menjalankannya mundur, dan brake() menghentikannya.

Dua sel 18650 penuh menghasilkan 8,4 V dan motor ini memiliki rating 6 V, jadi sketch tidak pernah meminta lebih dari 180 dari 255, sekitar 5,9 V rata-rata. Di rangkaian ini Uno berjalan dari USB; di gerobak sungguhan paket yang sama akan mengisi pin VIN Uno melalui saklar.

Mokxi memodelkan driver dan motornya, tetapi bukan gerobak yang bergerak di lantai, jadi tidak ada momentum yang membawanya keluar tikungan dan tidak ada cengkeraman yang bisa hilang. Itulah yang kamu sesuaikan dengan KP, KD, dan kecepatan dasar di lintasan sungguhan.

Kesalahan umum

Kemudi ke arah yang salah. Saat garis di kanan, roda kiri harus berputar lebih cepat. Kalau gerobakmu berbelok menjauhi garis, tukar tanda plus dan minus di dua baris kecepatan, atau tukar kabel salah satu motor.

Membaca sensor secara terbalik. Di board ini high berarti hitam. Beberapa board sebaliknya; cetak lima pembacaan dulu dan periksa.

Memasang sensor terlalu tinggi. TCRT5000 perlu berjarak beberapa milimeter di atas lantai. Lebih dari sekitar satu sentimeter, ia tidak bisa membedakan hitam dari putih.

Lupa STBY. Jika STBY low atau tidak tersambung, driver akan tidur dan motor tidak pernah berputar.

Tidak ada ground bersama antara baterai, driver, dan Uno.

Terlalu cepat. Gerobak yang selalu meleset di setiap tikungan butuh kecepatan dasar yang lebih rendah atau KD yang lebih besar sebelum butuh sensor yang lebih baik.

Buka rangkaian ini di editor. Arduino Uno: gerobak pengikut garis, dirangkai seperti yang dijalankan di bagian atas halaman ini. Ubah satu komponen atau nilainya dan jalankan lagi.

Buka rangkaian ini

Pertanyaan

Bagaimana robot line follower bekerja?

Sensor di bawah bagian depan membedakan selotip hitam dari lantai terang. Arduino menghitung seberapa jauh selotip dari tengah dan memperlambat roda di sisi tempat selotip berada, jadi robot berbelok kembali ke arahnya.

Berapa banyak sensor yang dibutuhkan line follower?

Dua sensor bisa mengikuti garis yang lembut. Lima, seperti di sini, memberikan posisi, bukan hanya kiri atau kanan, sehingga belokan jadi halus, dan robot bisa melihat garis finis melintang di lintasan.

Apa itu PID pada pengikut garis?

Proportional, integral, dan derivative: tiga cara mengubah error menjadi koreksi arah. Robot ini memakai P dan D. Suku P makin keras membelok makin jauh garisnya; suku D meredam belokan saat error sudah menyempit.

Bisakah aku memakai L298N sebagai pengganti TB6612FNG?

Bisa, kabel dan kodenya hampir sama: dua pin arah dan satu pin PWM per motor. L298N kehilangan sekitar 2 volt di transistornya, jadi motor mendapat lebih sedikit daya dari baterai. Mokxi punya kedua driver.

Rakit versi nyatanya

Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.