Robust Multilayer Vehicle Model-Aided INS Based on Soft and Hard Constraintsz

Abstract

The navigation accuracy is an important performance indicator for intelligent vehicles. Errors of the inertial navigation system (INS) diverge fast in the electromagnetic signal denial environment, and the vehicle model aid is a common approach to solve it. However, the accuracy of the vehicle model will be influenced by the road condition, vehicle motion state, and other interferences, so precision degradation and gross error are frequent. Against this problem, this article proposes the robust multilayer vehicle kinematics model (VKM)-aided INS. First, the gross error detection and isolation method is proposed based on the singular value decomposition (SVD) and chi-square test, and problems caused by the inadequate measurement redundancy are analyzed and solved by the “model redundancy.” Second, the multi-layer vehicle model-aided INS is proposed, which contains the sensor layer, the system layer I, and the system layer II. In the sensor layer, the soft and hard constraints of the vehicle model are defined, and the vehicle velocities are estimated with the constraints. Then, in the system layer I, the vehicle velocities from the sensor layer are used to estimate and correct INS errors. At last, the position is updated in the system layer II with the corrected attitude and velocity, so that the navigation performance can be improved. The simulation and field experiments proved that the proposed method has higher navigation accuracy and better robustness against gross error and high-dynamics situation and that its position error is less than 20 m in the 7-min field test.