Skip to content

Implementasi sistem kendali pada sistem Teensy & Arduino

License

Notifications You must be signed in to change notification settings

pronenewbits/IMU_EKF_UKF

Repository files navigation

Kode Teensy 4.0 untuk Extended Kalman Filter & Unscented Kalman Filter

Hello, it seems you got here from ancient link, please go to this repo for the latest updated code (and more description)!.

 

 

 

 

 

Koneksi Teensy 4.0 dengan MPU-9250:

Alt text

Jangan lupa kalibrasi magnetometer untuk mendapatkan hasil yang terbaik.

Contoh output magnetometer yang belum dikalibrasi: Alt text

Setelah dikalibrasi hard-iron:

Alt text

(TODO: implementasi kalibrasi soft-iron).

Untuk persamaan dinamik sistem IMU bisa dilihat di bawah ini: Alt text