An Improved Innovation Adaptive Kalman Filter for Integrated INS/GPS Navigation

: The performance of transportation systems has been greatly improved by the rapid development of connected and autonomous vehicles, of which high precision and reliable positioning is a key technology. An improved innovation adaptive Kalman ﬁlter (IAKF) is proposed to solve the vulnerability of Kalman ﬁltering (KF) in challenging urban environments during integrated navigation. First, the algorithm uses the innovation to construct a chi-squared test to determine the abnormal measurement noise; on this basis, the update method of the measurement noise variance matrix is improved, and the measurement noise variance matrix is adaptively updated by the difference between the current innovation and the mean value of the innovation when the measurement data is abnormal so as to reﬂect the impact degree of the current abnormal measurement data, thus suppressing the ﬁltering divergence and improving the positioning accuracy. The experimental results show that the proposed algorithm can well suppress the ﬁltering divergence when the measurement data are disturbed. The results demonstrate that the algorithm in this paper has improved adaptiveness and stability and provides a novel idea for the development of an intelligent trafﬁc positioning system.


Introduction
In recent years, global research on the application of intelligent transportation systems has developed rapidly [1,2]. Connected and autonomous vehicle (CAV) technology has quickly become a key component of intelligent transportation systems and an important pillar of smart city development [3]. CAV systems can not only provide information on the overall current road status, but also help vehicles choose the optimal path, which improves the operational efficiency and management of intelligent transportation. Considering the inherent defects such as high vehicle node movement speed and poor network stability in the Internet of Vehicles environment, higher requirements are put forward for the accuracy, stability and wide accessibility of vehicle positioning [4].
The positioning function of the Internet of Vehicles is mainly realized by the Global Navigation Satellite System (GNSS), Inertial System, and cameras. GNSS has the advantage of all-weather and high-precision positioning but has the disadvantage that the signal is easily blocked and interfered with [5]. The Inertial Navigation System (INS) does not rely on external information for autonomous navigation, which has the advantages of high short-term accuracy and strong reliability but has the disadvantage of the rapid accumulation of errors over time [6]. At present, multi-sensor information fusion technology is developing rapidly [7,8], and the positioning of vehicles in practical applications usually adopts integrated INS/GNSS navigation [9,10] and information fusion through a Kalman attitude parameters quickly. A method to establish the maximum a posteriori estimation and random weighted estimation of noise statistics was proposed [29], which can estimate and adjust the system noise statistics online, thus improving the filtering robustness. An adaptive filtering was proposed by [30] that can obtain the system noise estimate through the predefined fuzzy logic function and the chi-squared test value. However, it ignores the interference of the environment on the GPS signal.
In practical applications, a slight improvement in accuracy is secondary, and the number of adaptive parameters should be minimized to ensure the stability and reliability of filtering. The measurement noise is mainly caused by external factors, which are easy to change and have a great impact on the filtering accuracy. Constructing the adaptive factor by the residual vector is a typical adaptive filtering method [31], and the adaptive factor decreases as the residual increases, thus reducing the weight of the measurement data and achieving adaptive updating of the measurement noise variance matrix. However, adaptive factors are difficult to select for practical application. The conventional innovation adaptive filtering method is based on innovation to estimate the measurement noise and system noise so as to indirectly adjust the Kalman filter gain matrix, suppress the filter divergence, and improve the filter accuracy [32]. However, the method of using the average change value of the innovation covariance in the measurement update formula will reduce the sensitivity of the filter to the abnormal measurement value at the current moment and cannot sufficiently reduce the influence of the abnormal measurement value on the filtering.
Therefore, an improved innovation adaptive filtering algorithm (IAKF) was proposed in this paper for the shortcomings of attenuation filtering and conventional innovation adaptive filtering. Considering the Kalman filter update formulation, the gain matrix is mainly determined by the measurement noise variance matrix, the one-step prediction error variance matrix, and the system noise variance matrix. At the beginning of the filtering process, the filter's estimation of the state is mainly dependent on the measurements of GNSS, so the measurement data anomalies have a great impact on the filtering estimation. When the filtering reaches stability, the filtering estimates tend to stabilize, and the innovation better describes the relationship between the filtered estimates and the actual measured values. Thus, the proposed algorithm judges the measurement data abnormality by means of the chi-squared test. When the measurement data are abnormal, the measurement noise variance matrix is adaptively updated by means of the difference between the current innovation and the average change value of the innovation covariance over time.
Different from the traditional AKF algorithm, considering that the stability of the filter and the inherent characteristics of the system noise is not easy to change, the algorithm in this paper focuses on the adaptive update research of the measurement noise. In addition, unlike the traditional method of adaptively updating the measurement noise matrix by innovation, the proposed algorithm reflects the influence of current measurement outliers on filtering by means of the difference between the current innovation and the mean value of innovation. The change value of the innovation covariance is added to the initial measurement noise matrix to scale up the measurement noise matrix to reduce the effect of outliers on filter estimation.
The paper is organized as follows. Section 2 contains the introduction and analysis of the update method of the standard KF and the influence of its related parameters on the filter update. In Section 3, a method of constructing a chi-squared test using the innovation series is proposed, an improved method of updating the measurement noise is given, and then the mathematical model of INS/GNSS integrated navigation is established. In Section 4, experimental results and analysis are given. Finally, the corresponding discussion and conclusions are provided in Section 5.

Kalman Filter and Its Parameter Analysis
The discrete Kalman filter system equation and measurement equation are as follows: where X k is the state vector, Φ k,k−1 is the state transition matrix, Γ k,k−1 is the matrix of noise driving, W k−1 is the noise vector of the system, Z k is the measurement vector, H k denotes the measurement matrix, and V k is the measurement noise. W k−1 and V k are uncorrelated and meet the following properties: where Q k is the system noise matrix, R k is the measurement noise matrix, and δ kj is the Kronecker-δ function.
The update formula of the Kalman filter is shown below. The one-step state predicting equation is as follows: The error variance matrix of the one-step predicting method is as follows: The Kalman gain matrix is as follows: The state estimation equation is as follows: The estimation error variance matrix is as follows: From Equations (7) and (8), it can be concluded that the size of the gain matrix K k is mainly affected by the system noise matrix Q k−1 and the measurement noise matrix R k . Therefore, in the Kalman filter update process, if the setting of the system noise matrix Q k−1 is smaller than the actual noise distribution or the setting of the observed noise matrix R k is larger than the actual noise distribution, the gain matrix K k will be too small, resulting in a biased estimation due to the small uncertainty range of the true value of the state estimation. Conversely, too large a value of the gain matrix K k may lead to filter divergence.
As can be seen from Equation (9), if there are abnormal values in the measurement data, the system still uses the initialized measurement noise variance matrix without timely adjustment, and the abnormal measurement values will have an impact on the filtering results, resulting in the filtering convergence effect not being obvious or even causing filtering divergence. Therefore, if the observed noise matrix R k can be adaptively adjusted in the filtering process, the adaptability of the KF algorithm and the ability to suppress outliers will be greatly improved.

Constructing a Chi-Squared Test Using the Innovation Series
The chi-squared test is a hypothesis testing method that counts the degree of deviation between the theoretical value and the actual value of the sample. The magnitude of the chi-squared test statistic is determined by the degree of deviation between the theoretically estimated value and the actual measurement value. The greater the degree of deviation between the two, the greater the chi-squared test statistic. When the chi-squared test value is zero, the theoretically estimated value is equal to the actual observed value.
The innovation reflects the relationship between the actual current measurement and the estimated values. In the case of optimal filtering, the measure is not disturbed, and the innovation sequence obeys the Gaussian white noise property with zero mean. When the environment interferes with the measurement noise abnormally, the zero-mean characteristic of the whole innovation will also be destroyed. Therefore, the chi-squared test established by the innovation sequence can be used to judge whether there are outliers.
First, the statistical tests are constructed using innovation as follows: where r k denotes the innovation, and it is calculated as follows: Outliers in the statistic are detected by the chi-squared test, which has the following test issues: where m is the degree of freedom, that is, the dimension of the measurement information, and the decentralization parameter is zero. That is, T k follows a chi-squared distribution with m degrees of freedom. By setting the appropriate quantile a, the test rejection domain is That is, the value in the test rejection area indicates that the actual value of the statistic deviates too much from the theoretical value, and the assumption does not hold. This means that it is considered that the zero-mean characteristic of innovation is lost, the measurement is abnormally interfered with, and abnormal values appear.

