# Performance Analysis and Architectures for a MEMS-SINS/GPS Ultratight Integration System

Authors: Jianxin Ren; Junlin Zi; Hao Yang; Jin Li
Journal: Mathematical Problems in Engineering
 (2021)

---

## Abstract

In order to analyze the performance of strapdown inertial navigation system/global position system (SINS/GPS) ultratight integration system with low-precision microelectromechanical system (MEMS) under challenging environments, a new MEMS-SINS/GPS ultratight integration scheme is designed. The time-space difference carrier phase velocity (TSDCP-v) is used to assist the carrier tracking loop, the measurement model including nonlinear term is established, and the corresponding filtering algorithm is designed. A simulation and verification platform is established to analyze and verify the performance of the MEMS-SINS/GPS ultratight integration system designed in this paper. Compared with the SINS/GPS tight integration navigation system, the MEMS-SINS/GPS ultratight integration system has higher dynamic performance, anti-interference capability, and navigation performance. At the same time, the MEMS-SINS/GPS ultratight integration system improves the carrier tracking performance of SINS-assisted GPS ultratight integration system when using low-precision MEMS and in high dynamics, strong interference environments.


---

## Body

## 1. Introduction

The strapdown inertial navigation system/global position system (SINS/GPS) ultratight integration system assists the tracking loop to increase the equivalent bandwidth of the loop and enhance the system’s dynamic performance and anti-interference ability, so that the system’s accuracy and reliability can be improved [1]. It is gradually becoming the main research direction of SINS/GPS coupled system. The SINS/GPS ultratight integration system can be divided mainly into the vector-tracking based SINS/GPS ultratight coupled mode and the SINS-assisted GPS ultratight coupled mode. Microelectromechanical system (MEMS) has the advantages of cheap price, small volume, low energy consumption, and light weight [2]. Currently, the accuracy and reliability of MEMS inertial sensors have been rapidly improved. It is very meaningful to study a high-performance MEMS-SINS/GPS ultratight integration system.In vector-tracking based SINS/GPS ultratight coupled mode, the In-phase/Quadrature (I/Q) signals are processed by prefilters. The prefilters estimate loop tracking error to assist carrier loop. The integration navigation filter uses the estimation of prefilters to correct the SINS errors [3, 4]. In addition to using I/Q signals as measurement information, some researchers used quaternion errors as state variables to build nonlinear quaternion errors model [5, 6]. Due to the strong nonlinearity of the models above, the nonlinear filtering algorithms were used, including extended Kalman filter (EKF), unscented particle filter (UPF), and unscented Kalman filter (UKF) [7–9], to avoid large numbers of nonlinear errors and degraded system’s performance caused by highly dynamic, strong interference, and low-precision MEMS. Although this ultratight integration mode has stronger signal tracking and navigating ability, it is criticized for high complexity of the model, heavy computation load, residual time error, and low realizability [10, 11]. To address these problems, in [12], a linear measurement equation was obtained by time-space difference of I/Q angular rate and phase information that reduced the model error and complexity.Based on the tightly coupled SINS/GPS, the SINS-assisted GPS ultratight integration mode uses modified SINS parameters to calculate carrier Doppler frequency, assisting GPS carrier tracking loop. This ultratight integration mode has relatively simple model and higher realizability [6, 13]. However, in this mode, Doppler assist error increases rapidly in low-precision MEMS and highly dynamic and strong interference environments. When the Doppler assist error is large and the tracking loop does not have enough bandwidth to track it, the GPS measurement error would be related to the SINS velocity error. It would decrease the integrated Kalman filter (IKF) estimation accuracy, cause the carrier loop lose lock, and even cause the system to diverge [14]. In [15], the carrier-tracking errors were expanded as the IKF state variables, thus making the pseudorange-rate (PR-rate) error decorrelation. In [14], a new tracking-error estimator was designed, and it can remove the pseudorange (PR) and PR-rate error correlation. At the same time, this model of SINS/GPS ultratight integration introduces strong nonlinearity into the measurement equation of IKF when using the raw GPS PR and PR-rate measurements. Although EKF is a nonlinear filtering algorithm, it can result in a large modeling error and a divergent solution [16, 17] retaining the high-order nonlinear terms of pseudorange measurement by expanding pseudorange measurement second-order Taylor series, and the UKF was used to process it.Compared with PR measurement, the carrier phase measurement has higher accuracy and smaller error [18, 19]. In [20], the GPS receiver velocity was estimated by time-difference carrier phase (TDCP) measurement. In [21], the TDCP was applied to the SINS/GPS tightly integrated system. In [22], the TDCP velocity was used in the SINS/GPS ultratight integrated system to assist the GPS carrier tracking loop.In this paper, a new structure for the MEMS-SINS/GPS ultratight integration system based on the SINS-assisted GPS ultratight integration system is designed. The time-space difference carrier phase velocity (TSDCP-v) is used to assist the carrier loop, reducing Doppler-assisted error caused by low-precision MEMS and avoiding GPS measurement errors related to MEME-SINS velocity errors. The TSDCP-v and PR are used as the measurements of the IKF, and the second-order nonlinear term in the PR measurement is retained. The corresponding filtering algorithm is designed to improve the accuracy of IKF estimation. The simulation and verification platform is established to analyze and verify the performance of the MEMS-SINS/GPS ultratight integration system designed in this paper. Compared with the SINS/GPS tight integration navigation system, the MEMS-SINS/GPS ultratight integration system has higher dynamic performance, anti-interference capability, and navigation performance. At the same time, the MEMS-SINS/GPS ultratight integration system improves the carrier tracking performance of SINS-assisted GPS ultratight integration system when using low-precision MEMS and in high dynamics, strong interference environments.


## 2. The Architectures of MEMS-SINS/GPS Ultratight Integration System

The architecture of MEMS-SINS/GPS ultratight integration system designed in this paper is shown in Figure1. The IKF measurements included the GPS PR ρs minus the PR ρI calculated by SINS and the TSDCP-v Vcp minus the SINS velocity VI. The SINS error is estimated by IKF and used to correct the SINS solution result. The TSDCP-v is used to calculate Doppler aiding frequency faid. By aiding the Doppler aiding frequency faid and the carrier loop filter output fLFP to generate the driving signal fPLL for carrier NCO, the carrier NCO is controlled by fPLL to adjust the carrier frequency and carrier phase of local signal, leaving only the Doppler aiding error to be tracked by the carrier tracking loop. The carrier loop equivalent bandwidth is increased, and the system’s dynamic and anti-interference ability is enhanced. The frequency fPLL is converted to code frequency to assist the code tracking loop. In the IKF measurements, the second-order nonlinear term in the PR ρI measurement is retained. In addition, the nonlinear PR measurement is processed by UKF, which overcomes the nonlinear error introduced by the linearized PR measurement.Figure 1
The architectures for the MEMS-SINS/GPS ultratight integration system.In the conventional SINS-assisted GPS ultratight integration system shown in Figure2, the IKF measurements included linearized PR and PR-rate and the Doppler aiding frequency faid calculated by the corrected SINS velocity. In the SINS-assisted GPS ultratight integration system, various measurement errors of GPS and SINS are coupled deeply. When using low-precision MEMS and in high dynamics, strong interference environments, the Doppler aiding frequency error δfaid can increase rapidly. If the tracking loop does not have enough bandwidth to track it, relatively large correlated components in tracking errors (δϕ and δfPLL) can be induced. Consequently, the GPS measurement errors (δρs and δρ˙s) increased. The GPS measurement errors can be correlated with the SINS velocity error, reduce the estimation accuracy of the IKF, and then further increase Doppler aiding frequency error; they can even result in losing lock of the tracking loop. In addition, for the linear IKF, when using linearized PR and PR-rate measurements, it can result in large nonlinearity error and a divergent solution. In this paper, high-precision TSDCP-v is used to calculate Doppler aiding frequency, reducing the Doppler-assisted error and avoiding the GPS measurement errors related to the MEMS-SINS velocity errors. Adopting TSDCP-v and nonlinear PR as the measurements of the IKF could improve the estimation accuracy of the filter and then improve the integration navigation accuracy.Figure 2
The architectures for the SINS-assisted GPS ultratight integration system.


## 3. The Time-Space Difference Carrier Phase Velocity

The measurement models of PR and carrier phase at timek are as follows:(1)ρk=rk+cδtu,k−δtks+Ik+Tk+Ok+Mρ,k+ερ,k,(2)ϕk=λ−1rk+cδtu,k−δtks−Ik+Tk+Ok+Mϕ,k+N+εϕ,k,where ρk and ϕk are the pseudorange measurement and the carrier phase measurement, respectively; rk is the geometric distance from the receiver to the satellite; δtks and δtu,k are the satellite clock error and the receiver clock error, respectively; λ is the L1 carrier wavelength; Ik and Tk are the ionosphere error and the troposphere error, respectively; Ok is the satellite orbit error; Mρ,k and Mϕ,k are the multipath errors; N is the integer ambiguity; ε is the white noise; c is the light velocity.By subtracting the carrier phase measurementϕk from two consecutive moments in the case of continuous carrier tracking, the integer ambiguity can be eliminated. The error of satellite clock, satellite orbit, the troposphere, and ionosphere delay can also be eliminated. When the GPS receiver receives signals from different satellite at the same moment, the GPS receiver clock error is the same; and it can be removed by space difference. A high precision velocity measurement can be obtained by time-space difference carrier phase (TSDCP).According to [22], the result of TDCP is as follows:(3)λ⋅Δϕ˜ks=−δrM,k⋅eks+c⋅δtu,k+Δξ,where δr⟶M,k is the position change of receiver in the time interval from k−1.When the receiver receives the satellite signals numberedm and n, the GPS receiver clock error can be wiped out by space difference.(4)χΔϕn,m=λ⋅Δϕ˜kn−λ⋅Δϕ˜km=−δrM,k⋅ekn−ekm+Δξn−Δξm=−δrM,k⋅ekn−ekm+ηn,m,where χΔϕn,m is the result of time-space difference carrier phase, λ⋅Δϕ˜ks is the result of TDCP of satellite s, and eks is the line-of-sight unit vector from the GPS receiver to the satellite s.When the number of satellites observed by the receiver is more than two, it is necessary to perform TSDCP on the measurements from two different satellites, and the TSDCP measurement equation is(5)Z=H⋅δrM,k+ηΔϕ,where the matrices H and Z are(6)H=−ekn−ekmT…−ekn−ekoT…−eko−ekpT,Z=λ⋅Δϕ˜kn−Δϕ˜km…λ⋅Δϕ˜kn−Δϕ˜ko…λ⋅Δϕ˜ko−Δϕ˜kp.The TSDCP-v of the receiver can be calculated by(7)δrM,k=HTH−1HTZ,Vcp=δrM,kΔt,where Vcp is the time-space difference carrier phase velocity TSDCP-v; Δt is the time interval from k−1 to k.UsingVcp as the velocity estimation of the GPS receiver in ECEF, Xse is satellite’s position, Vse is satellite’s velocity, and Xre is receiver’s position. The Doppler assist frequency faid can be calculated by(8)faid=−fL1c⋅Vaid=−fL1c⋅Vse−Vcp⋅Xse−XreXse−Xre=−fL1c⋅Vse−Vcp⋅L⟶i.


