Next Article in Journal
Comparative Study of Distributed Acoustic Sensing Responses in Telecommunication Optical Cables
Previous Article in Journal
Trajectories of Adherence to Study-Prescribed Physical Activity Goals in a mHealth Weight Loss Intervention
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance

by
Yidong Shen
1,†,
Li Luo
1,*,†,
Guoqing Wang
2,
Tao Liu
3,*,
Lin Luo
1,
Jiaxi Guo
1 and
Shuangshuang Wang
4
1
School of Electronic Information and Electrical Engineering, Chengdu University, Chengdu 610106, China
2
School of Information and Control Engineering, China University of Mining and Technology, Xuzhou 221116, China
3
Chengdu Kinyea Technologies Company Ltd., Chengdu 610000, China
4
School of Literature and Journalism, Chengdu University, Chengdu 610106, China
*
Authors to whom correspondence should be addressed.
These authors contributed equally to this work.
Sensors 2025, 25(24), 7599; https://doi.org/10.3390/s25247599
Submission received: 10 November 2025 / Revised: 6 December 2025 / Accepted: 10 December 2025 / Published: 15 December 2025
(This article belongs to the Section Navigation and Positioning)

Abstract

Due to the influence of the complex underwater environment, the initial alignment method for Doppler velocity log (DVL)-aided strap-down inertial navigation systems (SINS) often suffer from performance degradation, especially when DVL measurements are contaminated by outliers. In this paper, an outlier-resistant Initial Alignment method with interference suppression for SINS/DVL integrated navigation system is proposed, by which, by constructing an improved Mahalanobis distance anomalous detection criterion, the anomaly of the residual vector composed of observation vectors is judged, and an adaptive weighting factor is introduced into the observation matrix to suppress the abnormal interference in the alignment process. Simulation and experimental results show that, compared with existing initial alignment methods, the proposed method achieves higher alignment accuracy in the presence of outliers, which is more suitable for the SINS/DVL integrated navigation system.

1. Introduction

Strapdown inertial navigation systems (SINS) are widely applied in underwater vehicles due to their continuity and autonomy, while Doppler velocity logs (DVL) provide velocity measurements without error accumulation [1,2,3]. The integration of SINS and DVL has thus become a standard navigation scheme for underwater applications. As the prerequisite for integrated navigation, the alignment process critically influences the overall accuracy and stability [4,5]. Although conventional analytic coarse alignment methods [6,7] and self-alignment methods [8,9,10,11,12] are well developed for static or oscillatory bases, they fail under dynamic conditions. In particular, in-motion alignment techniques have attracted extensive research attention to mitigate maneuver-induced limitations [13,14,15,16].
Employing external information to assist SINS initialization has been recognized as an effective strategy to mitigate the impact of motion disturbances on alignment accuracy. In [17], Wu first introduced the optimization-based alignment (OBA) method, where observation vectors are derived from the integration of the specific force equation, and the initial attitude matrix is subsequently obtained using attitude determination methods, thereby enabling in-motion alignment. Building on this foundation, Wu further proposed the velocity-integration-based OBA and position-integration-based OBA methods [3], which enhanced the accuracy of observation vector computation. To alleviate error accumulation during the integration process, a sliding-window-vector construction-based OBA method was later developed. Various extensions of OBA have also been reported, including DVL-aided OBA [18], odometer-aided OBA [19,20], velocity-aided OBA [21], and backtracking scheme based OBA methods [22,23]. While these methods are computationally efficient and structurally concise, their theoretical foundation still relies on least-squares estimation, making them sensitive to measurement disturbances. In complex environments, external information is prone to outliers, which may degrade alignment accuracy or even cause alignment failure. Therefore, enhancing the robustness of in-motion alignment has become one of the key challenges currently faced in the navigation field.
To mitigate the impact of outlier disturbances in in-motion alignment, Xu proposed a robust Kalman filter–based method [24]. In this approach, an observation vector model is first derived under a gravity-motion framework, and robust Kalman filtering is then employed to detect and reject outliers in real time. The filtered estimates are subsequently used to reconstruct the observation vectors, thereby achieving a robust OBA solution. In [25,26], Xu further introduced a weight-matching OBA method inspired by Huber’s robust estimation theory [27]. This method incorporated the Huber function into the OBA framework, established a statistical model for outlier detection parameters, and demonstrated strong anti-interference capability. However, the key parameter of the Huber weighting mechanism is typically set to a fixed empirical value [28]. Such a static threshold lacks adaptability to dynamic variations in measurement statistics, which may lead to misclassification or suboptimal weighting under non-stationary noise conditions, thus limiting its adaptability and optimal performance in more complex environments.
To this end, this paper proposes an outlier-resistant initial alignment method based on a refined Mahalanobis distance criterion. The method first constructs a residual vector model using the original observation vectors within the OBA framework, and then recursively updates the Mahalanobis distance corresponding to the current observation vector. Subsequently, the mean and variance of Mahalanobis distances from historical epochs are utilized to dynamically establish an anomaly detection criterion. An exponential-type flexible weighting function is then designed to adaptively adjust the weights of the observation vectors according to the anomaly detection results, thereby suppressing the impact of outlier disturbances in the OBA process. The effectiveness of the proposed method is validated through both simulations and experimental data. The results demonstrate that the method ensures the stable convergence of attitude errors over time, even under outlier disturbances, and achieves higher alignment accuracy and better robustness compared with state-of-the-art methods. The contributions of paper are as follows:
  • A detection method was presented under the OBA framework and recursively calculates the Mahalanobis distance. By using historical statistics to adaptively set the anomaly detection threshold, it achieves real-time and statistically meaningful effective identification of outliers in the observed sequence.
  • An exponential-type adaptive weighting function based on the detection mechanism was imported to realize the dynamic adjustment of the contribution of each historical epoch observation vector. This method overcomes a disadvantage that the traditional method depends on the fixed threshold value or static weight, so it can more effectively restrain outliers and interference.
  • The article not only verifies algorithm performance under the fiducial simulation environment, but also establishes a time-varying anomaly model and some scenes of sea trial track, and assesses performances of the way under different interference and maneuvering degrees.
