The escalating development of Maritime Autonomous Surface Ships (MASS) has imposed rigorous demands on the precision, continuity, and resilience of onboard integrated navigation systems. However, in complicated marine settings, data from the Global Navigation Satellite System (GNSS) and Doppler Velocity Log (DVL) are frequently corrupted by multipath effects and non-line-of-sight (NLOS) interference. These disturbances introduce anomalous observations that violate Gaussian noise assumptions, thereby severely deteriorating the robustness and estimation quality of traditional sliding-window factor graph optimization (SW-FGO). To mitigate this problem, this study introduces a novel integrated navigation strategy termed gradient-adaptive factor graph optimization (GA-FGO). By designing a gradient-adaptive robust objective function within the factor graph structure, the proposed method dynamically re-weights constraints from the inertial navigation system (INS), GNSS, and DVL. This mechanism adequately suppresses the influence of measurement outliers at the optimization level. Furthermore, a unified solution framework utilizing iterative reweighted least squares (IRLS) and the Gauss–Newton method is established to simultaneously perform adaptive weight updates and state estimation. Validation was based on offline field data benchmarked against the Extended Kalman Filter (EKF), Unscented Kalman Filter (UKF), and standard SW-FGO. The simulation results demonstrated that the GA-FGO algorithm achieves superior positioning accuracy and estimation stability under realistic measurement conditions.
The escalating development of Maritime Autonomous Surface Ships (MASS) has imposed rigorous demands on the precision, continuity, and resilience of onboard integrated navigation systems. However, in complicated marine settings, data from the Global Navigation Satellite System (GNSS) and Doppler Velocity Log (DVL) are frequently corrupted by multipath effects and non-line-of-sight (NLOS) interference. These disturbances introduce anomalous observations that violate Gaussian noise assumptions, thereby severely deteriorating the robustness and estimation quality of traditional sliding-window factor graph optimization (SW-FGO). To mitigate this problem, this study introduces a novel integrated navigation strategy termed Gradient-Adaptive Factor Graph Optimization (GA-FGO). By designing a gradient-adaptive robust objective function within the factor graph structure, the proposed method dynamically re-weights constraints from the Inertial Navigation System (INS), GNSS, and DVL. This mechanism effectively attenuates the influence of measurement outliers at the optimization level. Furthermore, a unified solution framework utilizing Iterative Reweighted Least Squares (IRLS) and the Gauss–Newton method is established to simultaneously perform adaptive weight updates and state estimation. Validation based on offline field data—benchmarked against the Extended Kalman Filter (EKF), Unscented Kalman Filter (UKF), and standard SW-FGO. Simulation results demonstrated that the GA-FGO algorithm achieves superior positioning accuracy and estimation stability under realistic measurement conditions.
Autonomous ships require reliable and economical navigation; however, their performance is hindered when satellite-based positioning signals become unavailable. In such global navigation satellite system (GNSS)-denied conditions, a backup navigation system integrating a strapdown inertial navigation system (SINS), Doppler velocity logger (DVL), and a compass (SINS/DVL/COMPASS) can provide essential state information, but the accuracy and fault tolerance of such systems are constrained by weak observability of position/heading errors and strong dependence on DVL measurements. This study proposes a fault-tolerant optimization method based on perceptual information compensation. First, radar imagery and electronic chart data are fused at the feature level using a weighted wavelet strategy to enhance the environmental feature saliency for shoreline extraction. Second, characteristic coastline inflection points are detected and tracked using a dual-curvature and distance-constrained procedure, generating external position observations via radar–chart matching. These observations are incorporated into the SINS/DVL/COMPASS framework to improve its state observability and robustness. Simulation results show that under nominal conditions, perceptual compensation mitigates error divergence and promotes the convergence of position errors, improving the positioning stability. In terms of robustness, the proposed method delivered more stable state-error behavior than the baseline under DVL speed faults of +2 m/s, −2 m/s, and +2 m/s injected at 301–330, 701–730, and 1101–1130 s, respectively. Quantitatively, the 3σ bounds of velocity and position-related errors are reduced under fault conditions, indicating improved fault tolerance and suitability for short-term nearshore autonomous navigation during GNSS outages.