Next Article in Journal
Architectural Framework and Feasibility of Internet of Things-Driven Mars Exploration via Satellite Constellations
Previous Article in Journal
Identifying System Non-Linearities by Fusing Signal Bispectral Signatures
Previous Article in Special Issue
Robust State Estimation Using the Maximum Correntropy Cubature Kalman Filter with Adaptive Cauchy-Kernel Size
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Kalman Filter with Adaptive Covariance Estimation for Carrier Tracking under Weak Signals and Dynamic Conditions

Science and Technology on Metrology and Calibration Laboratory, Beijing Institute of Radio Metrology and Measurement, Beijing 100854, China
*
Author to whom correspondence should be addressed.
Electronics 2024, 13(7), 1288; https://doi.org/10.3390/electronics13071288
Submission received: 18 February 2024 / Revised: 26 March 2024 / Accepted: 28 March 2024 / Published: 30 March 2024

Abstract

:
Kalman filtering (KF)-based tracking has been commonly employed in global navigation satellite system (GNSS) receivers to achieve robust tracking. However, under more serious conditions, such as severe strength attenuation and abrupt dynamic coexisting environments, it is difficult for KF-based tracking to keep tracking well due to the fixed noise statistics. To further enhance the carrier tracking performance, this paper proposes an adaptive KF carrier tracking method for resisting signal strength fading and high dynamic environments. The proposed method introduces the adaptive factor to adjust the process noise covariance to accommodate the noise statistics in actual variable situations. Moreover, we apply the chi-square hypothesis test to detect system stability. The adaptive factor is only applied when the system is not stable, which can enhance computational efficiency. The proposed method is conducted in the GPS L1 software receivers. According to the results, the proposed algorithm can improve the robustness in tracking performance compared with other tracking methods under signal serious fading and high dynamic conditions. Using the proposed method, GNSS receivers’ navigation performance can be improved under complex conditions.

1. Introduction

Global navigation satellite system (GNSS) receivers have been employed in many areas, such as autonomous navigation, transport monitoring, and so on [1]. Now, the positioning accuracy of some GNSS receivers can reach the centimeter level [2]. To achieve high accuracy, the signal acquisition and tracking modules are significant parts of GNSS receivers. The carrier tracking module is used for achieving carrier synchronization between the input navigation signal and the local carrier signal, which can eliminate the carrier from the navigation signal. The carrier tracking loop usually uses the PLL (phase-locked loop) and the FLL (frequency-locked loop). However, these loops cannot work very well under signal degraded and high dynamic conditions, such as dense foliage, or city overpasses, which frequently appear in complex environments. The PLL has a dilemma between the coherent integration time and the loop bandwidth, which makes it easy to lose lock in weak and high dynamic conditions [3]. The FLL’s measurement accuracy is worse than that of the PLL. Accordingly, the traditional tracking loop does not work well under harsh environments.
To address these problems, the KF (Kalman filter) is implemented in the carrier tracking loop because of its robustness in tracking performance [4]. The KF technique has been employed in many areas, such as navigation [5,6], satellite attitude estimation [7,8], unmanned aerial vehicles [9], high accuracy positioning [10], and so on. Psiaki and Jung [11] designed a KF-based tracking loop that can enhance the tracking sensitivity compared with PLL. Won et al. [12] analyzed the characteristics of the KF-based tracking method. Won et al. [13] and Salem et al. [14] both illustrated that the KF-based tracking loop shows better tracking sensitivity and can obtain more accurate state estimations than the conventional tracking loop under weak signal conditions. Nevertheless, the KF estimation performance is determined by accurate dynamic and stochastic models. The process noise covariance matrix ( Q k ) can influence Kalman gains during the whole filtering process. If there are errors in the noise covariances, the filtering estimations may be suboptimal or even divergent.
However, accurate noise covariances are usually difficult to determine due to complex environments. Moreover, in variable situations, the actual noise covariances are changeable and cannot be obtained precisely. In fact, the noise covariance matrices in KF are predefined before the filtering process, which will not be changed anymore in the system. The predetermined noise covariances are typically obtained from the empirical analysis, which is not suitable for the actual noise stochastic properties under time-varying environments [15]. To enhance the KF performance’s robustness, many adaptive Kalman filter (AKF) algorithms have been proposed. Liu et al. [16] and Farina et al. [17] have employed different AKF algorithms in integrated navigation systems and localization systems to improve estimation performance. Apart from linear KF systems, non-linear functions also need to adjust the covariance matrices to improve the filtering adaptivity [18,19].
In addition, there are also several AKF algorithms applied in the carrier tracking system. Yao et al. [20] proposed a novel adaptive two-stage KF for tracking loops in high dynamic conditions. Chen et al. [21] proposed a novel adaptive joint Kalman filter algorithm for the vector PLL, but this is not suitable for the scalar tracking loop. Harsha et al. [22] and Vila et al. [23] proposed the adaptive EKF (extended Kalman filter) method for carrier tracking, which is only fit for ionospheric scintillation conditions. Miao et al. [24] proposed the variational Bayesian adaptive cubature Kalman filter algorithm for high dynamic signal conditions. However, there is not enough research on weak and high dynamic signal conditions. In signal fading and high dynamic environments, the signal strength and the Doppler frequency are both variable and sometimes change rapidly. The KF carrier tracking with unchanged noise covariance matrices cannot obtain optimal estimations in this situation, or they even lose lock. Therefore, it is necessary to apply an appropriate AKF algorithm to enhance the carrier tracking’s performance under weak signals and high dynamic conditions.
In this research, we propose an AKF carrier tracking approach for weak signals and high dynamic conditions. The adaptive factors are analyzed and designed to adjust the process noise covariance matrix Q k adaptively, which can compensate for modeling errors due to the inaccurate Q k matrix. Moreover, this algorithm introduces the chi-square method to detect the system’s stability. The adaptive factor is used only when the system is not steady. Based on the GPS L1 software receiver experiment results, the proposed AKF tracking shows higher robustness of tracking performance under signal fading and high dynamic conditions.
The other sections are structured as follows. Section 2 illustrates the model of KF-based carrier tracking. Section 3 introduces the proposed AKF carrier tracking loop. Then, the experiment results and analyses are demonstrated in Section 4 and the proposed AKF tracking’s performance is validated. Finally, Section 5 draws conclusions.

2. KF-Based Tracking Algorithm

2.1. The Receiver Tracking Loop Model

The KF-based tracking loop’s block diagram is presented in Figure 1. Firstly, the digital IF (intermediate frequency) signal is separated into in-phase and the quadrature channels, which are multiplied separately by the sin and cos local replica carrier signals. These results are multiplied by the prompt local replica code. Then, we can obtain the correlated signals. The carrier NCO (numerically controlled oscillator) is applied to produce the local replica carrier signal.
After the correlator, the coherent integration values I p ( k ) and Q p ( k ) can be obtained. I p ( k ) and Q p ( k ) are input into the discriminator to generate carrier phase error, that is the KF-based loop filter’s measurement values. Finally, the carrier phase and frequency of the carrier NCO are updated by the KF loop filter’s estimated results. The ultimate aim is to ensure that the local carriers can remain consistent with the received carrier signals, and then the received IF signals’ carrier can be completely wiped off.

2.2. System Model

For the KF tracking loop, the state space model can be given by the following:
x k = Φ x k 1 + n k 1
z k = H x k + v k
where x k = Δ φ k ω k α k T , Φ = 1 T T 2 / 2 0 1 T 0 0 1 , z k = δ φ k , and H = 1 T / 2 T 2 / 6 . Δ φ k , ω k , and α k are, respectively, the carrier phase error, carrier Doppler error, and carrier Doppler frequency rate error. T denotes the tracking loop’s update period. δ φ k denotes the measurement value obtained from the phase discriminator.
In (1), n k denotes the system noise, and the corresponding covariance matrix Q k is [25]
Q k = ω r f C 2 q a T 5 / 20 T 4 / 8 T 3 / 6 T 4 / 8 T 3 / 3 T 2 / 2 T 3 / 6 T 2 / 2 T + ω r f 2 q d T 3 / 3 T 2 / 2 0 T 2 / 2 T 0 0 0 0 + ω r f 2 q b T 0 0 0 0 0 0 0 0
where q d and q b are, respectively, the power spectral density of the local oscillator frequency noise and phase noise. q a represents the power spectral density of the receiver-satellite line-of-light acceleration disturbance. C is the light velocity. ω r f is the nominal carrier frequency.
The measurement noise in Equation (2) is v k . The covariance matrix R k of v k is obtained as follows [3]:
R k = E v k v k T = 1 2 T ( c / n 0 ) k 1 + 1 2 T ( c / n 0 ) k
where ( c / n 0 ) k represents the signal carrier-to-noise ratio.
According to the system model in (1) and (2), the KF algorithm is summarized as follows:
x ^ k = Φ x ^ k 1
P ^ k = Φ P ^ k 1 Φ T + Q k 1
K k = P ^ k H T H P ^ k H T + R k 1
x ^ k = x ^ k + K k z k H x ^ k
P ^ k = I K k H P ^ k
where K k denotes the Kalman gain, which can update the weight between measurement values and predicted values of the system model. x ^ k and P ^ k denote the predicted estimation and covariance matrix of the state vector. x ^ k and P ^ k denote the estimated values and covariance matrix.

3. Proposed Adaptive KF-Based Tracking

Inadequate prior knowledge of process noise statistics would lead to suboptimal KF estimations or divergence. In the GNSS signal fading and high dynamic applications, the actual noise statistics are not fixed but variable. Accordingly, the noise statistics determined beforehand in the KF tracking are not sufficient to satisfy the practical situations. To enhance the KF tracking performance, an adaptive approach is proposed to tune the process noise covariance Q k to satisfy the variable environments.

3.1. Analysis of the Adaptive Factor

The innovation sequence can be used as a reliable indicator of the estimation performance, which is defined as the discrepancy between the actual measurement and the predicted result, as given below:
d k = z k H x ^ k
Then, the innovation covariance is
C k = E [ d k d k T ]
where C k is the actual innovation covariance. In practice, it is difficult to achieve the actual innovation covariance C k = E [ d k d k T ] , which can be estimated by the present and past sequences. The window function method is commonly applied for innovation covariance estimation, that is
C ^ k = 1 N i = k N + 1 k d i d i T
where N represents the window length and C ^ k represents the estimated innovation covariance matrix.
When there are no modeling errors, the innovation sequences follow the orthogonal principle [26], that is
E [ d k + j d k T ] = 0 ,   k = 1 , 2 ,   j = 1 , 2
However, when modeling errors exist in the filtering system, the orthogonal principle cannot follow well. Therefore, the proposed adaptive tuning method should make the system obey the orthogonal principle. The orthogonal principle can make useful information of the innovation sequences completely extracted.
Because the fixed Q k matrix of KF may be inconsistent with the variable practical situation, the adaptive factor is used to adjust the matrix Q k . Accordingly, the predicted state error covariance matrix P ^ k is given as
P ^ k = Φ P ^ k 1 Φ T + λ k Q k 1
where λ k is the adaptive factor, which should be computed according to (13) so that the innovation sequences can follow the orthogonal principle.
If the KF state estimations are quite accurate, the state estimate error x ˜ k = x k x ^ k could follow O x ˜ k 2 O x ˜ k . Then the following can be obtained [27]:
E [ d k + j d k T ] H Φ ( I K k + j 1 H k + j 1 )         Φ ( I K k + 2 H k + 2 )     Φ ( I K k + 1 H k + 1 ) Φ ( P ^ k H T K k C k )     j = 1 ,   2
where I denotes the identity matrix. Therefore, if the time-varying gain matrix K k is chosen appropriately for all j = 1, 2, … to make
P ^ k H T K k C k = 0
then the orthogonal principle E [ d k + j d k T ] = 0 can be satisfied.
Substituting (7) into (16), we have
P ^ k H T I H P ^ k H T + R k 1 C k = 0
The sufficient condition for Equation (17) is as follows:
H P ^ k H T + R k 1 C k = I
Therefore,
H P ^ k H T + R k = C k
Substituting (14) into (19), it can be obtained that
C k = H Φ P ^ k 1 Φ T H T + R k + λ k H Q k 1 H T
Define
A k H Φ P ^ k 1 Φ T H T + R k
B k H Q k 1 H T
Then (20) can be rewritten as
C k A k = λ k B k
The trace of (23) is as follows:
tr ( C k A k ) = tr ( λ k B k )
where tr() represents the trace of the matrix. Then, λ k is obtained:
λ k = tr ( C k A k ) tr ( B k )
The actual innovation covariance C k is difficult to obtain, which is typically estimated by C ^ k in (12). To decrease the computational burden, the recursive algorithm is applied in (12) to estimate the innovation covariance [28]:
C ^ k = C ^ k 1 + 1 N d k d k T d k N d k N T
where N is the window length of the sliding window, which should be correctly determined. Because if the window length is too small, it is difficult to obtain an unbiased estimate. On the contrary, if the window size is too large, the estimations cannot reflect the short-term statistics of innovation covariances. Jwo et al. [29] stated that a good window size is between 10 and 30.
Then, the adaptive factor λ k can be obtained as follows:
λ k = tr ( C ^ k A k ) tr ( B k )
In dynamic and weak signal conditions, tracking systems often involve high levels of uncertainty in the system model. The larger adaptive factor can reduce its reliance on the system model and place more trust in the measurements, which can effectively remove the impact of model uncertainty. Accordingly, to keep the state estimation accuracy, the adaptive factor should not be smaller than 1.
If the adaptive factor is larger than 1, indicating that the tracking system changes suddenly, the value of P ^ k will increase based on Equation (14). Meanwhile, the Kalman gain K k will increase according to Equation (7). Accordingly, based on Equation (8), more weight will be put on the measurement data, and then the accuracy of the state estimation will be improved [30]. A larger adaptive factor can respond more quickly to changes in the measurements. This can accelerate the convergence rate of the filter and provide more timely estimation results, adapting to the variations of the signal. Hence, the robustness and accuracy of the system can be improved. Then, the adaptive factor λ k should be as follows:
λ k = max 1 ,   tr ( C ^ k A k ) tr ( B k )   k = 1 , 2

3.2. The System Stability Detection

If the system remains stable, there is no need to employ the adaptive factor in the KF process. Excessive use of adaptive factors may reduce the filtering accuracy and increase the computational load. The adaptive factor is used only when the system is not steady. Hence, the hypothesis testing method is employed to test the system. Then, two hypotheses can be introduced:
γ 0 : the system operates in a stable state;
γ 1 : the system operates abnormally.
When the tracking system is stable, the innovation sequence d k follows Gaussian distribution with a zero mean [26]. Otherwise, when the tracking system is not stable, d k will not obey the Gaussian distribution. Therefore, the detailed expressions are as follows:
If the system is stable, then d k N 0 , C ^ k ;
If the system is not stable, then d k does not obey the Gaussian distribution.
Therefore, the system stability detection is realized by these characteristics.
According to the chi-square test, based on d k , the statistics function is defined as follows:
β k = d k T C ^ k 1 d k
If d k obeys a Gaussian white noise sequence, β k has χ 2 distribution with s-degree-of-freedom (s-DOF) and s denotes the innovation sequence’s dimension.
If α is chosen as the significance level, then
P x > χ α 2 ( s ) = χ α 2 ( n ) f ( x ) d x = α ,   0 < α 1
where x is the statistic of the χ 2 distribution. χ α 2 ( s ) is the threshold value which is decided by the given α and s [31]. Figure 2 shows the PDF (probability density function) of the chi-square distribution.
Accordingly, if the hypothesis γ 1 is established, β k will be greater than χ α 2 ( s ) , which indicates that the system is not stable. Otherwise, the system is in a stable state.

3.3. The Proposed Algorithm for Carrier Tracking