The remainder of this paper is organized as follows. Section 2 introduces the existing theoretical models and methods, along with our research motivation. Section 3 presents the principle of the proposed robust initial alignment method, detailing the procedures and framework for outlier detection in practical applications. Section 4 provides simulation experiments to demonstrate the effectiveness of the proposed method. Section 5 concludes the paper.

2. Problem Statement

In a SINS/DVL integrated navigation system, the velocity measurements provided by the DVL can be used to assist the initial alignment of the SINS. First, by applying the chain rule, the attitude matrix C b n ( t ) is decomposed as [3]:
C b n ( t ) = ( C n ( t ) n ( 0 ) ) T C b n ( 0 ) C b ( t ) b ( 0 )
Among them, t denotes the current time, C n ( t ) n ( 0 ) and C b ( t ) b ( 0 ) , respectively, represent the attitude matrices of the navigation frame n and the body frame b with respect to the initial epoch. C b n ( 0 ) represents the attitude matrix of the body frame b ( 0 ) with respect to the navigation frame n ( 0 ) at the initial time, which is a constant matrix. The two time-varying attitude matrices, C n ( t ) n ( 0 ) and C b ( t ) b ( 0 ) , can be updated through the attitude matrix differential equations:
C ˙ n ( t ) n ( 0 ) = C n ( t ) n ( 0 ) ( ω i n n ( t ) × )
C ˙ b ( t ) b ( 0 ) = C b ( t ) b ( 0 ) ( ω i b b ( t ) × )
Once the time-varying attitude matrices C n ( t ) n ( 0 ) and C b ( t ) b ( 0 ) are obtained, the central task of the OBA method is to determine the constant attitude matrix C b n ( 0 ) .
Based on the specific force equation, the observation vector equation can be derived as follows [29]:
C b n ( 0 ) α ( t M ) = β ( t M )
The observation vectors α ( t M ) and β ( t M ) can be expressed as
α ( t M ) = C b ( t M ) b ( 0 ) v b ( t M ) C b ( t m ) b ( 0 ) v b ( t m ) t m t M C b ( τ ) b ( 0 ) f b ( τ ) d τ + t m t M C b ( τ ) b ( 0 ) ω i e b ( τ ) × v b ( τ ) d τ
β ( t M ) = t m t M C n ( τ ) n ( 0 ) g n d τ
In the above equation, t m denotes the lower integration bound, representing the starting time of the current sliding window, and t M denotes the current time, i.e., the upper integration bound. When t M t m = L Δ t a (where L is the fixed length of the sliding window), the integration corresponds to the sliding integration within a window of length L Δ t a .
The discretized forms of the observation vectors α ( t M ) and β ( t M ) over the sliding window [ t m , t M ] can be expressed as follows:
α ( t M ) C b ( t ) b ( 0 ) v b ( t M ) C b ( t m ) b ( 0 ) v b ( t m ) Δ α 1 ( t M ) + Δ α 2 ( t M )
β ( t M ) = K = m M 1 C n ( t k ) n ( 0 ) ( Δ t I 3 × 3 + Δ t 2 2 [ ω i n n ( t k ) × ] ) g n
Here, M denotes the time index of the current time, m denotes the time index of the starting point t m of the current sliding window, M m represents the length of the sliding window, and Δ t is the computation interval. Δ α 1 ( t M ) corresponds to the discretized expression of the first integral term in Equation (5), while Δ α 2 ( t M ) corresponds to the discretized expression of the second integral term.
According to Equations (4)–(8), the attitude-determination method can uniquely determine the direction cosine matrix C b n ( 0 ) , thereby achieving moving-base alignment. Moreover, the reference vector β ( t M ) is updated from C n ( t k ) n ( 0 ) and g n , making it less susceptible to sensor output disturbances, whereas the observation vector α ( t M ) is formed directly from the outputs of the IMU and DVL. As a velocity-aiding sensor, the DVL is highly vulnerable to disturbances in complex underwater environments, such as turbulence or multipath effects, which often introduce outliers. These outliers severely degrade the construction accuracy of the vectors α ( t M ) and β ( t M ) , thus reducing initial alignment precision. In practical applications, DVL data may introduce abnormal observations due to environmental variations, which can cause deviations in the residuals and consequently affect the overall alignment accuracy. Existing robust alignment methods have not sufficiently accounted for the uncertainty in the statistical characteristics of observation data, leading to misclassification and improper handling of outliers, which in turn undermines the stability of the alignment results. Motivated by this, a robust initial alignment is presented in Section 3, where a new outlier-detection criterion based on Mahalanobis distances is established to dynamically detect outliers and adaptively adjust the weights of the observation vectors.

