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
DECLINATIONuntuk tempatmu. - Heading meloncat saat perahu miring.
TILT_COMPmati. - Kemudi bekerja terus saat ada gelombang. Naikkan
DEADBANDdi 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.
Related
Alur dan pelajaran menjelaskan cara kerja sebuah kursus, checkpoint-nya, dan kuis tiap babnya.