In the carrier tracking loop, z k is a scalar in the epoch k, then d k and β k are both scalars. Hence, the β k has the χ 2 distribution with 1-DOF:
β k χ 2 ( 1 )
Figure 3 shows the proposed AKF algorithm. The functions of the two orange blocks are to detect the system stability and adjust the process noise covariance Q k , respectively. Apart from these two blocks, other parts in Figure 3 mainly follow the standard KF algorithm. Accordingly, the proposed tracking loop architecture is based on Figure 1, while the KF-based loop filter module is replaced by the proposed AKF algorithm. In the proposed algorithm, the measurement noise covariance matrix R k remains constant during the filtering process. Reference [32] stated that the Q k -only adaptive algorithm is superior to the R k -only and both Q k and R k adaptive cases in practical estimating performance.

4. Performance Evaluation and Discussion

To assess the validity and superiority of the proposed approach, the software GPS (Global Positioning System) L1 receiver is conducted. The input signal of the software receiver is the IF signal, which is generated by a satellite navigation signal simulator. The frequency and sampling rate of the IF signal are 1.42 MHz and 10 MHz, respectively. The signal resolution is set to 4-bit. Nine channels have been simulated in the software receiver for the visible satellites.
To evaluate the performance, four tracking methods are used in the experiments.
Method 1: the proposed AKF-based tracking method;
Method 2: the conventional PLL tracking method (the PLL’s bandwidth is 15 Hz and the update period is 4 ms);
Method 3: the standard KF tracking;
Method 4: the STKF (strong tracking Kalman filter) tracking method.

4.1. Example 1: Signal Fading Rapidly and Acceleration Scenario

Figure 4 demonstrates the simulated fading signal with dynamics. In Figure 4a, the C / N 0 began with 45 dB-Hz for 20 s. Then the C / N 0 was descended by 1 dB per 5 s until it decreased to 25 dB-Hz. Then the signal kept the 25 dB-Hz for 60 s. After 180 s, the C / N 0 was increased by 1 dB per 5 s until reaching the initial signal power. In Figure 4b, during the first 20 s, the receiver halted. After 20 s, the receiver accelerated with 32 m/s2 and the velocity reached 3200 m/s at t = 120 s. After 120 s, the receiver remained at 3200 m/s until t = 180 s. Then, the receiver decelerated with −32 m/s2 for 100 s and then stopped at 280 s. The velocity set in the scenario often occurs in aircraft, which is a high dynamic scenario.
In four tracking methods, the parameters settings are as follows:
Method 1:
The initial parameter settings are listed in Table 1.
(i)
Initialize the process noise covariance matrix Q k using (3) with q a = 0 . 3   m 2 / s 6 / Hz . Initialize the measurement noise covariance R k using (4) with ( C / N 0 ) 0 = 45 dB-Hz and ( c / n 0 ) 0 = 10 4.5 . The update period of the tracking loop is 4 ms. For the weak and dynamic signals, the update period is a compromise parameter, which should be long enough to work under weak signal conditions and should be as short as possible to work under dynamic conditions simultaneously. Then we set the update period as 4 ms.
(ii)
In the proposed method, the window size for estimated innovation covariances is 20. To make a compromise between the unbiased estimation and the short-term statistics, reference [29] has stated that good window size is between 10 and 30.
(iii)
Set the significance level α to 0.01, and the threshold value χ 0.01 2 ( 1 ) is 6.6349. It means that the probability of { β k 6.6349 } is 0.01. If the event { β k 6.6349 } occurs, the hypothesis γ 1 will hold and the proposed AKF tracking will be implemented.
Method 2: in the PLL tracking method, the PLL’s bandwidth is 15 Hz. The update period of the tracking loop is the same as that in Method 1.
Method 3: in the standard KF tracking, the settings of Q k , R k , and loop update interval are the same as those in Method 1.
Method 4: in STKF tracking, the settings of Q k , R k , and loop update interval are the same as those in Method 1.
The C / N 0 and Doppler estimated results of the four algorithms for PRN 14 and PRN 19 are shown in Figure 5. Figure 5a,c are the estimated results for PRN 14. Meanwhile, Figure 5b,d are the estimated results for PRN 19. Figure 5 demonstrates that the proposed AKF tracking approach performs best, which can follow the variable signal strength. Other tracking methods cannot follow the weak and dynamic power and deviate from the actual value when the signal is weak. In Figure 5c,d, the Doppler rates for PRN 14 and PRN 19 are 39 Hz/s and 50 Hz/s from 20 s to 120 s, respectively. From 121 s to 180 s, the Doppler rates for PRN 14 and PRN 19 are 3 Hz/s and 23 Hz/s, respectively. The KF tracking and the PLL tracking cannot follow the sudden changes caused by the Doppler frequency variation and signal strength attenuation. KF tracking fails because it cannot update the Q k matrix by the adaptive algorithm. The PLL tracking fails because the tracking loop’s bandwidth is fixed and cannot adapt to the dynamic and weak signal. For the STKF tracking, although it introduces the fading factors, without the system stability detection and adaptive Q k , false fading factors can be obtained in the STKF, which leads to wrong estimations. Then, the STKF performance performs worse than the KF. Hence, STKF is difficult to ensure accurate fading factors for all situations [33]. Accordingly, the STKF tracking for PRN 14 is better than KF tracking, but the STKF for PRN 19 is worse than KF. With the system stability detection and Q k adaptation, the proposed AKF tracking method can keep tracking well during the whole process.
Figure 6 shows the adaptive factor of the proposed AKF algorithm. As we can observe, when the signal strength decreases quickly while the velocity is accelerating, the adaptive factor λ k will be turned to a larger value. However, as the signal strength increases, the system keeps track of the signal well and the adaptive factors need not be used.
This indicates that the adaptive process noise covariances play a significant role in adapting to the signal strength and dynamic variation. According to the results, the proposed AKF approach is effective in resisting sudden changes from the power fading and high dynamic of the navigation signal. The proposed AKF tracking shows higher robustness compared with other tracking algorithms. This superiority can improve the position accuracy of dynamic receivers under signal fading environments.