Improved Innovation-Based Measurement Noise Update Method
The expression for the innovation covariance in the filtered optimal case is The estimated value of the innovation covariance is generally obtained by the windowing method [33].
The traditional innovation adaptive filtering algorithm improves the filtering accuracy by updating the system noise variance matrix and the measurement noise variance matrix online [34].
While the system noise belongs to the inherent characteristics of the system, which are generally not easy to change, usually, as long as the settings are roughly accurate, the filtering accuracy will not have too great an impact. In practical applications, the stability of the filtering should be focused on. The measurement noise is mainly caused by external environmental factors, which have a large impact on the filtering accuracy; only Sustainability 2022, 14, 11230 6 of 17 the measurement noise variance matrix is adaptively updated in this paper. The improved measurement noise variance matrix update proposed in this paper is as follows: where k is the current epoch. When the chi-squared test, established in Section 3.1, detects abnormal measurement data, the innovation covariance is used for a posteriori estimation, and the change value of the innovation covariance is added on the basis of the initial measurement noise. The R k is adjusted upwardly, and the gain matrix K k is decreased to reduce the influence of measurement data with outliers on the filter estimation. The update process is as follows. The Kalman filter time update equation is When the chi-squared test detects a measurement abnormality, the measurement noise matrix is updated by Formula (19) and (20), and the Kalman filter measurement update formula takes the following form.
This method of adaptively updating the measurement noise matrix R k by making the difference between the current innovation and the average change value of the innovation covariance can reflect the influence of the current abnormal measurement data and adjust the gain matrix K k , thereby suppressing the filtering divergence and improving the filtering accuracy. The flowchart of the improved innovation adaptive Kalman filter algorithm is shown in Figure 1.

Mathematical Model of INS/GNSS Integrated Navigation
In this paper, the misalignment angle of the platform, the velocity error, the position error, and the zero bias of the gyro and accelerometer are selected to construct a 15-dimensional state vector. The state vector X is listed below: The state equation of the continuous system is where X(t) is the state vector, F(t) is the transfer matrix of step, G(t) is the matrix of noise driving, and W(t) is the noise vector of the system. k the difference between the current innovation and the average change value of the innovation covariance can reflect the influence of the current abnormal measurement data and adjust the gain matrix k K , thereby suppressing the filtering divergence and improving the filtering accuracy. The flowchart of the improved innovation adaptive Kalman filter algorithm is shown in Figure 1. Figure 1. Process of the improved innovation adaptive Kalman filter algorithm.

Mathematical Model of INS/GNSS Integrated Navigation
In this paper, the misalignment angle of the platform, the velocity error, the position error, and the zero bias of the gyro and accelerometer are selected to construct a 15-dimensional state vector. The state vector X is listed below: The state equation of the continuous system is where () Xt is the state vector, () Ft is the transfer matrix of step, () Gt is the matrix of noise driving, and () Wt is the noise vector of the system. Equation (27) after discretization processing is

