A Polar Robust Kalman Filter Algorithm for DVL-Aided SINSs Based on the Ellipsoidal Earth Model

Autonomous underwater vehicles (AUVs) play an increasingly essential role in the field of polar ocean exploration, and the Doppler velocity log (DVL)-aided strapdown inertial navigation system (SINS) is widely used for it. Due to the rapid convergence of the meridians, traditional inertial navigation mechanisms fail in the polar region. To tackle this problem, a transverse inertial navigation mechanism based on the earth ellipsoidal model is designed in this paper. Influenced by the harsh environment of the polar regions, unknown and time-varying outlier noise appears in the output of DVL, which makes the performance of the standard Kalman filter degrade. To address this issue, a robust Kalman filter algorithm based on Mahalanobis distance is used to adaptively estimate measurement noise covariance; thus, the Kalman filter gain can be modified to weight the measurement. A trial ship experiment and semi-physical simulation experiment were carried out to verify the effectiveness of the proposed algorithm. The results demonstrate that the proposed algorithm can effectively resist the influence of DVL outliers and improve positioning accuracy.


Introduction
Recently, the importance of the polar region, especially the Arctic Ocean, in traffic, economic, military, and scientific research has received increasing attention. Many researchers are devoted to polar science. In order to better explore the polar region, many challenging problems need to be solved. Polar navigation is the primary issue to be addressed. No matter what kind of carrier (e.g., the autonomous underwater vehicle (AUV)), precise navigation information is essential for the performance of tasks in the polar region. Considering the flexibility and concealment of AUVs, they can break through the season and terrain constraints of the polar environment for detection activities, improve data acquisition efficiency, and realize intelligent polar environment detection [1]. Thus, AUVs play an important role in polar ocean exploration, and AUV related navigation research is receiving increasing focus [2][3][4]. The reliability and accuracy of AUV navigation systems is critical for AUVs accomplishing tasks autonomously.
However, compared to the navigation method used in non-polar regions, the polar navigation of AUVs faces some difficulties. First, due to the peculiarities of polar geography, the traditional strapdown inertial navigation system (SINS) mechanism in the local-level geographic frame loses efficacy in the polar region [5]. The reason is that the meridian converges rapidly as the latitude increases, and the north reference definition thus becomes meaningless. Moreover, because the command angular velocity includes the tangent of latitude, calculation overflow and error amplification are inevitable in the polar region. A lot of work has been devoted to solving this problem. The main idea is to redefine the navigation frame used in the polar region in order to solve the calculation overflow Chang [19] proposes a robust Kalman filter algorithm, with the Mahalanobis distance between the measurement vector and its one-step prediction as a criterion, which can resist the influence of outliers on the filter results and adaptively estimate the measurement noise covariance value. The algorithm has good performance in terms of improving navigation accuracy in the presence of observation outliers.
In this paper, a new transverse integrated navigation method based on the earth ellipsoidal model is proposed. Compared to the traditional method, the proposed method reduces the error model based on the earth ellipsoid model and has higher accuracy in relation to long-endurance navigation. In addition, a DVL-aided SINS using a robust Kalman filter based on the Mahalanobis distance is proposed in order to cope with the complex environment in polar regions. The ship experiments and semi-physical simulation experiments verify that the algorithm can improve the positioning accuracy of the navigation system at mid-latitudes and in the polar region and resist the impact of DVL outliers on positioning accuracy. The structure of this paper is as follows: Section 2 introduces the definition of the transverse frame and designs a corresponding SINS mechanism based on the earth ellipsoidal model. Section 3 analyzes the system dynamic model of the DVL-aided SINS and designs a respective measurement model. In Section 4, a robust Kalman filter with Mahalanobis distance as a criterion is proposed to resist the influence of outliers on the filter results and adaptively estimate the measurement noise covariance value. In Section 5, the ship and semi-physical experiments used to evaluate the proposed algorithm are described. Finally, conclusions are drawn in Section 6.

Transverse Frame Definition and SINS Navigation Mechanism
The transverse frame can be used as navigation frame in the polar region. The meridian convergence at high latitudes has no effect on it due to the fact that the polar region in the traditional local-level geographic frame becomes the region adjacent to the equator in the redefined transverse frame. This section introduces the definition of the transverse frame, including the transverse earth frame and transverse local-level geographic frame, as well as the transformation relationship between them. Further, based on assumption of the ellipsoidal earth model, the SINS mechanism in the transverse local-level geographic frame is designed.

