invariant extended kalman filter

[pearlastrid]

IEKF node to fuse gyro, accel, rtk heading, rtk position, and mag data

• proof of concept in matlab
• implementation in c++