Robust Adaptive Multiple Backtracking VBKF for In-Motion Alignment of Low-Cost SINS/GNSS

The low-cost Strapdown Inertial Navigation System (SINS)/Global Navigation Satellite System (GNSS) is widely used in autonomous vehicles for positioning and navigation. Initial alignment is a critical stage for SINS operations, and the alignment time and accuracy directly affect the SINS navigation performance. To address the issue that low-cost SINS/GNSS cannot effectively achieve rapid and high-accuracy alignment in complex environments that contain noise and external interference, an adaptive multiple backtracking robust alignment method is proposed. The sliding window that constructs observation and reference vectors is established, which effectively avoids the accumulation of sensor errors during the full integration process. A new observation vector based on the magnitude matching is then constructed to effectively reduce the effect of outliers on the alignment process. An adaptive multiple backtracking method is designed in which the window size can be dynamically adjusted based on the innovation gradient; thus, the alignment time can be significantly shortened. Furthermore, the modified variational Bayesian Kalman filter (VBKF) that accurately adjusts the measurement noise covariance matrix is proposed, and the Expectation–Maximization (EM) algorithm is employed to refine the prior parameter of the predicted error covariance matrix. Simulation and experimental results demonstrate that the proposed method significantly reduces alignment time and improves alignment accuracy. Taking heading error as the critical evaluation indicator, the proposed method achieves rapid alignment within 120 s and maintains a stable error below 1.2° after 80 s, yielding an improvement of over 63% compared to the backtracking-based Kalman filter (BKF) method and over 57% compared to the fuzzy adaptive KF (FAKF) method.