scholarly journals An Adaptive UWB/MEMS-IMU Complementary Kalman Filter for Indoor Location in NLOS Environment

2019 ◽  
Vol 11 (22) ◽  
pp. 2628 ◽  
Author(s):  
Liu ◽  
Li ◽  
Wang ◽  
Zhang

High precision positioning of UWB (ultra-wideband) in NLOS (non-line-of-sight) environment is one of the hot issues in the direction of indoor positioning. In this paper, a method of using a complementary Kalman filter (CKF) to fuse and filter UWB and IMU (inertial measurement unit) data and track the errors of variables such as position, speed, and direction is presented. Based on the uncertainty of magnetometer and acceleration, the noise covariance matrix of magnetometer and accelerometer is calculated dynamically, and then the weight of magnetometer data is set adaptively to correct the directional error of gyroscope. Based on the uncertainty of UWB distance observations, the covariance matrix of UWB measurement noise is calculated dynamically, and then the weight of UWB data observations is set adaptively to correct the position error. The position, velocity and direction errors are corrected by the fusion of UWB and IMU. The experimental results show that the algorithm can reduce the gyroscope deviation with magnetic noise and motion noise, so that the orientation estimates can be improved, as well as the positioning accuracy can be increased with UWB ranging noise.

Sensors ◽  
2018 ◽  
Vol 18 (10) ◽  
pp. 3435 ◽  
Author(s):  
Xin Li ◽  
Yan Wang ◽  
Kourosh Khoshelham

Ultra wideband (UWB) has been a popular technology for indoor positioning due to its high accuracy. However, in many indoor application scenarios UWB measurements are influenced by outliers under non-line of sight (NLOS) conditions. To detect and eliminate outlying UWB observations, we propose a UWB/Inertial Measurement Unit (UWB/IMU) fusion filter based on a Complementary Kalman Filter to track the errors of position, velocity and direction. By using the least squares method, the positioning residual of the UWB observation is calculated, the robustness factor of the observation is determined, and an observation weight is dynamically set. When the robustness factor does not exceed a pre-defined threshold, the observed value is considered trusted, and adaptive filtering is used to track the system state, while the abnormity of system state, which might be caused by IMU data exceptions or unreasonable noise settings, is detected by using Mahalanobis distance from the observation to the prior distribution. When the robustness factor exceeds the threshold, the observed value is considered abnormal, and robust filtering is used, whereby the impact of UWB data exceptions on the positioning results is reduced by exploiting Mahalanobis distance. Experimental results show that the observation error can be effectively estimated, and the proposed algorithm can achieve an improved positioning accuracy when affected by outlying system states of different quantity as well as outlying observations of different proportion.


2014 ◽  
Vol 602-605 ◽  
pp. 2958-2961
Author(s):  
Tao Lai ◽  
Guang Long Wang ◽  
Wen Jie Zhu ◽  
Feng Qi Gao

Micro inertial measurement unit integration storage test system is a typical multi-sensor information fusion system consists of microsensors. The Federated Kalman filter is applied to micro inertial measurement unit integration storage test system. The general structure and characteristics of Federated Kalman filter is expounded. The four-order Runge-Kutta method based on quaternion differential equation was used to dispose the output angular rate data from gyroscope, and the recurrence expressions was established too. The control system based ARM Cortex-M4 master-slave structure is adopted in this paper. The result shown that the dimensionality reduced algorithm significantly reduces implementation complexity of the method and the amount computation. The filtering effect and real-time performance have much increased than traditionally method.


Author(s):  
Qizhi He ◽  
Weiguo Zhang ◽  
Degang Huang ◽  
Huakun Chen ◽  
Jinglong Liu

Optimal two stage Kalman filter (OTSKF) is able to obtain optimal estimation of system states and bias for linear system which contains random bias. Unscented Kalman filter (UKF) is a conventional nonlinear filtering method which utilizes Sigmas point sampling and unscented transformation technology realizes propagation of state means and covariances through nonlinear system. Aircraft is a typical complicate nonlinear system, this paper treats the faults of Inertial Measurement Unit (IMU) as random bias, established a filtering model which contains faults of IMU. Hybird the two stage filtering technique and UKF, this paper proposed an optimal two stage unscented Kalman filter (OTSUKF) algorithm which is suitable for fault diagnosis of IMU, realized optimal estimation of system states and faults identification of IMU via proposed innovative designing method of filtering model and the algorithm was validated that it is robust to wind disterbance via real flight data and it is also validated that proposed OTSUKF is optimal in the existance of wind disturbance via comparing with the existance iterated optimal two stage extended kalman filter (IOTSEKF) method.


Author(s):  
Qizhi He ◽  
Weiguo Zhang ◽  
Xiaoxiong Liu ◽  
Weinan Li

In the case of nonlinear systems with random bias, the Optimal Two-Stage Unscented Kalman Filter (OTSUKF) can obtain the optimal estimation of system state and bias. But it requires random bias to be accurately modeled, while it is always very difficult in actual situation because the aircraft is a typical nonlinear system. In this paper, the faults of the Inertial Measurement Unit (IMU) are treated as a random bias, and the random walk model is used to describe the fault. The accuracy of the random walk model depends on the degree of matching between the covariance of the random walk model and the actual situation. For the IMU fault diagnosis method based on OTSUKF, the covariance of the random walk model is assigned with a constant matrix, and the value of the matrix is initialized empirically. It is very difficult to select a matching matrix in practical applications. For this problem, in this paper, the covariance matrix of the random walk model is adaptively adjusted online based on the innovation covariance matching technique, and an adaptive Two-Stage Unscented Kalman Filter (ATSUKF) is proposed to solve the fault diagnosis problem of the IMU. The simulation experiment compares the IMU fault diagnosis performance of OTSUKF and ATSUKF, and verifies the effectiveness of the proposed adaptive method.


Sensors ◽  
2019 ◽  
Vol 19 (2) ◽  
pp. 364 ◽  
Author(s):  
Ming Xia ◽  
Chundi Xiu ◽  
Dongkai Yang ◽  
Li Wang

The pedestrian navigation system (PNS) based on inertial navigation system-extended Kalman filter-zero velocity update (INS-EKF-ZUPT or IEZ) is widely used in complex environments without external infrastructure owing to its characteristics of autonomy and continuity. IEZ, however, suffers from performance degradation caused by the dynamic change of process noise statistics and heading estimation errors. The main goal of this study is to effectively improve the accuracy and robustness of pedestrian localization based on the integration of the low-cost foot-mounted microelectromechanical system inertial measurement unit (MEMS-IMU) and ultrasonic sensor. The proposed solution has two main components: (1) the fuzzy inference system (FIS) is exploited to generate the adaptive factor for extended Kalman filter (EKF) after addressing the mismatch between statistical sample covariance of innovation and the theoretical one, and the fuzzy adaptive EKF (FAEKF) based on the MEMS-IMU/ultrasonic sensor for pedestrians was proposed. Accordingly, the adaptive factor is applied to correct process noise covariance that accurately reflects previous state estimations. (2) A straight motion heading update (SMHU) algorithm is developed to detect whether a straight walk happens and to revise errors in heading if the ultrasonic sensor detects the distance between the foot and reflection point of the wall. The experimental results show that horizontal positioning error is less than 2% of the total travelled distance (TTD) in different environments, which is the same order of positioning error compared with other works using high-end MEMS-IMU. It is concluded that the proposed approach can achieve high performance for PNS in terms of accuracy and robustness.


2020 ◽  
pp. 002029402091770
Author(s):  
Li Xing ◽  
Xiaowei Tu ◽  
Weixing Qian ◽  
Yang Jin ◽  
Pei Qi

The paper proposes an angular velocity fusion method of the microelectromechanical system inertial measurement unit array based on the extended Kalman filter with correlated system noises. In the proposed method, an adaptive model of the angular velocity is built according to the motion characteristics of the vehicles and it is regarded as the state equation to estimate the angular velocity. The signal model of gyroscopes and accelerometers in the microelectromechanical system inertial measurement unit array is used as the measurement equation to fuse and estimate the angular velocity. Due to the correlation of the state and measurement noises in the presented fusion model, the traditional extended Kalman filter equations are optimized, so as to accurately and reliably estimate the angular velocity. By simulating angular rates in different motion modes, such as constant and change-in-time angular rates, it is verified that the proposed method can reliably estimate angular rates, even when the angular rate has been out of the microelectromechanical system gyroscope measurement range. And results show that, compared with the traditional angular rate fusion method of microelectromechanical system inertial measurement unit array, it can estimate angular rates more accurately. Moreover, in the kinematic vehicle experiments, the performance advantage of the proposed method is also verified and the angular rate estimation accuracy can be increased by about 1.5 times compared to the traditional method.


Sign in / Sign up

Export Citation Format

Share Document