Dersler ve öğrenme oyunu

Bir tekne otomatik pilotu yap

Simüle edilmiş bir dümen pilotu: eğim telafili pusula, sınırlı bir dümen, 359 ile 1'i ayırt eden bir PID başlık döngüsü ve GPS ara noktaları. Asla navigasyon için kullanılmaz.

Kurs ne öğretiyor

Six lessons in three chapters, at /learn/path/build-boat-autopilot on /learn. Şu temele dayanır: Control systems and PID and Accelerometers, gyros and IMUs rather than teaching them again.

  • Kuzey hangi yönde. LSM303AGR'nin alanı atan2 ile bir başlığa çevrilip 0 ile 360 arasında tutulur, manyetik olanı gerçeğe çeviren sapma (Annapolis'te 11 derece batı) ve ivmeölçerden eğim telafisi: 20 derece yatışta düz formül 11 için 329 okur, telafilili olan ise 11 okur.
  • Dümen tut. 30 dereceye ve saniyede 40 dereceyle sınırlı bir dümen servosu, ardından hatası -180..180 aralığına sarılmış bir PID baş döngüsü (359 başlıktan 1 rota +2'dir, -358 değil), dönüş hızı üzerinde türev, toparlandığı bir savurma ve dalgalarda dümenin salınımını durduran bir ölü bölge.
  • Navigasyon. Bir GPS konumu, haversine mesafe ve yön, bir varış yarıçapı ve baştan sona gidilen bir ara nokta rotası.

Model ve uyarı

Simülatörde su yoktur. boathelm kodu tekneyi modeller: dönüş hızı dümenin her derecesi için saniyede 0,6 dereceye, bir saniyelik gecikmeyle yaklaşır ve GPS konumundan 4 m/s hızla hareket eder. Pusulanın başlığını sürüklemek modellenen pruvası vurur; yatırmak eğim telafisini sınar. Gerçek teknelerde modelde olmayan akıntı, sapma, rüzgar ve dalgalar vardır.

Bu kurs öğrenme içindir. Gerçek seyrüsefer için değildir: gerçek bir otopilot test edilmiş bir üründür ve biri nöbette kalır.

Devre

Parça Kablolama
LSM303AGR SDA ve SCL, 5 V
Dümen servosu sinyal pin 9'da, kendi 5 V'u
NEO-6M TX pin 8'e, RX pin 7'den
Döner düğme CLK pin 2'de, DT pin 3'te, SW pin 4'te: tık başına 5 derece, AUTO veya STANDBY için bas

Kod, seri monitörde auto, standby, course N, rudder N, compass, waves on, waves off, nav ve status komutlarını kabul eder.

Sorun giderme

  • Yön yaklaşık 11 derece sapıyor. Bu sapma açısıdır: bulunduğun yer için DECLINATION değerini kontrol et.
  • Tekne yattığında yön birden değişiyor. TILT_COMP kapalı.
  • Dümen dalgalar sürekli varken çalışıyor. Dalgaların neden olduğu sapmanın üstüne çıkacak şekilde DEADBAND değerini yükselt.
  • "no GPS fix yet". Çalıştır'dan sonra bir iki saniye bekle.
  • Tekne bir dönüm noktasının etrafında dönüyor. Varış yarıçapı, dönüş çemberine göre çok küçük.

Yollar ve dersler, bir kursun, kontrol noktalarının ve bölüm sınavlarının nasıl çalıştığını açıklar.