4.2. Example 2: Abrupt Dynamics and Signal Fading Scenario

The second example is used to further verify the proposed algorithm’s validity. In Example 1, the dynamics contain acceleration, while Example 2 not only contains acceleration but also contains higher-order dynamics, which are abrupt turns.
This example implements the signal fading and higher-order dynamics simultaneously. Figure 7 demonstrates the signal strength and dynamics for Example 2. For the signal power, the C / N 0 started with 37 dB-Hz, and then was descended by 2 dB per 30 s. The maximum attenuation was 22 dB at 180 s and was kept at 25 dB-Hz for 25 s. The dynamics of the signal are illustrated in Table 2, which has been divided into ten intervals. Figure 7c labels the ten intervals of dynamics to reflect the Doppler variation of PRN 14.
The height of the receiver remains constant during the whole simulation process. Figure 8 shows the trajectory of the receiver. The receiver motion coexisted with acceleration, deceleration, and three abrupt turns. The first two turns turned with 90 degrees and the third one turned with 180 degrees. This scenario is used to simulate the aircraft flying in the sky and passing through obstructions, like forests and so on.
For the parameters set in this test, apart from R k , the other initial parameters in the four methods are identical to those in Example 1. R k is initialized using (4) with C / N 0  = 37 dB-Hz and ( c / n 0 ) 0 = 10 3.7 .
The C / N 0 and Doppler estimated results after 60 s for PRN 14 and PRN 20 are shown in Figure 9. Figure 9a,c show the estimations for PRN 14. Figure 9b,d show the estimations for PRN 20. In Figure 9a,b, all four tracking algorithms can obtain accurate estimated values when the C / N 0 is relatively higher and the receiver motion includes acceleration and abrupt turns. As the C / N 0 decreases below 27 dB-Hz, only the proposed method can follow the signal fading and dynamic signals during the whole process.
When the C / N 0 decreases to 25 dB-Hz and the receiver experiences the third clockwise turn, the PLL method and the KF tracking both cannot work well and lose lock. Because the STKF tracking does not have system stability detection and Q k adaptation, the STKF may introduce inaccurate fading factors and perform worse than KF. As shown in Figure 9, the STKF is worse than KF in PRN 20.
The adaptive factor of the proposed AKF algorithms for Example 2 is shown in Figure 10. When the system encounters sudden dynamics, the adaptive factor λ k will be larger, otherwise, the adaptive factor will be set to 1.
Therefore, for the first two abrupt turns under relatively high C/N0, all four tracking algorithms can track well. When the third turn is under relatively low C/N0, the KF and PLL tracking cannot adapt to the signal variation. The serious strength fading and abrupt motion cause the KF and PLL tracking cannot match the actual harsh situations. However, because the proposed adaptive factor can adjust the noise statistics to satisfy the real variable noise environments, the proposed AKF tracking can compensate for the modeling error under harsh environments.
Accordingly, in comparison with other tracking methods, the proposed AKF approach can adapt to the variable signal and show more robust tracking performance when the serious strength fading and sharp turns coincide. The proposed tracking approach can enhance the navigation performance of GPS receivers in complex environments with higher-order dynamic and signal attenuation.

4.3. Complexity Analysis

Compared with the KF-based tracking, the extra computational load in the proposed method is mainly the computation of β k and λ k , as shown in Figure 3 marked with the orange blocks. Note that n represents the dimension of the state vector, and m denotes the dimension of the measurement vector. Firstly, the computation of β k requires three equations shown in Figure 3, and then the computation complexity of β k is O(n). Three variables d k , β k , and C ^ k are scalars, and Table 3 shows the details of three equations for one iteration. For the computation of variable β k , d k 2 has been obtained in the computation of C ^ k , so the multiplication number of the variable β k is 1. Secondly, the calculation of λ k also needs three equations shown in Figure 3. The computation complexity for A k is O(n3). However, because Φ is a 3 × 3 upper triangular matrix, the computation of A k needs 24 multiplications and 14 additions, which is the most time-intensive part. The computation of B k needs 12 multiplications and 8 additions. The total operations are 44 multiplications and 28 additions, as demonstrated in Table 3.
According to Lo et al. [34], the multiplication number M(n, m) and the addition number A(n, m) for each KF iteration are as follows:
M ( n , m ) = 2 n 3 + 3 n 2 m + n 2 + 2 n m 2 + 2 n m
A ( n , m ) = 2 n 3 + 3 n 2 m + 2 n m 2 n m n
For the KF tracking, n = 3 and m = 1. Hence, M(n, m) and A(n, m) are 102 and 81, respectively.
Accordingly, in comparison with KF tracking, the calculation load of the proposed AKF method increases about 43% of multiplications and 34% of additions. However, the calculation of λ k is only used when the system works abnormally. When the system operates in the steady state, only β k needs to be computed, the computational load of which is small, as shown in Table 2. Therefore, in comparison with the KF-based tracking, the extra calculation burden in the proposed AKF method is not heavy.

5. Conclusions