## 4. The Model of the MEMS-SINS/GPS Ultratight Integration System

### 4.1. State Equations

From [23, 24], the state equation of the system is expressed as(9)X˙=FX+GW,X=ϕnδvnδpnεb∇bbclkdclkT,where ϕn=ϕEϕNϕU is the error angle, δvn=δvEδvNδvU is the velocity error, and δpn=δLδλδh is the position error. The constant bias of gyroscope is εb=εbxεbyεbz, and the constant bias of accelerometer ∇b=∇bx∇by∇bz is the accelerometer constant bias. bclk and dclk are the clock error and the clock frequency error of receiver, respectively.


### 4.2. Measurement Equations

The measurement equations of MEMS-SINS/GPS ultratight integration system are composed of TSDCP-v and PR. In order to avoid the nonlinear error due to the linearization of PR measurement in high dynamics and strong interference environments, a new PR measurement equation that retains the second-order nonlinear term is constructed. The measurement model of PR at timek shown in (1) can be rewritten as(10)ρsj=Rj+bclk+vj,where Rj=r−rsj, r is the actual position of receiver, rsj is the satellite position, and vj is the measurement error modeled as white noise.Assuming thatrI is the receiver position vector estimated by MEMS-SINS, the pseudorange estimate ρIj is as follows:(11)ρIj=rI−rsj.Denote the MEMS-SINS position error in ECEF byδr, δr=rI−r, and expend equation (11) by a Taylor series about r to the second-order term; the pseudorange estimated by MEMS-SINS is as follows:(12)ρIj=Rj+Jacobijr⋅δr+12δrT⋅Hessijr⋅δr,where Jacobijr=∂ρIj/∂rI|rI=r is the Jacobian matrix and Hessijr=∂/∂rI∂ρIj/∂rI|rI=r is Hessian matrix.According to equations (10) and (12), the pseudorange measurement of satellite j is as follows:(13)δρj=ρIj−ρsj=Jacobijr⋅δr+12δrT⋅Hessijr⋅δr−bclk+vj.The pseudorange measurement equation of MEMS-SINS/GPS ultratight integration system is as follows:(14)Zρ=δρ=HρX+12XTDvTCλeHessi1CλeDvXXTDvTCλeHessi2CλeDvX⋮XTDvTCλeHessimCλeDvX+Vρ=Hρ′X+Vρ,where(15)δρ=ρI−ρs=δρ1δρ2⋯δρmT,Hρ=0m×6Du⋅Cλe0m×6−e0m×1,Du=Jacobi1rJacobi2r⋯JacobimrT,Dv=03×6I3×303×8,e=11⋯11×mT,Vρ=vρ1vρ2⋯vρmT.Cλe is the transition matrix from geographic coordinates to ECEF coordinates:(16)Cλe=−RN+hsinLcosλ−RN+hcosLsinλcosLcosλ−RN+hsinLsinλRN+hcosLcosλcosLsinλRN1−e2+hcosL0sinL.The velocity measurement can be obtained by the difference between TSDCP velocityVcp and MEMS-SINS velocity VI.(17)Zv=VI−Vcp=HvX+Vv,Hv=0m×3Im×30m×90m×10m×1.Equations (14) and (17) are the measurement equations of the MINS/GPS ultratight integrated system.


### 4.3. Integrated Kalman Filter

Because the velocity measurement is linear, the pseudorange measurement is nonlinear, and there are different noise characteristics between the measurements; the IKF uses a sequential filtering configuration. In the process of IKF update,X^0 and P0 are the initial state estimates. The state equations processed by the conventional Kalman filter (KF) are(18)X^k/k−1=Φk/k−1X^k−1,Pk/k−1=Φk/k−1Pk−1Φk/k−1T+Qk−1,X^k0=X^k/k−1,Pk0=Pk/k−1.As the pseudorange measurement is nonlinear, it is processed by UKF. The UT transformation of pseudorange measurement prediction is as follows:(19)χk/k−1=X^k0X^k0n+γPk0X^k0n−γPk0,ηi,k/k−1=Hρ′χi,k/k−1,y^k/k−1=∑i=02nWimηi,k/k−1,Py,k/k−1=∑i=02nWicηi,k/k−1−y^k/k−1ηi,k/k−1−y^k/k−1T+Rk1,Pxy,k/k−1=∑i=02nWicχi,k/k−1−X^k0ηi,k/k−1−y^k/k−1T.The state estimate by UKF is(20)Kk1=Pxy,k/k−1Py,k/k−1−1,X^k1=X^k0+Kk1Zk1−y^k/k−1,Pk1=Pk0−Kk1Py,k/k−1Kk1T,where Zk1 and Rk1 are pseudorange measurement and noise variance matrix at epoch k, respectively.As the velocity measurement is linear, it is processed by the KF as follows:(21)Kk2=Pk1HvTHvPk1HvT+Rk2−1,X^k2=X^k1+Kk2Zk2−HvX^k1,Pk2=I−Kk2HvPk1,X^k=X^k2,Pk=Pk2,where Zk2 and Rk2 are the velocity measurement and the measurement noise variance matrix at k. X^k and Pk are the IKF outputs at epoch, respectively.


## 4.1. State Equations

From [23, 24], the state equation of the system is expressed as(9)X˙=FX+GW,X=ϕnδvnδpnεb∇bbclkdclkT,where ϕn=ϕEϕNϕU is the error angle, δvn=δvEδvNδvU is the velocity error, and δpn=δLδλδh is the position error. The constant bias of gyroscope is εb=εbxεbyεbz, and the constant bias of accelerometer ∇b=∇bx∇by∇bz is the accelerometer constant bias. bclk and dclk are the clock error and the clock frequency error of receiver, respectively.