Transverse Frame Definition
There are several different transverse frame definitions, and the differences between them are small. The transverse frame defined in this paper is the same as the one defined in Yao et al. [8]. As shown in Figure 1, the transverse earth frame is denoted by the e' frame. The e' frame can be defined through two sequence rotations of the earth-centered earth-fixed frame, i.e., e frame. Namely, the e frame is rotated −90 • around its x e axis, then rotated −90 • around the intermediate z e axis. The direction cosine matrix (DCM) between them can be written as follows: The Greenwich meridian plane becomes the transverse equator in the transverse earth frame. The intersection point of the 90 • E meridian with the equator is the transverse north pole N', and the intersection point of the 90 • W meridian with the equator is the transverse south pole S'. The transverse parallel is parallel to the transverse equator. The semi-ellipse passing through the transverse north pole N', the transverse south pole S', and the north pole N is the transverse 0 • meridian. The transverse local-level geographic frame is defined as the t-frame. Its definition is as follows: the origin is at point P 0 , which is the projection point of the AUV position point P on the local-level plane; the x t axis is along the tangent of the transverse parallel and toward to the transverse east; the z t axis is along the upward direction, which is vertical to the local-level plane, and coincides with the z g axis is the projection point of the AUV position point P on the local-level plane; the xt axis is along the tangent of the transverse parallel and toward to the transverse east; the zt axis is along the upward direction, which is vertical to the local-level plane, and coincides with the zg axis of the local-level geographic frame; the yt axis, xt axis, and zt axis constitute a right-handed orthogonal frame. The xt axis, yt axis, and zt axis are respectively denoted by E t , N t , and U t . The projection of point P on the transverse equator is denoted by point M. The intersection point of the normal PP0 and the transverse equator is denoted by point Q. The transverse longitude λ t is defined as the included angle between the transverse equator and the PQM plane. The transverse latitude L t is defined as the included angle between the line PQ and the transverse equator, namely, the included angle between the line PQ and the line MQ.
Moreover, in this paper, the i frame, b frame, d frame, and the g frame respectively represent the inertial frame, the body frame of the AUV, the body frame of the DVL, and the local-level geographic frame, with tri-axes denoted by E g , N g , U g (xg axis, yg axis, and zg axis). The b frame and d frame both adopt the 'right-front-up' definition.
Transverse Equator Transverse Longitude Transverse Parallel where L is the traditional latitude and λ the traditional longitude. Similarly, the DCM from the e' frame to the t frame is written as ' sin cos 0 sin cos sin sin cos cos cos cos sin sin According to the chain rule, the DCM from the g frame to the t frame can be written as t t e e g e e g C = C C C (4) By geometric trigonometry, the relationships between the transverse latitude and transverse longitude and the traditional latitude and traditional longitude are as follows: The DCM from the e frame to the g frame is written as where L is the traditional latitude and λ the traditional longitude. Similarly, the DCM from the e' frame to the t frame is written as According to the chain rule, the DCM from the g frame to the t frame can be written as By geometric trigonometry, the relationships between the transverse latitude and transverse longitude and the traditional latitude and traditional longitude are as follows: where C 23 represents the element in the second row and third column of the matrix C t e .C 12 represents the element in the first row and second column of the matrix C t e . The inverse transformation relationship between them can also be obtained by a similar method. Note that the height definition h t , no matter whether in the transverse local-level geographic Sensors 2022, 22, 7879 5 of 19 frame or the local-level geographic frame, is the same and is defined as the vertical distance from the horizontal plane. The height's positive direction is upward.
According to the above defined transverse local-level geographic frame, there is an angle, σ, between the transverse north reference and the traditional north reference. The DCM from the g frame to the t frame can also be written as According to Equations (4) and (6), substituting Equations (1)- (3) and (5) into Equation

Transverse SINS Mechanism Based on the Earth Ellipsoidal Model
Generally, the transverse SINS mechanism adopts the spherical earth model regarding the flexibility of mathematical calculation. However, the earth is closer to an ellipsoid, and there is an error in principle related to the spherical assumption. Aiming at solving this problem, the earth ellipsoidal model is adopted in this paper. In fact, under assumption of the ellipsoidal earth model, the transverse north reference can be obtained by rotating the grid north reference −90 • around the upward direction, which makes it easier to transform between them.
The attitude update equation in the transverse local-level geographic frame is written as where C t b is the DCM from the b frame to the t frame, ω b ib is the angular velocity of the b frame relative to the i frame as measured by the gyro assembly, [•×] is the symmetric matrix of vector •, and ω t it is the angular velocity of the t frame relative to the i frame, which can be expressed as with where ω t ie is the angular velocity of the e' frame relative to the i frame, ω t e t is the angular velocity of the t frame relative to the e' frame, ω ie is the earth rotation rate, R x is the radius of the curvature along the x axis, R y is the radius of the curvature along the y axis, τ is the twist rate of the ellipsoidal, v t E is the transverse east velocity, and v t N is the transverse north velocity. The right side of Equation (10) can be written as 1−e 2 cos 2 L t cos 2 λ t R N = R e (1−e) 2 (1−e 2 cos 2 L t cos 2 λ t ) 3/2 (11) where R e is the earth semi-major axis radius and e is the eccentricity of the earth. The velocity update equation in the transverse local-level geographic frame is written as where T is the AUV's velocity, f b is the specific force measured by the accelerometer assembly, and g t is the gravity vector. The position evolution in the transverse local-level geographic frame is expressed as the following position DCM differential equation and height differential equation: When the AUV sails into the polar region, the navigation frame is switched from the g frame to the t frame. Therefore, the navigation parameters should also be projected in the corresponding navigation frame, and the transformation relationship is as follows: Similarly, when the AUV sails out of the polar region, the inverse transformation relationship can be obtained.

Kalman Filter Model Design for a DVL-Aided SINS in the Transverse Frame
With the assist of the DVL, the SINS error can be restrained, and the polar navigation accuracy can thus be maintained. Generally, a Kalman filter is used as the information fusion method to fuse the information from the DVL and the SINS. This section introduces the system dynamic model and measurement model of the DVL-aided SINS, and corresponding models are designed in the transverse local-level geographic frame.

