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
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 pin | Disambung ke | Catatan |
|---|---|---|
| Sensor S1 (kiri) sampai S5 (kanan) | A4, A3, A2, A1, A0 | High di atas garis hitam |
| VCC dan GND sensor | 5 V (IOREF) dan GND | |
| TB6612 PWMA, AIN1, AIN2 | Pin 5, 2, 4 | Motor kiri |
| TB6612 PWMB, BIN1, BIN2 | Pin 6, 7, 8 | Motor kanan |
| TB6612 STBY | Pin 9 | Low membuat driver tidur |
| TB6612 VCC | 5 V | Catu daya logika |
| TB6612 VM | Baterai + | Catu daya motor |
| Semua ground | GND | Baterai, 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".
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 iniPertanyaan
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.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.