Equation (27) after discretization processing is
where Φ(k, k − 1) is the state transfer matrix, Γ(k − 1) is the noise matrix, and W(k − 1) is the system noise sequence. The measurement equation is constructed by taking the difference between the threedimensional position output by INS and GNSS as the measurement value.
The position information output by the INS consists of the actual position and the solution error of the INS, which can be written as the following formula: where L, λ, and h represent the actual latitude, longitude and altitude of the current vehicle, respectively. δL I NS , δλ I NS , δh I NS represent the latitude, longitude and altitude errors of the INS solution output, respectively.
GNSS position information consists of two parts, the actual position and the position error of GNSS, which can be written as the following formula: where δL GNSS , δλ GNSS , and δh GNSS represent the latitude, longitude and altitude errors of GNSS, respectively.
H k is defined as follows: V k is defined as follows: where η L , η λ and η h represent the noise errors when the GNSS receiver acquires the current latitude, longitude and altitude, which are all Gaussian white noise. Finally, the INS/GNSS loose integrated navigation model constructed in this paper is shown in Figure 2.

Simulation Experiment
To verify the effectiveness of the algorithm proposed in the article, a simulation ex periment was first carried out, in which the performance of the IMU (inertial measure ment unit) device is shown in Table 1. The simulation experiment first simulates the track and velocity of the vehicle, as shown in Figures 3 and 4, respectively.