System Dynamic Model Design
The system dynamic model of the DVL-aided SINS includes two parts: the SINS error equation and the DVL error equation. The SINS error equation includes the attitude error equation, the velocity error equation, and the position error equation. These equations have similar styles to the corresponding equations projected in the traditional local-level geographic frame. These equations can be obtained by perturbing Equations (8), (12), and (13).
The SINS attitude error equation projected in the t frame is as follows: where δθ t is the position error angle related to the position DCM C t e (its components are δθ t E , δθ t N , and δθ t U , respectively), δω b ib is the gyro assembly error including gyro bias ε b and gyro noise w b g , and R eh t = R e + h t is just a simplified representation. Note that the Equation (18) ignores the earth ellipse and the influence of distortion. δθ t E and δθ t N are the equivalent representational forms of position error.
The SINS velocity error equation projected in the t frame is as follows: a is the accelerometer assembly error including accelerometer bias ∇ b and accelerometer noise w b a . The gyro and accelerometer biases can be modelled by a first-order Markov process as where τ g and τ a are the correlation time of the Markov process and w Mg and w Ma represent the zero-mean Gaussian white noise. The SINS position error equation projected in the t frame is as follows: where the position error angle and the height error are adopted to describe position error. Moreover, perturbing Equation (3) and rearranging both sides of it yields Equation (22) demonstrates that the elements of the position error angle vector are linearly related: Therefore, only two error angles are required to describe the error in the position DCM. In this paper, δθ t E and δθ t N are selected, as Equation (18) shows. For simplicity, the DVL error equation includes the installation error equation and the scale factor error equation. The output of the DVL in the b frame can be expressed as follows: error of the DVL relative to the AUV's body frame, C b d is the true installation error matrix, δk is the scale factor error of the DVL, v d is the true AUV velocity projected in the d frame, and δv d is the DVL measurement noise. Since the projection of forward velocity measured by the DVL does not receive the effect of the roll angle, the roll angle error can be ignored. The DVL error parameters can be taken as constants, namely, At this point, the system error states are listed as follows: The system dynamic model is written as .

x(t) = F(t)x(t) + G(t)w(t)
where F(t) is the system state matrix, G(t) is the system noise matrix, and w(t) is system noise. These matrices can be determined by Equations (15), (19)-(21), and (26).

Measurement Model Design
The difference between the SINS velocity output and the DVL velocity output is used as the Kalman filter measurement vector, which can be expressed as whereṽ t SI NS is the SINS velocity computed value (which is the sum of true velocity v t and velocity error δv t ) andC t b is the computed attitude DCM, which can be written as The measurement model can be written as follows: where z(t) is the measurement vector, H(t) is the measurement matrix whose components can be determined according to Equation (32), and υ(t) is measurement noise.

Robust Kalman Filter Algorithm
Under the assumptions of Gaussian-distributed system noise and measurement noise, the standard Kalman filter is the optimal choice as its error is the minimal mean squared and it is unbiased and consistent. However, if the system noise or measurement noise is a non-Gaussian distribution, the Kalman filter performance is inevitably degraded, especially regarding the gross error of measurement. In actual application environments, especially in the harsh environment of the polar region, the measurement noise of the DVL will be affected by the environment, and its working state will not stable. There is occasional gross error in the DVL output. These conditions do not meet the assumptions of the standard Kalman filter, thus the normal working state of the integrated navigation filter will be affected. Aiming at solving this problem, this section introduces the Mahalanobis distance of the innovation vector as a criterion to adjust measurement noise variance.

Standard Kalman Filter Algorithm
The Kalman filter is the most commonly used information fusion method in the integrated navigation systems of AUVs. Based on the system dynamic model and measurement model introduced in Section 3.1, the basic assumptions of the Kalman filter regarding system noise and measurement noise are as follows: where δ kj is the Kronecker delta function (its value is 1 when k = j and 0 otherwise), Q k is the system noise covariance matrix, and R k is the measurement noise covariance matrix.
Both system noise and measurement noise are modeled as zero-mean Gaussian white noise.
Generally, the Kalman filter process can be divided into time update and measurement update.
The time update process of the Kalman filter in discrete forms begins with the one-step prediction of system state, which is as follows: The covariance matrix of the one-step prediction is as follows: whereX k−1 represents state estimation at the epoch k−1,X k/k−1 is the one-step prediction of state estimation, Φ k/k−1 is the state transition matrix, P k/k−1 is the one-step prediction of covariance matrix, P k−1 is the covariance matrix of state estimation at the epoch k−1, and Γ k−1 is the system noise matrix.
If the DVL output is obtained, its one-step prediction can be used to form an innovation vector, which is as follows:Z whereZ k is the innovation vector, Z k is the measurement vector at epoch k, H k is the measurement matrix, and Z k/k−1 = H kXk/k−1 is the measurement one-step prediction. The Kalman filter gain matrix is represented as follows: The state estimation at epoch k is as follows: The covariance matrix at epoch k can be represented as follows: The standard Kalman filter process is shown in Figure 2. is the system noise matrix. If the DVL output is obtained, its one-step prediction can be used to form an innovation vector, which is as follows: H is the measurement matrix, and H X is the measurement one-step prediction. The Kalman filter gain matrix is represented as follows: The state estimation at epoch k is as follows: The covariance matrix at epoch k can be represented as follows: The standard Kalman filter process is shown in Figure 2.

