Sensor Fusion for Underwater Vehicle Navigation Compensating Misalignment Using Lie Theory
Journal: Sensors
Year: 2024

This paper presents a sensor fusion method for navigation of unmanned underwater vehicles. The method combines Lie theory into Kalman filter to estimate and compensate for the misalignment between the sensors: inertial navigation system and Doppler Velocity Log (DVL). In the process and measurement model equations, a 3-dimensional Euclidean group (SE(3)) and 3-sphere space (S3) are used to express the pose (position and attitude) and misalignment, respectively. SE(3) contains position and attitu