scholarly journals Robust Adaptive Cubature Kalman Filter and Its Application to Ultra-Tightly Coupled SINS/GPS Navigation System

Sensors ◽  
2018 ◽  
Vol 18 (7) ◽  
pp. 2352 ◽  
Author(s):  
Xin Zhao ◽  
Jianli Li ◽  
Xunliang Yan ◽  
Shaowen Ji

In this paper, we propose a robust adaptive cubature Kalman filter (CKF) to deal with the problem of an inaccurately known system model and noise statistics. In order to overcome the kinematic model error, we introduce an adaptive factor to adjust the covariance matrix of state prediction, and process the influence introduced by dynamic disturbance error. Aiming at overcoming the abnormality error, we propose the robust estimation theory to adjust the CKF algorithm online. The proposed adaptive CKF can detect the degree of gross error and subsequently process it, so the influence produced by the abnormality error can be solved. The paper also studies a typical application system for the proposed method, which is the ultra-tightly coupled navigation system of a hypersonic vehicle. Highly dynamical scene experimental results show that the proposed method can effectively process errors aroused by the abnormality data and inaccurate model, and has better tracking performance than UKF and CKF tracking methods. Simultaneously, the proposed method is superior to the tracing method based on a single-modulating loop in the tracking performance. Thus, the stable and high-precision tracking for GPS satellite signals are preferably achieved and the applicability of the system is promoted under the circumstance of high dynamics and weak signals. The effectiveness of the proposed method is verified by a highly dynamical scene experiment.

2021 ◽  
Vol 13 (10) ◽  
pp. 1943
Author(s):  
Cheng Pan ◽  
Nijia Qian ◽  
Zengke Li ◽  
Jingxiang Gao ◽  
Zhenbin Liu ◽  
...  

In complex urban environments, a single Global Navigation Satellite System (GNSS) is often not ideal for navigation due to a lack of sufficient visible satellites. Additionally, the heading angle error of a GNSS/micro-electro-mechanical system–grade inertial measurement unit (MIMU) tightly coupled integration based on the single antenna is large, and the attitude angle, velocity, and position calculated therein all have large errors. Considering the above problems, this paper designs a tightly coupled integration of GNSS/MIMU based on two GNSS antennas and proposes a singular value decomposition (SVD)-based robust adaptive cubature Kalman filter (SVD-RACKF) according to the model characteristics of the integration. In this integration, the high-accuracy heading angle of the carrier is obtained through two antennas, and the existing attitude angle information is used as the observation to constrain the filtering estimation. The proposed SVD-RACKF uses SVD to stabilize the numerical accuracy of the recursive filtering. Furthermore, the three-stage equivalent weight function and the adaptive adjustment factor are constructed to suppress the influence of the gross error and the abnormal state on the parameter estimation, respectively. A set of real measured data was employed for testing and analysis. The results show that dual antennas and dual systems can improve the positioning performance of the integrated system to a certain extent, and the proposed SVD-RACKF can accurately detect the gross errors of the observations and effectively suppress them. Compared with the cubature Kalman filter, the proposed filtering algorithm is more robust, with higher accuracy and reliability of parameter estimation.


2019 ◽  
Vol 13 ◽  
pp. 174830181983304
Author(s):  
Hangshuai Ma ◽  
Rong Wang ◽  
Zhi Xiong ◽  
Jianye Liu ◽  
Chuanyi Li

The application of Beidou Satellite Navigation System (BDS) is developing rapidly. To satisfy the increasing demand for positioning performance, single-frequency precise point positioning (SFPPP) has been a focus in recent years. By introducing the SFPPP technique into the INS/BDS integrated system, higher navigation accuracy can be obtained. Cycle slip, which is caused by signal blockage during the measurement of the carrier phase, is a challenge for SFPPP application. In the INS/SFPPP-BDS integrated system, cycle slip can cause serious bias in BDS carrier phase measurements. In this paper, a new INS/SFBDS-PPP tightly coupled navigation system and a robust adaptive filtering method are proposed. Using a low-cost single-frequency receiver integrated with INS, an observation model was built based on the pseudo range and carrier phase by PPP preprocessing. The cycle slip was introduced into the state vector to improve the estimation precision. The test statistics, comprising the innovation and its covariance, were used to estimate the time at which cycle slip occurred and its amplitude to compensate for its effect on the observation. Finally, the proposed system model and algorithm are validated by simulation.


Sensors ◽  
2021 ◽  
Vol 21 (24) ◽  
pp. 8180
Author(s):  
Jijun Geng ◽  
Linyuan Xia ◽  
Jingchao Xia ◽  
Qianxia Li ◽  
Hongyu Zhu ◽  
...  

Indoor localization based on pedestrian dead reckoning (PDR) is drawing more and more attention of researchers in location-based services (LBS). The demand for indoor localization has grown rapidly using a smartphone. This paper proposes a 3D indoor positioning method based on the micro-electro-mechanical systems (MEMS) sensors of the smartphone. A quaternion-based robust adaptive cubature Kalman filter (RACKF) algorithm is proposed to estimate the heading of pedestrians based on magnetic, angular rate, and gravity (MARG) sensors. Then, the pedestrian behavior patterns are distinguished by detecting the changes of pitch angle, total accelerometer and barometer values of the smartphone in the duration of effective step frequency. According to the geometric information of the building stairs, the step length of pedestrians and the height difference of each step can be obtained when pedestrians go up and downstairs. Combined with the differential barometric altimetry method, the optimal height can be computed by the robust adaptive Kalman filter (RAKF) algorithm. Moreover, the heading and step length of each step are optimized by the Kalman filter to reduce positioning error. In addition, based on the indoor map vector information, this paper proposes a heading calculation strategy of the 16-wind rose map to improve the pedestrian positioning accuracy and reduce the accumulation error. Pedestrian plane coordinates can be solved based on the Pedestrian Dead-Reckoning (PDR). Finally, combining pedestrian plane coordinates and height, the three-dimensional positioning coordinates of indoor pedestrians are obtained. The proposed algorithm is verified by actual measurement examples. The experimental verification was carried out in a multi-story indoor environment. The results show that the Root Mean Squared Error (RMSE) of location errors is 1.04–1.65 m by using the proposed algorithm for three participants. Furthermore, the RMSE of height estimation errors is 0.17–0.27 m for three participants, which meets the demand of personal intelligent user terminal for location service. Moreover, the height parameter enables users to perceive the floor information.


Sign in / Sign up

Export Citation Format

Share Document