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

Làm hệ lái tự động cho thuyền

Một hệ thống lái tự động mô phỏng: la bàn bù nghiêng, bánh lái giới hạn, vòng PID giữ hướng phân biệt được 359 với 1, và các điểm GPS. Không dùng để dẫn đường thật.

Khóa học dạy gì

Six lessons in three chapters, at /learn/path/build-boat-autopilot on /learn. Nó xây dựng trên Control systems and PID and Accelerometers, gyros and IMUs rather than teaching them again.

  • Bắc ở hướng nào. Từ trường của LSM303AGR biến thành hướng bằng atan2 và giữ trong 0 đến 360, độ lệch từ biến hướng nam châm thành hướng thật (11 độ tây tại Annapolis), và bù nghiêng bằng gia tốc kế: ở độ nghiêng 20 độ, công thức phẳng đọc 329 thay vì 11, còn công thức bù đọc đúng 11.
  • Lái. Servo bánh lái giới hạn 30 độ và 40 độ mỗi giây, rồi vòng PID giữ hướng với sai số cuộn về -180..180 (hướng đi 1 từ hướng 359 là +2, không phải -358), đạo hàm trên tốc độ quay, cú gió nó tự phục hồi, và dải chết giúp bánh lái không dao động trong sóng.
  • Dẫn đường. Tọa độ GPS, khoảng cách và phương vị haversine, bán kính tới điểm đến, và tuyến gồm nhiều điểm GPS đi suốt từ đầu đến cuối.

Mô hình, và lời cảnh báo

Trình mô phỏng không có nước. Sketch boathelm mô hình hóa con thuyền: tốc độ quay dần tiến về 0,6 độ mỗi giây trên mỗi độ bánh lái với trễ một giây, và nó di chuyển 4 m/s từ tọa độ GPS. Kéo hướng của la bàn sẽ đánh mũi thuyền trong mô hình; nghiêng nó để thử bù nghiêng. Thuyền thật còn có dòng chảy, trôi gió, gió và sóng mà mô hình không có.

Khóa học này dùng để học tập. Nó không dùng để dẫn đường thực tế: autopilot thật là một sản phẩm đã được kiểm định, và luôn cần có người canh trực.

Mạch điện

Linh kiện Đi dây
LSM303AGR SDA và SCL, 5 V
Servo lái tín hiệu trên chân 9, nguồn 5 V riêng
NEO-6M TX vào chân 8, RX từ chân 7
Núm xoay CLK trên chân 2, DT trên chân 3, SW trên chân 4: mỗi bước nhấp là 5 độ, nhấn để chuyển AUTO hoặc STANDBY

Sketch nhận các lệnh auto, standby, course N, rudder N, compass, waves on, waves off, nav và status trong Serial Monitor.

Khắc phục sự cố

  • Hướng chỉ lệch khoảng 11 độ. Đó là độ lệch từ: hãy kiểm tra DECLINATION cho nơi bạn ở.
  • Hướng chỉ bị giật khi thuyền nghiêng. TILT_COMP đang tắt.
  • Servo lái chạy liên tục khi có sóng. Hãy tăng DEADBAND lên trên mức lắc lư do sóng gây ra.
  • "no GPS fix yet". Hãy đợi một hai giây sau khi nhấn Chạy.
  • Thuyền quay vòng quanh một điểm mốc. Bán kính đến điểm quá nhỏ so với vòng quay của nó.

Lộ trình và bài học giải thích cách một khóa học, các điểm kiểm tra và bài kiểm tra cuối chương của nó hoạt động.