## 4.2. Measurement Equations

The measurement equations of MEMS-SINS/GPS ultratight integration system are composed of TSDCP-v and PR. In order to avoid the nonlinear error due to the linearization of PR measurement in high dynamics and strong interference environments, a new PR measurement equation that retains the second-order nonlinear term is constructed. The measurement model of PR at timek shown in (1) can be rewritten as(10)ρsj=Rj+bclk+vj,where Rj=r−rsj, r is the actual position of receiver, rsj is the satellite position, and vj is the measurement error modeled as white noise.Assuming thatrI is the receiver position vector estimated by MEMS-SINS, the pseudorange estimate ρIj is as follows:(11)ρIj=rI−rsj.Denote the MEMS-SINS position error in ECEF byδr, δr=rI−r, and expend equation (11) by a Taylor series about r to the second-order term; the pseudorange estimated by MEMS-SINS is as follows:(12)ρIj=Rj+Jacobijr⋅δr+12δrT⋅Hessijr⋅δr,where Jacobijr=∂ρIj/∂rI|rI=r is the Jacobian matrix and Hessijr=∂/∂rI∂ρIj/∂rI|rI=r is Hessian matrix.According to equations (10) and (12), the pseudorange measurement of satellite j is as follows:(13)δρj=ρIj−ρsj=Jacobijr⋅δr+12δrT⋅Hessijr⋅δr−bclk+vj.The pseudorange measurement equation of MEMS-SINS/GPS ultratight integration system is as follows:(14)Zρ=δρ=HρX+12XTDvTCλeHessi1CλeDvXXTDvTCλeHessi2CλeDvX⋮XTDvTCλeHessimCλeDvX+Vρ=Hρ′X+Vρ,where(15)δρ=ρI−ρs=δρ1δρ2⋯δρmT,Hρ=0m×6Du⋅Cλe0m×6−e0m×1,Du=Jacobi1rJacobi2r⋯JacobimrT,Dv=03×6I3×303×8,e=11⋯11×mT,Vρ=vρ1vρ2⋯vρmT.Cλe is the transition matrix from geographic coordinates to ECEF coordinates:(16)Cλe=−RN+hsinLcosλ−RN+hcosLsinλcosLcosλ−RN+hsinLsinλRN+hcosLcosλcosLsinλRN1−e2+hcosL0sinL.The velocity measurement can be obtained by the difference between TSDCP velocityVcp and MEMS-SINS velocity VI.(17)Zv=VI−Vcp=HvX+Vv,Hv=0m×3Im×30m×90m×10m×1.Equations (14) and (17) are the measurement equations of the MINS/GPS ultratight integrated system.


## 4.3. Integrated Kalman Filter

Because the velocity measurement is linear, the pseudorange measurement is nonlinear, and there are different noise characteristics between the measurements; the IKF uses a sequential filtering configuration. In the process of IKF update,X^0 and P0 are the initial state estimates. The state equations processed by the conventional Kalman filter (KF) are(18)X^k/k−1=Φk/k−1X^k−1,Pk/k−1=Φk/k−1Pk−1Φk/k−1T+Qk−1,X^k0=X^k/k−1,Pk0=Pk/k−1.As the pseudorange measurement is nonlinear, it is processed by UKF. The UT transformation of pseudorange measurement prediction is as follows:(19)χk/k−1=X^k0X^k0n+γPk0X^k0n−γPk0,ηi,k/k−1=Hρ′χi,k/k−1,y^k/k−1=∑i=02nWimηi,k/k−1,Py,k/k−1=∑i=02nWicηi,k/k−1−y^k/k−1ηi,k/k−1−y^k/k−1T+Rk1,Pxy,k/k−1=∑i=02nWicχi,k/k−1−X^k0ηi,k/k−1−y^k/k−1T.The state estimate by UKF is(20)Kk1=Pxy,k/k−1Py,k/k−1−1,X^k1=X^k0+Kk1Zk1−y^k/k−1,Pk1=Pk0−Kk1Py,k/k−1Kk1T,where Zk1 and Rk1 are pseudorange measurement and noise variance matrix at epoch k, respectively.As the velocity measurement is linear, it is processed by the KF as follows:(21)Kk2=Pk1HvTHvPk1HvT+Rk2−1,X^k2=X^k1+Kk2Zk2−HvX^k1,Pk2=I−Kk2HvPk1,X^k=X^k2,Pk=Pk2,where Zk2 and Rk2 are the velocity measurement and the measurement noise variance matrix at k. X^k and Pk are the IKF outputs at epoch, respectively.


## 5. Simulation and Analysis

To analyze the antijamming capability, dynamic performance, and navigation performance of MEMS-SINS/GPS ultratight integration system under challenging environments, the simulation experiments are designed, and the simulation platform is shown in Figure3. The trajectory generator generates the ideal trajectory of the carrier. The ideal trajectory is used to simulate the IF signal and the IMU outputs. The IF signal and the IMU outputs are used in the SINS/GPS tight integration system, the SINS-assisted GPS ultratight integration system, and the MEMS-SINS/GPS ultratight integration system to verify system performance. The carrier ideal trajectory is shown in Figure 4.Figure 3
The simulation platform for system.Figure 4
The carrier real trajectory.The system uses low-precision MEMS, the gyro constant bias is3∘/h, the random noise is 0.3∘/h, the acceleration constant bias is 1000μg, and its random noise is 100μg/Hz. In MEMS-SINS, the initial attitude error is 0.2,0.2,0.2″, the initial velocity error is 0.05,0.05,0.05m/s, and the initial position error is 10,10,15m. The GPS IF signal frequency is 2 MHz; narrowband noise interference and broadband noise interference with SNR=−27dB are modulated on the IF signal. In the GPS software receiver module, the sampling frequency is 10 MHz, the noise bandwidth is adjustable, and the damping factor is 0.7. The integrated system navigation output cycle is 10 ms.


