Aiming at the GNSS receiver vulnerability in challenging urban environments and low power consumption of integrated navigation systems, an improved robust adaptive Kalman filter (IRAKF) algorithm with real-time performance and low computation complexity for single-frequency GNSS/MEMS-IMU/odometer integrated navigation module is proposed. The algorithm obtains the scale factor by the prediction residual, and uses it to adjust the artificially set covariance matrix of the observation vector under different GNSS solution states, so that the covariance matrix of the observation vector changes continuously with the complex scene. Then, the adaptive factor is calculated by the Mahalanobis distance to inflate the state prediction covariance matrix. In addition, the one-step prediction Kalman filter is introduced to reduce the computational complexity of the algorithm. The performance of the algorithm is verified by vehicle experiments in the challenging urban environments. Experiments show that the algorithm can effectively weaken the effects of abnormal model deviations and outliers in the measurements and improve the positioning accuracy of real-time integrated navigation. It can meet the requirements of low power consumption real-time vehicle navigation applications in the complex urban environment.
Attitude and heading estimation methods using the global navigation satellite system (GNSS) are generally based on multi-antenna deployment, where the installation space and system cost increase with the increase in the number of antennas. Since the single-antenna receiver is still the major choice of the mass market, we focus on precise and reliable heading and pitch estimation using a low-cost GNSS receiver. Carrier phase observations are precise but have an ambiguity problem. A single difference between consecutive epochs can eliminate ambiguity and reduce the measurement errors. In this work, a measurement model based on the time-differenced carrier phases (TDCPs) is utilized to estimate the precise delta position of the antenna between two consecutive epochs. Then, considering the motion constraint, the heading and pitch angles of a moving land vehicle can be determined by the components of the estimated receiver delta position. A threshold on the length of the delta position is selected to avoid large errors in static periods. To improve the reliability of the algorithm, the Doppler-aided cycle slip detection method is applied to exclude carrier phases with possible cycle slips. A real vehicular dynamic experiment using a low-cost, single-frequency GNSS receiver is conducted to evaluate the proposed algorithm. The experimental results show that the proposed algorithm is capable of providing precise vehicular heading and pitch estimates, with both the root mean square errors being better than 1.5°. This also indicates that the cycle slip exclusion is indispensable to avoid unexpected large errors.
Positioning accuracy and power consumption are essential performance indicators of integrated navigation and positioning chips. This paper proposes a single-frequency GNSS/MEMS-IMU/odometer real-time high-precision integrated navigation algorithm with dynamic power adaptive adjustment capability in complex environments. It is implemented in a multi-sensor fusion navigation SiP (system in package) chip. The simplified INS algorithm and the simplified Kalman filter algorithm are adopted to reduce the computation load, and the strategy of adaptively adjusting the data rate and selecting the observation information for measurement update in different scenes and motion modes is combined to realize high-precision positioning and low power consumption in complex scenes. The performance of the algorithm is verified by real-time vehicle experiments in a variety of complex urban environments. The results show that the RMS statistical value of the overall positioning error in the entire road section is 0.312 m, and the overall average power consumption is 141 mW, which meets the requirements of real-time integrated navigation for high-precision positioning and low power consumption. It supports single-frequency GNSS/MEMS-IMU/odometer integrated navigation SiP chip in real-time, high-precision, low-power, and small-volume applications.
Modern navigation systems are inseparable from an integrated solution consisting of a global navigation satellite system (GNSS) and an inertial navigation system (INS) since they serve as an important cornerstone of national comprehensive positioning, navigation, and timing (PNT) technology and can provide position, velocity, and attitude information at higher accuracy and better reliability. A robust adaptive method utilizes the observation information of both systems to optimize the filtering system, overcoming the shortcomings of the Kalman filter (KF) in complex urban environments. We propose a novel robust adaptive scheme based on a multi-condition decision model suitable for tightly coupled real-time kinematic (RTK)/INS architecture, which can reasonably determine whether the filtering system performs robust estimation (TCRKF) or adaptive filtering (TCAKF), improving the robust estimation method of two factors considering ambiguity variance for RTK-related observations. The performance of the proposed robust adaptive algorithm was evaluated through two sets of real vehicle tests. Compared with the TCAKF and TCRKF algorithms, the new robust adaptive scheme improves the average three-dimensional (3D) position root mean square (RMS) by 31% and 18.88%, respectively. It provides better accuracy and reliability for position, velocity, and attitude simultaneously.
The real-time response and accuracy of the attitude (i.e., roll and pitch) estimation from low-cost inertial measurement unit (IMU) have become the key issues restricting related applications. This paper proposes a robust attitude estimation scheme which can perform well under dynamic conditions. When only accelerometers are used to calculate and correct the attitude, the external acceleration becomes the main source of attitude estimation errors. Moreover, the truncation error in the linearization process of the nonlinear system also affects the attitude estimation. As our first contribution, the external acceleration is modeled as a first-order Gauss Markov model, and its value is calculated under the indirect Kalman filter (IKF) framework. The measurement noise covariance matrix of the IKF is adaptively adjusted to enhance its robustness and reduce the negative impact caused by inaccurate modeling. In the second part of our work, the two-step cascade filter method is used for attitude estimation. The attitude obtained from the gravity field based on the gradient descent (GD) algorithm shows fast response capabilities, and hence, it is embedded as a measurement in the IKF by using the chain-derivation rule. The truncation error introduced into the linearization process of the nonlinear system is effectively avoided. Both simulation and experiments are carried out to verify the feasibility and accuracy of the proposed algorithm. The results show that the approach proposed in this paper can meet the accuracy requirements of consumer products.
Aiming at the problem that position errors accumulate rapidly in foot-mounted pedestrian navigation systems using a low-cost inertial sensor, a novel three-dimensional (3D) positioning method is proposed. First, when the foot is still, an improved zero velocity detection method that assigns different weights to each inertial measurement unit (IMU) data in a sliding window is designed to reduce positioning errors. When the foot is in swing, a lateral velocity restriction method is proposed by analyzing the gait characteristics of pedestrians. In addition, when pedestrians need altitude positioning in the building, the stair step height is also applied to the zero-velocity update (ZUPT)-aided inertial navigation system, which can effectively improve altitude positioning accuracy. Experiments under multi-gait modes show that the proposed zero velocity detection method can achieve smaller positioning errors compared with other traditional zero velocity detection methods. Moreover, the trajectory estimated by the proposed method has a higher coincidence with the real trajectories, the two-dimensional (2D) plane positioning error is less than 0.9% and the average altitude positioning error is only 0.12 m.