Pelajaran dan game belajarnya

Membuat autopilot kapal

Sebuah kemudi pilot tersimulasi: kompas dengan kompensasi kemiringan, kemudi terbatas, loop PID heading yang bisa membedakan 359 dari 1, dan waypoint GPS. Tidak untuk navigasi sungguhan.

Apa yang diajarkan kursus ini

Six lessons in three chapters, at /learn/path/build-boat-autopilot on /learn. Ini dibangun di atas Control systems and PID and Accelerometers, gyros and IMUs rather than teaching them again.

  • Ke mana arah utara. Medan LSM303AGR diubah menjadi heading dengan atan2 dan dijaga di 0 sampai 360, deklinasi yang mengubah utara magnetik menjadi utara sejati (11 derajat barat di Annapolis), dan kompensasi kemiringan dari akselerometer: pada kemiringan 20 derajat rumus datar membaca 329 untuk 11, dan yang dikompensasi membaca 11.
  • Mengemudi. Servo kemudi dibatasi ke 30 derajat dan 40 derajat per detik, lalu loop PID heading dengan error dilipat ke -180..180 (haluan 1 dari heading 359 adalah +2, bukan -358), derivatif pada laju putar, hantaman yang bisa dipulihkan, dan deadband yang menghentikan kemudi berayun di ombak.
  • Navigasi. Fix GPS, jarak dan bearing haversine, radius kedatangan, dan rute waypoint yang berlayar dari ujung ke ujung.

Modelnya, dan peringatannya

Simulator tidak punya air. Sketch boathelm memodelkan kapal: laju putarnya melunak menuju 0,6 derajat per detik per derajat kemudi dengan jeda satu detik, dan bergerak 4 m/s dari fix GPS. Menyeret heading kompas mengguncang haluan model; memiringkannya menguji kompensasi kemiringan. Kapal sungguhan menambah arus, leeway, angin dan ombak yang tidak dimiliki model ini.

Kursus ini untuk belajar. Ini bukan untuk navigasi sungguhan: autopilot sungguhan adalah produk yang teruji, dan selalu ada orang yang berjaga.

Rangkaian

Komponen Pengkabelan
LSM303AGR SDA dan SCL, 5 V
Servo kemudi sinyal di pin 9, 5 V sendiri
NEO-6M TX ke pin 8, RX dari pin 7
Kenop putar CLK di 2, DT di 3, SW di 4: 5 derajat per klik, tekan untuk AUTO atau STANDBY

Sketch menerima auto, standby, course N, rudder N, compass, waves on, waves off, nav dan status di Serial Monitor.

Penyelesaian masalah

  • Heading-nya meleset sekitar 11 derajat. Itu deklinasi: cek DECLINATION untuk tempatmu.
  • Heading meloncat saat perahu miring. TILT_COMP mati.
  • Kemudi bekerja terus saat ada gelombang. Naikkan DEADBAND di atas olengan yang ditimbulkan gelombang.
  • "no GPS fix yet". Tunggu satu-dua detik setelah Jalankan.
  • Perahu berputar mengelilingi waypoint. Radius kedatangan terlalu kecil untuk lingkaran putarnya.

Alur dan pelajaran menjelaskan cara kerja sebuah kursus, checkpoint-nya, dan kuis tiap babnya.