Sebuah mobil robot penghindar halangan Arduino
Menengah
Atau lihat semua pelajaran.
- 526komponen di meja kerja
- 46board sedang berjalan
- 1.00xwaktu nyata, di semua board
Robot penghindar halangan adalah salah satu proyek Arduino paling populer, dan itu wajar. Ini proyek pertama di mana kode kamu membuat keputusan sendiri. Mobilnya maju, melihat ke depan, dan berbelok saat ada sesuatu mendekat.
Rangkaian di atas adalah build yang sesungguhnya: Arduino Uno, driver motor L298N, sasis mobil robot 2WD, dan sensor ultrasonik HC-SR04 di depan. Tekan Jalankan dan mobil akan melaju di lantai yang digambar di dalam sasis. Geser slider sensor untuk menaruh sesuatu di depannya, dan lihat mobil berhenti, mundur, berbelok, lalu melanjutkan. Semuanya berjalan di browser kamu dengan sketch di bawah ini.
Yang kamu butuhkan
- Arduino Uno
- Sasis mobil robot 2WD dengan dua motor gear TT
- Satu modul driver motor L298N
- Sensor ultrasonik HC-SR04
- Baterai 7 V atau lebih, misalnya baterai dua sel 7.4 V
- Kabel jumper
Pengkabelan
| Komponen dan pin | Disambung ke | Catatan |
|---|---|---|
| HC-SR04 TRIG | Pin 12 | Memulai ping |
| HC-SR04 ECHO | Pin 11 | HIGH selama waktu yang dibutuhkan suara untuk kembali |
| HC-SR04 VCC | L298N 5V | Regulator pada driver membuat 5 V dari baterainya |
| HC-SR04 GND | GND | Ground bersama |
| ENA, IN1, IN2 pada L298N | Pin 5, 6, 7 | Motor kiri; jumper ENA dilepas |
| ENB, IN3, IN4 pada L298N | Pin 10, 8, 9 | Motor kanan; jumper ENB dilepas |
| L298N 12V | Baterai + | Baterai 7,4 V, jumper regulator dipasang |
| L298N GND | Baterai - dan GND Uno | Semua ground disatukan |
| OUT1, OUT2 | Motor kiri | Tukar jika rodanya berjalan mundur |
| OUT3, OUT4 | Motor kanan | Tukar jika rodanya berjalan mundur |
Lihat dulu, lalu tentukan
Seluruh robot hanya satu loop pendek. Pertama ia membaca jarak. Kalau tidak ada apa pun yang lebih dekat dari 25 cm (sekitar 10 inci), ia maju. Kalau ada, ia berhenti, mundur selama 400 ms, berputar ke kanan selama 450 ms, lalu melihat lagi.
Loop ini menunggu 60 ms antar ping. Datasheet HC-SR04 meminta waktu tenang sebanyak itu, supaya echo terakhir sudah hilang sebelum ping berikutnya dikirim.
void loop() {
uint16_t mm = sonar.read();
if (mm != 0 && mm < STOP_MM) {
Serial.print("obstacle at ");
Serial.print(mm);
Serial.println(" mm: back up and turn");
drive(0, 0);
delay(200);
drive(-CRUISE, -CRUISE);
delay(400);
drive(CRUISE, -CRUISE);
delay(450);
drive(0, 0);
delay(100);
} else {
drive(CRUISE, CRUISE);
}
delay(60);
}Membaca jarak
HC-SR04 itu seperti stopwatch untuk suara. Uno menahan TRIG HIGH selama 10 mikrodetik. Sensor mengirim semburan pendek ultrasonik, lalu menahan ECHO HIGH selama waktu yang dibutuhkan suara untuk memantul kembali. Pada suhu ruang, suara menempuh satu sentimeter bolak-balik dalam sekitar 58 mikrodetik.
Contoh ini memakai helper kecil, mokxi_hcsr04.h, yang menghitung waktunya dan mengembalikan hasil dalam milimeter. Kamu juga bisa melakukannya sendiri dengan pulseIn(), yang di sini bekerja sama seperti di Uno sungguhan. Tutorial sensor ultrasonik kami menunjukkan versi itu.
Hasil baca 0 berarti tidak ada echo yang kembali sama sekali. Sketch menganggapnya "tidak ada apa pun di sana", bukan "persis di depan sensor". Satu pengecekan itu mencegah mobil panik di ruangan kosong.
Menggerakkan motor
Motor memakai helper drive() yang sama dengan tutorial L298N kami. Setiap sisi menerima kecepatan dari -255 sampai 255. Kedua sisi maju berarti lurus ke depan. Satu maju dan satu mundur berarti berputar di tempat.
Mobil melaju di kecepatan 200 dari 255, bukan kecepatan penuh. Itu memberinya sedikit waktu ekstra untuk bereaksi. L298N juga menyimpan sekitar 2,5 V dari baterai untuk dirinya sendiri, jadi motor menerima kurang dari 7,4 V dari baterai.
Coba di editor
Ubah STOP_MM dari 250 ke 400 dan mobil akan berbelok lebih awal. Ubah putaran 450 ms menjadi waktu acak antara 300 dan 700 ms dengan random(), supaya tidak terjebak di sudut yang sama.
Cetak jarak di setiap loop dan buka Serial Plotter. Geser slider bolak-balik dan lihat garisnya melewati titik berhenti 250 mm.
Kesalahan umum
Satu roda berjalan mundur. Motor terpasang saling cermin di sasis. Tukar dua kabel motor itu di driver.
Mobil berputar terus-menerus. Pastikan kedua pin enable tersambung dan kedua jumper dilepas, kalau tidak satu sisi akan selalu berjalan kencang penuh.
Uno mereset saat motor menyala. Di mobil sungguhan, motor menurunkan tegangan baterai sejenak. Baterai baru, atau catu daya terpisah untuk Uno, memperbaikinya.
Ping terlalu cepat. Beri jeda minimal 60 ms antar ping, atau echo lama bisa kembali terbaca sebagai hasil baru.
Buka rangkaian ini di editor. Arduino Uno: mobil penghindar halangan, dengan kabel seperti yang berjalan di bagian atas halaman ini. Ubah komponen atau nilainya dan jalankan lagi.
Buka rangkaian iniPertanyaan
Komponen apa saja yang kubutuhkan untuk robot penghindar halangan?
Arduino Uno, sasis 2WD dengan dua motor gear, driver motor L298N, sensor ultrasonik HC-SR04, baterai 7 V atau lebih, dan kabel jumper.
Dari mana kudapat kode untuk robot penghindar halangan?
Sketch lengkapnya ada di halaman proyek halaman ini, dan terbuka di editor dengan satu klik. Kamu bisa mengubahnya dan menjalankannya di mobil simulasi sebelum membuat yang sungguhan.
Bisakah aku memakai sensor IR alih-alih sensor ultrasonik?
Bisa. Modul deteksi halangan IR seperti FC-51 memberi HIGH atau LOW biasa saat ada yang dekat, jadi pengecekannya cukup satu digitalRead. Jangkauannya lebih pendek dan tidak bisa memberi tahu seberapa jauh benda itu. FC-51 juga ada di kotak komponen Mokxi.
Apakah mobil simulasi menabrak dinding sungguhan?
Tidak. Lantai di dalam sasis datar dan tanpa dinding. Slider HC-SR04-lah halangannya, jadi kamulah yang menentukan seberapa jauh jaraknya. Mobil juga melaju lurus sempurna, sementara mobil sungguhan sedikit menyimpang.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.