### 5.1. Result and Analysis of TSDCP Velocity

The high-precision TSDCP velocity is calculated by time-space difference carrier phase measurement. The carrier phase measurement is output by carrier tracking loop, and the carrier phase measurement and the carrier phase measurement error are shown in Figure5.Figure 5
(a) Carrier phase measurement. (b) Carrier phase measurement error.
(a)(b)The TSDCP velocity error is shown in Figure6.Figure 6
TSDCP velocity error.
(a)(b)(c)As shown in Figure6, the accuracy of TSDCP velocity can reach the centimeter, and the TSDCP velocity error is less than 0.04 m/s. Therefore, using TSDCP velocity to calculate the Doppler frequency to aid the GPS carrier tracking loop, the proposed MEMS-SINS/GPS ultratight integration system reduces the Doppler aiding error introduced by low-precision MEMS and avoids GPS measurement error related to MEMS-SINS velocity error.


### 5.2. The Dynamic Performance Analysis of MEMS-SINS/GPS Ultratight Integration System

In the MEMS-SINS/GPS ultratight integration system, TSDCP-v is used to calculate the Doppler aiding frequency to aid the GPS carrier tracking loop. Figure7 shows the Doppler aiding frequency of carrier tracking loop corresponding to PRN8 and the carrier tracking frequency error output by carrier loop filter in the MEMS-SINS/GPS ultratight integration system.Figure 7
(a) Doppler aiding frequency. (b) Carrier tracking frequency error.
(a)(b)In the SINS/GPS tight integration system, the GPS carrier tracking loop is not assisted by the aid information, and the carrier NCO is modulated by the output of carrier loop filter. The carrier tracking frequency error output by carrier loop filter in the SINS/GPS tight integration system is shown in Figure8.Figure 8
The carrier tracking frequency error of SINS/GPS tight integration system.The Doppler aiding frequency and the carrier tracking frequency error of MEMS-SINS/GPS ultratight integration system in Figure7 are compared with the carrier tracking frequency error of SINS/GPS tight integration system in Figure 8. The Doppler aiding frequency in MEMS-SINS/GPS ultratight integration system can accurately estimate the carrier frequency variation of the carrier loop filter output, so that the carrier tracking loop only needs to track the remaining small aid frequency error.In the MEMS-SINS/GPS ultratight integration system, the carrier tracking loop is assisted by Doppler aiding frequency. On the one hand, the influence of carrier dynamic on tracking loop is eliminated, the dynamic tracking ability of the tracking loop is enhanced, and the probability of losing lock of carrier tracking loop is reduced. On the other hand, equivalent bandwidth of tracking loop is increased, so as to reduce the dynamic stress error. Therefore, compared with the SINS/GPS tight integration system, the MEMS-SINS/GPS ultratight integration system has higher dynamic performance.


### 5.3. The Antijamming Capability Analysis of MEMS-SINS/GPS Ultratight Integration System

The GPS carrier tracking loop measurement error is one of the factors influencing the carrier tracking performance of PLL. The measurement errors and tracking thresholds are closely related because the carrier tracking loop loses lock when the measurement errors exceed a certain tracking threshold.Considering the thermal noise and dynamic stress error, the conservative rule-of-thumb tracking threshold for PLL is described as(22)δPLL=δtPLL+θe3≤15∘.1-sigma thermal noise and dynamic stress error can be described as(23)δtPLL=3602πBnC/N01+12TC/N0°,θe=dnR/dtnw0n,where Bn denotes the noise bandwidth of PLL, C/N0 represents the carrier-to-noise ratio, T is the predetection integration time, dnR/dtn is the maximum of the LOS acceleration between the receiver and the satellite, and n and w0 denote the order and the natural frequency of PLL, respectively. The relationship between w0 and the noise bandwidth Bn is Bn=0.25ω0 for a first-order PLL, Bn=0.53ω0 for a second-order PLL, and Bn=0.7845ω0 for a third-order PLL.For a second-order PLL, suppose that the predetection integration time is 1 ms, and the maximum of the LOS acceleration between the receiver and the satellite is 10g. Considering the thermal noise and dynamic stress error, the relationship between SINS/GPS tight integration carrier tracking loop measurement error, noise bandwidth, and carrier-to-noise ratio is shown in Figure9.Figure 9
The relationship between measurement, noise bandwidth, and carrier-to-noise ratio in the SINS/GPS tight integration system.It can be seen from Figure9 that the SINS/GPS tight integration system has a contradiction between restraining the thermal noise and dynamic stress error. Decreasing the bandwidth would reduce the thermal noise but would result in large dynamic stress error simultaneously.In the MEMS-SINS/GPS ultratight integration system, the carrier tracking loop is assisted by the TSDCP velocity, and the dynamic stress error is compensated. The GPS carrier tracking loop measurement error is mainly related to thermal noise. The relationship between PLL measurement error, noise bandwidth, and carrier-to-noise ratio in ultratight integration system is shown in Figure10.Figure 10
The relationship between measurement error, noise bandwidth, and carrier-to-noise ratio in MEMS-SINS/GPS ultratight integration system.It can be seen from Figure10 that, in the MEMS-SINS/GPS ultratight integration, the contradiction between the dynamic performance and antinoise capability can be solved. On one hand, the equivalent bandwidth increased, thereby reducing the dynamic stress error. On the other hand, it restrains the thermal noise. With the noise bandwidth decreasing, the PLL measurement error decreases, and the carrier-to-noise ratio threshold of the carrier loop becomes lower. The PLL can track under lower signal-to-noise ratio conditions, and the antijamming capability is improved.Analyze the antijamming capability of the system by calculating the ratio of interference to signal power (J/S). Table1 shows the antijamming performance comparison of SINS/GPS tight integration system and MEMS-SINS/GPS ultratight integration system. It can be seen from Table 1 that, compared to the tight integration system, the antijamming ability of the MEMS-SINS/GPS ultratight integration system is improved by about 5 dB.Table 1
The anti-interference tolerance of systems.
Noise bandwidth/HzC/N threshold/dBHzNarrowband interference tolerance J/S/dBBroadband interference tolerance J/S/dBTight integration system252831.6434.65Ultratight integration system523.536.4439.45The carrier-to-noise ratio of satellite signals in SINS/GPS tight integration system and ultratight integration system are shown in Figure11. In SINS/GPS tight integration system, when the noise bandwidth is 14 Hz, in addition to the PRN17, the carrier-to-noise ratios of other satellite signals are lower than 20dBHz, and the corresponding tracking channel is lose lock. The C/N estimation of SINS/GPS tight integration system is shown in Figure 11(a). In MEMS-SINS/GPS ultratight integration system, when the noise bandwidth is 5 Hz, the signal carrier-to-noise ratio is higher than 30dBHz, the corresponding tracking channel can work normally, and the C/N estimation is shown in Figure 11(b). Compared with SINS/GPS tight integration system, the ultratight integration system has higher anti-interference ability.Figure 11
(a) C/N estimation of SINS/GPS tight integration. (b) C/N estimation of MEMS-SINS/GPS ultratight integration.
(a)(b)


