1. Introduction
In recent years, GNSS users’ demand for location information has been continuously increasing, and the original users of measurement receivers have been developed into an increasing number of low-cost smart terminal user groups, including smartphones and low-cost receivers. The integration of multiple systems and frequency bands has increased the number of visible satellites and the amount of observation data, thus enhancing the status of smart terminal positioning services. This integration has also improved the data quality, positioning accuracy, and reliability of smart terminals [
1]. However, due to the limitations of low-cost chips, the overall data quality of low-cost smart terminals is poor and unstable. Navigation and positioning are often performed in challenging environments, such as urban canyons, where the performance of GNSS positioning is further weakened [
2,
3]. The increased redundancy of observation data in multiple systems and frequency bands also indicates higher possibilities for gross errors in data [
4]. Although observation value quality control can be performed, an actual measurement situation is complex, and it is challenging to control the threshold setting. In high-precision positioning, the carrier phase serves as the main observation quantity, and demands high data quality. However, the quality control method has limitations in its application. If the observation noise is too high, the effectiveness of data verification can be significantly reduced. A robust Kalman filter model offers an improved solution to this problem. It combines robust estimation with the Kalman filter to identify outliers, and reduces their impact on the solution result by increasing the variance and covariance of the outlier observation equation.
In May 2016, Google opened the GNSS raw data acquisition interface for the Android system, enabling domestic scholars to easily access satellite signal measurement values, such as pseudo-range and carrier phase values. To realize accurate location tracking in low-cost smart terminals, various data processing methods and positioning algorithms have been developed [
5,
6]. Banville [
7] studied the GPS single-frequency pseudo-range single-point positioning of low-cost smart terminals. The results showed that low-cost smart terminals could provide positioning data with meter-level accuracy. Gill [
8] analyzed the single-frequency precision point positioning (PPP) of low-cost smart terminals, and on the basis of the original single point positioning, the performance analysis of the low cost intelligent terminal antenna has added and proved that low-cost smart terminals could achieve decimeter-level positioning. Chen [
9] used a low-cost smart terminal to improve the precision of a single-point positioning mode; the plane positioning accuracy was 0.81 m, and the elevation positioning accuracy was 1.65 m. This research further proves that low-cost terminals can also achieve high-precision positioning. In addition to pseudo-range single-point positioning algorithms, relative positioning algorithms have also been studied; among these algorithms, real-time kinematics (RTK) is the main method [
10]. With the increase in the number of systems and frequency bands in low-cost smart terminals, many studies have conducted more in-depth research on their models. Robert [
11] used the variance component estimation method to reconstruct a pseudo-range and carrier random model, studied its time correlation, and connected the low-cost smart terminal u-blox M8T to an external professional receiver antenna to achieve the positioning accuracy of a professional receiver. Li [
12] considered single-frequency real-time dynamic positioning, added the quartile method to establish a robust model, dynamically determined the threshold, and eliminated the gross error of the observation value. Although abnormal data can be eliminated through data preprocessing and other methods, the quality of GNSS signals received by low-cost smart terminals varies greatly, and it is challenging to control the threshold setting, thus making it impossible to completely eliminate outliers and positioning errors. As a result, the quality control effect in the later period is significantly reduced [
13]. Robust adaptive Kalman filtering provides an improved solution, and its essence is to combine robust estimation with Kalman filtering to identify outliers. It increases the variance and covariance of the outlier observation equation to reduce the impact of outliers on the solution [
14]. From the aforementioned research, it can be concluded that the quality of observation values of low-cost smart terminals is poor, and abnormal data processing needs to be performed in terms of data preprocessing and quality control to improve positioning performance. In view of that, this research studied robust estimation in smart terminal data processing [
15].
In recent years, the Kalman filter has been widely used due to its particularity. Most of the robust Kalman filters have been developed based on the M-estimation approach. Following the Bayesian theory, according to different prior distributions, M-estimation can be divided into three common types: M-LS filtering, LS-M filtering, and MM filtering [
16]. Since an observation model is always rank-deficient in the actual settlement process, a robust Kalman filtering algorithm for the rank-deficient model was proposed. In addition, using equivalent weight functions and equivalent quasi-covariance matrix algorithms, the impact of abnormal observations on results can be reduced [
17]. Adaptive filtering has also been widely used in recent years, since it can effectively weaken and eliminate the influence of colored noise. The more common adaptive filtering methods include Sage–Husa adaptive filtering and evanescent filtering [
18,
19]. Sage–Husa adaptive filtering defines a reasonable window, and uses a residual sequence within the window to estimate the observation and system noises in real-time. Evanescent filtering converts the variance–covariance of the previous epoch state vector into the filtering process, and then performs expansion to reduce the impact on the accuracy of parameter estimates. A number of studies have comprehensively considered the systematic errors of observations and kinematic models in the Kalman filtering process, and suppressed the interference of abnormal observation values by adaptively reducing the weight of the equidistant weighted matrix constructed from the observation residuals [
20].
Consequently, recent research on robust Kalman filtering has mostly focused on professional receivers, and the theory is relatively mature. However, fewer scholars have used robust adaptive theory to study the positioning problem of low-cost smart terminals. To address this shortcoming, this paper introduces a robust Kalman filter estimation and adaptive algorithm based on the RTK positioning model of a non-difference error correction value. To identify the pre-test abnormal innovation of low-cost smart terminals, the IGGIII function is used for regulation. After undergoing robust processing, the part of the post-test standardized residual that exceeds the threshold is robustly processed. Further, by dynamically adjusting and updating the pre-test innovation of the equivalent weight matrix and adaptive factors, the impact of the system model error on system state estimation is eliminated, thus improving the accuracy of state parameter estimation. In addition, to analyze the improvement effect of the proposed method on low-cost smart terminals, this study uses multi-system multi-frequency data from Xiaomi 8 (Xiaomi, Beijing, China), Huawei P40 (Huawei, Shenzhen, China), and Huawei mate40 (Huawei, Shenzhen, China) smartphones and low-cost receivers. The improvement in the low-cost smart terminal RTK positioning performance achieved by robust adaptive Kalman filtering was analyzed in different environments, positioning states, and system combinations [
21]. The results indicate that certain types of smart terminals can achieve high-precision positioning. Finally, feasibility experiments of combined positioning at different frequencies using the same system were conducted for low-cost smart terminals. Therefore, for low-cost intelligent terminal positioning, the RTK method improves the positioning accuracy through differential processing, which can eliminate most of the influence of common error sources of the mobile phone and the receiver. The Kalman filtering algorithm is a filtering method based on state estimation, which is used to estimate state variables of the system. Therefore, the combination of the two methods can provide more accurate location information in mobile phone positioning.
The rest of this paper is organized as follows.
Section 2 summarizes the models, chip types, and other characteristics of several low-cost smart terminals that support GNSS raw data, and introduces the multi-system RTK positioning model algorithm and Kalman filter estimation method.
Section 3 describes the proposed RTK positioning model based on the Kalman filter’s robust adaptive algorithm, including the construction of adaptive factors.
Section 4 verifies the effectiveness of the robust adaptive Kalman filter and the adaptive factor using the static data obtained from several low-cost smart terminals and dynamic data collected under two conditions. Finally,
Section 5 concludes this study.
3. Robust Filtering Algorithm
3.1. Robust Kalman Filter Estimation
Pre-test robust estimation refers to performing certain processing on raw data before parameter estimation, in order to reduce the impact of outliers on the estimation result. The innovation vector in Kalman filtering refers to the error sequence between the observed and predicted values. The innovation is the pre-test estimated detection volume. The innovation vector can be expressed as follows:
where
is the state prediction vector;
is the innovation residual vector, which can reflect the error size of an observation; and
represents the variance–covariance matrix of the innovation vector. In this research, the state noise was assumed to be Gaussian white noise, so the influence of state noise on the algorithm was not considered [
26].
The post-test robust estimation refers to modifying the estimation result after parameter estimation to reduce the impact of outliers on the estimation result. The post-test residuals and variance–covariance of the Kalman filter can be respectively expressed by the following:
The post-test standardized residual of the th residual is to change the diagonal elements in the pre-test variance–covariance matrix to the diagonal elements in . However, it should be noted that the standardization method is applicable only if the observations are not correlated with each other, and the variance is distributed diagonally. If the variance matrix is not a diagonal matrix, the covariance elements associated with it need to be adjusted after increasing and inflating the variance of the abnormal observations. It is necessary to ensure that the variance and covariance after inflation can still maintain the original correlation coefficient.
When performing residual vector testing, the innovation residual vectors need to be standardized. The standardized residuals should conform to the standard normal distribution, and the standardized formula of the
th residual is defined as follows:
where
is the square root value of the
th element on the
diagonal.
The Huber function or the IGGIII function has been commonly used to determine the excess of the standardized residual and adjust the variance–covariance matrix. In practical applications, the IGGIII function has been more practical than the Huber function. Therefore, this study uses the IGGIII function to control the variance of the observation equation, which can be expressed as follows:
where
k1 and
k0 are threshold constants.
Since the residuals in pre-test robust estimation are typically large, based on empirical values, this study set them as follows: k1 = 7 and k0 = 2.5. Similarly, in the post-test robust estimation, based on empirical values, they were set as follows: k1 = 3, k0 = 1.5.
The equation formed after the inter-star difference is substituted into the observation equation in the RTK positioning contains the reference star observation value. When the variance matrix is not a diagonal matrix, the correlation between elements is inherent in the pre-test. After the variance of abnormal observations is increased and inflated, it is necessary to consider the adjustment of the covariance elements so that the original correlation coefficients of the inflated variance and covariance remain unchanged. Assume that the variances of observation vectors
and
are
and
, respectively, and the covariance is
. If gross errors occur in both observation vectors, their variance expansion factors are denoted by
and
, respectively. Then, the variance after inflation is expressed by the following:
Further, to ensure that the correlation coefficient
is unchanged, the following holds:
where
and
are the variances after inflation of
and
, respectively, and
is the covariance after inflation.
After the Kalman filter provides the estimation result, unlike the pre-test residuals, the post-test residuals show a certain correlation with each other, causing the observation value errors that are not detected by pre-test detection to interfere with the normal value; also, the degree of interference is related to relevance. The post-test robustness may reduce the weight of normal observations and affect positioning performance. To this end, this research adopted the following processing strategy. All gross errors in the pre-test residuals are subjected to robust processing, and normal estimation is performed. During the robust post-test processing, only the maximum value of the standardized residual that exceeds the threshold is subjected to robust processing. If there is a gross error, it is initialized, and the measurement is updated until the standardized residuals are smaller than the threshold.
3.2. Robust Adaptive Kalman Filtering
During the Kalman filtering process, there can be large errors in a dynamic model. In this case, the system noise is too small and cannot accurately describe the prediction parameter errors, which can affect the subsequent measurement result of the solution. Even if the robust observation value algorithm is used, it may not be possible to ensure the stability of positioning results. Therefore, to achieve reasonable system noise settings, this study uses an adaptive filtering algorithm to adjust the weight matrix of the state advance prediction vector and observation vector dynamically by constructing an adaptive factor. In addition, the difference between the dynamic model forecast information and the dynamic carrier motion trajectory is eliminated to improve positioning reliability. Moreover, this study performs multi-factor adaptive filtering to regulate the variance of the predicted state quantity. Finally, this study uses multi-factor adaptive filtering to regulate the variance of the predicted state quantity.
The adaptive factor is defined based on the post-test innovation residual. The innovation residual and the components of the predicted state vector discrepancy are expressed as follows:
where the innovation vector
is calculated from the predicted state
at a time
;
is the state estimate at a time
;
is the state that has been corrected by
;
is the state that has not been corrected by
; therefore, the innovation vector
can better reflect the disturbance of the dynamic system; finally,
represents a certain component.
Then, the calculation formula of adaptive factor
can be expressed as follows [
27]:
where
is the standardized residual, and
and
are constants. In this study,
= 1.0 and
= 2.5; since the prior covariance matrix is a non-diagonal matrix after recursion, the principle of a two-factor equivalent covariance was adopted to ensure that its symmetry and correlation do not change;
is the standard deviation of a prediction vector
. The adaptive covariance matrix of
and the off-diagonal elements of
are related as follows:
where the variance of the diagonal element is obtained by the following:
Therefore, the overall estimation obtained by the robust adaptive Kalman filter can be expressed by the following:
where
is the process noise,
is the equivalent variance, and
is the equivalent variance–covariance matrix.
The specific process is to adjust the filter gain matrix by changing the respective variance–covariance matrix. After the variance of abnormal observations is increased and inflated, the associated covariance elements are adjusted so that the original correlation coefficients of the inflated variance and covariance remain unchanged. Further, each standardized residual is adjusted using the IGGIII function to adjust the variance of the observation, in order to achieve robust processing of the post-test residual data.
The flowchart of the robust adaptive filtering process is presented in
Figure 1, where
is the test information obtained from the innovation vector
and the covariance matrix. The discrepancy value
of the predicted state vector is obtained through the expansion of the state prediction covariance matrix;
and
represent the system threshold and measurement threshold, respectively, which are determined by performing multiple static tests at different points using the motion state equations.
The residual sequence in the observation data is judged based on the observation threshold, and the weight of the observation information is reduced for the part exceeding the threshold. In addition, after the residual sequence in the carrier state data is judged based on the state threshold, adaptive factor correction is performed on the part exceeding the threshold. The process described above constitutes a correction mechanism for the robust adaptive Kalman filter model. In this model, if the observation data residual and the state data residual do not exceed the corresponding thresholds, standard Kalman filtering is performed. This strategy helps to improve the robustness and adaptability of the filtering system so that it can effectively deal with potential abnormal observations and state information.