3. An Initial Alignment Method with Interference Suppression Based on Mahalanobis Distance

To address above problems, this paper proposes a novel robust initial alignment method. The Mahalanobis distance, which accounts for both correlations among features and scale differences in the data, serves as an effective measure of deviation between outliers and the sample mean. Therefore, it is often used as an indicator for detecting outliers. To detect whether the observation vector in the optimized alignment method is affected by outliers from DVL outputs, we construct the residual vector h i as the data vector in the Mahalanobis distance based on Equation (4).
h i = | | β M | | 2 | | α M | | 2
where the observation vectors α ( t M ) and β ( t M ) are abbreviated as α M and β M , respectively. Let h i denote the residual vector at observation index i (i, …, M), where M represents the current time sequence. Therefore, the squared Mahalanobis distance based on h i can be expressed as:
D M 2 = ( h M μ ) T Σ 1 ( h M μ )
where
μ = 1 M 1 i = 1 M 1 h i
Σ = 1 M 1 i = 1 M 1 ( h i μ ) ( h i μ ) T
In the above equation, μ denotes the mean of the residual vector h i , and Σ represents its covariance matrix. Under the influence of complex marine environment, the statistical characteristics of sensor errors may change. Directly using the Mahalanobis distance to establish an outlier criterion may led to both false alarms and missed detections. Therefore, this paper constructs an outlier criterion based on the cumulative statistical properties of the Mahalanobis distance, as follows:
D M > μ D + 2 σ D
where
μ D = 1 M i = 1 M D i
σ D = 1 M 1 i = 1 M ( D i μ D ) 2
If the Mahalanobis distance D M of the residual vector h i at the current time satisfies Equation (13), the observation vector at that time is regarded as containing an outlier. The corresponding residual vector h i is then excluded from the updates of Equations (11) and (12), thereby preventing the statistics μ and Σ from being contaminated.
Based on the outlier criterion defined in Equation (13), we develop a flexible weighting-update scheme for the observation vector, as follows:
w M = e ( D M δ ) γ D M > μ D + 2 σ D 1 D M μ D + 2 σ D
Here, γ denotes the exponential control parameter. Experimental results show that the optimum performance is achieved when γ = 4 . The parameter δ acts as the scale factor that controls the mapping from the residual magnitude to the weight attenuation. To ensure consistency with the statistical criterion of the Mahalanobis distance, δ is set to 5.0239 in this study, corresponding to the critical value of the chi-square distribution with one degree of freedom n = 1 for a 97.5% confidence level.
Based on the outlier criterion in Equation (13), the weighting coefficient w M obtained from Equation (16) is applied to the construction of the attitude observation matrix K M . By assigning each innovation term a weight of w M , the robustness of the optimized alignment model against abnormal observations can be further enhanced. The updated formula of the observation matrix is therefore given as:
K M = K M 1 + w M ( [ β M ( t M ) + ] [ α M ( t M ) ] ) T ( [ β M ( t M ) + ] [ α M ( t M ) ] )
Based on Equations (4) and (7)–(17), a robust initial alignment method with interference suppression, utilizing the Mahalanobis distance with the proposed outlier-detection criterion, is developed. The specific updating process is illustrated in Figure 1, and the detailed procedure is given as follows:
a. Initialize μ to 0 and Σ to σ v , and set μ D = 0 , σ D = δ .
b. The observation vectors α ( t M ) and β ( t M ) at the current time is calculated by using Equations (7) and (8).
c. Compute the residual vector h i by substituting α ( t M ) and β ( t M ) into Equation (9), and then determine the Mahalanobis distance D M at the current time via Equation (10).
d. Determine the presence of outlier interference using Equation (13). If not detected, update μ and Σ recursively with the current residual vector h M and Mahalanobis distance D M by using (11) and (12); If detected, keep μ and Σ unchanged for the next time.
e. Update μ D and σ D by using (14) and (15).
f. Substitute D M into Equation (16) to obtain the updated weight w M . Then, use w M in Equation (17) to update the observation matrix K M .
g. Finally, the attitude determination algorithm is subsequently employed to complete the in-motion initial alignment.
To enhance computational efficiency, Equations (11) and (12) can be computed using a recursive updating scheme, with the complete procedure provided in Appendix A.

