Mounting Parameter Estimation from Velocity Vector Observations for Land Vehicle Navigation

A velocity model composing speed sensors and motion constraints is used as the direct and effective auxiliary information of GNSS/INS integrated systems to improve the land vehicle navigation accuracy under interfered or blocked GNSS signal environments. Precise determination of the mounting parameter (the geometric relationship between sensors), including mounting angle and lever arm, is necessary to realize the full potential of velocity assistance. We propose an optimal mounting parameter estimation scheme based on velocity vector observations. The quaternion-based optimal attitude determination method is used to estimate the mounting angle, and the weighted recursive least square is applied to estimate the lever arm. A land vehicle test and an agricultural tractor test are carried out to verify the feasibility and correctness, and IMUs of different grades, especially the MEMS IMUs, are used. The results show that attitude errors especially the heading error are the main factors influencing mounting angle estimation and that the statistical lateral velocity based on the estimated mounting parameters is better than 0.03 m/s, thus better satisfying vehicle motion constraints.