A Robust Integration of Gps and Mems-Ins Through Trajectory-Constrained Adaptive Kalman Filtering
Zebo Zhou,Yong Li,Chris Rizos,Yunzhong Shen
2009-01-01
Abstract:Micro-Electro-Mechanical Sensor (MEMS) inertial navigation sensors (INS) and GPS are attractive technologies for low-cost navigation applications. In the loosely-coupled integration schemes, GPS provides the position and velocity for real-time correction of the inertial sensor errors as well as the navigation parameters of the MEMS-INS. As an efficient estimation algorithm, the Kalman filter (KF) is widely used in integrated navigation systems. The traditional KF can produce optimal estimates under the assumption that both observation errors and prediction errors are zero-mean and independent of each other. Unfortunately, this is not true in some scenarios, such as severe multipath environments or urban canyon areas. In such cases, adaptive factors can be applied to suppress the influence of the abnormal states. These adaptive factors are usually constructed under the assumption that the present information should be reliable and accurate. However this assumption is not always true because an operational system often has unexpected errors due to either state or observation models. Based on a Conventional Kalman filter (CKF) for the loosely-coupled integration of GPS and MEMS-INS, this paper introduces an efficient Adaptive Kalman filter (AKF) to control the influence of the state model errors. Since the efficiency of the AKF strongly depends on the precision of the GPS solution of the present epoch, a trajectory-constrained algorithm is used to improve the GPS solution's reliability and accuracy. The basic idea is to use the information of several previous epochs to predict the solution at the present epoch, which is further fused with the present GPS output to generate a reliable GPS solution at the present epoch. The research focuses on the establishment of the trajectory model using a discrete time moving-window implementation. This paper introduces the Newton Forward Extrapolation (NFE) model, which is comparatively simple and suitable for constraining the trajectories of moving platforms, thus improving the reliability and accuracy of GPS position and velocity solutions. A GPS/MEMS-INS vehicle experiment was conducted in order to study the performance and efficiency of the proposed algorithms. Three algorithms were tested: CKF, AKF without trajectory constraint, and AKF with trajectory constraint (TCAKF). The results show that: i) the CKF has the worst performance since it is influenced by either state model errors of the MEMS-INS or GPS observation errors; ii) the AKF can control the influence of abnormal state model errors, however its precision is dramatically decreased when GPS observations are contaminated by outliers, and iii) TCAKF can control both the state model and the observation model errors. The TCAKF can therefore be used for loosely-coupled GPS/MEMS-INS integration.