4. Experimental Validation and Performance Analysis

4.1. Simulation Experiments

To validate the correctness and effectiveness of the proposed robust alignment method, simulation experiments were carried out. A 300-s navigation trajectory was designed under moving-base conditions, with attitude variations, velocity profiles, and the ground-truth trajectory illustrated in Figure 2, Figure 3 and Figure 4. As shown, the trajectory encompasses acceleration, deceleration, turning, and steady linear motion, which are representative of the typical navigation patterns of an underwater vehicle. The sensors’ accuracy configuration is shown in Table 1, where the IMU (100 Hz, gyroscope bias of 0.01°/h, accelerometer bias of 100 μg) and the DVL (5 Hz, velocity measurement noise standard deviation of 0.05 m/s) are specified. Based on the above conditions, we conducted simulations for two sets of outliers probability models separately. The first set simulated the situation where the outliers probability remained constant, while the second set corresponded to the case where the outliers probability changed.

4.1.1. The First Simulation

To model occasional abnormal DVL velocity measurements, outliers are generated by amplifying the instantaneous noise sample by a factor of 200 with a probability of 2%. The DVL measurement error is modeled as
ν k 1 N ( 0 , Σ ν ) , w . p . 1 p 0 N ( 0 , α 0 2 Σ ν ) , w . p . p 0
where ν k 1 is the DVL velocity measurement error at the k1-th moment, Σ ν is the nominal DVL noise covariance, p 0 = 0.02 is the fixed outlier probability, and α 0 = 200 is the noise amplification factor.
The proposed method (MOBA) is compared with several alternatives, including the conventional optimization-based alignment (OBA) [30], the OBA method without additional outlier injection (OBAr), and the robust OBA method (ROBA) [25]. The root-mean-square errors (RMSE) of alignment obtained from 10 independent runs are plotted in Figure 5, Figure 6 and Figure 7 and summarized in Table 2.
As illustrated in Figure 5 and Figure 6, the pitch and roll angles are only marginally influenced by outliers, and all methods achieve rapid convergence within 0.1° in less than 50 s. Nevertheless, the alignment results obtained by the MOBA method are closer to those of the ideal OBAr. Figure 7 and Table 2 further demonstrate that the OBA method yields larger alignment errors, whereas both ROBA and MOBA exhibit robustness against outlier interference, with MOBA delivering superior alignment accuracy. Notably, the proposed MOBA method is the only one that maintains heading accuracy within the acceptable range of 1°, this is the standard benchmark in simulation and general underwater navigation evaluations, while both OBA and ROBA fall outside this range. This improvement arises from the fact that OBA lacks any mechanism to resist interference, while ROBA relies solely on empirically selected threshold parameters for suppression. By contrast, MOBA is capable of identifying outliers through a statistical detection criterion and dynamically updating the monitoring statistics. In addition, it incorporates an adaptive weighting factor to regulate the influence of observational innovations on the alignment process, thereby ensuring enhanced robust alignment performance.

4.1.2. The Second Simulation

To further assess the behavior of the alignment algorithms under more diverse and time-varying disturbance conditions, we conducted an additional simulation experiment using the segmented outlier model. The 300-s experiment was divided into five 60-s phase. In each phase, the DVL measurement noise follows the same nominal distribution, while sporadic outliers are generated with phase-dependent probabilities and magnitudes. Specifically, the DVL velocity measurement error ν k 2 in phase s is modeled as
ν k 2 N ( 0 , Σ ν ) , w . p .   1 p s N ( 0 , α s 2 Σ ν ) , w . p .   p s
where k 2 ( k 2 = 1 , 2 , ) denotes each discrete time sample, and s ( s = 1 , 2 , , 5 ) indicates the specific 60-s time segment to which the current sample k 2 belongs. p s is the outlier probability in segment s ( p s 0.02 ) , α s is the noise amplification factor ( α s 200 ) , consistent with the implementation in which outliers are produced by scaling the instantaneous noise sample by α s . The segment-specific parameters are listed in Table 3. All other simulation settings—including the attitude maneuver profile, velocity inputs, and reference trajectory—were kept strictly identical to those used in the first simulation to ensure fair comparison.
The alignment results of the roll, pitch, and heading angles for the five-segment disturbance model are displayed in Figure 8a–c, and the corresponding RMSE values during the final 50 s are summarized in Table 4. It can be observed that the proposed MOBA method consistently maintains the highest robustness across all disturbance phases, and is the only method that keeps the heading accuracy within the commonly accepted practical tolerance of approximately 1° under these more challenging conditions.