To enhance the tracking robustness in signal attenuation and high dynamic environments, an adaptive KF-based carrier tracking approach is proposed. The proposed approach introduces the adaptive algorithm into the KF algorithm to self-tune the process noise covariance, which makes the tracking approach accommodate the time-varying signals. Moreover, the chi-square method is applied to detect system stability. The AKF algorithm is used when the tracking system is not steady, which can improve accuracy and computational efficiency.
The algorithm has been applied to the GPS L1 software receiver. According to the test results, the proposed carrier tracking algorithm can enhance the tracking robustness in severe fading and high dynamic environments compared with other tracking methods. Accordingly, when the proposed AKF approach is implemented in the GNSS receivers, it can enhance the navigation and positioning accuracy of high-speed receivers moving through obstructions in complicated environments.
For future research, the proposed tracking algorithm can be applied in complex conditions, such as automatic driving or unmanned aerial vehicle navigation systems experiencing high dynamic and signal fading. Moreover, the adaptability of the proposed algorithm can adjust the system noise covariance, which can also be employed in other nonlinear filtering methods, such as unscented KF (UKF), extended KF (EKF), and so on. Our work lays a theoretical foundation for nonlinear filtering and can enhance the filtering robustness in complex conditions. In addition, when the proposed AKF approach is implemented in the GNSS receivers, it can enhance navigation and positioning accuracy in complex environments.

Author Contributions

Conceptualization, Y.C. and S.Z.; methodology, Y.C., X.W. and H.W.; software, Y.C., H.W. and H.Y.; validation, Y.C., S.Z. and X.W.; investigation, Y.C., H.W. and H.Y.; writing—original draft preparation, Y.C.; writing—review and editing, S.Z.; supervision, S.Z.; project administration, X.W. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Data Availability Statement

Data are contained within the article.

Acknowledgments