Simulation Experiment
To verify the effectiveness of the algorithm proposed in the article, a simulation experiment was first carried out, in which the performance of the IMU (inertial measurement unit) device is shown in Table 1. The simulation experiment first simulates the track and velocity of the vehicle, as shown in Figures 3 and 4, respectively. From the track and velocity curve of the vehicle, it can be seen that the state of the vehicle includes acceleration, deceleration, turning and other conventional states.
The GPS positioning error is shown in Figure 5. The GPS signal is disturbed by the environment during the 400-450 s time period, and the positioning error becomes larger; that is, the measurement data is abnormal. The GPS positioning error statistics are shown in Table 2.    From the track and velocity curve of the vehicle, it can be seen that the state of the vehicle includes acceleration, deceleration, turning and other conventional states.
The GPS positioning error is shown in Figure 5. The GPS signal is disturbed by the environment during the 400-450 s time period, and the positioning error becomes larger; that is, the measurement data is abnormal. The GPS positioning error statistics are shown in Table 2.   From the track and velocity curve of the vehicle, it can be seen that the state of the vehicle includes acceleration, deceleration, turning and other conventional states.
The GPS positioning error is shown in Figure 5. The GPS signal is disturbed by the environment during the 400-450 s time period, and the positioning error becomes larger; that is, the measurement data is abnormal. The GPS positioning error statistics are shown in Table 2.    It can be seen from Figure 5 and Table 2 that the GPS positioning error is relatively stable, but in the 400-450 s time period, the GPS signal is disturbed by the environment, resulting in abnormal measurements. The positioning error increases sharply, the fluctuation is large, and the maximum value of horizontal error reaches 24.382 m. Therefore, if the measurement noise matrix is not updated, the abnormal measurement will have a significant impact on the filtering, which will reduce the filtering accuracy and even cause the filtering to diverge.
In order to verify the effectiveness of the proposed algorithm in this paper, it is compared with the KF and traditional AKF algorithms, and the east and north velocity error curves, east and north position error curves and horizontal positioning error curves of INS/GNSS integrated navigation are output, as shown in Figures 6-8. if the measurement noise matrix is not updated, the abnormal measurement will have a significant impact on the filtering, which will reduce the filtering accuracy and even cause the filtering to diverge. In order to verify the effectiveness of the proposed algorithm in this paper, it is compared with the KF and traditional AKF algorithms, and the east and north velocity error curves, east and north position error curves and horizontal positioning error curves of INS/GNSS integrated navigation are output, as shown in Figures 6-8.   if the measurement noise matrix is not updated, the abnormal measurement will have a significant impact on the filtering, which will reduce the filtering accuracy and even cause the filtering to diverge. In order to verify the effectiveness of the proposed algorithm in this paper, it is compared with the KF and traditional AKF algorithms, and the east and north velocity error curves, east and north position error curves and horizontal positioning error curves of INS/GNSS integrated navigation are output, as shown in Figures 6-8.   It can be seen from the error curves in Figures 6-8 that in the non-interference period, the errors of the KF, AKF and IAKF algorithms are almost identical, which is because the statistical characteristics of the noise are basically realistic, and the measurement data do not contain outliers according to the 95% chi-squared test. However, in the interference period, the environment interferes with the measurement information, and the zero-mean property of the innovation is invalid, so the KF algorithm has a large estimation error. The AKF algorithm suppresses the filter divergence by adaptively correcting the system noise matrix and the measurement noise matrix. However, the proposed algorithm reduces the influence of the outliers on the filtering estimation by increasing the measurement noise matrix when there are outliers in the measurement data. From Figures 6-8, it can be seen that the IAKF is more effective than the AKF algorithm in suppressing filter divergence, although, in Figure 7, the AKF has a lower maximum error in the eastward position. In addition, the statistical analysis of the positioning errors of GPS, KF, AKF and this paper's algorithm in the simulation experiment is carried out in this paper, as shown in Table 3. As can be seen from Table 3, the mean and maximum values of the positioning errors of the KF, AKF and the proposed algorithm are significantly reduced compared to those of GPS, which indicates that the integrated INS/GNSS navigation is more accurate and stable compared to GNSS positioning alone. At the same time, due to the adaptive update of the measurement noise variance matrix, the algorithm in this paper has a more obvious suppression effect on the measurement anomaly compared with the KF algorithm, in which the mean value of error is reduced by 8.97%, and the maximum value of error is reduced by 39.62%. In addition, compared with the traditional AKF, the proposed algorithm performs better in terms of both the mean value of error and the maximum value of error, which verifies the stability and adaptiveness of the IAKF algorithm. It can be seen from the error curves in Figures 6-8 that in the non-interference period, the errors of the KF, AKF and IAKF algorithms are almost identical, which is because the statistical characteristics of the noise are basically realistic, and the measurement data do not contain outliers according to the 95% chi-squared test. However, in the interference period, the environment interferes with the measurement information, and the zero-mean property of the innovation is invalid, so the KF algorithm has a large estimation error. The AKF algorithm suppresses the filter divergence by adaptively correcting the system noise matrix and the measurement noise matrix. However, the proposed algorithm reduces the influence of the outliers on the filtering estimation by increasing the measurement noise matrix when there are outliers in the measurement data. From Figures 6-8, it can be seen that the IAKF is more effective than the AKF algorithm in suppressing filter divergence, although, in Figure 7, the AKF has a lower maximum error in the eastward position. In addition, the statistical analysis of the positioning errors of GPS, KF, AKF and this paper's algorithm in the simulation experiment is carried out in this paper, as shown in Table 3. As can be seen from Table 3, the mean and maximum values of the positioning errors of the KF, AKF and the proposed algorithm are significantly reduced compared to those of GPS, which indicates that the integrated INS/GNSS navigation is more accurate and stable compared to GNSS positioning alone. At the same time, due to the adaptive update of the measurement noise variance matrix, the algorithm in this paper has a more obvious suppression effect on the measurement anomaly compared with the KF algorithm, in which the mean value of error is reduced by 8.97%, and the maximum value of error is reduced by 39.62%. In addition, compared with the traditional AKF, the proposed algorithm performs better in terms of both the mean value of error and the maximum value of error, which verifies the stability and adaptiveness of the IAKF algorithm.

Real Vehicle Experiment
In order to verify the validity of the algorithm of the article, a set of real vehicle data was used for the experiment, and a 500 s segment of the data was selected. The IMU (FOG-KVH1775) was used, and the sampling frequency was 100 Hz; GPS adopted differential positioning, and the output frequency was 1 Hz. The data were output from the fiber-optic level integrated navigation system as the real value, with a theoretical error of 0.02 m or less, and the data were processed using MATLAB. The performance parameters of the IMU are shown in Table 4, and the track and velocity of the vehicle are shown in Figures 9 and 10.