4.2. Field Test

To verify the actual performance of the proposed MOBA method, we conducted an initial alignment experiment using a 1200-s sea trial dataset. The attitude, velocity, and motion trajectory within the complete period are shown in Figure 9a–c. To facilitate performance evaluation, we divided the entire dataset into four consecutive 300-s segments, and conducted independent initial alignment tests for each period to examine the robustness of the method under different motion patterns. The experimental data were collected using a fiber-optic strapdown inertial navigation system (FSINS), a DVL, and a high-precision integrated navigation system, with the detailed configuration summarized in Table 5. The FSINS consisted of a fiber-optic gyroscope (bias stability: 0.01°/h, angle random walk: < 0.03 ° / h / H z ) and accelerometers (bias stability: 100 μg, velocity random walk: < 10 μ g / Hz ), with an output rate of 98 Hz. The DVL provided measurements at 1 Hz with a velocity measurement noise standard deviation of 0.1 m/s. The outputs of the high-precision integrated navigation system were used as reference data. Outliers were randomly injected into the DVL output with a 2% probability to emulate occasional abnormal observations in practical systems and to evaluate the algorithm’s robustness under non-ideal conditions. Figure 9d–g present the heading estimation errors of the four methods (OBAr, OBA, ROBA, and MOBA) for the four trajectory segments, while Table 6 summarizes the corresponding RMSE values computed over the final 50 s of each alignment. The simulation and practical test results show that, under outlier disturbances, all compared methods exhibit very similar RMSE performance in roll and pitch. Therefore, only the accuracy comparison of the heading angle is presented here.
The results in Figure 9d–g indicate that, in terms of heading angle accuracy, the OBA method fails to meet the commonly accepted practical accuracy requirement of approximately 1°. This is because the OBA method lacks any mechanism to suppress DVL outlier disturbances, making its heading estimation highly sensitive to outlier contamination. In contrast, both the ROBA method and the proposed MOBA method are able to keep the heading angle RMSE within 1°. Among them, MOBA exhibits more stable and consistently reliable performance across all four trajectory segments and remains unaffected even under higher maneuver intensity or increased outlier disturbances. This demonstrates that MOBA can maintain strong engineering applicability across a wider range of operating scenarios.

5. Conclusions

In this paper, a method based on outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance was proposed. By performing dynamic outlier detection together with adaptive weighting of the observations, the method effectively suppresses the influence of outlier disturbances during the alignment process. Experimental results show that, compared with existing approaches, the proposed MOBA method achieves higher alignment accuracy and stronger robustness in the presence of DVL outliers, demonstrating its suitability for moving-base alignment of DVL-aided SINS in complex marine environments. The method also has limitations, it is currently applicable only to medium- and high-precision initial alignment. Similar to most optimization-based initial alignment schemes, its performance degrades under low-precision sensor conditions, where moving-base alignment remains a challenging problem. Future work will consider incorporating error estimation and compensation mechanisms to improve alignment performance in low-precision scenarios.

Author Contributions

Y.S. and L.L. (Li Luo) conceived and designed the proposed alignment method; Y.S. performed the experiment; L.L. (Li Luo) contributed experiment tools and analyzed the data; Y.S., S.W., L.L. (Li Luo), G.W., T.L., L.L. (Lin Luo), J.G. and S.W. wrote the paper. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported in part by the National Natural Science Foundation of China under Grant 62303077 and Grant 62373362; and in part by the Chengdu University 2025 College Student Innovation Training Program Project under Grant S202511079047.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

The original contributions presented in this study are included in the article. Further inquiries can be directed to the corresponding author.

Conflicts of Interest

Author Tao Liu was employed by the Chengdu Kinyea Technologies Company Ltd., company. The remaining authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Nomenclature