The authors would like to thank the helpful comments of the anonymous reviewers.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Yasyukevich, Y.V.; Zhang, B.; Devanaboyina, V.R. Advances in GNSS Positioning and GNSS Remote Sensing. Sensors 2024, 24, 1200. [Google Scholar] [CrossRef] [PubMed]
  2. Hamza, V.; Stopar, B.; Sterle, O.; Pavlovčič-Prešeren, P. Low-Cost Dual-Frequency GNSS Receivers and Antennas for Surveying in Urban Areas. Sensors 2023, 23, 2861. [Google Scholar] [CrossRef] [PubMed]
  3. Yang, R.; Ling, V.; Poh, K.; Morton, Y. Generalized GNSS signal carrier tracking: Part II: Optimization and implementation. IEEE Trans. Aerosp. Electron. Syst. 2017, 53, 1798–1811. [Google Scholar] [CrossRef]
  4. López-Salcedo, J.A.; Del Peral-Rosado, J.A.; Seco-Granados, G. Survey on robust carrier tracking techniques. IEEE Commun. Surv. Tutor. 2014, 16, 670–688. [Google Scholar] [CrossRef]
  5. Wang, D.; Dong, Y.; Li, Z.; Li, Q.; Wu, J. Constrained MEMS-Based GNSS/INS Tightly Coupled System with Robust Kalman Filter for Accurate Land Vehicular Navigation. IEEE Trans. Instrum. Meas. 2020, 69, 5138–5148. [Google Scholar] [CrossRef]
  6. Gao, G.; Gao, B.; Gao, S.; Hu, G.; Zhong, Y. A hypothesis test-constrained robust Kalman filter for INS/GNSS integration with abnormal measurement. IEEE Trans. Veh. Technol. 2023, 72, 1662–1673. [Google Scholar] [CrossRef]
  7. Chen, X.; Cao, L.; Guo, P.; Xiao, B. A higher-order robust correlation Kalman filter for satellite attitude estimation. ISA Trans. 2020, 124, 326–327. [Google Scholar] [CrossRef] [PubMed]
  8. Wu, M.; He, Y.; Luo, S.; Liu, W. Particle filter-based real-time phase line bias estimation for GNSS-based attitude deter-mination with common-clock receivers. Adv. Space Res. 2023, 71, 1682–1699. [Google Scholar] [CrossRef]
  9. Liu, Y.; Duan, C.; Liu, L.; Cao, L. Discrete-Time Incremental Backstepping Control with Extended Kalman Filter for UAVs. Electronics 2023, 12, 3079. [Google Scholar] [CrossRef]
  10. Feng, S.; Ochieng, W.; Moore, T.; Hill, C.; Hide, C. Carrier phase-based integrity monitoring for high-accuracy positioning. GPS Solut. 2019, 13, 13–22. [Google Scholar]
  11. Psiaki, L.; Jung, H. Extended Kalman filter methods for tracking weak GPS signals. In Proceedings of the 15th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GPS 2002), Portland, OR, USA, 24–27 September 2002; pp. 2539–2553. [Google Scholar]
  12. Won, J.; Pany, T.; Eissfeller, B. Characteristics of Kalman filters for GNSS signal tracking loop. IEEE Trans. Aerosp. Electron. Syst. 2012, 48, 3671–3681. [Google Scholar] [CrossRef]
  13. Won, H.; Dotterbock, D.; Eissfeller, B. Performance comparison of different forms of Kalman filter approach for a vector-based GNSS signal tracking loop. Navigation 2010, 57, 185–199. [Google Scholar] [CrossRef]
  14. Salem, D.; O’Driscoll, C.; Lachapelle, G. Methodology for comparing two carrier phase tracking techniques. GPS Solut. 2012, 16, 197–207. [Google Scholar] [CrossRef]
  15. Feng, B.; Fu, M.; Ma, H.; Xia, Y.; Wang, B. Kalman filter with recursive covariance estimation-sequentially estimating process noise covariance. IEEE Trans. Ind. Electron. 2014, 61, 6253–6263. [Google Scholar] [CrossRef]
  16. Liu, Y.; Fan, X.; Lv, C.; Wu, J.; Li, L.; Ding, D. An innovative information fusion method with adaptive Kalman filtering for integrated INS/GPS navigation of autonomous vehicles. Mech. Syst. Signal Process. 2018, 100, 605–616. [Google Scholar] [CrossRef]
  17. Farina, B.; Tolado, J.; Acosta, L. Augmented Kalman filter design in a localization system using onboard sensors with intrinsic delays. IEEE Sens. J. 2023, 23, 12105–12113. [Google Scholar] [CrossRef]
  18. Curbelo, E.; Martino, L.; Llorente, F.; Delgado-Gomez, D. Adaptive Posterior Distributions for Uncertainty Analysis of Covariance Matrices in Bayesian Inversion Problems for Multioutput Signals. viXra 2023. viXra:2310.0032. [Google Scholar]
  19. Martino, L.; Llorente, F.; Cuberlo, E.; Lopez-Santiago, J.; Miguez, J. Automatic Tempered Posterior Distributions for Bayesian Inversion Problems. Mathematics 2021, 9, 784. [Google Scholar] [CrossRef]
  20. Yao, G.; Wu, W.; He, X. High dynamic carrier phase tracking based on adaptive Kalman filtering. In Proceedings of the Chinese Control and Decision Conference (CCDC), Mianyang, China, 23–25 May 2011; pp. 1245–1249. [Google Scholar]
  21. Chen, S.; Gao, Y. Improvement of carrier phase tracking in high dynamic conditions using an adaptive joint vector tracking architecture. GPS Solut. 2019, 23, 15. [Google Scholar] [CrossRef]
  22. Harsha, S.; Ratnam, V. Implementation of advanced carrier tracking algorithm using adaptive-extended Kalman filter for GNSS receivers. IEEE Geosci. Remote Sens. Lett. 2016, 13, 1280–1284. [Google Scholar] [CrossRef]
  23. Vila, J.; Closas, P.; Fernández, C.; Lopez, A.; Seco-Granados, G. Adaptive GNSS carrier tracking under ionospheric scintillation: Estimation vs. mitigation. IEEE Commun. Lett. 2015, 19, 961–964. [Google Scholar] [CrossRef]
  24. Miao, Z.; Lv, Y.; Xu, D.; Shen, F.; Pang, S. Analysis of a variational Bayesian adaptive cubature Kalman filter tracking loop for high dynamic conditions. GPS Solut. 2017, 21, 111–122. [Google Scholar] [CrossRef]
  25. O’Driscoll, C.; Petovello, G.; Lachapelle, G. Choosing the coherent integration time for Kalman filter-based carri-er-phase tracking of GNSS signals. GPS Solut. 2011, 15, 345–356. [Google Scholar] [CrossRef]
  26. Yin, Z.; Li, G.; Zhang, Y.; Liu, J. Symmetric-Strong-Tracking-Extended-Kalman-Filter-Based Sensorless Control of Induction Motor Drives for Modeling Error Reduction. IEEE Trans. Ind. Informat. 2019, 15, 650–662. [Google Scholar] [CrossRef]
  27. Zhou, D.; Xi, Y.; Zhang, Z. A suboptimal multiple fading extended Kalman filter. Acta Autom. Sin. 1991, 17, 689–695. [Google Scholar]
  28. Gao, W.; Li, J.; Zhou, G.; Li, Q. Adaptive Kalman filtering with recursive noise estimator for integrated SINS/DVL systems. J. Navig. 2015, 68, 142–161. [Google Scholar] [CrossRef]
  29. Jwo, D.; Chung, F.; Weng, T. Adaptive Kalman Filter for Navigation Sensor Fusion; Intech Open: London, UK, 2010; pp. 67–69. [Google Scholar]
  30. Rahimi, M.; Boulet, B. Estimation of the State Variables and Unknown Input of a Two-Speed Electric Vehicle Driveline Using Fading-Memory Kalman Filter. IEEE Trans. Transp. Electrif. 2016, 2, 210–220. [Google Scholar] [CrossRef]
  31. Soken, H.; Hajiyev, C. Pico satellite attitude estimation via robust unscented Kalman filter in the presence of measurement faults. ISA Trans. 2010, 49, 249–256. [Google Scholar] [CrossRef] [PubMed]
  32. Jin, D. Adaptive Kalman filtering based on optimal autoregressive predictive model. GPS Solut. 2017, 21, 307–317. [Google Scholar] [CrossRef]
  33. Ge, Q.; Shao, T.; Wen, C.; Sun, R. Analysis on strong tracking filtering for linear dynamic systems. Math. Probl. Eng. 2015, 648125. [Google Scholar] [CrossRef]
  34. Lo, K.; Lu, Q.; Kwon, W. Comments on ‘optimal solution of the two-stage Kalman estimator’. IEEE Trans. Autom. Control 2002, 47, 198–199. [Google Scholar]
