Adaptive Robust Filtering Based on SE(3) and Its Application in SINS/DVL Navigation

Abstract Aiming at the problems of state‑space inconsistency and vulnerability to measurement outliers caused by the traditional Euler‑angle error model in the SINS/DVL integrated navigation system under complex environments, this paper proposes a robust adaptive algorithm based on the special Euclidean group SE(3). Firstly, by introducing the Lie group/Lie algebra theory, the estimated states of the transformed cubature Kalman filter (TCKF) are embedded into the SE(3) space, and left/right error TCKF (LSE/RSE‑TCKF) is constructed, which essentially improves the spatial consistency of attitude and velocity state estimation. Furthermore, an adaptive mechanism is designed by combining the chi‑square test with the Huber method to detect innovation vectors in real time and reconstruct abnormal measurements during the measurement update phase, thus forming the SE(3) robust adaptive transformed cubature Kalman filter (SE(3)‑RATCKF). Ship‑borne SINS/DVL experimental results show that, compared with traditional methods, the proposed algorithm not only effectively solves the state‑space inconsistency problem and significantly improves navigation accuracy under large misalignment angles, but also exhibits superior robustness. It can adaptively suppress measurement outlier interference in complex environments and avoid excessive compensation under normal measurement conditions, which verifies its effectiveness in improving the estimation accuracy and stability of integrated navigation systems.

Authors

Institutions

Publication Details

Journal
Research Square
Published
2026-11-16
DOI
https://doi.org/10.21203/rs.3.rs-11442439/v1
Primary Topic
Inertial Sensor and Navigation
Type
preprint
Controls
|||
ALL TIME
JAN
FEB
MAR
APR
MAY
JUN
JUL
AUG
SEP
OCT
NOV
preprint

Adaptive Robust Filtering Based on SE(3) and Its Application in SINS/DVL Navigation

Mingming Liu, Liu Jinlai
1 links
Research Square
Inertial Sensor and Navigation
preprint

Adaptive Robust Filtering Based on SE(3) and Its Application in SINS/DVL Navigation

Mingming Liu, Liu Jinlai
preprint en

Abstract

Abstract Aiming at the problems of state‑space inconsistency and vulnerability to measurement outliers caused by the traditional Euler‑angle error model in the SINS/DVL integrated navigation system under complex environments, this paper proposes a robust adaptive algorithm based on the special Euclidean group SE(3). Firstly, by introducing the Lie group/Lie algebra theory, the estimated states of the transformed cubature Kalman filter (TCKF) are embedded into the SE(3) space, and left/right error TCKF (LSE/RSE‑TCKF) is constructed, which essentially improves the spatial consistency of attitude and velocity state estimation. Furthermore, an adaptive mechanism is designed by combining the chi‑square test with the Huber method to detect innovation vectors in real time and reconstruct abnormal measurements during the measurement update phase, thus forming the SE(3) robust adaptive transformed cubature Kalman filter (SE(3)‑RATCKF). Ship‑borne SINS/DVL experimental results show that, compared with traditional methods, the proposed algorithm not only effectively solves the state‑space inconsistency problem and significantly improves navigation accuracy under large misalignment angles, but also exhibits superior robustness. It can adaptively suppress measurement outlier interference in complex environments and avoid excessive compensation under normal measurement conditions, which verifies its effectiveness in improving the estimation accuracy and stability of integrated navigation systems.

Research Square
China Shipbuilding Industry Corporation (China) (CN), Guangdong Communication Polytechnic (CN)
Inertial Sensor and Navigation
AI Navigator

Ask Laika to Summarize, Analyze, and Connect papers live on the map.

Summarize Papers & Methodologies

Extract key findings, datasets, and comparative methods across publications.

Benchmark Rankings & Visual Analytics

Rank top research institutions, authors, funders, topics, and journals by Field-Weighted Citation Impact (FWCI) and paper volume with instant charts.

Connect Distant Disciplines

Bridge topological clusters on the map to find hidden collaborative intersections.

Laika access coming soon