NotationsDefinitions
b Body frame
Earth frame
Inertial frame
n Navigation frame (geographic frame)
f b Specific force in b-frame
g n Gravity vector
ω i b b Body angular rate in b frame
v b Ground velocity of SINS in b frame
C x 1 x 2 Attitude matrix from x 1 -frame to x 2 -frame
C b n ( t ) Attitude matrix from body frame b to navigation frame n at time t
x ( t ) Value of the variable x at time t
ω x 1 x 2 x 3 Angular velocity of x 2 -frame with respect to x 1 -frame projected in x 3 -frame
ω i n n × Skew-symmetric matrix of the angular velocity of the inertial frame with respect to the navigation frame, projected in n-frame, i.e., the cross-product operator satisfying ( ω i n n × ) x = ω i n n × x .
ω i b b × Skew-symmetric matrix of the angular velocity of the inertial frame with respect to the body frame, expressed in the b-frame, i.e., the cross-product operator satisfying ( ω i b b × ) x = ω i b b × x for any vector x .

Appendix A

Let the current discrete time be denoted as M , and let n M represent the total number of non-outlying observations from the initial time step up to time M . Let μ M denote the sample mean vector calculated from the first n M data points, and Σ M the corresponding sample covariance matrix. When the observation vector at the current time step is identified as a non-outlying data point, the Mahalanobis distance can be updated recursively using the following procedure:
Update the number of data points
n M = n M 1 + 1
Update the mean μ M
μ M = μ M 1 + 1 n M ( h M μ M 1 )
Update the covariance matrix
Σ M = n M 1 n M Σ M 1 + 1 n M ( ( h M μ M 1 ) ( h M μ M 1 ) T ) n M 1 n M ( h M μ M 1 ) ( h M μ M 1 ) T
By employing the above expression, and under the condition of no outlier observations, the mean and covariance can be updated using the recursive formulas.
When the observation vector at the current time step is affected by outliers:
Update the number of data points
n M = n M 1
Update the mean μ M
μ M = μ M 1
Update the covariance matrix
Σ M = Σ M 1
By employing the above expression, when outlier observations are present, the mean and variance are retained from the previous time step to prevent contamination by the outliers and to avoid compromising the judgment at the next time step.