Figure 1. Block diagram of the KF-based carrier tracking loop. (I denotes in-phase, Q denotes quadrature).
Figure 1. Block diagram of the KF-based carrier tracking loop. (I denotes in-phase, Q denotes quadrature).
Electronics 13 01288 g001
Figure 2. The PDF of the chi-square distribution.
Figure 2. The PDF of the chi-square distribution.
Electronics 13 01288 g002
Figure 3. The proposed AKF algorithm’s flow chart.
Figure 3. The proposed AKF algorithm’s flow chart.
Electronics 13 01288 g003
Figure 4. The signal C/N0 and the velocity of the signals for Example 1: (a) the C/N0 variations of the signals; (b) the velocity variations of the signals.
Figure 4. The signal C/N0 and the velocity of the signals for Example 1: (a) the C/N0 variations of the signals; (b) the velocity variations of the signals.
Electronics 13 01288 g004
Figure 5. The C/N0 and Doppler estimated results of the four algorithms for Example 1. (a,c) are the results for PRN 14 satellite signal; (b,d) are the results for PRN 19 satellite signal. (PRN: pseudo-random number).
Figure 5. The C/N0 and Doppler estimated results of the four algorithms for Example 1. (a,c) are the results for PRN 14 satellite signal; (b,d) are the results for PRN 19 satellite signal. (PRN: pseudo-random number).
Electronics 13 01288 g005
Figure 6. The results of the adaptive factor λ k in Example 1.
Figure 6. The results of the adaptive factor λ k in Example 1.
Electronics 13 01288 g006
Figure 7. The signal C/N0, velocity and the Doppler of the signals for Example 2: (a) the C/N0 variation of the signals; (b) the velocity variation of the signals; (c) the Doppler frequency variation for PRN 14 of the signals (the numbers with circles corresponds to the numbers in Table 2).
Figure 7. The signal C/N0, velocity and the Doppler of the signals for Example 2: (a) the C/N0 variation of the signals; (b) the velocity variation of the signals; (c) the Doppler frequency variation for PRN 14 of the signals (the numbers with circles corresponds to the numbers in Table 2).
Electronics 13 01288 g007
Figure 8. The trajectory of the receiver in the simulation for Example 2. (The numbers with circles corresponds to the numbers in Table 2, and the red arrows denotes the direction of the receiver’s movement).
Figure 8. The trajectory of the receiver in the simulation for Example 2. (The numbers with circles corresponds to the numbers in Table 2, and the red arrows denotes the direction of the receiver’s movement).
Electronics 13 01288 g008
Figure 9. The C/N0 and Doppler estimated results of the four algorithms after 60 s for Example 2. (a,c) are the results for the PRN 14 satellite signal; (b,d) are the results for PRN 20 satellite signal.
Figure 9. The C/N0 and Doppler estimated results of the four algorithms after 60 s for Example 2. (a,c) are the results for the PRN 14 satellite signal; (b,d) are the results for PRN 20 satellite signal.
Electronics 13 01288 g009
Figure 10. The results of the adaptive factor λ k in Example 2.
Figure 10. The results of the adaptive factor λ k in Example 2.
Electronics 13 01288 g010
Table 1. The initial parameters settings for Method 1.
Table 1. The initial parameters settings for Method 1.
ParametersDescriptionValues
Q k Process noise covariance matrix Using   Equation   ( 3 )   with   q a = 0 . 3   m 2 / s 6 / Hz
R k Measurement noise covariance matrix Using   Equation   ( 4 )   with   ( C / N 0 ) 0 = 45 dB-Hz
TUpdate period of the tracking loop4 ms
NWindow size for estimated innovation covariances20
χ α 2 ( 1 ) Threshold value to detect system stability6.6349
Table 2. Description of vehicle motion.
Table 2. Description of vehicle motion.
NumberMovement StateTime (s)
1Stationary0–60
2Accelerated (a = 40 m/s2)61–85
3Constant velocity (v = 1000 m/s)86–90
4Decelerated (a = −27.5 m/s2)91–122
51st clockwise turn with 90° (radius r = 763.94 m)123–132
6Constant velocity (v = 120 m/s)133–150
72nd clockwise turn with 90° (radius r = 763.94 m)151–160
8Constant velocity (v = 120 m/s)161–170
93rd clockwise turn with 180° (radius r = 763.94 m)171–190
10Decelerated (a = −8 m/s2)191–205
Table 3. Computational complexity of β k and λ k for one-step iteration.
Table 3. Computational complexity of β k and λ k for one-step iteration.
FunctionVariableNumber of MultiplicationsNumber of Additions
Calculation of β k d k 33
C ^ k 32
β k 10
Calculation of λ k A k 2414
B k 128
λ k 11
Total requirements4428
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Cheng, Y.; Zhang, S.; Wang, X.; Wang, H.; Yang, H. Kalman Filter with Adaptive Covariance Estimation for Carrier Tracking under Weak Signals and Dynamic Conditions. Electronics 2024, 13, 1288. https://doi.org/10.3390/electronics13071288

AMA Style

Cheng Y, Zhang S, Wang X, Wang H, Yang H. Kalman Filter with Adaptive Covariance Estimation for Carrier Tracking under Weak Signals and Dynamic Conditions. Electronics. 2024; 13(7):1288. https://doi.org/10.3390/electronics13071288

Chicago/Turabian Style

Cheng, Yan, Shengkang Zhang, Xueyun Wang, Haifeng Wang, and Huijun Yang. 2024. "Kalman Filter with Adaptive Covariance Estimation for Carrier Tracking under Weak Signals and Dynamic Conditions" Electronics 13, no. 7: 1288. https://doi.org/10.3390/electronics13071288

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