Một xe robot tránh vật cển Arduino
Trung bình
Hoặc xem mọi bài học.
- 526linh kiện trên bàn làm mạch
- 46bo mạch đang chạy
- 1.00xthời gian thực, trên mọi bo mạch
Robot tránh vật cản là một trong những dự án Arduino phổ biến nhất, và cũng đáng như vậy. Đây là dự án đầu tiên mà code của bạn tự ra quyết định. Xe chạy tới, nhìn phía trước, và rẽ tránh khi có thứ gì đó đến gần.
Mạch trên là một bản dựng thật: Arduino Uno, driver động cơ L298N, khung xe robot 2WD và cảm biến siêu âm HC-SR04 ở phía trước. Nhấn Chạy và xe chạy ngang qua sàn được vẽ bên trong khung xe. Kéo thanh trượt của cảm biến để đặt vật trước nó, và xem xe dừng, lùi, rẽ rồi tiếp tục. Tất cả chạy ngay trong trình duyệt với sketch bên dưới.
Những gì bạn cần
- Một Arduino Uno
- Khung xe robot 2WD với hai động cơ TT có hộp số
- Một module driver động cơ L298N
- Một cảm biến siêu âm HC-SR04
- Bộ pin từ 7 V trở lên, chẳng hạn bộ pin 7.4 V hai cell
- Dây cắm
Đi dây
| Linh kiện và chân | Nối tới | Ghi chú |
|---|---|---|
| TRIG của HC-SR04 | Chân 12 | Bắt đầu một ping |
| ECHO của HC-SR04 | Chân 11 | HIGH trong thời gian âm thanh quay về |
| VCC của HC-SR04 | L298N 5V | Bộ ổn áp của driver tạo 5 V từ pin |
| GND của HC-SR04 | GND | Chung mass |
| L298N ENA, IN1, IN2 | Chân 5, 6, 7 | Động cơ bên trái; tháo jumper ENA |
| L298N ENB, IN3, IN4 | Chân 10, 8, 9 | Động cơ bên phải; tháo jumper ENB |
| L298N 12V | Cực dương pin | Bộ pin 7.4 V, bật jumper ổn áp |
| L298N GND | Cực âm pin và GND của Uno | Tất cả các chân GND nối chung |
| OUT1, OUT2 | Động cơ trái | Đổi chỗ nếu bánh xe quay ngược |
| OUT3, OUT4 | Động cơ phải | Đổi chỗ nếu bánh xe quay ngược |
Nhìn trước rồi mới quyết định
Cả chiếc xe chỉ là một vòng lặp ngắn. Đầu tiên nó đọc khoảng cách. Nếu không có gì gần hơn 25 cm (khoảng 10 inch), xe chạy thẳng. Nếu có, xe dừng, lùi lại 400 ms, quay phải 450 ms rồi nhìn lại.
Vòng lặp chờ 60 ms giữa hai lần phát sóng. Tài liệu HC-SR04 yêu cầu khoảng lặng chừng đó để tiếng vọng trước tắt hẳn trước khi lần phát sau đi ra.
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);
}Đọc khoảng cách
HC-SR04 như một chiếc đồng hồ bấm giờ cho âm thanh. Uno giữ TRIG ở mức HIGH trong 10 microgiây. Cảm biến phát một xung siêu âm ngắn, rồi giữ ECHO ở mức HIGH đúng bằng thời gian âm thanh bật ngược về. Ở nhiệt độ phòng, âm thanh đi một xen-ti-mét rồi quay về mất khoảng 58 microgiây.
Ví dụ dùng một hàm hỗ trợ nhỏ, mokxi_hcsr04.h, lo phần đo thời gian và trả về milimét. Bạn cũng có thể tự làm bằng pulseIn(), ở đây nó hoạt động giống như trên Uno thật. Bài hướng dẫn về cảm biến siêu âm của chúng tôi có trình bày phiên bản đó.
Số đọc bằng 0 nghĩa là không có tiếng vọng nào quay về. Sketch coi đó là "không có gì ở đó", chứ không phải "sát ngay cảm biến". Chính phép kiểm tra đó giúp xe không hoảng loạn trong căn phòng trống.
Điều khiển động cơ
Các động cơ dùng cùng hàm drive() như trong bài hướng dẫn L298N của chúng tôi. Mỗi bên nhận một tốc độ từ -255 đến 255. Hai bên tiến là chạy thẳng. Một bên tiến một bên lùi là quay tại chỗ.
Xe chạy với tốc 200 trên 255, không phét hết ga. Như vậy xe có thêm chút thời gian để phản ứng. L298N cũng giữ lại khoảng 2.5 V của pin cho chính nó, nên động cơ nhận được ít hơn 7.4 V của bộ pin.
Thử trong trình soạn thảo
Đổi STOP_MM từ 250 thành 400 thì xe rẽ tránh sớm hơn. Đổi 450 ms quay thành một thời gian ngẫu nhiên từ 300 đến 700 ms bằng random(), để xe không bị kẹt mãi ở một góc.
In khoảng cách ở mỗi vòng lặp và mở Serial Plotter. Kéo thanh trượt qua lại và xem đường cắt qua điểm dừng 250 mm.
Những lỗi thường gặp
Một bánh xe quay ngược. Hai động cơ nằm đối xứng nhau trên khung xe. Đổi chỗ hai dây của động cơ đó ở mạch điều khiển.
Xe xoay vòng tròn mãi. Kiểm tra xem cả hai chân enable đã được nối dây và cả hai jumper đã tháo ra chưa, nếu không một bên sẽ luôn chạy hết công suất.
Uno bị reset khi động cơ khởi động. Trên xe thật, động cơ làm pin tụt điện áp trong chốc lát. Một bộ pin mới, hoặc một nguồn riêng cho Uno, sẽ khắc phục được.
Phát sóng quá nhanh. Để cách nhau ít nhất 60 ms giữa hai lần phát, nếu không tiếng vọng cũ có thể quay về thành số đọc mới.
Mở mạch này trong trình soạn thảo. Arduino Uno: xe tránh vật cản, được nối dây như đang chạy ở đầu trang này. Đổi một linh kiện hoặc một giá trị rồi chạy lại.
Mở mạchCâu hỏi
Tôi cần những linh kiện gì cho một robot tránh vật cản?
Một bo mạch Arduino Uno, một khung xe 2WD với hai động cơ có bánh răng, một mạch điều khiển động cơ L298N, một cảm biến siêu âm HC-SR04, một bộ pin 7 V trở lên và các dây cắm.
Tôi lấy code cho robot tránh vật cản ở đâu?
Toàn bộ sketch nằm trên trang dự án của trang này, và chỉ một cú nhấp là mở được trong trình soạn thảo. Bạn có thể chỉnh sửa và chạy trên chiếc xe mô phỏng trước khi làm chiếc thật.
Tôi có thể dùng cảm biến IR thay cho cảm biến siêu âm không?
Được. Một module IR tránh vật cản như FC-51 cho ra mức HIGH hoặc LOW đơn giản khi có vật ở gần, nên phép kiểm tra chỉ còn một digitalRead. Nó có tầm ngắn hơn và không cho biết vật cách bao xa. FC-51 cũng có trong hộp linh kiện của Mokxi.
Chiếc xe mô phỏng có đâm vào tường thật không?
Không. Sàn bên trong khung xe phẳng và không có tường. Thanh trượt của HC-SR04 chính là vật cản, nên bạn quyết định nó cách bao xa. Xe cũng chạy thẳng tuyệt đối, trong khi xe thật thường bị lệch đi một chút.
Tiếp tục nào
Lắp mạch này ngoài đời
Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.