References

  1. Xu, X.; Xu, X.; Zhang, T.; Wang, Z. In-motion filter-QUEST alignment for strapdown inertial navigation systems. IEEE Trans. Instrum. Meas. 2018, 67, 1979–1993. [Google Scholar] [CrossRef]
  2. Xu, X.; Xu, X.; Yao, Y.; Wang, Z. In-motion coarse alignment method based on reconstructed observation vectors. Rev. Sci. Instrum. 2017, 88, 035001. [Google Scholar] [CrossRef]
  3. Wu, Y.; Pan, X. Velocity/position integration formula—Part I: Application to in-flight coarse alignment. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1006–1023. [Google Scholar] [CrossRef]
  4. Qin, Y.; Yan, G.; Gu, D.; Zheng, J. Clever way of SINS coarse alignment despite rocking ship. J. Northwest. Polytech. Univ. 2005, 23, 681–684. [Google Scholar]
  5. Xu, X.; Xu, X.; Zhang, T.; Li, Y.; Zhou, F. Improved Kalman filter for SINS coarse alignment based on parameter identification. J. Chin. Inert. Technol. 2016, 24, 320–329. [Google Scholar]
  6. Wu, Y.; Pan, Y.; Hu, X.; Wu, Z. Observability of initial alignment for strapdown inertial navigation systems. IEEE Trans. Aerosp. Electron. Syst. 2009, 45, 1015–1029. [Google Scholar]
  7. Li, J.; Fang, J.; Du, M. Error analysis and gyro-bias calibration of analytic coarse alignment for airborne POS. IEEE Trans. Instrum. Meas. 2012, 61, 3058–3064. [Google Scholar] [CrossRef]
  8. Liu, X.; Xu, X.; Zhao, Y.; Wang, L.; Liu, Y. An initial alignment method for strapdown gyrocompass based on gravitational apparent motion in inertial frame. Measurement 2014, 55, 593–604. [Google Scholar] [CrossRef]
  9. Liu, X.; Liu, X.; Song, Q.; Yang, Y.; Liu, Y.; Wang, L. A novel self-alignment method for SINS based on three vectors of gravitational apparent motion in inertial frame. Measurement 2015, 62, 47–62. [Google Scholar] [CrossRef]
  10. Li, J.; Gao, W.; Zhang, Y. Gravitational apparent motion-based SINS self-alignment method for underwater vehicles. IEEE Trans. Veh. Technol. 2018, 67, 11402–11410. [Google Scholar] [CrossRef]
  11. Li, J.; Gao, W.; Zhang, Y.; Wang, Z. Gradient descent optimizationbased self-alignment method for stationary SINS. IEEE Trans. Instrum. Meas. 2019, 68, 3278–3286. [Google Scholar] [CrossRef]
  12. Wang, J.; Zhang, T.; Tong, J.; Li, Y. A fast SINS self-alignment method under geographic latitude uncertainty. IEEE Sens. J. 2020, 20, 2885–2894. [Google Scholar] [CrossRef]
  13. Xu, X.; Sun, Y.; Gui, J.; Yao, Y.; Zhang, T. A fast robust in-motion alignment method for SINS with DVL aided. IEEE Trans. Veh. Technol. 2020, 69, 3816–3827. [Google Scholar] [CrossRef]
  14. Wu, Y.; Pan, X. Velocity/position integration formula—Part II: Application to strapdown inertial navigation computation. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1024–1034. [Google Scholar] [CrossRef]
  15. Syed, Z.F.; Aggarwal, P.; Niu, X.; El-Sheimy, N. Civilian vehicle navigation: Required alignment of the inertial sensors for acceptable navigation accuracies. IEEE Trans. Veh. Technol. 2008, 57, 3402–3412. [Google Scholar] [CrossRef]
  16. Zhang, T.; Wang, J.; Jin, B.; Li, Y. Application of improved fifth-degree cubature Kalman filter in the nonlinear initial alignment of strapdown inertial navigation system. Rev. Sci. Instrum. 2019, 90, 095001. [Google Scholar] [CrossRef]
  17. Wu, M.; Wu, Y.; Hu, X.; Hu, D. Optimization-based alignment for inertial navigation systems: Theory and algorithm. Aerosp. Sci. Technol. 2011, 15, 1–17. [Google Scholar] [CrossRef]
  18. Chang, L.; Li, Y.; Xue, B. Initial alignment for a Doppler velocity log-aided strapdown inertial navigation system with limited information. IEEE/ASME Trans. Mechatron. 2017, 22, 329–338. [Google Scholar] [CrossRef]
  19. Chang, L.; He, H.; Qin, F. In-Motion Initial Alignment for Odometer-Aided Strapdown Inertial Navigation System Based on Attitude Estimation. IEEE Sens. J. 2017, 17, 766–773. [Google Scholar] [CrossRef]
  20. Chang, L.; Li, J.; Li, K. Optimization-based alignment for strapdown inertial navigation system: Comparison and extension. IEEE Trans. Aerosp. Electron. Syst. 2016, 52, 1697–1713. [Google Scholar] [CrossRef]
  21. Zhang, Q.; Li, S.; Xu, Z.; Niu, X. Velocity-based optimizationbased alignment (VBOBA) of low-end MEMS IMU/GNSS for low dynamic applications. IEEE Sens. J. 2020, 20, 5527–5539. [Google Scholar] [CrossRef]
  22. Chang, L.; Qin, F.; Li, A. A novel backtracking scheme for attitude determination-based initial alignment. IEEE Trans. Autom. Sci. Eng. 2014, 12, 384–390. [Google Scholar] [CrossRef]
  23. Chang, L.; Hu, B.; Li, Y. Backtracking integration for fast attitude determination-based initial alignment. IEEE Trans. Instrum. Meas. 2014, 64, 795–803. [Google Scholar] [CrossRef]
  24. Xu, X.; Guo, Z.; Yao, Y.; Zhang, T. Robust initial alignment for SINS/DVL based on reconstructed observation vectors. IEEE/ASME Trans. Mechatron. 2020, 25, 1659–1667. [Google Scholar] [CrossRef]
  25. Xu, X.; Gui, J.; Sun, Y.; Yao, Y. A robust in-motion alignment method based on DVL. IEEE Trans. Instrum. Meas. 2021, 70, 1–12. [Google Scholar]
  26. Xu, X.; Sun, Y.; Yao, Y.; Zhang, T. A Robust In-Motion Optimization-Based Alignment for SINS/GPS Integration. IEEE Trans. Intell. Transp. Syst. 2022, 23, 4362–4372. [Google Scholar] [CrossRef]
  27. Huber, P.J. Robust Statistics; Wiley: Hoboken, NJ, USA, 2005. [Google Scholar]
  28. Durovic, Z.M.; Kovacevic, B.D. Robust estimation with unknown noise statistics. IEEE Trans. Autom. Control 1999, 44, 1292–1296. [Google Scholar] [CrossRef]
  29. Xu, X.; Gui, J.; Sun, Y.; Yao, Y.; Zhang, T. A Robust In-Motion Alignment Method With Inertial Sensors and Doppler Velocity Log. IEEE Trans. Instrum. Meas. 2021, 70, 8500413. [Google Scholar] [CrossRef]
  30. Guo, Y.; Yuan, S.; Wu, Z.; Xu, X.; Xu, J. DVL Aided SINS Coarse Alignment Solution with High Dynamics. IEEE Access 2020, 8, 155655–155666. [Google Scholar] [CrossRef]