### 5.4. The Performance Analysis of Carrier Tracking Loop Compared with SINS-Assisted GPS Ultratight Integration System

The carrier tracking loop performances of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system can be compared by the outputs of PLL lock detectors. The outputs of PLL lock detectors can be calculated by the carrier tracking phase error output by the carrier phase discriminator in carrier tracking loop. The closer the output value of PLL lock detectors is to 1, the better the signal tracking performance of carrier tracking loop is. The PLL lock detector outputs of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system are shown in Figure12.Figure 12
(a) The PLL detector outputs of SINS-assisted GPS ultratight integration. (b) The PLL detector outputs of MEMS-SINS/GPS ultratight integration.
(a)(b)The RMS of the PLL detector outputs of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system are shown in Table2.Table 2
The RMS of PLL detector outputs of two ultratight integration system.
PRN1PRN17PRN7PRN11PRN8PRN18SINS-assisted GPS ultratight integration0.92850.95480.91550.92520.92060.9132MEMS-SINS/GPS ultratight integration0.94650.95460.93530.94220.92060.9222From Figure12 and Table 2, when using low-precision MEMS and in high dynamics and strong interference environment, the MEMS-SINS/GPS ultratight integration navigation system can avoid the correlation between GPS measurement error and SINS velocity error by introducing TSDCP-v to assist the carrier tracking loop, which can keep the signals tracked stably. Compared with SINS-assisted GPS ultratight integration system, the MEMS-SINS/GPS ultratight integration navigation system has higher signal tracking ability.


### 5.5. The Navigation Performance Analysis of MEMS-SINS Ultratight Integration System

Figures13–15 show the navigation errors of the SINS/GPS tight integration system, the SINS-assisted GPS ultratight integration system, and the MEMS-SINS/GPS ultratight integration system. At the same time, the navigation accuracy comparison of the three integration navigation systems above is shown in Table 3.Figure 13
SINS/GPS tight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Figure 14
SINS-assisted GPS ultratight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Figure 15
MEMS-SINS/GPS ultratight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Table 3
Comparison of navigation accuracy between three integration navigation systems.
Navigation errorTight integrationSINS-assisted GPS ultratight integrationMEMS-SINS/GPS ultratight integrationPosition error (m)Latitude2.42421.63300.8353Longitude3.49421.55770.8161Altitude4.16741.81850.8472Velocity error (m/s)East0.05370.05490.0128North0.10960.04410.0104Up0.12300.09020.0124In high dynamics and strong interference environment, the SINS/GPS tight integration system carrier tracking loop is easy to lose lock. As a result, the satellite signal tracked by the tracking loop becomes less, or even the satellite signal cannot be tracked, as shown in Figure11(a). The navigation accuracy of SINS/GPS tight integration system decreases or even diverges. In the SINS/GPS ultratight integration system, the carrier tracking loop is assisted by assist information, improving the system’s dynamic performance and antijamming ability. Then, the navigation performance is also improved.Comparing the navigation errors of the SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system, the navigation solution error of the MEMS-SINS/GPS ultratight integration system is smaller, and the IKF is more stable. On the one hand, the carrier tracking performance of the MEMS-SINS/GPS ultratight integration system is higher than the SINS-assisted GPS ultratight integration system when using low-precision MEMS and in high dynamics and strong interference environments. It makes the observation accuracy of the tracking loop output used for the combined filter become higher. On the other hand, in the MEMS-SINS/GPS ultratight integration system, the second-order nonlinear term in the PR measurement is retained, and the nonlinear PR measurement is processed by UKF, which overcomes the nonlinear error introduced by the linearized PR measurement.


## 5.1. Result and Analysis of TSDCP Velocity

