Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS
Under large azimuth misalignment conditions, the initial alignment of strapdown inertial navigation systems (SINS) is challenged by the nonlinear characteristics of the error model. Traditional particle filter (PF) algorithms suffer from the inappropriate selection of importance density functions an...
Saved in:
| Main Authors: | , |
|---|---|
| Format: | Article |
| Language: | English |
| Published: |
MDPI AG
2025-05-01
|
| Series: | Information |
| Subjects: | |
| Online Access: | https://www.mdpi.com/2078-2489/16/5/416 |
| Tags: |
Add Tag
No Tags, Be the first to tag this record!
|
| _version_ | 1849711837671587840 |
|---|---|
| author | Ning Wang Fanming Liu |
| author_facet | Ning Wang Fanming Liu |
| author_sort | Ning Wang |
| collection | DOAJ |
| description | Under large azimuth misalignment conditions, the initial alignment of strapdown inertial navigation systems (SINS) is challenged by the nonlinear characteristics of the error model. Traditional particle filter (PF) algorithms suffer from the inappropriate selection of importance density functions and severe particle degeneration, which limit their applicability in high-precision navigation. To address these limitations, this paper proposes an adaptive mixed-order spherical simplex-radial cubature particle filter (MLG-AMSSRCPF) algorithm based on matrix Lie group representation. In this approach, attitude errors are represented on the matrix Lie group SO(3), while velocity errors and inertial sensor biases are retained in Euclidean space. Efficient bidirectional conversion between Euclidean and manifold spaces is achieved through exponential and logarithmic maps, enabling accurate attitude estimation without the need for Jacobian matrices. A hybrid-order cubature transformation is introduced to reduce model linearization errors, thereby enhancing the estimation accuracy. To improve the algorithm’s adaptability in dynamic noise environments, an adaptive noise covariance update mechanism is integrated. Meanwhile, the particle similarity is evaluated using Euclidean distance, allowing the dynamic adjustment of particle numbers to balance the filtering accuracy and computational load. Furthermore, a multivariate Huber loss function is employed to adaptively adjust particle weights, effectively suppressing the influence of outliers and significantly improving the robustness of the filter. Simulation and the experimental results validate the superior performance of the proposed algorithm under moving-base alignment conditions. Compared with the conventional cubature particle filter (CPF), the heading accuracy of the MLG-AMSSRCPF algorithm was improved by 31.29% under measurement outlier interference and by 39.79% under system noise mutation scenarios. In comparison with the unscented Kalman filter (UKF), it yields improvements of 58.51% and 58.82%, respectively. These results demonstrate that the proposed method substantially enhances the filtering accuracy, robustness, and computational efficiency of SINS, confirming its practical value for initial alignment in high-noise, complex dynamic, and nonlinear navigation systems. |
| format | Article |
| id | doaj-art-952806c8bb1b47d9bf8f3b7fd62ff051 |
| institution | DOAJ |
| issn | 2078-2489 |
| language | English |
| publishDate | 2025-05-01 |
| publisher | MDPI AG |
| record_format | Article |
| series | Information |
| spelling | doaj-art-952806c8bb1b47d9bf8f3b7fd62ff0512025-08-20T03:14:31ZengMDPI AGInformation2078-24892025-05-0116541610.3390/info16050416Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINSNing Wang0Fanming Liu1College of Intelligent Systems Science and Engineering, Harbin Engineering University, Harbin 150001, ChinaCollege of Intelligent Systems Science and Engineering, Harbin Engineering University, Harbin 150001, ChinaUnder large azimuth misalignment conditions, the initial alignment of strapdown inertial navigation systems (SINS) is challenged by the nonlinear characteristics of the error model. Traditional particle filter (PF) algorithms suffer from the inappropriate selection of importance density functions and severe particle degeneration, which limit their applicability in high-precision navigation. To address these limitations, this paper proposes an adaptive mixed-order spherical simplex-radial cubature particle filter (MLG-AMSSRCPF) algorithm based on matrix Lie group representation. In this approach, attitude errors are represented on the matrix Lie group SO(3), while velocity errors and inertial sensor biases are retained in Euclidean space. Efficient bidirectional conversion between Euclidean and manifold spaces is achieved through exponential and logarithmic maps, enabling accurate attitude estimation without the need for Jacobian matrices. A hybrid-order cubature transformation is introduced to reduce model linearization errors, thereby enhancing the estimation accuracy. To improve the algorithm’s adaptability in dynamic noise environments, an adaptive noise covariance update mechanism is integrated. Meanwhile, the particle similarity is evaluated using Euclidean distance, allowing the dynamic adjustment of particle numbers to balance the filtering accuracy and computational load. Furthermore, a multivariate Huber loss function is employed to adaptively adjust particle weights, effectively suppressing the influence of outliers and significantly improving the robustness of the filter. Simulation and the experimental results validate the superior performance of the proposed algorithm under moving-base alignment conditions. Compared with the conventional cubature particle filter (CPF), the heading accuracy of the MLG-AMSSRCPF algorithm was improved by 31.29% under measurement outlier interference and by 39.79% under system noise mutation scenarios. In comparison with the unscented Kalman filter (UKF), it yields improvements of 58.51% and 58.82%, respectively. These results demonstrate that the proposed method substantially enhances the filtering accuracy, robustness, and computational efficiency of SINS, confirming its practical value for initial alignment in high-noise, complex dynamic, and nonlinear navigation systems.https://www.mdpi.com/2078-2489/16/5/416initial alignmentlarge azimuth misalignment anglematrix lie groupmixed-order spherical simplex-radial cubature Kalman filteradaptive particle number and weightcubature particle filter |
| spellingShingle | Ning Wang Fanming Liu Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS Information initial alignment large azimuth misalignment angle matrix lie group mixed-order spherical simplex-radial cubature Kalman filter adaptive particle number and weight cubature particle filter |
| title | Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS |
| title_full | Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS |
| title_fullStr | Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS |
| title_full_unstemmed | Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS |
| title_short | Application of the Adaptive Mixed-Order Cubature Particle Filter Algorithm Based on Matrix Lie Group Representation for the Initial Alignment of SINS |
| title_sort | application of the adaptive mixed order cubature particle filter algorithm based on matrix lie group representation for the initial alignment of sins |
| topic | initial alignment large azimuth misalignment angle matrix lie group mixed-order spherical simplex-radial cubature Kalman filter adaptive particle number and weight cubature particle filter |
| url | https://www.mdpi.com/2078-2489/16/5/416 |
| work_keys_str_mv | AT ningwang applicationoftheadaptivemixedordercubatureparticlefilteralgorithmbasedonmatrixliegrouprepresentationfortheinitialalignmentofsins AT fanmingliu applicationoftheadaptivemixedordercubatureparticlefilteralgorithmbasedonmatrixliegrouprepresentationfortheinitialalignmentofsins |