Robust Kalman Filter Algorithm
The standard Kalman filter is optimal if the DVL measurement noise is a zero-mean Gaussian distribution. However, the harsh polar environment adverse influences DVL performance, which causes gross error and thick-tailed noise to appear [20]. These conditions do not meet the assumptions of the standard Kalman filter and will thus affect the

Robust Kalman Filter Algorithm
The standard Kalman filter is optimal if the DVL measurement noise is a zero-mean Gaussian distribution. However, the harsh polar environment adverse influences DVL performance, which causes gross error and thick-tailed noise to appear [20]. These conditions do not meet the assumptions of the standard Kalman filter and will thus affect the normal working state of the filter. Generally, by adjusting the measurement noise covariance matrix according to some criterion, the performance of the Kalman filter can be improved. The notation of the Mahalanobis distance is introduced here, which denotes the distance of two different vectors.
where Σ is covariance matrix. In the standard Kalman filter, the Mahalanobis distance between the measurement vector Z k and its one-step prediction Z k/k−1 is defined as Equation (41), which is used as the criterion for judging the abnormal value of the measurement [19]: where M k denotes Mahalanobis distance at epoch k. In fact, if the basic assumptions of the standard Kalman filter are satisfied, M 2 k should be chi-square distributed with degree of freedom m, which is the dimensional measurement vector. Therefore, the chi-square test can be used to determine if Z k is an outlier. According to the given statistical threshold χ α and significance level α, if M 2 k ≤ χ 2 α , Z k is considered as a normal measurement; however, if M 2 k > χ 2 α , Z k is considered as an outlier, and the measurement noise is inflated as follows to achieve robust estimation:R whereR k denotes the inflated measurement noise covariance and λ k the inflated factor of R k . Substituting Equation (42) into Equation (41) yields At this point,M k can be viewed as a function of λ k . By the choice of λ k ,M k should meet the normal value judgment whereP k/k−1 = H k P k/k−1 H T k . λ k can be solved by Newton's iterative method, which is given by where i is the number of iterations. The initial value of λ k is selected as 1.
According to Equation (45), the iterative calculation process of λ k is expressed as follows: and the iterative process terminates whenM 2 k (i) ≤ χ 2 α . After solving for λ k , the adjust filter gain matrix can be expressed as follows: The robust state estimation can be updated based on the above mentionedK k . To sum up, the algorithm of the robust Kalman filter is shown in Figure 3.

Experimental Result and Discussion
To verify the effectiveness of the proposed algorithm in this paper, a ship experim and semi-physical simulation experiment were carried out. Since the transverse fram also applicable at mid-latitudes, the effectiveness of the proposed algorithm is firstly ified through a ship experiment. The collected raw data of the SINS and DVL is then verted to the polar regions to further verify the effectiveness of the algorithm using semi-physical simulation method proposed in [8].

Ship Experiment
The trial ship was equipped with a DVL-aided SINS and a GNSS, which was use the reference equipment. The corresponding equipment parameters are listed in Tab The sailing area was a section of the Yangtze River. The velocity measured by the D was relative to the ground. The ship trajectory is shown in Figure 4a,b, and the coordin of the starting position were [110.98 °E, 30.96 °N]. The ship experiment lasted about The first 900 s of the experiment was for initial SINS alignment, and the ship retur after about 3.3 h. The velocity measured by the DVL is projected in the d-frame, and it be converted to the b-frame with the DVL installation error parameters. As shown in ure 5, there are some outliers in the DVL velocity output because of its unstable wor condition. In addition, the unknown environment also affects the working condition the DVL, and its measurement accuracy decreases as a result.

Experimental Result and Discussion
To verify the effectiveness of the proposed algorithm in this paper, a ship experiment and semi-physical simulation experiment were carried out. Since the transverse frame is also applicable at mid-latitudes, the effectiveness of the proposed algorithm is firstly verified through a ship experiment. The collected raw data of the SINS and DVL is then converted to the polar regions to further verify the effectiveness of the algorithm using the semi-physical simulation method proposed in [8].