The high-precision TSDCP velocity is calculated by time-space difference carrier phase measurement. The carrier phase measurement is output by carrier tracking loop, and the carrier phase measurement and the carrier phase measurement error are shown in Figure5.Figure 5
(a) Carrier phase measurement. (b) Carrier phase measurement error.
(a)(b)The TSDCP velocity error is shown in Figure6.Figure 6
TSDCP velocity error.
(a)(b)(c)As shown in Figure6, the accuracy of TSDCP velocity can reach the centimeter, and the TSDCP velocity error is less than 0.04 m/s. Therefore, using TSDCP velocity to calculate the Doppler frequency to aid the GPS carrier tracking loop, the proposed MEMS-SINS/GPS ultratight integration system reduces the Doppler aiding error introduced by low-precision MEMS and avoids GPS measurement error related to MEMS-SINS velocity error.


## 5.2. The Dynamic Performance Analysis of MEMS-SINS/GPS Ultratight Integration System

In the MEMS-SINS/GPS ultratight integration system, TSDCP-v is used to calculate the Doppler aiding frequency to aid the GPS carrier tracking loop. Figure7 shows the Doppler aiding frequency of carrier tracking loop corresponding to PRN8 and the carrier tracking frequency error output by carrier loop filter in the MEMS-SINS/GPS ultratight integration system.Figure 7
(a) Doppler aiding frequency. (b) Carrier tracking frequency error.
(a)(b)In the SINS/GPS tight integration system, the GPS carrier tracking loop is not assisted by the aid information, and the carrier NCO is modulated by the output of carrier loop filter. The carrier tracking frequency error output by carrier loop filter in the SINS/GPS tight integration system is shown in Figure8.Figure 8
The carrier tracking frequency error of SINS/GPS tight integration system.The Doppler aiding frequency and the carrier tracking frequency error of MEMS-SINS/GPS ultratight integration system in Figure7 are compared with the carrier tracking frequency error of SINS/GPS tight integration system in Figure 8. The Doppler aiding frequency in MEMS-SINS/GPS ultratight integration system can accurately estimate the carrier frequency variation of the carrier loop filter output, so that the carrier tracking loop only needs to track the remaining small aid frequency error.In the MEMS-SINS/GPS ultratight integration system, the carrier tracking loop is assisted by Doppler aiding frequency. On the one hand, the influence of carrier dynamic on tracking loop is eliminated, the dynamic tracking ability of the tracking loop is enhanced, and the probability of losing lock of carrier tracking loop is reduced. On the other hand, equivalent bandwidth of tracking loop is increased, so as to reduce the dynamic stress error. Therefore, compared with the SINS/GPS tight integration system, the MEMS-SINS/GPS ultratight integration system has higher dynamic performance.


## 5.3. The Antijamming Capability Analysis of MEMS-SINS/GPS Ultratight Integration System

The GPS carrier tracking loop measurement error is one of the factors influencing the carrier tracking performance of PLL. The measurement errors and tracking thresholds are closely related because the carrier tracking loop loses lock when the measurement errors exceed a certain tracking threshold.Considering the thermal noise and dynamic stress error, the conservative rule-of-thumb tracking threshold for PLL is described as(22)δPLL=δtPLL+θe3≤15∘.1-sigma thermal noise and dynamic stress error can be described as(23)δtPLL=3602πBnC/N01+12TC/N0°,θe=dnR/dtnw0n,where Bn denotes the noise bandwidth of PLL, C/N0 represents the carrier-to-noise ratio, T is the predetection integration time, dnR/dtn is the maximum of the LOS acceleration between the receiver and the satellite, and n and w0 denote the order and the natural frequency of PLL, respectively. The relationship between w0 and the noise bandwidth Bn is Bn=0.25ω0 for a first-order PLL, Bn=0.53ω0 for a second-order PLL, and Bn=0.7845ω0 for a third-order PLL.For a second-order PLL, suppose that the predetection integration time is 1 ms, and the maximum of the LOS acceleration between the receiver and the satellite is 10g. Considering the thermal noise and dynamic stress error, the relationship between SINS/GPS tight integration carrier tracking loop measurement error, noise bandwidth, and carrier-to-noise ratio is shown in Figure9.Figure 9
The relationship between measurement, noise bandwidth, and carrier-to-noise ratio in the SINS/GPS tight integration system.It can be seen from Figure9 that the SINS/GPS tight integration system has a contradiction between restraining the thermal noise and dynamic stress error. Decreasing the bandwidth would reduce the thermal noise but would result in large dynamic stress error simultaneously.In the MEMS-SINS/GPS ultratight integration system, the carrier tracking loop is assisted by the TSDCP velocity, and the dynamic stress error is compensated. The GPS carrier tracking loop measurement error is mainly related to thermal noise. The relationship between PLL measurement error, noise bandwidth, and carrier-to-noise ratio in ultratight integration system is shown in Figure10.Figure 10
The relationship between measurement error, noise bandwidth, and carrier-to-noise ratio in MEMS-SINS/GPS ultratight integration system.It can be seen from Figure10 that, in the MEMS-SINS/GPS ultratight integration, the contradiction between the dynamic performance and antinoise capability can be solved. On one hand, the equivalent bandwidth increased, thereby reducing the dynamic stress error. On the other hand, it restrains the thermal noise. With the noise bandwidth decreasing, the PLL measurement error decreases, and the carrier-to-noise ratio threshold of the carrier loop becomes lower. The PLL can track under lower signal-to-noise ratio conditions, and the antijamming capability is improved.Analyze the antijamming capability of the system by calculating the ratio of interference to signal power (J/S). Table1 shows the antijamming performance comparison of SINS/GPS tight integration system and MEMS-SINS/GPS ultratight integration system. It can be seen from Table 1 that, compared to the tight integration system, the antijamming ability of the MEMS-SINS/GPS ultratight integration system is improved by about 5 dB.Table 1
The anti-interference tolerance of systems.
Noise bandwidth/HzC/N threshold/dBHzNarrowband interference tolerance J/S/dBBroadband interference tolerance J/S/dBTight integration system252831.6434.65Ultratight integration system523.536.4439.45The carrier-to-noise ratio of satellite signals in SINS/GPS tight integration system and ultratight integration system are shown in Figure11. In SINS/GPS tight integration system, when the noise bandwidth is 14 Hz, in addition to the PRN17, the carrier-to-noise ratios of other satellite signals are lower than 20dBHz, and the corresponding tracking channel is lose lock. The C/N estimation of SINS/GPS tight integration system is shown in Figure 11(a). In MEMS-SINS/GPS ultratight integration system, when the noise bandwidth is 5 Hz, the signal carrier-to-noise ratio is higher than 30dBHz, the corresponding tracking channel can work normally, and the C/N estimation is shown in Figure 11(b). Compared with SINS/GPS tight integration system, the ultratight integration system has higher anti-interference ability.Figure 11
(a) C/N estimation of SINS/GPS tight integration. (b) C/N estimation of MEMS-SINS/GPS ultratight integration.
(a)(b)


