Dersler ve öğrenme oyunu

Sensör füzyonu ve Kalman filtresi

Varyanstan iki durumlu bir Kalman filtresine kadar sensör kaynaştırmasının arkasındaki matematiği öğren ve kendi jiroskop sapmalarını öğrenen bir duruş göstergesi yap.

Kurs ne öğretiyor

Sensör füzyonu ve Kalman filtresi, Uno üzerinde dört bölümlük yedi dersten oluşur. İvmeölçerler, jirolar ve IMU'lar kursunun devamıdır ve onun tamamlayıcı filtresini tekrar etmek yerine üzerine inşa eder.

  • Gürültü, ölçülmüş: ortalama, standart sapma ve varyans, 68-95 kuralı, ortlamanın karekök yasası, ve bir hareketli ortalama ile bir EMA'nın gürültüsü ve gecikmesi, bir basamak testiyle ölçülür.
  • From fusion to Kalman: the complementary filter derived (alpha from tau, the crossover frequency, the steady error bias x tau, the noise it passes), then the 1D Kalman filter worked step by step to its steady state, with an innovation test and a wrong R.
  • Gerçek Kalman: galerinin Kalman filtresi eğim açısı (açı ve jiro sapması tek filtrede), ve bir pusulayla füzyonlanmış bir GPS, 10 derece sapmış bir pusulunun ona ne yaptığı dahil.
  • Patron işi proje: SSD1306 OLED üzerinde, kodun içine yazılmış ve uyarlanabilir ölçüm gürültüsüne sahip, iki durumlu iki Kalman filtresiyle sürülen bir yapay ufuk.

Her bölüm kısa bir sınavla biter. Şuradan aç: /learn.

Devreler

Bir ders galerinin MPU6050 ile Kalman filtresi eğim açısı projesini açar. Geri kalan dersler kurs için yazılmış kodları çalıştırır:

kod parça ne yaptığı
kalnoise MPU6050 200 okumalık pencereler: ortalama, sd, varyans, 68-95, ve avg N
kalema MPU6050 yan yana bir hareketli ortalama ve bir EMA, step, alpha ve spike
kalcomp MPU6050 formüllere göre puanlanan bir tamamlayıcı filtre, tau ve bias
kal1d MPU6050 adım adım bir skaler Kalman filtresi, kararlı durum, q
kalgps NEO-6M, MPU-9250 ölü hesap artı GPS düzeltmeleri, gerçeğe karşı puanlanır ve ins
kalboss MPU6050, SSD1306 jyro sapmalarını öğrenen iki durumlu filtreler ve sarsıntı

Kodlar neden gürültü ekliyor

Simüle edilen sensörler kusursuzdur. Bu kurstaki her kod, temiz okumanın üzerine tohumlanmış Gauss gürültüsü ve bilinen sapmalar ekler; sayılar en üstte sabitler olarak durur ve temiz okuma, puanlama için gerçek değer olarak saklanır. Bu sayede her ders bir formülden bir sayıyı öngörebilir ve sonra kontrol edebilir. Tohumlanmış bir üreteç sayesinde bir çalıştırma her seferinde aynı sayıları yazdırır.

Dürüst sınırlar

The filters here are linear and assume Gaussian noise. 3D attitude is not linear, which is why drones run extended Kalman filters or Madgwick and Mahony filters on quaternions; a full inertial navigation system also integrates the accelerometers twice and needs GPS to stop the drift. A Kalman filter is only as good as the Q and R it is given.

Sorun giderme

  • Bir sayı derstekinden biraz farklı. Birkaç yüz gürültülü örnekten çıkan bir istatistik yüzde birkaç sapar; ders ne kadar sapacağını söyler.
  • OLED yavaş güncelleniyor. Uno'nun I2C hattı üzerinden 1 KB'lık bir kare yaklaşık saniyenin üçte birini alır, bu yüzden kod saniyede bir kez yeniden çizim yapar.
  • GPS düzeltmeleri yok. Modülün TX'inin pin 4'e gittiğini ve düzeltmesinin açık olduğunu kontrol et (açıp kapatmak için modüle tıkla).