A Nonlinear Filter Based on Fast Unscented Transformation with Lie Group State Representation for SINS/DVL Integration

This study addresses the nonlinear estimation problem in the strapdown inertial navigation system (SINS) and Doppler velocity log (DVL) integrated navigation by proposing an improved filtering algorithm based on SE2(3) Lie group state representation. A dynamic model satisfying the group affine condition is established to systematically construct both left-invariant and right-invariant error state spaces, upon which two nonlinear filtering approaches are developed. Although the fast unscented transformation method is not novel by itself, its first integration with the SE2(3) Lie group model for SINS/DVL integrated navigation represents a significant advancement. Experimental results demonstrate that under large misalignment angles, the proposed method achieves slightly lower attitude errors compared to linear approaches, while also reducing position estimation errors during dynamic maneuvers. The 12,000 s endurance test confirms the algorithm’s stable long-term performance. Compared with conventional unscented Kalman filter methods, the proposed approach not only reduces computation time by 90% but also achieves real-time processing capability on embedded platforms through optimized sampling strategies and hierarchical state propagation mechanisms. These innovations provide an underwater navigation solution that combines theoretical rigor with engineering practicality, effectively overcoming the computational efficiency and dynamic adaptability limitations of traditional nonlinear filtering methods.