Học

Một robot dò đường Arduino, từ cảm biến đến tay lái

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
Arduino Uno: xe bốn bánh dò đườngtrực tiếp0.000 s 0.00x
Nhấp để mở trong trình soạn thảo
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.

Robot dò đường là robot đầu tiên mà hầu hết các bộ kit robot thường làm. Một hàng cảm biến nằm dưới đầu xe nhìn xuống sàn, Arduino tính xem dải băng dính đen đang ở đâu, rồi làm chậm một bánh xe và tăng tốc bánh kia để giữ băng dính ở giữa. Đó là một bài học nhỏ nhưng trọn vẹn về cảm biến, ra quyết định và điều khiển.

Mạch ở trên là một bo mạch Uno với cảm biến dò đường năm kênh trên A0 đến A4, driver động cơ TB6612FNG, hai động cơ có hộp số và một cục pin hai cell 18650. Xe không di chuyển trên màn hình, nên sàn sẽ di chuyển thay: kéo thanh trượt trên cảm biến để trượt băng dính sang trái hay phải, và xem hai bánh xe đổi tốc độ. Bấm vào ô màu để đặt một vạch đen ngang đường đua, xe sẽ dừng ở vạch đích.

Những gì bạn cần

  • Một Arduino Uno
  • A 5-channel line tracking sensor board (five TCRT5000 sensors)
  • Driver động cơ TB6612FNG
  • Hai động cơ hộp số 6 V trên khung hai bánh xe
  • Cục pin cho động cơ (ở đây là hai cell 18650, 8.4 V khi đầy)
  • Dây cắm và băng dính điện màu đen trên sàn sáng màu

Đi dây

Linh kiện và chânNối tớiGhi chú
Cảm biến S1 (trái) đến S5 (phải)A4, A3, A2, A1, A0Mức cao trên vạch đen
VCC và GND của cảm biến5 V (IOREF) và GND
TB6612 PWMA, AIN1, AIN2Chân 5, 2, 4Động cơ bên trái
TB6612 PWMB, BIN1, BIN2Chân 6, 7, 8Động cơ bên phải
TB6612 STBYChân 9Mức thấp cho driver ngủ
TB6612 VCC5 VNguồn cấp cho phần logic
TB6612 VMCực dương pinNguồn cho động cơ
Tất cả các chân GNDGNDPin, driver và Uno nối chung

Đọc vạch bằng năm cảm biến

Mỗi cảm biến gồm một LED hồng ngoại và một cảm biến ánh sáng chiếu xuống dưới. Sàn trắng phản xạ ánh sáng còn băng dính đen hút ánh sáng, và một bộ so sánh trên bo mạch biến điều đó thành tín hiệu digital đơn giản: mức cao trên vạch đen, mức thấp trên nền trắng. Vì vậy sketch đọc năm kênh bằng digitalRead(), dù chúng được nối vào các chân analog.

Các cảm biến cách nhau 15 mm. Sketch gán cho mỗi cảm biến một vị trí, từ -30 mm cho S1 bên trái đến +30 mm cho S5 bên phải, và lấy trung bình vị trí của những cảm biến nhìn thấy băng dính. Khi vạch nằm dưới cảm biến giữa, vạch ở 0 mm. Giữa S3 và S4, cả hai cùng thấy vạch, trung bình là 7 mm. Cách này cho vị trí chính xác hơn khoảng cách giữa các cảm biến.

Tay lái: P và D

Vị trí chính là sai số: vạch lệch bao xa so với giữa. Hai bánh xe đều xuất phát ở tốc độ cơ bản 120 trên 255. Sketch cộng một lượng rẽ vào bánh trái và trừ đi ở bánh phải. Lượng rẽ bằng KP nhân sai số cộng KD nhân với mức thay đổi của sai số so với lần trước. KP kéo xe về phía vạch; KD giảm dao động để xe không lắc lư.

Khi vạch nằm dưới cảm biến giữa, Serial Monitor hiện "line 0 mm left 120 right 120". Trượt băng dính sang phải 15 mm thì ổn định ở "line 15 mm left 165 right 75": bánh trái nhanh hơn, nên xe rẽ phải, quay lại vạch. Trượt vạch xuống dưới S1 thì hiện "line -30 mm left 30 right 180".

Vòng lặp chính, từ xe 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);
}

Mất vạch, và vạch đích