Ship Experiment
The trial ship was equipped with a DVL-aided SINS and a GNSS, which was used as the reference equipment. The corresponding equipment parameters are listed in Table 1. The sailing area was a section of the Yangtze River. The velocity measured by the DVL was relative to the ground. The ship trajectory is shown in Figure 4a,b, and the coordinates of the starting position were [110.98 • E, 30.96 • N]. The ship experiment lasted about 6 h. The first 900 s of the experiment was for initial SINS alignment, and the ship returned after about 3.3 h. The velocity measured by the DVL is projected in the d-frame, and it can be converted to the b-frame with the DVL installation error parameters. As shown in Figure 5, there are some outliers in the DVL velocity output because of its unstable working condition. In addition, the unknown environment also affects the working conditions of the DVL, and its measurement accuracy decreases as a result.   However, the outliers in the DVL outputs are difficult identify with the standard Kalman filter. If they are used as a measurement vector by the standard Kalman filter, the   However, the outliers in the DVL outputs are difficult identify with the standard Kalman filter. If they are used as a measurement vector by the standard Kalman filter, the performance will inevitably be degraded. To verify the effectiveness of the proposed algorithm, three groups of experiments were carried out for comparison, and the navigation However, the outliers in the DVL outputs are difficult identify with the standard Kalman filter. If they are used as a measurement vector by the standard Kalman filter, the performance will inevitably be degraded. To verify the effectiveness of the proposed algorithm, three groups of experiments were carried out for comparison, and the navigation frame of the three groups of experiments was the transverse frame in all cases. Moreover, for the sake of convenience, all the experimental results were converted to the traditional local-level geographic frame for presentation. The three groups of comparison experiments are listed as follows: • Group 1 directly used the DVL velocity output as the measurement vector, and the standard Kalman filter (KF) was performed for data fusion. • Group 2 also used the standard Kalman filter for data fusion, but only a time update was performed when the DVL worked abnormally. • Group 3 used a robust Kalman filter (RKF) for data fusion and did not remove the outliers of DVL outputs.
The measurement noise variance used by the standard Kalman filter and robust Kalman filter is shown in Figure 6. It can be seen that the robust Kalman filter can adjust the measurement noise covariance value adaptively according to the DVL measurement value. However, the standard Kalman filter only uses a constant measurement noise covariance value. Taking GNSS-aided SINS velocity as the benchmark, comparison of the velocity errors of the three groups is shown in Figure 7, which can demonstrate the influence of the outliers on the integrated navigation accuracy. Besides the east velocity error and the north velocity error, the radial velocity error is also calculated, which is the vector sum of the east velocity error and north velocity error. Since the upward velocity measured by the DVL is not accurate, the trial ship's upward velocity is considered to be 0 m/s in the experiments. As can be seen from Figure 7, the velocity errors of Group 1 are drastically affected by the outliers and, in the case of abnormal DVL output appearing, the wrong velocity values affect the normal operation of the integrated navigation system. The maximum radial velocity error of the three groups was 7.09 m/s, 0.91 m/s, and 0.87 m/s, respectively. The root mean square error (RSME) of the radial velocity is shown in Figure 8, which was calculated every 10 s. The time-averaged RMSE (TARMSE) of the three groups was 0.24 m/s, 0.13 m/s, and 0.073 m/s, respectively. Group 2 and Group 3 are almost unaffected by the DVL outliers. Note that Group 2 can only be used as a post-processing result due to the fact that outliers are artificially removed. frame of the three groups of experiments was the transverse frame in all cases. Moreover, for the sake of convenience, all the experimental results were converted to the traditional local-level geographic frame for presentation. The three groups of comparison experiments are listed as follows: • Group 1 directly used the DVL velocity output as the measurement vector, and the standard Kalman filter (KF) was performed for data fusion. • Group 2 also used the standard Kalman filter for data fusion, but only a time update was performed when the DVL worked abnormally. • Group 3 used a robust Kalman filter (RKF) for data fusion and did not remove the outliers of DVL outputs.
The measurement noise variance used by the standard Kalman filter and robust Kalman filter is shown in Figure 6. It can be seen that the robust Kalman filter can adjust the measurement noise covariance value adaptively according to the DVL measurement value. However, the standard Kalman filter only uses a constant measurement noise covariance value. Taking GNSS-aided SINS velocity as the benchmark, comparison of the velocity errors of the three groups is shown in Figure 7, which can demonstrate the influence of the outliers on the integrated navigation accuracy. Besides the east velocity error and the north velocity error, the radial velocity error is also calculated, which is the vector sum of the east velocity error and north velocity error. Since the upward velocity measured by the DVL is not accurate, the trial ship's upward velocity is considered to be 0 m/s in the experiments. As can be seen from Figure 7, the velocity errors of Group 1 are drastically affected by the outliers and, in the case of abnormal DVL output appearing, the wrong velocity values affect the normal operation of the integrated navigation system. The maximum radial velocity error of the three groups was 7.09 m/s, 0.91 m/s, and 0.87 m/s, respectively. The root mean square error (RSME) of the radial velocity is shown in Figure 8, which was calculated every 10 s. The time-averaged RMSE (TARMSE) of the three groups was 0.24 m/s, 0.13 m/s, and 0.073 m/s, respectively. Group 2 and Group 3 are almost unaffected by the DVL outliers. Note that Group 2 can only be used as a postprocessing result due to the fact that outliers are artificially removed.   The comparison of positioning errors from the three groups is shown in Figure 9. It can be seen that the effect of velocity outliers on positioning accuracy is devastating. The positioning error of Group 1 oscillates dramatically due to the presence of DVL outliers, and the maximum radial positioning error is about 457 m. In addition, the outliers cause the estimated trajectory of Group 1 to gradually deviate from the true trajectory. Although the positioning accuracy of Group 2 is improved by removing the outliers and its maximum radial positioning error is about 117.7 m, it is obvious in Figure 9 that the positioning error oscillates significantly at the turn around. This is due to the rapid change in the ship's attitude that leads to the inaccurate DVL velocity output. During this period, only the pure inertial navigation is performed, leading to the accumulation of navigation errors. This also illustrates the limitation of the standard Kalman filter, which cannot adaptively modify the measurement noise covariance value to eliminate the adverse impact of inaccurate DVL velocity. As expected, the maximum radial positioning error of Group 3 is about 81.5 m, which is the minimum value among the three groups in the experiments. The RMSE of the position is shown in Figure 10, which was calculated every 10 s. The TARMSE of the three Groups was 326.89 m, 53.48 m, and 40.22 m, respectively. Group 3 improved by 87.7% compared to Group 1 and improved by 24.8% compared to Group 2. Since the measurement noise covariance value is adaptively modified according to the  The comparison of positioning errors from the three groups is shown in Figure 9. It can be seen that the effect of velocity outliers on positioning accuracy is devastating. The positioning error of Group 1 oscillates dramatically due to the presence of DVL outliers, and the maximum radial positioning error is about 457 m. In addition, the outliers cause the estimated trajectory of Group 1 to gradually deviate from the true trajectory. Although the positioning accuracy of Group 2 is improved by removing the outliers and its maximum radial positioning error is about 117.7 m, it is obvious in Figure 9 that the positioning error oscillates significantly at the turn around. This is due to the rapid change in the ship's attitude that leads to the inaccurate DVL velocity output. During this period, only the pure inertial navigation is performed, leading to the accumulation of navigation errors. This also illustrates the limitation of the standard Kalman filter, which cannot adaptively modify the measurement noise covariance value to eliminate the adverse impact of inaccurate DVL velocity. As expected, the maximum radial positioning error of Group 3 is about 81.5 m, which is the minimum value among the three groups in the experiments. The RMSE of the position is shown in Figure 10, which was calculated every 10 s. The TARMSE of the three Groups was 326.89 m, 53.48 m, and 40.22 m, respectively. Group 3 improved by 87.7% compared to Group 1 and improved by 24.8% compared to Group 2. Since the measurement noise covariance value is adaptively modified according to the The comparison of positioning errors from the three groups is shown in Figure 9. It can be seen that the effect of velocity outliers on positioning accuracy is devastating. The positioning error of Group 1 oscillates dramatically due to the presence of DVL outliers, and the maximum radial positioning error is about 457 m. In addition, the outliers cause the estimated trajectory of Group 1 to gradually deviate from the true trajectory. Although the positioning accuracy of Group 2 is improved by removing the outliers and its maximum radial positioning error is about 117.7 m, it is obvious in Figure 9 that the positioning error oscillates significantly at the turn around. This is due to the rapid change in the ship's attitude that leads to the inaccurate DVL velocity output. During this period, only the pure inertial navigation is performed, leading to the accumulation of navigation errors. This also illustrates the limitation of the standard Kalman filter, which cannot adaptively modify the measurement noise covariance value to eliminate the adverse impact of inaccurate DVL velocity. As expected, the maximum radial positioning error of Group 3 is about 81.5 m, which is the minimum value among the three groups in the experiments. The RMSE of the position is shown in Figure 10, which was calculated every 10 s. The TARMSE of the three Groups was 326.89 m, 53.48 m, and 40.22 m, respectively. Group 3 improved by 87.7% compared to Group 1 and improved by 24.8% compared to Group 2. Since the measurement noise covariance value is adaptively modified according to the DVL measurement value, the robust Kalman filter significantly improves positioning accuracy. DVL measurement value, the robust Kalman filter significantly improves positioning accuracy.
Although outliers in the DVL output can be artificially removed through data postprocessing, the identification of outliers using a standard Kalman filter is difficult in the actual navigation system. However, the robust Kalman filter can effectively solve this problem. This experiment verifies the effectiveness of the robust Kalman filter in DVLaided SINSs in the transverse frame.