Real Vehicle Experiment
In order to verify the validity of the algorithm of the article, a set of real vehicle data was used for the experiment, and a 500 s segment of the data was selected. The IMU (FOG-KVH1775) was used, and the sampling frequency was 100 Hz; GPS adopted dif ferential positioning, and the output frequency was 1 Hz. The data were output from the fiber-optic level integrated navigation system as the real value, with a theoretical error o 0.02 m or less, and the data were processed using MATLAB. The performance parameters of the IMU are shown in Table 4, and the track and velocity of the vehicle are shown in Figures 9 and 10.

Real Vehicle Experiment
In order to verify the validity of the algorithm of the article, a set of real vehicle data was used for the experiment, and a 500 s segment of the data was selected. The IMU (FOG-KVH1775) was used, and the sampling frequency was 100 Hz; GPS adopted differential positioning, and the output frequency was 1 Hz. The data were output from the fiber-optic level integrated navigation system as the real value, with a theoretical error of 0.02 m or less, and the data were processed using MATLAB. The performance parameters of the IMU are shown in Table 4, and the track and velocity of the vehicle are shown in Figures 9 and 10.    The GPS positioning error curve is shown in Figure 11. To verify the effectiveness of the algorithm in this paper, interference errors, including Gaussian noise and irregular random errors, are added in the 400-450 s time period.
Sustainability 2022, 14, x FOR PEER REVIEW The GPS positioning error curve is shown in Figure 11. To verify the effect of the algorithm in this paper, interference errors, including Gaussian noise and lar random errors, are added in the 400-450 s time period.   The GPS positioning error curve is shown in Figure 11. To verify the effectiven of the algorithm in this paper, interference errors, including Gaussian noise and irre lar random errors, are added in the 400-450 s time period.    From Figures 12 and 13, it can be seen that IAKF performs better in terms of veloc ty error and position error, both in the east and north, and both are better than KF. A can be seen from Figure 14, the IAKF algorithm has a better suppression effect on hor zontal position error and stronger filtering stability compared to the traditional AK which is due to the detection of anomalous measurements using the cardinality test the innovation construction, which amplifies the gain matrix by updating measureme noise matrix, thus reducing the influence of the anomalous measurements on the filte ing estimation.
Furthermore, the integrated INS/GNSS navigation tracks of different positionin methods are output in order to more intuitively demonstrate the positioning perfo  From Figures 12 and 13, it can be seen that IAKF performs better in terms of velocity error and position error, both in the east and north, and both are better than KF. As can be seen from Figure 14, the IAKF algorithm has a better suppression effect on horizontal position error and stronger filtering stability compared to the traditional AKF, which is due to the detection of anomalous measurements using the cardinality test of the innovation construction, which amplifies the gain matrix by updating measurement noise matrix, thus reducing the influence of the anomalous measurements on the filtering estimation.
Furthermore, the integrated INS/GNSS navigation tracks of different positioning methods are output in order to more intuitively demonstrate the positioning performance in this paper, as shown in Figure 15. From Figures 12 and 13, it can be seen that IAKF performs better in terms of velocity error and position error, both in the east and north, and both are better than KF. As can be seen from Figure 14, the IAKF algorithm has a better suppression effect on horizontal position error and stronger filtering stability compared to the traditional AKF, which is due to the detection of anomalous measurements using the cardinality test of the innovation construction, which amplifies the gain matrix by updating measurement noise matrix, thus reducing the influence of the anomalous measurements on the filtering estimation.
Furthermore, the integrated INS/GNSS navigation tracks of different positioning methods are output in order to more intuitively demonstrate the positioning performance in this paper, as shown in Figure 15.  Figure 15 shows the localization performance of KF, AKF and IAKF. It can be clearly seen from the figure that the KF positioning track has obvious deviation in the road section where the GPS signal is interfered with. Although the performance of the AKF algorithm has improved, the track is still not ideal. Compared with the AKF algorithm, the track of the IAKF algorithm is closer to the real vehicle track, and the curve effect is smoother. Thus, the experimental results show that the algorithm in this paper can effectively suppress the filter divergence and improve the positioning accuracy. The error statistics of the article for the true vehicle experiment are shown in Table 5. As shown in Table 5, IAKF reduces the mean value of error by 7.06% relative to KF, and the maximum value of error is reduced by 49.17%. In addition, compared with AKF, the algorithm in this paper performs better in terms of position error maximum. This shows that the proposed algorithm can not only effectively suppress the error divergence but also performs better compared with the traditional AKF.