Ở khúc cua gắt, băng dính có thể trượt qua ngoài cảm biến ngoài cùng, lúc đó không cảm biến nào nhìn thấy gì. Sketch ghi nhớ sai số trước đó và quay về phía đó: một bánh tiến ở mức 110, bánh kia lùi ở mức 110, cho đến khi một cảm biến tìm lại được băng dính. Kéo băng dính ra khỏi mép trái thì Serial Monitor hiện "searching, last -30 mm left -110 right 110".

Cả năm cảm biến cùng đen một lúc nghĩa là có một vạch ngang đường đua. Sketch gọi brake() trên cả hai động cơ và in ra "finish bar: stopped".

Động cơ và nguồn

TB6612FNG là một mạch cầu H cho hai động cơ. Với mỗi động cơ, hai chân đặt chiều quay và một chân PWM đặt tốc độ, còn STBY phải ở mức cao không thì chẳng gì chạy cả. Thư viện SparkFun TB6612 gói gọn tất cả: drive(150) chạy động cơ tiến ở mức 150, drive(-150) chạy lùi, và brake() dừng lại.

Hai cell 18650 đầy cho ra 8.4 V còn các động cơ này định mức 6 V, nên sketch không bao giờ yêu cầu quá 180 trên 255, khoảng 5.9 V trung bình. Trong mạch này Uno chạy từ USB; trên xe thật thì cục pin đó sẽ cấp cho chân VIN của Uno qua một công tắc.

Mokxi mô phỏng driver và các động cơ, nhưng không mô phỏng xe chạy trên sàn, nên không có quán tính kéo xe trượt khỏi khúc cua và cũng không có độ bám để mất. Đó là những thứ bạn phải tinh chỉnh KP, KD và tốc độ cơ bản trên đường đua thật.

Những lỗi thường gặp

Rẽ nhầm chiều. Khi vạch nằm bên phải, bánh trái phải chạy nhanh hơn. Nếu xe của bạn rẽ ra khỏi vạch, hãy đổi dấu cộng và trừ ở hai dòng tốc độ, hoặc hoán đổi dây của một động cơ.

Đọc cảm biến bị ngược chiều. Trên bo mạch này, mức cao nghĩa là màu đen. Một số bo mạch thì ngược lại; hãy in ra năm số đọc trước rồi kiểm tra.

Gắn cảm biến quá cao. Một TCRT5000 cần cách sàn vài milimet. Quá khoảng một xen-ti-mét là nó không phân biệt được đen với trắng.

Quên chân STBY. Khi STBY ở mức thấp hoặc không nối thì driver ngủ và động cơ không bao giờ quay.

Không có mass chung giữa pin, driver và Uno.

Tốc độ quá cao. Một chiếc xe vượt quá vạch ở mọi khúc cua thì cần giảm tốc độ cơ bản hoặc tăng KD trước khi cần cảm biến tốt hơn.

Mở mạch này trong trình soạn thảo. Arduino Uno: xe dò đường, được nối dây như khi chạy ở đầu trang này. Hãy đổi một linh kiện hoặc một giá trị rồi chạy lại.

Mở mạch

Câu hỏi

Robot dò đường hoạt động thế nào?

Các cảm biến ở phía trước phân biệt băng dính đen với sàn sáng. Arduino tính xem băng dính lệch khỏi giữa bao xa và làm chậm bánh xe ở phía băng dính, nhờ vậy robot quay trở lại đúng đường.

Robot dò đường cần bao nhiêu cảm biến?

Hai cảm biến đủ để theo một đường nhẹ. Năm cảm biến, như ở đây, cho ra vị trí thay vì chỉ trái hoặc phải, nhờ đó đánh lái mượt hơn, và còn giúp robot nhận ra vạch đích ngang qua đường đua.

PID trong robot dò đường là gì?

Proportional, integral và derivative: ba cách biến sai số thành hiệu chỉnh hướng. Robot này dùng P và D. Số hạng P quay càng mạnh khi vạch càng lệch xa; số hạng D làm dịu cua khi sai số đã đang thu nhỏ.

Tôi có thể dùng L298N thay cho TB6612FNG không?

Được, cách nối dây và code gần như giống nhau: hai chân hướng và một chân PWM cho mỗi động cơ. L298N mất khoảng 2 vôn trên transistor của nó, nên động cơ nhận được ít điện từ pin hơn. Mokxi có cả hai driver này.

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.