Semi-Physical Simulation Experiment
Due to the difficulty of conducting experiments in the polar regions, the semi-physical simulation method proposed in [8] is adopted to generate the raw data of SINSs and DVLs at high latitudes, which can then be used to verify the algorithm proposed in this paper. The experimental data collected at mid-latitudes were converted to simulate the trial ship condition in the polar region, and the converted trajectory is shown in Figure 11. The simulated trial ship trajectory is near the 80 °N. The semi-physical simulation method used in this paper keeps the attitude and velocity of the trial ship relative to the ground unchanged and only changes the position relative to the earth. Thus, the DVL measurement is still valid in the experiment. Moreover, the maneuvering situation of the trial ship Although outliers in the DVL output can be artificially removed through data postprocessing, the identification of outliers using a standard Kalman filter is difficult in the actual navigation system. However, the robust Kalman filter can effectively solve this problem. This experiment verifies the effectiveness of the robust Kalman filter in DVLaided SINSs in the transverse frame.

Semi-Physical Simulation Experiment
Due to the difficulty of conducting experiments in the polar regions, the semi-physical simulation method proposed in [8] is adopted to generate the raw data of SINSs and DVLs at high latitudes, which can then be used to verify the algorithm proposed in this paper. The experimental data collected at mid-latitudes were converted to simulate the trial ship condition in the polar region, and the converted trajectory is shown in Figure 11. The simulated trial ship trajectory is near the 80 °N. The semi-physical simulation method used in this paper keeps the attitude and velocity of the trial ship relative to the ground unchanged and only changes the position relative to the earth. Thus, the DVL measurement is still valid in the experiment. Moreover, the maneuvering situation of the trial ship Although outliers in the DVL output can be artificially removed through data postprocessing, the identification of outliers using a standard Kalman filter is difficult in the actual navigation system. However, the robust Kalman filter can effectively solve this problem. This experiment verifies the effectiveness of the robust Kalman filter in DVLaided SINSs in the transverse frame.

Semi-Physical Simulation Experiment
Due to the difficulty of conducting experiments in the polar regions, the semi-physical simulation method proposed in [8] is adopted to generate the raw data of SINSs and DVLs at high latitudes, which can then be used to verify the algorithm proposed in this paper. The experimental data collected at mid-latitudes were converted to simulate the trial ship condition in the polar region, and the converted trajectory is shown in Figure 11. The simulated trial ship trajectory is near the 80 • N. The semi-physical simulation method used in this paper keeps the attitude and velocity of the trial ship relative to the ground unchanged and only changes the position relative to the earth. Thus, the DVL measurement is still valid in the experiment. Moreover, the maneuvering situation of the trial ship can be maintained to the greatest extent possible. However, compared to the mid-latitudes, the increased latitude makes the longitude variation region bigger in the case of identical trajectories. Figure 12 shows the simulated DVL velocity outputs. As mentioned above, the semi-physical simulation method adopted in this paper can maintain an unchanged DVL velocity measurement. As a result, the outliers still exist in the DVL outputs, and the adverse effect of them should be removed by the filter algorithm.
can be maintained to the greatest extent possible. However, compared to the mid-latitudes, the increased latitude makes the longitude variation region bigger in the case of identical trajectories. Figure 12 shows the simulated DVL velocity outputs. As mentioned above, the semi-physical simulation method adopted in this paper can maintain an unchanged DVL velocity measurement. As a result, the outliers still exist in the DVL outputs, and the adverse effect of them should be removed by the filter algorithm.  Three groups of experiments were conducted for comparison that were the same as the experiments at mid-latitudes. The navigation frame used was the t-frame. Comparison of the velocity errors for the three groups of experiments is shown in Figure 13. As shown, the velocity errors at high latitudes are almost the same as those at mid-latitudes due to the fact that the DVL velocity measurement remains unchanged. The maximum radial velocity errors of the three groups were 7.11 m/s, 0.98 m/s, and 0.84 m/s, respectively. The RMSE of radial velocity is shown in Figure 14, which was calculated every 10 s. The TARMSE of the three groups was 0.24 m/s, 0.095 m/s, and 0.078 m/s, respectively. The results are consistent with the mid-latitude regions. Importantly, the standard Kalman filter cannot resist the adverse effect of DVL outliers. The robust Kalman filter can solve this problem well. The comparison of positioning errors is shown in Figure 15. It can be can be maintained to the greatest extent possible. However, compared to the mid-latitudes, the increased latitude makes the longitude variation region bigger in the case of identical trajectories. Figure 12 shows the simulated DVL velocity outputs. As mentioned above, the semi-physical simulation method adopted in this paper can maintain an unchanged DVL velocity measurement. As a result, the outliers still exist in the DVL outputs, and the adverse effect of them should be removed by the filter algorithm.  Three groups of experiments were conducted for comparison that were the same as the experiments at mid-latitudes. The navigation frame used was the t-frame. Comparison of the velocity errors for the three groups of experiments is shown in Figure 13. As shown, the velocity errors at high latitudes are almost the same as those at mid-latitudes due to the fact that the DVL velocity measurement remains unchanged. The maximum radial velocity errors of the three groups were 7.11 m/s, 0.98 m/s, and 0.84 m/s, respectively. The RMSE of radial velocity is shown in Figure 14, which was calculated every 10 s. The TARMSE of the three groups was 0.24 m/s, 0.095 m/s, and 0.078 m/s, respectively. The results are consistent with the mid-latitude regions. Importantly, the standard Kalman filter cannot resist the adverse effect of DVL outliers. The robust Kalman filter can solve this problem well. The comparison of positioning errors is shown in Figure 15. It can be Three groups of experiments were conducted for comparison that were the same as the experiments at mid-latitudes. The navigation frame used was the t-frame. Comparison of the velocity errors for the three groups of experiments is shown in Figure 13. As shown, the velocity errors at high latitudes are almost the same as those at mid-latitudes due to the fact that the DVL velocity measurement remains unchanged. The maximum radial velocity errors of the three groups were 7.11 m/s, 0.98 m/s, and 0.84 m/s, respectively. The RMSE of radial velocity is shown in Figure 14, which was calculated every 10 s. The TARMSE of the three groups was 0.24 m/s, 0.095 m/s, and 0.078 m/s, respectively. The results are consistent with the mid-latitude regions. Importantly, the standard Kalman filter cannot resist the adverse effect of DVL outliers. The robust Kalman filter can solve this problem well. The comparison of positioning errors is shown in Figure 15. It can be seen that the positioning errors of the three groups of experiments all increased as the latitudes rose. The reason for this is that initial alignment accuracy decreases at high latitudes, and the performance of the DVL-aided SINS is therefore inevitably influ-enced. The maximum radial positioning error of the three groups of experiments was 1289.0 m, 328.7 m, and 250.3 m, respectively. The RMSE of positions was calculated every ten seconds and is shown in Figure 16. The TARMSE of the three groups was 880.13 m, 170.46 m, and 141.69 m, respectively. The positioning accuracy of Group 3 was improved by 83.9% and 16.88% compared to Group 1 and Group 2. Moreover, at high latitudes, the adverse effect of the DVL outliers is even greater than it was for mid-latitudes. The reason for this is that observability of the system error states is decreased, which makes these estimations susceptibly influenced by the filter measurement. Through semi-physical simulation experiments, the effectiveness of the algorithm in the polar region is proven. The robust Kalman filter algorithm can resist the adverse effect of the DVL outliers and effectively improve the positioning accuracy of DVL-aided SINSs.
seen that the positioning errors of the three groups of experiments all increased as latitudes rose. The reason for this is that initial alignment accuracy decreases at high tudes, and the performance of the DVL-aided SINS is therefore inevitably influenced. maximum radial positioning error of the three groups of experiments was 1289.0 m, 3 m, and 250.3 m, respectively. The RMSE of positions was calculated every ten seconds is shown in Figure 16. The TARMSE of the three groups was 880.13 m, 170.46 m, 141.69 m, respectively. The positioning accuracy of Group 3 was improved by 83.9% 16.88% compared to Group 1 and Group 2. Moreover, at high latitudes, the adverse ef of the DVL outliers is even greater than it was for mid-latitudes. The reason for this is observability of the system error states is decreased, which makes these estimations ceptibly influenced by the filter measurement. Through semi-physical simulation exp ments, the effectiveness of the algorithm in the polar region is proven. The robust Kalm filter algorithm can resist the adverse effect of the DVL outliers and effectively impr the positioning accuracy of DVL-aided SINSs.   latitudes rose. The reason for this is that initial alignment accuracy decreases at hig tudes, and the performance of the DVL-aided SINS is therefore inevitably influence maximum radial positioning error of the three groups of experiments was 1289.0 m m, and 250.3 m, respectively. The RMSE of positions was calculated every ten second is shown in Figure 16. The TARMSE of the three groups was 880.13 m, 170.46 m 141.69 m, respectively. The positioning accuracy of Group 3 was improved by 83. 9 16.88% compared to Group 1 and Group 2. Moreover, at high latitudes, the adverse of the DVL outliers is even greater than it was for mid-latitudes. The reason for this observability of the system error states is decreased, which makes these estimation ceptibly influenced by the filter measurement. Through semi-physical simulation e ments, the effectiveness of the algorithm in the polar region is proven. The robust K filter algorithm can resist the adverse effect of the DVL outliers and effectively im the positioning accuracy of DVL-aided SINSs.

Conclusions
In order to address the AUV polar navigation issue, a polar robust Kalman fil gorithm for DVL-aided SINSs based on the earth ellipsoidal model is proposed i paper. The transverse local-level geographic frame is defined as the navigation fra the polar region, and the related navigation parameters are redefined. Based on the s ical earth assumption, the system dynamic model and measurement model of the aided SINS are respectively designed, and the error related to the earth parameter c avoided. Further, a robust Kalman filter with Mahalanobis distance as a criterion i posed to resist the influence of DVL outliers on the integrated navigation results and tively estimate the measurement noise covariance value, whereby the Kalman filte can be modified to weight the measurement. A trial ship experiment and semi-ph simulation experiment were carried out to verify the effectiveness of the proposed rithm. The results demonstrate that the proposed algorithm can effectively resist t

Conclusions
In order to address the AUV polar navigation issue, a polar robust Kalman f gorithm for DVL-aided SINSs based on the earth ellipsoidal model is proposed paper. The transverse local-level geographic frame is defined as the navigation fr the polar region, and the related navigation parameters are redefined. Based on the ical earth assumption, the system dynamic model and measurement model of th aided SINS are respectively designed, and the error related to the earth parameter avoided. Further, a robust Kalman filter with Mahalanobis distance as a criterion posed to resist the influence of DVL outliers on the integrated navigation results and tively estimate the measurement noise covariance value, whereby the Kalman filt can be modified to weight the measurement. A trial ship experiment and semi-p simulation experiment were carried out to verify the effectiveness of the propose rithm. The results demonstrate that the proposed algorithm can effectively resist fluence of DVL outliers and improve positioning accuracy.

Conclusions
In order to address the AUV polar navigation issue, a polar robust Kalman filter algorithm for DVL-aided SINSs based on the earth ellipsoidal model is proposed in this paper. The transverse local-level geographic frame is defined as the navigation frame in the polar region, and the related navigation parameters are redefined. Based on the spherical earth assumption, the system dynamic model and measurement model of the DVL-aided SINS are respectively designed, and the error related to the earth parameter can be avoided. Further, a robust Kalman filter with Mahalanobis distance as a criterion is proposed to resist the influence of DVL outliers on the integrated navigation results and adaptively estimate the measurement noise covariance value, whereby the Kalman filter gain can be modified to weight the measurement. A trial ship experiment and semi-physical simulation experiment were carried out to verify the effectiveness of the proposed algorithm. The results demonstrate that the proposed algorithm can effectively resist the influence of DVL outliers and improve positioning accuracy.