Conclusions and Discussion
An improved innovation adaptive filtering algorithm is proposed for the vulnerability of integrated INS/GNSS navigation systems in challenging environments. First, the article analyzes the update formula of the Kalman filter, and the gain matrix is mainly determined by the measurement noise variance matrix, the one-step prediction error matrix and the system noise variance matrix. The measurement noise is easily affected by the environment and has a large impact on the filtering accuracy. In addition, the article reduces the number of adaptive parameters to ensure the stability and reliability of the filtering in practical applications.
Second, when the filtering is stable, the filtering estimation accuracy is improved, Figure 15. Track comparison of different algorithms. Figure 15 shows the localization performance of KF, AKF and IAKF. It can be clearly seen from the figure that the KF positioning track has obvious deviation in the road section where the GPS signal is interfered with. Although the performance of the AKF algorithm has improved, the track is still not ideal. Compared with the AKF algorithm, the track of the IAKF algorithm is closer to the real vehicle track, and the curve effect is smoother. Thus, the experimental results show that the algorithm in this paper can effectively suppress the filter divergence and improve the positioning accuracy. The error statistics of the article for the true vehicle experiment are shown in Table 5. As shown in Table 5, IAKF reduces the mean value of error by 7.06% relative to KF, and the maximum value of error is reduced by 49.17%. In addition, compared with AKF, the algorithm in this paper performs better in terms of position error maximum. This shows that the proposed algorithm can not only effectively suppress the error divergence but also performs better compared with the traditional AKF.

Conclusions and Discussion
An improved innovation adaptive filtering algorithm is proposed for the vulnerability of integrated INS/GNSS navigation systems in challenging environments. First, the article analyzes the update formula of the Kalman filter, and the gain matrix is mainly determined by the measurement noise variance matrix, the one-step prediction error matrix and the system noise variance matrix. The measurement noise is easily affected by the environment and has a large impact on the filtering accuracy. In addition, the article reduces the number of adaptive parameters to ensure the stability and reliability of the filtering in practical applications.
Second, when the filtering is stable, the filtering estimation accuracy is improved, and the innovation is more descriptive of the relationship between the filtered estimates and the actual measurement data. Thus, the algorithm uses the innovation sequence to construct a chi-squared test to determine the measurement data anomaly, and when the measurement data is anomalous, the measurement noise variance matrix is adaptively updated by means of the difference between the current innovation and the average change in the innovation covariance.
The proposed algorithm is simulated and verified by the measured vehicle data by establishing the INS/GNSS integrated navigation system model and comparing the KF algorithm and AKF algorithm. The experimental results show that the proposed algorithm can suppress the filter divergence well when the measurement data is disturbed. Compared with the KF algorithm, the average positioning accuracy is improved by 7.06%. In addition, in terms of error maximum, the performance effect is better than AKF, which points to the fact that the proposed algorithm has good adaptability and robustness. The algorithm in this paper has a certain application value in the development of intelligent transportation systems, providing ideas to solve the inherent defects such as high movement speed of vehicle nodes and poor network stability in the CAV environment and meeting the requirements of accuracy, stability and wide accessibility of vehicle positioning in intelligent transportation.
In the future, we intend to combine the algorithm of this paper with attenuation filtering. In practical applications, model building is not perfect, and the filtering accuracy decreases with model errors. Attenuation filtering can increase the weight of current measurements to solve this problem. With the widespread use of integrated INS/GNSS navigation, low cost and high accuracy have become the focus of future research, and therefore, the articles will focus on this.