Design and implementation of a model predictive observer for AHRS

Abstract

A GPS-aided Inertial Navigation System (GAINS) is used to determine the orientation‚ position and velocity of ground and aerial vehicles. The data measured by Inertial Navigation System (INS) and GPS are commonly integrated through an Extended Kalman Filter (EKF). Since the EKF requires linearized models and complete knowledge of predefined stochastic noises‚ the estimation performance of this filter is attenuated by unmodeled nonlinearity and bias uncertainties of MEMS inertial sensors. The Attitude Heading Reference System (AHRS) is applied based on the quaternion and Euler angles methods. A moving horizon-based estimator such as Model Predictive Observer (MPO) enables us to approximate and estimate linear systems affected by unknown uncertainties. The main objective of this research is to present a new MPO method based on the duality principle between controller and observer of dynamic systems and its implementation in AHRS mode of a low-cost INS aided by a GPS. Asymptotic stability of the proposed MPO is proven by applying Lyapunov’s direct method. The field test of a GAINS is performed by a ground vehicle to assess the long-time performance of the MPO method compared with the EKF. Both the EKF and MPO estimators are applied in AHRS mode of the MEMS GAINS for the purpose of real-time performance comparison. Furthermore‚ we use flight test data of the GAINS for evaluation of the estimation filters. The proposed MPO based on both the Euler angles and quaternion methods yields better estimation performances compared to the classic EKF.