Bài học và trò chơi học tập

Làm xe đua bám line

Xe đua bám line như một bài toán điều khiển thực sự: cụm năm cảm biến, vị trí vạch tính bằng milimet, lái kiểu P rồi PD, đo độ bám đường và thời gian mỗi vòng.

Bài học này dạy gì

Bảy bài học trong ba chương, dành cho người học đã biết Uno và Serial Monitor:

  • Nhìn thấy line: cách một TCRT5000 và một bộ so sánh biến băng dính đen thành chân cao, vì sao băng 19 mm hợp với khoảng cách 15 mm, năm kênh thành một con số, và vị trí của line là trung bình có trọng số theo milimet, với chín bước và tầm 37 mm của nó.
  • Đánh lái: lái vi sai qua TB6612FNG (tiến, quay tại chỗ, phanh ngắn, trôi), rồi bộ điều khiển P, bão hòa ở mức kẹp PWM, và số hạng D bật lên khi lỗi đột ngột và phanh cua khi trở lại.
  • Đua xe: tốc độ cơ bản đối chiếu với công thức bám đường v = sqrt(mu x g x r), giảm tốc khi vào cua, một bộ pin đã mệt, vòng đua được tính đến từng phần trăm giây với khoảng cách từ bộ mã hóa bánh xe, và dự án: một cuộc đua ba vòng với các hệ số điều chỉnh của riêng bạn và một cơ chế an toàn.

Mở tại /learn/path/build-line-follower-racer.

Các mạch

  • Xe đẩy bám line (thư viện) chạy lfrsense: chỉ đọc tracker với động cơ tắt. Nó in mẫu bit (S1-S5: 00110) và vị trí (position 7.5 mm) mỗi khi băng dính di chuyển.
  • Bộ truyền động robot TB6612 (thư viện) chạy tbdrive: hai động cơ hộp số trên bốn pin AA, qua tiến, nửa tốc độ, quay tại chỗ, lùi, phanh và chế độ chờ.
  • Xe đua bám line: xe đẩy trên khung gầm 2WD, chạy lfrrace. S1 đến S5 của tracker nối vào A4 đến A0, TB6612 vào chân 2 và 4 đến 9, encoder bánh trái vào chân 3, và bộ pin 2S 18650 nuôi động cơ. Gõ kp 3, kd 6, base 120, slow 0, stop hoặc go để tinh chỉnh trực tiếp.

Bạn chính là đường đua

Khung gầm không chạy trên đường đua vẽ sẵn, nên băng dính di chuyển thay. Bấm vào tracker và kéo nó: 100 là băng nằm dưới cảm biến giữa, 115 là lệch 15 mm sang phải, 0 là không có line, và ô màu đặt một vạch ngang làm vạch xuất phát và đích. Mọi con số xe đua in ra đều phụ thuộc vào chỗ bạn đặt băng dính.

Khắc phục sự cố

  • Bánh xe không phản hồi với băng dính: xe đua chỉ in khi lệnh điều khiển bánh thay đổi, nên hãy kéo băng dính sang vị trí mới.
  • Một vòng không được tính: các vạch cách nhau ít hơn một giây được tính là một. Đặt băng dính lại vào chính giữa giữa hai vạch.
  • Bánh trái bị ghim ở 180: đó là MAX_SPEED, mức lớn nhất mà động cơ 6 V nên nhận từ viên pin 8.4 V.
  • Xe đua quay tại chỗ: nó bị mất line và đang tìm về phía lần cuối nhìn thấy line. Kéo băng dính lại dưới tracker, hoặc đặt LOST_STOP_MS để nó dừng lại thay vì tìm tiếp.