Figure 1. The updating process of the proposed robust initial alignment method.
Figure 1. The updating process of the proposed robust initial alignment method.
Sensors 25 07599 g001
Figure 2. Attitude angle variation curve.
Figure 2. Attitude angle variation curve.
Sensors 25 07599 g002
Figure 3. Velocity variation curve.
Figure 3. Velocity variation curve.
Sensors 25 07599 g003
Figure 4. Trajectory variation curve.
Figure 4. Trajectory variation curve.
Sensors 25 07599 g004
Figure 5. Roll angle error curve.
Figure 5. Roll angle error curve.
Sensors 25 07599 g005
Figure 6. Pitch angle error curve.
Figure 6. Pitch angle error curve.
Sensors 25 07599 g006
Figure 7. Heading angle error curve.
Figure 7. Heading angle error curve.
Sensors 25 07599 g007
Figure 8. (a) Roll angle error curve; (b) Pitch angle error curve; (c) Heading angle error curve;.
Figure 8. (a) Roll angle error curve; (b) Pitch angle error curve; (c) Heading angle error curve;.
Sensors 25 07599 g008
Figure 9. (a) Attitude angle variation curve. (b) Velocity variation curve. (c) Trajectory variation curve. (d) Heading angle error for Segment 1. (e) Heading angle error for Segment 2. (f) Heading angle error for Segment 3. (g) Heading angle error for Segment 4.
Figure 9. (a) Attitude angle variation curve. (b) Velocity variation curve. (c) Trajectory variation curve. (d) Heading angle error for Segment 1. (e) Heading angle error for Segment 2. (f) Heading angle error for Segment 3. (g) Heading angle error for Segment 4.
Sensors 25 07599 g009aSensors 25 07599 g009b
Table 1. Sensor configuration.
Table 1. Sensor configuration.
SensorParameterValue
IMUSampling frequency100 Hz
Gyroscope bias0.01°/h
Gyroscope noise 0.001 ° / h
Accelerometer bias100 μg
Accelerometer noise 10   μ g / Hz
DVLSampling frequency5 Hz
Velocity noise standard deviation0.05 m/s
Outlier probabilityrandom noise amplified ×200
2%
Table 2. Comparison of the RMSE of the attitude angles in the first simulation.
Table 2. Comparison of the RMSE of the attitude angles in the first simulation.
Error TypeOBArOBAROBAMOBA
Pitch0.005°0.04°0.017°0.009°
Roll0.006°0.011°0.008°0.006°
Heading0.57°4.39°1.85°0.89°
Table 3. Parameters of the time-segmented outlier model.
Table 3. Parameters of the time-segmented outlier model.
SegmentDuration (s)Probability pMagnitude mag
10–600.00110
260–1200.01050
3120–1800.015100
4180–2400.020150
5240–3000.020200
Table 4. Comparison of the RMSE of the attitude angles in the second simulation.
Table 4. Comparison of the RMSE of the attitude angles in the second simulation.
Error TypeOBArOBAROBAMOBA
Pitch0.005°0.04°0.02°0.001°
Roll0.006°0.012°0.007°0.011°
Heading0.64°4.36°1.79°0.92°
Table 5. Sensor configuration.
Table 5. Sensor configuration.
SensorParameterValue
IMUSampling frequency98 Hz
Gyroscope bias stability 0.01°/h
Gyroscope angle random walk < 0.03 ° / h / Hz
Accelerometer bias stability100 μg
Accelerometer velocity random walk < 10 μ g / Hz
DVLSampling frequency1 Hz
Standard deviation of velocity measurement noise0.1 m/s
Outlier probabilityprobability of 2%
Table 6. Heading RMSE for Segment 1–4.
Table 6. Heading RMSE for Segment 1–4.
SegmentOBArOBAROBAMOBA
10.1160°8.7566°0.7660°0.2001°
20.3416°3.2290°0.2102°0.3725°
30. 8062°11.1331°0.6311°0.8092°
40.2623°13.7160°0.3188°0.2727°
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Shen, Y.; Luo, L.; Wang, G.; Liu, T.; Luo, L.; Guo, J.; Wang, S. Outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance. Sensors 2025, 25, 7599. https://doi.org/10.3390/s25247599

AMA Style

Shen Y, Luo L, Wang G, Liu T, Luo L, Guo J, Wang S. Outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance. Sensors. 2025; 25(24):7599. https://doi.org/10.3390/s25247599

Chicago/Turabian Style

Shen, Yidong, Li Luo, Guoqing Wang, Tao Liu, Lin Luo, Jiaxi Guo, and Shuangshuang Wang. 2025. "Outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance" Sensors 25, no. 24: 7599. https://doi.org/10.3390/s25247599

APA Style

Shen, Y., Luo, L., Wang, G., Liu, T., Luo, L., Guo, J., & Wang, S. (2025). Outlier-Resistant Initial Alignment of DVL-Aided SINS Using Mahalanobis Distance. Sensors, 25(24), 7599. https://doi.org/10.3390/s25247599

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop