Next Article in Journal
A Hybrid TDMA/CSMA-Based Wireless Sensor and Data Transmission Network for ORS Intra-Microsatellite Applications
Next Article in Special Issue
Design of an Inertial-Sensor-Based Data Glove for Hand Function Evaluation
Previous Article in Journal
Sparsity-Driven Reconstruction Technique for Microwave/Millimeter-Wave Computational Imaging
Previous Article in Special Issue
An Innovative Strategy for Accurate Thermal Compensation of Gyro Bias in Inertial Units by Exploiting a Novel Augmented Kalman Filter
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Hybrid Transverse Polar Navigation for High-Precision and Long-Term INSs

Department of Precision Instrument, Tsinghua University, Beijing 100084, China
*
Authors to whom correspondence should be addressed.
Sensors 2018, 18(5), 1538; https://doi.org/10.3390/s18051538
Submission received: 16 April 2018 / Revised: 9 May 2018 / Accepted: 10 May 2018 / Published: 12 May 2018
(This article belongs to the Special Issue Inertial Sensors and Systems 2018)

Abstract

:
Transverse navigation has been proposed to help inertial navigation systems (INSs) fill the gap of polar navigation ability. However, as the transverse system does not have the ability of navigate globally, a complicated switch between the transverse and the traditional algorithms is necessary when the system moves across the polar circles. To maintain the inner continuity and consistency of the core algorithm, a hybrid transverse polar navigation is proposed in this research based on a combination of Earth-fixed-frame mechanization and transverse-frame outputs. Furthermore, a thorough analysis of kinematic error characteristics, proper damping technology and corresponding long-term contributions of main error sources is conducted for the high-precision INSs. According to the analytical expressions of the long-term navigation errors in polar areas, the 24-h period symmetrical oscillation with a slowly divergent amplitude dominates the transverse horizontal position errors, and the first-order drift dominates the transverse azimuth error, which results from the g 0 gyro drift coefficients that occur in corresponding directions. Simulations are conducted to validate the theoretical analysis and the deduced analytical expressions. The results show that the proposed hybrid transverse navigation can ensure the same accuracy and oscillation characteristics in polar areas as the traditional algorithm in low and mid latitude regions.

1. Introduction

Nowadays, the increased exploration of polar areas makes the high-precision navigation of airplanes and vessels at high latitudes an urgent requirement in economic, military and research fields [1,2]. Although there are abundant navigation methods at low and mid attitudes, most of them (e.g., radio navigation, satellite navigation, magnetic compasses and celestial navigation) are limited, or even invalid, in polar regions due to the special geometry and magnetic field required [3,4,5,6,7]. Fortunately, inertial navigation is based on dead reckoning with almost no need for external information [8], which makes inertial navigation systems (INSs) insensitive to the outside environment. Thus, INSs should be able to stably provide high-precision navigation solutions at high latitudes. However, some problems have to be solved first [9,10]. Firstly, the convergence of meridians causes a significant increase in longitude error and azimuth error at high latitudes and even the invalidity of the heading reference near the poles. Secondly, the rates of velocity and azimuth are predicted to sharply increase when the system passes through the poles, which could cause overflow during computing.
The primary cause of such problems is that the widely used definition of the navigation frame, namely, the geographic frame (n-frame), relies on the geographic distribution of parallels, meridians and the poles. A representative solution is to choose other navigation frames of which the definitions are independent of such geographic distribution. The grid system [11] and transverse system [12] have been proposed to achieve this goal. These two systems are based on a grid frame and a transverse frame, respectively, which have become widely used in recent research related to polar navigation. Although the practical differences between the two systems are inconspicuous, the transverse system is easier to visualize and less complicated [12]. Its basic idea is to move the poles to somewhere on the equator. Thus, the new equator will run through the traditional poles, and the advantages of equatorial navigation could be obtained in polar navigation [12]. However, as the shape of the Earth is closer to an ellipsoid than to a sphere, the standard transverse system is limited by the principle error resulting from the spherical assumption. Yao et al. [13] and Li et al. [14] modified the definition of the transverse frame under the ellipsoidal Earth model. These two works used different normals to indicate the local-level plane, and they also have different definitions of transverse latitude and transverse longitude. The modified transverse frame shown in reference [13] has similar advantages to the n-frame—able to indicate the movement and attitude relative to the surface of the Earth and to cooperate with external auxiliary information.
It should be noted that neither the grid system nor the transverse system has the ability to navigate globally. When the vehicle locates near the intersection points of the 90° W and 90° E meridians with the equator, both of the two systems face similar problems to the n-frame system in polar areas. As the n-frame is widely used at low and mid latitudes, the system needs a complicated switch between the polar navigation algorithm and the traditional algorithm when it moves across the polar circles, which would introduce a sudden change in the core integral process. Zhou et al. [15] and Yao et al. [16] have proposed indirect polar navigation methods, using a combination of the wander navigation system and grid navigation or the transverse navigation to achieve inner consistency. However, the wander attitude reference can be employed only in some polar regions because it would become invalid at latitudes of ± 90 ° [17]. Such a problem can be solved by choosing a navigation frame that is completely independent of the shape of the Earth and the system’s position. Based on this thought, Liu et al. [18] employed the pseudo INS mechanization to constitute a global navigation algorithm. The navigation calculation unit is executed in the pseudo-Earth frame under the spherical Earth model, which matches the standard transverse frame but is not a commonly-used mechanization in general INSs. In addition, the navigation calculation outputs under the spherical Earth model need to be corrected and transformed to the ellipsoidal Earth model for human–machine interaction and communication [18]. In order to achieve the same or better performance of global navigation with the least change in the existing systems, we would like to improve the algorithm one step further using the simpler, and more frequently used, Earth-fixed mechanization directly under the ellipsoidal Earth model.
In order to improve the precision of polar navigation, more factors have been considered. For example, an accurate initial alignment is essential for INSs. Gao et al. employed the unscented Kalman filter to accomplish the polar alignment based on the pseudo-Earth frame [19]. Cheng et al. used the adaptive unscented Kalman filter with the aid of a star sensor to improve the accuracy of polar transfer alignment for conditions where the master INS is inaccurate and the information from the system model is abnormal [20]. Wang et al. proposed a polar transfer alignment algorithm based on an improved adaptive Kalman filter, which aimed to solve the problem caused by lever-arm and flexural deformation [21]. Moreover, Yan et al. established an integrated navigation system to improve the polar navigation accuracy of unmanned underwater vehicles [22]. As for the high-precision and long-term INSs, it is not enough to merely provide the pure-inertial mechanization and error models. The analysis of damping technology and error propagation is also essential. Li et al. [23] proposed a polar damping technology for the transverse strapdown INS based on the system’s static error characteristics. Huang et al. designed a damping algorithm based on the Kalman filter to reduce the overshoot errors due to the switch from the non-damping state to the damping state [24]. In this paper, the damping technology is discussed, and two more aspects are taken into consideration: First, outside of the polar areas, the kinematic error characteristics could be analyzed using static models, as the system’s angular velocity around the Earth’s axis is far less than the Earth’s rotational rate. However, in polar areas, the movement around the Earth’s axis is non-ignorable compared with the Earth’s rotation and thus, results in a change in the error characteristics, which has not been addressed in existing works. Second, a damping method that does not increase the complexity of the navigation algorithm switch is preferred. In addition, navigation errors of INSs are induced by multiple error sources. Finding out long-term contributions of main error sources is essential for the design of high-precision INSs [25], which is barely discussed in the polar navigation themed existing works and will be addressed in this paper.
This research focuses on a hybrid polar navigation method which has a more concise form and will be easier to implement. A comprehensive analysis of this method is proposed including the basic mechanism, the pure-inertial error model, the discussion of proper damping technology and the corresponding long-term error propagation for high-precision INSs. The rest of this paper is arranged as follows: In Section 2, the oscillation of traditional horizontal channels in polar areas is reanalyzed considering the longitude rate. Then, the pure-inertial hybrid transverse polar navigation method and its error models are proposed in Section 3 and Section 4, respectively. In Section 5, the damping technology is discussed based on the kinematic error characteristics. The analytical expressions of the long-term navigation errors are deduced in Section 6. The simulation results are discussed in Section 7. Finally, conclusions are drawn in Section 8.

2. Traditional Horizontal Oscillation in Polar Regions

Before the polar navigation method for INSs is discussed, it should be noted that the convergence of meridians will cause other problems besides the rapid growth of errors. The system’s longitude rate ( λ ˙ ) is a function of the eastern velocity ( v E ) and latitude (L) [26]:
λ ˙ = v E ( R N + h ) cos L ,
where h is the height above the reference ellipsoid and R N is the normal radius of curvature taken in the direction of the prime vertical, given in [26,27]
R N = a ( 1 e 2 sin 2 L ) 1 / 2 ,
where a is the semi-major axis and e is the first eccentricity of the reference ellipsoid.
In Equation (1), cos L decreases along with the increase of latitude and will tend towards zero as the latitude approaches ± 90 ° . At low or mid latitudes, λ ˙ is far less than the Earth’s rotational rate ( ω i e ). Therefore, the low speed kinematic error characteristics can be represented using static error models. However, when the system moves along a certain parallel near the poles, the considerable magnification of λ ˙ leads to a difference between the static and kinematic oscillation characteristics in the system’s horizontal channels.
Based on the n-frame error models of the pure-inertial navigation [8,26,28], variables involving λ ˙ remain, while other relatively small quantities and the coupling between the vertical and the horizontal channels are neglected. Thus, the state equation of the kinematic errors in horizontal channels is simplified as
( δ r ˙ N δ r ˙ E δ v ˙ N δ v ˙ E ψ ˙ N ψ ˙ E ψ ˙ D ) = ( 0 λ ˙ sin L 1 0 0 0 0 λ ˙ sin L 0 0 1 0 0 0 ω s 2 0 0 ω 1 0 g 0 0 ω s 2 ω 1 0 g 0 0 0 0 0 0 0 ω 2 0 0 0 0 0 ω 2 0 ω 3 0 0 0 0 0 ω 3 0 ) ( δ r N δ r E δ v N δ v E ψ N ψ E ψ D ) + ( 0 0 N E ε N ε E ε D ) ,
where
ω 1 = ( 2 ω i e + λ ˙ ) sin L ω 2 = ( ω i e + λ ˙ ) sin L ω 3 = ( ω i e + λ ˙ ) cos L } .
In Equation (3), δ r N and δ r E are the Northern and Eastern position errors, δ v N and δ v E are the Northern and Eastern velocity errors, ψ N , ψ E and ψ D represent the Northern, Eastern and vertical components of the psi angle (the psi angle is a rotation vector that reflects the orientation difference between the computed version and the actual version of the navigation frame due to gyro errors [29]), ω s is the Schuler frequency, N and E are the Northern and Eastern accelerometer errors, ε N , ε E and ε D are the Northern, Eastern and vertical components of gyro drift errors, and g is the gravity acceleration.
Using A 7 × 7 to denote the coefficient matrix in Equation (3), the characteristic equation can be calculated from | sI A 7 × 7 | ( I denotes the 7 × 7 unit matrix), as
s ( s 2 + ω ˜ 2 ) [ s 4 + 2 ( Ω 2 + 2 ω ˜ 2 sin 2 L ) + Ω 4 ] = 0 ,
where
Ω 2 = ω s 2 λ ˙ sin 2 L ( λ ˙ + 2 ω i e ) ω ˜ = ω i e + λ ˙ } .
The roots of the characteristic equation consist of zero, a pair of purely imaginary numbers ± j( λ ˙ + ωie) and two pairs of complex numbers whose angular frequencies are approximately ωs ± ( λ ˙ + ωie)sin L. In contrast to the conditions at low and mid latitudes, the distribution of characteristic roots in polar areas is also influenced by the longitude rate, λ ˙ . Thus, the horizontal channels would have two kinds of oscillation characteristics according to the magnitude of λ ˙ .
(1) When the system situates in polar regions but is still away from the poles, the order of magnitude of λ ˙ is similar to ω i e and much smaller than ω s (e.g., λ ˙ = 8.95 × 10−5 rad/s for v E = 5   m / s at 89.5° N). In the short term, ( λ ˙ + ω i e ) sin   L can be neglected and the oscillations in horizontal channels are mainly Schuler oscillations. Therefore, the traditional damping network is still workable, and the angular frequency of the damped horizontal channels is λ ˙ + ωie, which means more drastic fluctuation in error curves.
(2) If the system is close enough to the poles, the order of magnitude of λ ˙ is similar to, or even bigger than, ω s (e.g., λ ˙ = 0.045 rad/s for v E = 5   m / s at 89.999° N). Then, the angular frequencies of the complex roots, namely λ ˙ + ωie and ω s ± ( λ ˙ + ω i e ) sin   L , are mainly determined by λ ˙ . This means that the fluctuation in horizontal channels will be far more drastic than Schuler oscillations. Therefore, the traditional damping network is invalid.
In summary, the problems that traditional INSs are confronted with in polar areas include not only the extremely large longitude error and azimuth error, but also more drastic fluctuation in the horizontal channels and even the invalidity of existing damp techniques due to the system’s movement. A polar inertial navigation algorithm should solve both the problems.

3. Mechanism of Hybrid Transverse Navigation

Fundamentally, all the problems that the traditional inertial navigation algorithm encounters in polar areas result from the convergence of meridians. If definitions of all the coordinates used in the navigation algorithm are not influenced by either the poles’ location or the distribution of parallels and meridians, such problems will be theoretically solved. Inertial-frame (i-frame) and the Earth-fixed-frame (e-frame) navigation are able to satisfy this demand.
For example, using e-frame as the navigation frame, the differential equations of position, velocity and direction cosine matrix of attitude are [8,25]
r ˙ e = v e v ˙ e = C m e f m 2 ω i e e v e + g e C ˙ m e = ω i e e C m e + C m e ω i m m } ,
where r is the position vector, v is the velocity vector relative to the Earth, f is the specific force vector measured by the accelerometer unit, g is the gravity vector, ω i e e is the angular velocity vector of the e-frame relative to the i-frame, ω i m m is the angular velocity vector of the measurement frame (m-frame) relative to the i-frame, the symbol indicates the formation of the antisymmetric matrix representation of the inner vector, and C m e is the direction cosine matrix from m-frame to e-frame.
Based on Equation (7), the e-frame error model of the pure-inertial system is [8,25]
δ r ˙ e = δ v e δ v ˙ e = f e Ψ e + C m e Δ f m 2 ω i e e δ v e + ( Γ s e ω i e e ω i e e ) δ r e + C n e δ g n Ψ ˙ e = ω i e e Ψ e + ε e } ,
where Γ s e is the tensor of gravitational gradients and Ψ e is the psi angle in the e-frame. The main error sources of an INS are the accelerometer error, Δ f m , gyro drift rate, ε e and the gravity disturbance vector, δ g n . In the differential equations of navigation errors, the variables C m e Δ f m , ε e , C n e δ g n , f e and r e change with the system’s position and then influence the equations’ solutions. If all of the error sources remain at the same level and the vehicle’s kinestate has no sudden change at different latitudes, solutions of Equation (8) will vary in the form of finite changes in the three components of a vector with a constant length as it points at different directions. Therefore, the e-frame algorithm could provide globally consistent navigation solutions without sharply increasing the number of errors in any region.
However, most applications prefer to use information about movements relative to the surface of the Earth, which the e-frame navigation outputs are not able to provide. This is the reason why almost all INSs use the n-frame as the navigation frame at low and mid latitudes. Although the n-frame becomes invalid near the poles, transverse and grid navigation based on alternative local-level frames have been presented and could ensure the same accuracy as traditional INSs in low or mid latitude regions. Yet, it should be noted that the transverse frame and the grid frame will become invalid near certain points on the equator. As a consequence, taking global navigation into consideration, a switch between traditional and polar navigation is required when the vehicle travels across the polar circles; this will be complicated and destroy the consistency of the entire navigation algorithm.
Here, a hybrid navigation method is designed to combine the advantages of the e-frame system and the transverse system. The time integral in the INSs will be always carried out in the e-frame using Equation (7), namely, employing e-frame mechanization. However, outputs will be based on different frames according to the latitude. At low or mid latitudes, the system will output traditional n-frame positions, velocities and attitudes. In polar areas, the system will output navigation information based on the transverse frame. Thus, the switch is only needed in the output part and will be much easier to realize. The transverse frame used here is the modified one under the ellipsoidal Earth model [13] shown in Figure 1.
As shown in Figure 1, the transverse equatorial plane is the Greenwich meridian plane. The intersections of the 90° W and 90° E meridians with the equator are denoted as the transverse South Pole S and the transverse North Pole N , respectively. X e , Y e and Z e denote the three axes of the transverse Earth-fixed frame (e′-frame). The X e axis points toward the traditional North Pole N, the Y e axis points toward the intersection of the equator and the Greenwich meridian, and the Z e axis points toward N . For a point, P, above the Earth’s surface, P 0 denotes the intersection of the local-level plane with its normal PP 0 . This normal will intersect with the X e axis at point Q. Point M is the projection of P onto the transverse equatorial plane. The included angle of PP 0 and the transverse equatorial plane is denoted as the transverse latitude, L , the included angle of line QM and the X e axis is denoted as the transverse longitude, λ , and the transverse height, h , has the same definition as the traditional one. X n , Y n and Z n denote the three axes of the transverse geographic frame (n′-frame). X n points to the transverse north, which is along the intersecting line of plane PQM and the local-level plane. Z n is the vector along the normal of the local-level plane and downwards. Y n points to the transverse east to form the right-handed coordinate system.
The low and mid latitude part of the hybrid navigation algorithm and the corresponding error analysis were proposed in reference [25]. In this research, the high-latitude part, namely the hybrid transverse polar navigation method, will be mainly discussed. The calculations from the solutions of Equation (7) for the transverse position, velocity and attitude are given by the following equations.
(1) Transverse latitude and longitude
Based on their definitions and geometrical relationship, transverse latitude and longitude can be calculated iteratively using
L = arctan ( r y e ( r x e ) 2 + ( r z e + e 2 R N sin L ) 2 ) λ = arctan ( r x e r z e + e 2 R N sin L ) h = ( r x e ) 2 + ( r y e ) 2 cos L R N } ,
where [13]
R N = a ( 1 e 2 cos 2 L cos 2 λ ) 1 / 2 .
(2) Transverse velocity and attitude
The direction cosine matrix from the e-frame to the n′-frame could be calculated as
C e n = ( sin λ sin L cos L cos λ sin L cos λ 0 sin λ sin λ cos L sin L cos λ cos L ) .
Then, the transverse velocity relative to the Earth is
v n = C e n v e .
The direction cosine matrix from the body frame (b-frame) to the n′-frame is
C b n = C e n C b e ,
The transverse attitude angles are defined as the transverse roll, φ , the transverse pitch, θ , and the transverse yaw, ψ , which are the Euler angles calculated from C b n .

4. Error Models of Pure-Inertial Hybrid Transverse Navigation

According to the analysis around Equation (8), error models in the e-frame are globally consistent. On the basis of the solutions of Equation (8), transverse navigation errors could be obtained by the following equations.

4.1. Transverse Position Errors

Transverse latitude and longitude errors can be calculated from the horizontal transverse position errors. According to reference [13] and the approximate relationship, R N R M R , they can be calculated with
δ L = δ r N R δ λ = δ r E R cos L } ,
where R M is the radius in the direction of the meridian, and R is the geocentric distance of the system. Using the transformation, δ r n = C e n δ r e , the vector consisting of transverse latitude and longitude errors δ Λ = ( δ L δ λ ) T can be calculated from the e-frame position errors, with
δ Λ = J 3 δ r e ,
where
J 3 = 1 R ( sin λ sin L cos L cos λ sin L cos λ cos L 0 sin λ cos L ) .
The height error can be calculated as
δ h = δ r D = ( sin λ cos L sin L cos λ cos L ) δ r e = J 2 T δ r e .

4.2. Transverse Velocity Error

Perturbing the equation, v n = C e n v e , yields the transverse velocity error
δ v n = J 1 δ Λ + C e n δ v e ,
where
J 1 = ( v D sin L v E 0 sin L v N + cos L v D v N cos L v E ) .

4.3. Transverse Phi Angle and Attitude Errors

The phi angle, Φ , is the rotation vector that reflects the difference between the platform frame and the true frame. It is composed of the psi angle, Ψ , and δ Θ [29,30]:
Φ = Ψ + δ Θ ,
where δ Θ represents the discrepancy between the computer frame and the true frame. When specified in the n′-frame, Equation (20) will be
Φ n = A 3 δ Λ + C e n Ψ e ,
where
A 3 = ( 0 cos L 1 0 0 sin L ) .
Then, the transverse attitude errors and the transverse phi angle have a relationship:
Φ n = ( 0 sin ψ cos ψ cos θ 0 cos ψ sin ψ cos θ 1 0 sin θ ) ( δ ψ δ θ δ ϕ ) .
From comparing the formulae given in this section with those regarding the n-frame navigation errors [8,25], it can be seen that the methods to calculate the n′-frame and the n-frame navigation errors from the e-frame error models share the same structure, in spite of nuances in the calculation of some matrices. Therefore, with the e-frame error models being globally consistent, the global error models of the hybrid navigation scheme can achieve consistency in their forms.

5. Error Propagation Characteristics and Damping Technology

For high-precision INSs, damping is essential for long-term accuracy. To discuss the damping technology for hybrid transverse polar navigation, the first step is to analyze the pure-inertial error propagation characteristics.
No matter which frame is chosen for time integral, the error models will be the same when they have been transformed into one certain coordinate system. Therefore, the n′-frame error model shown in Equation (24) [13] can be used directly:
δ r ˙ n = δ v n ω e n n δ r n δ v ˙ n = 2 ω i e n + ω e n n δ v n + ( Γ s n ω i e n ω i e n ) δ r n + f n Ψ n + Δ f n + δ g n Ψ ˙ n = ω i n n Ψ n + ε n } .
As the transverse height and the traditional height are actually the same, the characteristics of the vertical channel remain unchanged. Thus, the traditional vertical damping assisted by the altimeter is still an appropriate method for stabilizing the transverse vertical channel.
According to their definitions, in polar areas, the transverse latitude is quite small, and the transverse longitude is close to 0° (near the North Pole) or 180° (near the South Pole). Thus, ω i e cos λ is close to ± ω i e , and the rates of transverse latitude and longitude are far less than ω i e according to Equation (14), which means that the static and kinematic error models are approximately the same. Based on Equation (24), the state equation of the transverse horizontal channels is simplified as
( δ r ˙ N δ r ˙ E δ v ˙ N δ v ˙ E ψ ˙ N ψ ˙ E ψ ˙ D ) = ( 0 0 1 0 0 0 0 0 0 0 1 0 0 0 ω s 2 0 0 ω 1 0 g 0 0 ω s 2 ω 1 0 g 0 0 0 0 0 0 0 ω 2 ω i e sin λ 0 0 0 0 ω 2 0 ω 3 0 0 0 0 ω i e sin λ ω 3 0 ) ( δ r N δ r E δ v N δ v E ψ N ψ E ψ D ) + ( 0 0 N E ε N ε E ε D ) ,
where
ω 1 = 2 ω i e cos λ cos L ω 2 = ω i e cos λ cos L ω 3 = ω i e cos λ sin L } .
Using Equation (25), the characteristic equation is
s ( s 2 + ω i e 2 ) [ s 4 + 2 ( ω s 2 + 2 ω i e 2 cos 2 L cos 2 λ ) s 2 + ω s 4 ] = 0 .
The roots of Equation (27) consist of zero, a pair of purely imaginary numbers ( ± j ω i e ) and two pairs of complex numbers whose angular frequencies are approximately ω s ± ω i e cos   L cos   λ . This result is similar to the conditions of traditional horizontal channels at low or mid latitudes. In the short term, Schuler oscillations dominate, and thus, the traditional horizontal damping network could be transplanted onto the n′-frame. The error curves of the damped system oscillate with a 24-h period.
Fortunately, as the mechanization is based on e-frame, the horizontal damping network has the same global structure. The damped e-frame differential equations are [8,25]
r ˙ e = v e K 1 D J 2 ( h h a ) v ˙ e = C m e f m 2 ω i e e v e + g e K 2 D J 2 ( h h a ) C n e C ( v n v r n ) C ˙ m e = ω i e e C m e + C m e ω i m m } ,
where K 1 D and K 2 D are the vertical damping coefficients, C represents the horizontal damping coefficient matrix, h a is the external height reference and v r n is the external velocity reference. C n e C ( v n v r n ) is the only part that needs to be changed as the vehicle travels across the polar circles. At low and mid latitudes, it will be replaced by C n e C ( v n v r n ) . The error propagation of the damped hybrid transverse navigation is shown in Figure 2, and the coefficient matrices were given in Section 4.

6. Long-Term Error Analysis for Damped Hybrid Transverse Navigation

In order to improve the system’s performance, it is necessary to determine the contribution of each error source to the navigation errors. Although INSs are actually nonlinear and time-varying, it is possible to obtain the approximate analytical expressions of the navigation errors through proper simplification.
According to the error propagation of the damped hybrid transverse navigation shown in Figure 2, with the coupling between vertical and horizontal channels and terms related to ω i e , L ˙ and λ ˙ being neglected, transverse horizontal position and velocity errors satisfy the differential equations:
δ r ˙ N = δ v N δ r ˙ E = δ v E δ v ˙ N + C δ v N + ω s 2 δ r N = Δ f N f D ψ E + f E ψ D + C ( v D ψ E + v E ψ D ) δ v ˙ E + C δ v E + ω s 2 δ r E = Δ f E + f D ψ N f N ψ D + C ( v D ψ N + v N ψ D ) } .
Then, the Laplace transformation of horizontal position errors is
δ r N ( s ) = ( s + C ( s ) ) δ r N 0 + δ v N 0 s 2 + C ( s ) s + ω s 2 + C ( s ) ( ψ D v E ψ E v D ) + ψ D f E ψ E f D s 2 + C ( s ) s + ω s 2 δ r E ( s ) = ( s + C ( s ) ) δ r E 0 + δ v E 0 s 2 + C ( s ) s + ω s 2 + C ( s ) ( ψ D v N + ψ N v D ) ψ D f N + ψ E f D s 2 + C ( s ) s + ω s 2 } .
Based on the final-value theorem and Equation (21), the steady-state transverse horizontal position, velocity and attitude errors are:
δ L = ψ E + Δ f N g δ λ cos L = ψ N + Δ f E g δ v N = R δ L ˙ = R ε E + Δ f ˙ N ω s 2 δ v E = R δ λ ˙ cos L = R ε N + Δ f ˙ E ω s 2 ϕ N = Δ f E g ϕ E = Δ f N g ϕ D = ψ D + ( ψ N Δ f E g ) tan L } .
If the right side is calculated from the e-frame values, Equation (31) can be written as
δ L = ψ x e cos λ ψ z e sin λ + 1 g ( Δ f x e sin λ sin L + Δ f y e cos L Δ f z e cos λ sin L ) δ λ cos L = ψ x e sin λ sin L ψ y e cos L + ψ z e cos λ sin L + 1 g ( Δ f x e cos λ Δ f z e sin λ ) δ v N = R [ ψ ˙ x e cos λ ψ ˙ z e sin λ + 1 g ( Δ f ˙ x e sin λ sin L + Δ f ˙ y e cos L Δ f ˙ z e cos λ sin L ) ] δ v E = R [ ψ ˙ x e sin λ sin L ψ ˙ y e cos L + ψ ˙ z e cos λ sin L + 1 g ( Δ f ˙ x e cos λ Δ f ˙ z e sin λ ) ] ϕ N = 1 g ( Δ f x e cos λ Δ f z e sin λ ) ϕ E = 1 g ( Δ f x e sin λ sin L + Δ f y e cos L Δ f z e cos λ sin L ) ϕ D = 1 cos L ( sin λ ψ x e + cos λ ψ z e ) tan L g ( Δ f x e cos λ Δ f z e sin λ ) } .
Equation (32) uses the e-frame accelerometer errors and gyro drifts, which are related to the orientation of the m-frame and the error models of inertial measurement units (IMUs). As the mechanization of space-stable INSs best matches the hybrid transverse algorithm, the detailed analytical expressions of long-term navigation errors are given for such systems.

6.1. Error Model of Accelerometer Unit

For low-speed cruising, the specific forces measured can be approximately expressed as
( f x P f y P f z P ) C n P ( 0 0 g ) = g ( A ϕ cos ( γ 2 P + ϕ ) A ϕ sin ( γ 2 P + ϕ ) cos λ cos L ) ,
where
A ϕ = 1 cos 2 L cos 2 λ sin ϕ = sin L / A ϕ cos ϕ = cos L sin λ / A ϕ } .
The superscript P denotes the platform frame (P-frame), and γ 2 P represents the rotation of the space-stable platform, which is ω i e t .
In the P-frame, the error model of the three-axis accelerometer unit is [28]
( Δ f x P Δ f y P Δ f z P ) = ( Δ S F x S F x Δ β x z Δ β x y Δ β y z Δ S F y S F y Δ β y x Δ β z y Δ β z x Δ S F z S F z ) ( f x P f y P f z P ) ( x y z ) ,
where , Δ S F S F and Δ β represent the zero bias, scale factor error and installation angle error with corresponding subscripts denoting the direction. Combining Equation (35) with Equation (33) and transforming the result to e-frame yields
Δ f x e g = ( x g Δ β x y cos L cos λ ) cos γ 2 P ( y g + Δ β y x cos L cos λ ) sin γ 2 P + A ϕ ( Δ β y z 2 Δ β x z 2 ) sin ( 2 γ 2 P + ϕ ) + A ϕ ( Δ S F x 2 S F x Δ S F y 2 S F y ) cos ( 2 γ 2 P + ϕ ) A ϕ ( Δ β y z 2 + Δ β x z 2 ) sin ϕ + A ϕ ( Δ S F x 2 S F x + Δ S F y 2 S F y ) cos ϕ Δ f y e g = ( x g Δ β x y cos L cos λ ) sin γ 2 P ( y g + Δ β y x cos L cos λ ) cos γ 2 P + A ϕ ( Δ β y z 2 Δ β x z 2 ) cos ( 2 γ 2 P + ϕ ) A ϕ ( Δ S F x 2 S F x Δ S F y 2 S F y ) sin ( 2 γ 2 P + ϕ ) + A ϕ ( Δ β y z 2 + Δ β x z 2 ) cos ϕ + A ϕ ( Δ S F x 2 S F x + Δ S F y 2 S F y ) sin ϕ Δ f z e g = z g + Δ S F z S F z cos L cos λ + Δ β z x A ϕ sin ( γ 2 P + ϕ ) Δ β z y A ϕ cos ( γ 2 P + ϕ ) } .

6.2. Gyro Dift and Psi Angle

Based on the fundamental gyro drift models [25,28,31], the residual drift rates of gyros on the space-stable platform after proper calibration and error compensation can be modeled as
Δ ω 1 x = Δ ε 1 x + A ϕ Δ d ¯ 11 cos ( γ 2 P + ϕ ) Δ ω 1 y = Δ ε 1 y + A ϕ Δ d ¯ 11 sin ( γ 2 P + ϕ ) }   polar gyro ,
Δ ω 2 z = Δ ε ¯ 2 z + Δ d 22 cos L cos λ A ϕ cos ( γ 2 P + ϕ )   equatorial gyro ,
where Δ ε 1 x , Δ ε 1 y and Δ ε ¯ 2 z are called the g 0 coefficients, and Δ d ¯ 11 and Δ d 22 are called the g 1 coefficients.
Substituting Equations (37) and (38) into the differential equations of the perturbed motion of the space-stable platform [25] yields the three components of the psi angle as
ψ x e ( t ) Δ d ¯ 11 A ϕ ω i e ( sin ϕ + sin ( ω i e t ϕ 0 ) ) + ψ x e ( 0 ) cos ω i e t + ψ y e ( 0 ) sin ω i e t + Δ ε 1 x t cos [ ω i e t + γ 2 P ( 0 ) ] + Δ ε 1 y t sin [ ω i e t + γ 2 P ( 0 ) ] ψ y e ( t ) Δ d ¯ 11 A ϕ ω i e ( cos ϕ cos ( ω i e t ϕ 0 ) ) ψ x e ( 0 ) sin ω i e t + ψ y e ( 0 ) cos ω i e t Δ ε 1 x t sin [ ω i e t + γ 2 P ( 0 ) ] + Δ ε 1 y t cos [ ω i e t + γ 2 P ( 0 ) ] ψ z e ( t ) = ψ z e ( 0 ) + Δ ε ¯ 2 z t + Δ d 22 cos L cos l A ϕ ω i e + ϕ ˙ { sin [ ω i e t + γ 2 P ( 0 ) + ϕ ] sin [ γ 2 P ( 0 ) + ϕ 0 ] } } ,
where the time-varying characteristic of ϕ in polar areas has been considered, and ϕ 0 is its initial value.

6.3. Long-Term Contribution of Main Error Sources

Substituting Equations (36) and (39) into Equation (32) yields the approximate analytical expressions of the long-term navigation errors of the low-speed space-stable INSs, which reflect the propagation of the main error sources. As the horizontal position errors and the azimuth error are the most concerning, the impacts of different error coefficients on them are listed in Table 1. Second-order small quantities have been neglected based on the fact that the sine and tangent of transverse latitude and longitude gradually approach zero as the vehicle moves towards the poles.
From Table 1, it can be concluded that:
(1)
The terms dominated in transverse latitude and longitude errors are the slowly divergent 24-h period oscillation caused by Δ ε 1 x and Δ ε 1 y and the persistent 24-h period oscillation caused by x , y , Δ β x y , Δ β y x , Ψ x e ( 0 ) and Ψ y e ( 0 ) .
(2)
For the transverse azimuth error, the linear growth caused by Δ ε ¯ 2 z predominates. The initial alignment error, Ψ z e ( 0 ) , will induce a constant bias. The slowly divergent 24-h period oscillation caused by Δ ε 1 x and Δ ε 1 y also exists. Although it is attenuated by sin λ , it is possible for this fluctuation to become apparent after a sufficient length of time.
(3)
All the dominant terms in error curves will account for larger proportions, and others gradually disappear as the system comes close to the poles. Specifically, transverse latitude and longitude errors will symmetrically and divergently oscillate, and the transverse azimuth error curve will be an oblique line when the system is close enough to the poles.
where
A ϑ = 1 sin 2 L cos 2 λ sin ϑ = sin L sin λ / A ϑ cos ϑ = cos L / A ϑ }

7. Simulation and Discussion

Simulation results of the proposed method are presented in this section. Outputs of gyros and accelerometers were generated by the space-stable INS simulator. The errors of IMUs were generated based on the error models presented in Section 6, where the g 0 and g 1 coefficients of gyro drifts were all 10 4   ° / h , the initial alignment errors were 10″, and the zero biases, scale factor errors and installation errors of the accelerometers were 2 × 10 5 g, 10 ppm and 10″, respectively. These values of error parameters were chosen based on the general performance of IMUs in the navigation grade (1 nm/h) class [31,32] and a certain high-precision INS [33]. In addition, it is assumed that proper calibration and error compensation have been carried out during the initialization.

7.1. e-Frame Navigation Errors at Different Latitudes

First, it was demonstrated that the e-frame mechanization would not be affected by the system’s position. The vehicle was set to move along the parallels of 1° N, 40° N and 89.5° N eastwards at a speed of 5 m/s for 3 days. The e-frame position errors, velocity errors and phi angles are shown in Figure 3, Figure 4 and Figure 5, respectively, where all of the error curves are normalized by the maximum absolute values in the corresponding directions among the three latitudes.
From Figure 3 and Figure 4, it can be seen that position and velocity errors at different latitudes showed no sharp increases but only variance in the distribution of the components in three directions. At low latitudes, components in the x and y directions were distinctly smaller than the one in the z direction, while the situation at high latitudes is the opposite. Also, the drifts in the x- and y-direction position errors were more obvious at lower latitudes. As for the e-frame phi angles, Figure 5 shows that they were finite and almost unrelated to the latitude. Such results validate the use of the e-frame mechanization globally.

7.2. Long-Term Hybrid Transverse Navigation Errors in Polar Areas

The initial position was set to be ( 89.5 °   N   116 °   E   0   m ) T , which is quite an extreme condition. The simulation involved the vehicle moving along the 89.5 °   N parallel at a speed of 5 m/s eastwards for 3 days. The horizontal position errors and the azimuth error using the traditional navigation algorithm and the hybrid transverse navigation algorithm are shown in Figure 6 and Figure 7, respectively, where all error curves are normalized by the maximum absolute values of the traditional latitude errors.
From Figure 6, it can be seen that the longitude error and azimuth error were far larger than the latitude error and that they became over 100 times larger on the third day. Moreover, oscillations in the error curves had about seven cycles within 3 days, which is obviously different from the long-term oscillation characteristics at low and mid latitudes. The angular frequency of the oscillations actually matches ( λ ˙ + ωie) and conforms to the proposal that in polar areas, movements along the parallels will result in more drastic fluctuations in navigation errors.
The error curves shown in Figure 7 do not have similar problems to Figure 6. Using the hybrid transverse navigation algorithm, navigation errors are at normal levels and their oscillation period is approximately 24 h. Such results are consistent with use of the traditional algorithm at low and mid latitudes. In addition, analytical errors were calculated based on Table 1 and compared with the simulated errors in Figure 7. The results show that they fit with each other and validate the analytical expressions in Section 6. At 89.5° N, the transverse latitude errors and longitude errors were mainly due to symmetrical divergent oscillation caused by the x- and y-direction g 0 gyro drift coefficients, and the transverse azimuth error was mainly due to the linear drift caused by the z-direction g 0 gyro drift coefficient. The analytical expressions theoretically explain the error curves shown in existing research and could be used to assist the design of high-precision INSs for polar applications.

8. Conclusions

This research proposed a hybrid transverse polar navigation method based on a combination of e-frame navigation and transverse navigation. A kinematic pure-inertial error analysis was conducted to introduce proper damping technology for high-precision and long-term INSs in polar areas. According to the theoretical analysis, the error models proposed can retain the same structure globally and the damping network can be globally consistent. This means that the hybrid global navigation is mathematically convenient and can be easily implemented by merely switching the coordinate system for navigation outputs, without any break in the core integral process. The simulation results showed that the e-frame mechanization is not influenced by the system’s position, and that the proposed polar navigation method can ensure the same accuracy and oscillation characteristics as the traditional algorithm in low and mid latitude regions. The proposed polar navigation method could be used in INSs of different types, and it is most suitable for the space-stable INSs, in principle. The analytical expressions of the long-term navigation errors in the damped space-stable INSs were deduced to figure out the contributions of main error sources, which were also validated by the simulation results. They could help to further improve the systems’ polar accuracy.

Author Contributions

R.W. completed the hybrid transverse polar navigation mechanism and deduced the long-term analytical expressions of the navigation errors; Q.W. and F.H. came up with the idea of algorithm simplification using the combination of two different types of INSs; R.W., Q.W., and F.H. jointly contributed to writing this paper; R.Z. and P.H. considered that the system’s velocity would influence the polar error characteristics and helped to reanalyze the kinematic error models; H.L. helped to build the space-stable INS simulator.

Acknowledgments

The authors would like to acknowledge the support offered by National Natural Science Foundation of China (61603208).

Conflicts of Interest

The authors declare no conflict of interest. The founding sponsors had no role in the design of the study; in the collection, analyses, or interpretation of data; in the writing of the manuscript, and in the decision to publish the results.

References

  1. Ho, J. The implications of Arctic sea ice decline on shipping. Mar. Policy 2010, 34, 713–715. [Google Scholar] [CrossRef]
  2. Hong, N. The melting Arctic and its impact on China’s maritime transport. Res. Transp. Econ. 2012, 35, 50–57. [Google Scholar] [CrossRef]
  3. Pedersen, E.S. Polar airline navigation. Navigation 1955, 4, 270–274. [Google Scholar] [CrossRef]
  4. Anderson, E.W. Navigation in polar regions. J. Navig. 1957, 10, 156–161. [Google Scholar] [CrossRef]
  5. Greenaway, K.R.; Gates, M.D. Polar Air Navigation: A Record; Art Bookbindery: Winnipeg, MB, Canada, 2009. [Google Scholar]
  6. Ngwira, C.M.; Mckinnell, L.; Cilliers, P.J. GPS phase scintillation observed over a high-latitude Antarctic station during solar minimum. J. Atmos. Sol.-Terr. Phys. 2010, 72, 718–725. [Google Scholar] [CrossRef]
  7. Andalsvik, Y.L.; Jacobsen, K.S. Observed high-latitude GNSS disturbances during a less-than-minor geomagnetic storm. Radio Sci. 2014, 49, 1277–1288. [Google Scholar] [CrossRef]
  8. Britting, K.R. Inertial Vavigation Systems Analysis; Wiley-Interscience: New York, NY, USA, 1971; ISBN 047110485X. [Google Scholar]
  9. Dyer, G.C. Polar navigation—A New transverse Mercator technique. J. Navig. 1971, 24, 484–495. [Google Scholar] [CrossRef]
  10. Ignagni, M.B. An all-Earth inertial navigation scheme. Navigation 1972, 19, 209–214. [Google Scholar] [CrossRef]
  11. Herrick, S. Grid navigation. Geogr. Rev. 1944, 34, 436–456. [Google Scholar] [CrossRef]
  12. Fox, W.A.W. Transverse navigation: An alternative to the grid system. J. Navig. 1949, 2, 25–35. [Google Scholar] [CrossRef]
  13. Yao, Y.Q.; Xu, X.S.; Li, Y.; Liu, Y.T.; Sun, J.; Tong, J.W. Transverse navigation under the ellipsoidal Earth model and its performance in both polar and non-polar areas. J. Navig. 2015, 69, 335–352. [Google Scholar] [CrossRef]
  14. Li, Q.; Ben, Y.Y.; Yu, F.; Tan, J. Bin Transversal strapdown INS based on reference ellipsoid for vehicle in the polar region. IEEE Trans. Veh. Technol. 2015, 65, 7791–7795. [Google Scholar] [CrossRef]
  15. Zhou, Q.; Yue, Y.Z.; Zhang, X.D.; Tian, Y. Indirect grid inertial navigation mechanization for transpolar aircraft. J. Chin. Inert. Technol. 2014, 22, 18–23. (In Chinese) [Google Scholar]
  16. Yao, Y.Q.; Xu, X.S.; Tong, J.W. Indirect transverse inertial navigation algorithm in polar region. J. Chin. Inert. Technol. 2015, 23, 29–34. (In Chinese) [Google Scholar]
  17. Salychev, O.S. Applied Inertial Navigation Problems and Solutions; BMSTU press: Moscow, Russia, 2004. [Google Scholar]
  18. Liu, M.; Li, G.C.; Gao, Y.; Li, S.T.; Meng, Q.W.; Du, S.T. Improved polar inertial navigation algorithm based on pseudo INS mechanization. Aerosp. Sci. Technol. 2018, 77, 105–116. [Google Scholar] [CrossRef]
  19. Gao, Y.; Liu, M.; Li, G.C.; Guang, X.X. Initial alignment for SINS based on pseudo-Earth frame in polar regions. Sensors 2017, 17, 1416. [Google Scholar] [CrossRef] [PubMed]
  20. Cheng, J.H.; Wang, T.; Wang, L.; Wang, Z.M. A new polar transfer alignment algorithm with the aid of a star sensor and based on an adaptive unscented Kalman filter. Sensors 2017, 17, 2417. [Google Scholar] [CrossRef] [PubMed]
  21. Wang, T.; Cheng, J.H.; Guan, D.X.; Kang, Y.Y.; Zhang, W. Modified compensation algorithm of lever-arm effect and flexural deformation for polar shipborne transfer alignment based on improved adaptive Kalman filter. Meas. Sci. Technol. 2017, 28, 095101. [Google Scholar] [CrossRef]
  22. Yan, Z.P.; Wang, L.; Zhang, W.; Zhou, J.J.; Wang, M. Polar grid navigation algorithm for unmanned underwater vehicles. Sensors 2017, 17, 1599. [Google Scholar]
  23. Li, Q.; Ben, Y.Y.; Sun, F.; Huo, L. Transversal strapdown INS and damping technology for marine in polar region. In Proceedings of the IEEE/ION Position, Location and Navigation Symposium—PLANS 2014, Monterey, CA, USA, 5–8 May 2014; pp. 1365–1370. [Google Scholar]
  24. Huang, W.Q.; Fang, T.; Luo, L.; Zhao, L.; Che, F.Z. A damping grid strapdown inertial navigation system based on a Kalman filter for ships in polar regions. Sensors 2017, 17, 1551. [Google Scholar] [CrossRef] [PubMed]
  25. Gao, Z.Y. Inertial Navigation System Technology; Tsinghua University Press: Beijing, China, 2012. (In Chinese) [Google Scholar]
  26. Grewal, M.S.; Weill, L.R.; Andrews, A.P. Global Positioning Systems, Inertial Navigation, and Integration; John Wiley & Sons: Hoboken, NJ, USA, 2007. [Google Scholar]
  27. Hofmann-Wellenhof, B.; Moritz, H. Physical Geodesy; Springer Science & Business Media: Berlin, Germany, 2006. [Google Scholar]
  28. Nash, R.A.; Levine, S.A.; Roy, K.J. Error analysis of space-stable inertial navigation systems. IEEE Trans. Aerosp. Electron. Syst. 1971, 4, 617–629. [Google Scholar] [CrossRef]
  29. Blankinship, K.G. A general theory for inertial navigator error modeling. In Proceedings of the 2008 IEEE/ION Position, Location and Navigation Symposium, Monterey, CA, USA, 5–8 May 2008; pp. 1152–1166. [Google Scholar]
  30. Goshen-Meskin, D.; Bar-Itzhack, I.Y. Unified approach to inertial navigation system error modeling. J. Guid. Control Dyn. 1992, 15, 648–653. [Google Scholar] [CrossRef]
  31. Gao, Z.Y.; Kistner, A.; Sorg, H. Identification of the gyro drift error model by using a two-axis servo turntable. Z. Flugwiss. Weltraumforsch. 1989, 13, 240–247. [Google Scholar]
  32. Jalving, B.; Gade, K.; Svartveit, K.; Willumsen, A.; Sørhagen, R. DVL velocity aiding in the HUGIN 1000 integrated inertial navigation system. Model. Identif. Control 2004, 25, 223–235. [Google Scholar] [CrossRef]
  33. Hu, P.; Gao, Z.Y.; She, Y.J.; Cai, L.; Han, F.T. Shipborne heading determination and error compensation based on a dynamic baseline. GPS Solut. 2015, 19, 403–410. [Google Scholar] [CrossRef]
Figure 1. Definition of the modified transverse frame under the ellipsoidal Earth model.
Figure 1. Definition of the modified transverse frame under the ellipsoidal Earth model.
Sensors 18 01538 g001
Figure 2. The error propagation of the damped hybrid transverse navigation.
Figure 2. The error propagation of the damped hybrid transverse navigation.
Sensors 18 01538 g002
Figure 3. The e-frame position errors at different latitudes.
Figure 3. The e-frame position errors at different latitudes.
Sensors 18 01538 g003
Figure 4. The e-frame velocity errors at different latitudes.
Figure 4. The e-frame velocity errors at different latitudes.
Sensors 18 01538 g004
Figure 5. The e-frame phi angles at different latitudes.
Figure 5. The e-frame phi angles at different latitudes.
Sensors 18 01538 g005
Figure 6. Horizontal position errors and the azimuth error using the traditional algorithm.
Figure 6. Horizontal position errors and the azimuth error using the traditional algorithm.
Sensors 18 01538 g006
Figure 7. Horizontal position errors and the azimuth error using the hybrid transverse algorithm, and comparisons with the analytical expressions.
Figure 7. Horizontal position errors and the azimuth error using the hybrid transverse algorithm, and comparisons with the analytical expressions.
Sensors 18 01538 g007
Table 1. Long-term horizontal position errors and azimuth error induced by error coefficients in the space-stable inertial navigation systems (INSs).
Table 1. Long-term horizontal position errors and azimuth error induced by error coefficients in the space-stable inertial navigation systems (INSs).
Error CoefficientsCorresponding Navigation Errors
δ L δ λ cos   L ϕ D
Gyro drift model coefficients Δ ε 1 x Δ ε 1 x t cos   λ cos ω i e t A ϑ Δ ε 1 x t sin ( ω i e t + ϑ ) 1 cos L Δ ε 1 x t sin   λ cos ω i e t
Δ ε 1 y Δ ε 1 y t cos   λ sin ω i e t A ϑ Δ ε 1 y t cos ( ω i e t + ϑ ) 1 cos L Δ ε 1 y t sin   λ sin ω i e t
Δ ε ¯ 2 z Δ ε ¯ 2 z t sin   λ Δ ε ¯ 2 z t cos   λ sin L 1 cos L Δ ε ¯ 2 z t cos   λ
Δ d ¯ 11 Δ d ¯ 11 A ϕ cos λ ω i e [ sin ϕ + sin ( ω i e t ϕ 0 ) ] Δ d ¯ 11 A ϕ A ϑ ω i e [ cos ( ϑ ϕ ) cos ( ω i e t + ϑ ϕ 0 ) ] 0
Δ d 22 0 0 Δ d 22 A ϕ cos 2 λ ω i e + ϕ ˙ [ sin ( ω i e t + ϕ ) sin ϕ 0 ]
Accelerometer error model coefficients Δ S F x S F x Δ S F x 2 S F x [ cos 2 λ cos L sin L A ϕ A ϑ sin ( 2 ω i e t + ϑ + ϕ ) ] Δ S F x 2 S F x [ A ϕ cos   λ cos ( 2 ω i e t + ϕ ) + cos L cos   λ sin   λ ] 0
Δ S F y S F y Δ S F y 2 S F y [ cos 2 λ cos L sin L + A ϕ A ϑ sin ( 2 ω i e t + ϑ + ϕ ) ] Δ S F y 2 S F y [ A ϕ cos   λ cos ( 2 ω i e t + ϕ ) + cos L cos   λ sin   λ ] 0
Δ S F z S F z Δ S F z S F z cos 2 λ cos L sin L Δ S F z S F z cos L sin λ cos λ 0
x g x g A ϑ sin ( ω i e t + ϑ ) x g cos   λ cos ω i e t x g cos   λ tan L cos ω i e t
y g y g A ϑ cos ( ω i e t + ϑ ) y g cos   λ sin ω i e t y g cos   λ tan L sin ω i e t
z g z g cos   λ sin L z g sin   λ 0
Δ β x y Δ β x y cos L cos   λ A ϑ sin ( ω i e t + ϑ ) Δ β x y cos L cos 2   λ cos ω i e t Δ β x y sin L cos 2   λ cos ω i e t
Δ β y x Δ β y x cos L cos   λ A ϑ cos ( ω i e t + ϑ ) Δ β y x cos L cos 2   λ sin ω i e t Δ β y x sin L cos 2   λ sin ω i e t
Δ β x z Δ β x z 2 ( sin   λ A ϕ A ϑ cos ( 2 ω i e t + ϑ + ϕ ) ) Δ β x z 2 ( A ϕ cos   λ sin ( 2 ω i e   t + ϕ ) + sin L cos   λ ) 0
Δ β z x 0 0 0
Δ β y z Δ β y z 2 ( sin   λ + A ϕ A ϑ cos ( 2 ω i e t + ϑ + ϕ ) ) Δ β y z 2 ( A ϕ cos   λ sin ( 2 ω i e t + ϕ ) sin L cos   λ ) 0
Δ β z y 0 0 0
Initial alignment errors Ψ x e ( 0 ) Ψ x e ( 0 )   cos   λ cos ω i e t Ψ x e ( 0 ) A ϑ sin ( ω i e t + ϑ ) 1 cos L Ψ x e ( 0 ) sin   λ cos ω i e t
Ψ y e ( 0 ) Ψ y e ( 0 )   cos   λ sin ω i e t Ψ y e ( 0 ) A ϑ cos ( ω i e t + ϑ ) 1 cos L Ψ y e ( 0 ) sin   λ sin ω i e t
Ψ z e ( 0 ) Ψ z e ( 0 ) sin   λ Ψ z e ( 0 ) cos   λ sin L 1 cos L Ψ z e ( 0 )   cos   λ

Share and Cite

MDPI and ACS Style

Wu, R.; Wu, Q.; Han, F.; Zhang, R.; Hu, P.; Li, H. Hybrid Transverse Polar Navigation for High-Precision and Long-Term INSs. Sensors 2018, 18, 1538. https://doi.org/10.3390/s18051538

AMA Style

Wu R, Wu Q, Han F, Zhang R, Hu P, Li H. Hybrid Transverse Polar Navigation for High-Precision and Long-Term INSs. Sensors. 2018; 18(5):1538. https://doi.org/10.3390/s18051538

Chicago/Turabian Style

Wu, Ruonan, Qiuping Wu, Fengtian Han, Rong Zhang, Peida Hu, and Haixia Li. 2018. "Hybrid Transverse Polar Navigation for High-Precision and Long-Term INSs" Sensors 18, no. 5: 1538. https://doi.org/10.3390/s18051538

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