Features of Invariant Extended Kalman Filter Applied to Unmanned Aerial Vehicle Navigation

Sensors (Basel). 2018 Aug 29;18(9):2855. doi: 10.3390/s18092855.

Abstract

This research used an invariant extended Kalman filter (IEKF) for the navigation of an unmanned aerial vehicle (UAV), and compared the properties and performance of this IEKF with those of an open-source navigation method based on an extended Kalman filter (EKF). The IEKF is a fairly new variant of the EKF, and its properties have been verified theoretically and through simulations and experiments. This study investigated its performance using a practical implementation and examined its distinctive features compared to the previous EKF-based approach. The test used two different types of UAVs: rotary wing and fixed wing. The method uses sensor measurements of the location and velocity from a GPS receiver; the acceleration, angular rate, and magnetic field from a microelectromechanical system-attitude heading reference system (MEMS-AHRS); and the altitude from a barometric sensor. Through flight tests, the estimated state variables and internal parameters such as the Kalman gain, state error covariance, and measurement innovation for the IEKF method and EKF-based method were compared. The estimated states and internal parameters showed that the IEKF method was more stable and convergent than the EKF-based method, although the estimated locations, velocities, and altitudes of the two methods were comparable.

Keywords: GPS; Kalman gain; MEMS-AHRS; attitude; error covariance; estimation; innovation; invariant extended Kalman filter; location; unmanned aerial vehicle; velocity.