## 5.4. The Performance Analysis of Carrier Tracking Loop Compared with SINS-Assisted GPS Ultratight Integration System

The carrier tracking loop performances of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system can be compared by the outputs of PLL lock detectors. The outputs of PLL lock detectors can be calculated by the carrier tracking phase error output by the carrier phase discriminator in carrier tracking loop. The closer the output value of PLL lock detectors is to 1, the better the signal tracking performance of carrier tracking loop is. The PLL lock detector outputs of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system are shown in Figure12.Figure 12
(a) The PLL detector outputs of SINS-assisted GPS ultratight integration. (b) The PLL detector outputs of MEMS-SINS/GPS ultratight integration.
(a)(b)The RMS of the PLL detector outputs of SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system are shown in Table2.Table 2
The RMS of PLL detector outputs of two ultratight integration system.
PRN1PRN17PRN7PRN11PRN8PRN18SINS-assisted GPS ultratight integration0.92850.95480.91550.92520.92060.9132MEMS-SINS/GPS ultratight integration0.94650.95460.93530.94220.92060.9222From Figure12 and Table 2, when using low-precision MEMS and in high dynamics and strong interference environment, the MEMS-SINS/GPS ultratight integration navigation system can avoid the correlation between GPS measurement error and SINS velocity error by introducing TSDCP-v to assist the carrier tracking loop, which can keep the signals tracked stably. Compared with SINS-assisted GPS ultratight integration system, the MEMS-SINS/GPS ultratight integration navigation system has higher signal tracking ability.


## 5.5. The Navigation Performance Analysis of MEMS-SINS Ultratight Integration System

Figures13–15 show the navigation errors of the SINS/GPS tight integration system, the SINS-assisted GPS ultratight integration system, and the MEMS-SINS/GPS ultratight integration system. At the same time, the navigation accuracy comparison of the three integration navigation systems above is shown in Table 3.Figure 13
SINS/GPS tight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Figure 14
SINS-assisted GPS ultratight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Figure 15
MEMS-SINS/GPS ultratight integration system navigation errors. (a) Position error. (b) Velocity errors.
(a)(b)Table 3
Comparison of navigation accuracy between three integration navigation systems.
Navigation errorTight integrationSINS-assisted GPS ultratight integrationMEMS-SINS/GPS ultratight integrationPosition error (m)Latitude2.42421.63300.8353Longitude3.49421.55770.8161Altitude4.16741.81850.8472Velocity error (m/s)East0.05370.05490.0128North0.10960.04410.0104Up0.12300.09020.0124In high dynamics and strong interference environment, the SINS/GPS tight integration system carrier tracking loop is easy to lose lock. As a result, the satellite signal tracked by the tracking loop becomes less, or even the satellite signal cannot be tracked, as shown in Figure11(a). The navigation accuracy of SINS/GPS tight integration system decreases or even diverges. In the SINS/GPS ultratight integration system, the carrier tracking loop is assisted by assist information, improving the system’s dynamic performance and antijamming ability. Then, the navigation performance is also improved.Comparing the navigation errors of the SINS-assisted GPS ultratight integration system and the MEMS-SINS/GPS ultratight integration system, the navigation solution error of the MEMS-SINS/GPS ultratight integration system is smaller, and the IKF is more stable. On the one hand, the carrier tracking performance of the MEMS-SINS/GPS ultratight integration system is higher than the SINS-assisted GPS ultratight integration system when using low-precision MEMS and in high dynamics and strong interference environments. It makes the observation accuracy of the tracking loop output used for the combined filter become higher. On the other hand, in the MEMS-SINS/GPS ultratight integration system, the second-order nonlinear term in the PR measurement is retained, and the nonlinear PR measurement is processed by UKF, which overcomes the nonlinear error introduced by the linearized PR measurement.


## 6. Conclusions

In the MEMS-SINS/GPS ultratight integration system, the TSDCP velocity assists the carrier tracking loop and improves the dynamic performance of the system. By reducing the noise bandwidth of the loop filter, on the one hand, the anti-interference tolerance of GPS is improved, and the carrier-to-noise ratio threshold of the tracking loop is reduced; on the other hand, noise interference can be suppressed by reducing the noise bandwidth and the carrier-to-noise ratio can be improved. By constructing the PR measurement that retains the second-order nonlinear term and designing the corresponding filtering algorithm, the accuracy of IKF estimation is improved. Compared with the SINS/GPS tight integration navigation system, the MEMS-SINS/GPS ultratight integration system has higher dynamic performance, anti-interference capability, and navigation performance. At the same time, the MEMS-SINS/GPS ultratight integration system improves the carrier tracking performance of SINS-assisted GPS ultratight integration system when using low-precision MEMS and in high dynamics, strong interference environments.



---

*Source: 8892205-2021-03-11.xml*