Abstract
The integration of global navigation satellite systems (GNSS) and inertial navigation systems (INS) employs robust methods to ensure reliable navigation solutions in challenging environments, where the robustness parameter is used to balance accuracy and estimator stability. However, in time-varying GNSS conditions or prolonged harsh environments, a parameter–environment inconsistency may lead to incorrect rejection or excessive down-weighting of normal measurements, causing accuracy degradation or divergence. To address this issue, this paper proposes a scenario-aided robust factor graph optimization (RFGO) algorithm that adapts the robustness parameter to time-varying conditions. Scenarios are first classified based on GNSS/INS integrated error characteristics, and an observation model is constructed using GNSS signal features. Considering the latency of the integration scenarios induced by INS characteristics, a hidden semi-Markov model (HSMM) with state duration modeling is employed for scenario awareness. Based on the inferred scenarios, a scenario-driven robustness adjustment strategy is developed within the dynamic covariance scaling-based RFGO framework, thereby ensuring consistency between the robustness parameter and the actual scenarios. Vehicle experiment results illustrated that the HSMM achieved recognition accuracies of 80.24%, 75.48%, and 96.55% in three different scenarios, respectively. Compared with fixed-parameter methods, the proposed method increased the proportion of high-accuracy epochs by 13.6%–27.1% and reduced abnormal epochs by 41.4%–51.4%, demonstrating improved accuracy and solution stability in complex environments.
Funding Information
  • National Natural Science Foundation of China (52371368)
  • National Natural Science Foundation of China (51979047)

This publication has 38 references indexed in Scilit: