A SINS Error Correction Approach Based on Dual-Threshold ZV Detection and Cubature Kalman Filter

Global Navigation Satellite Systems (GNSS) can provide real-time positioning information for outdoor users, but cannot for indoor scenarios or heavily occluded outdoor scenarios. Strap-down Inertial Navigation System (SINS) are widely used to locate people in complex interior or heavily occluded outdoor scenarios due to its light weight and low power consumption. However, IMU of SINS are noisy, and the sampling data error is large, which is a divergence of the error with time. Therefore, it will generate a positioning accumulation error, which affects the final positioning accuracy. The problem of cumulative IMU errors is usually dealt with by Zero-Velocity Update (ZUPT). The zero-velocity detection part of basic ZUPT method usually uses a single threshold to determine the gait of pedestrian, which often has the problem of gait misjudgment and omission. To address these problems, this paper proposes a composite conditional detection method to solve the problem of misjudgment in the zero-velocity interval. In addition, we redesign the zero-velocity update algorithm and uses the Cubature Kalman filter (CKF) for pedestrian positioning error correction. The experimental results demonstrate that the proposed ZUPT method based on dual-threshold detection can better detect the interval between pedestrian motion and stationery than ones with single threshold. The zero-velocity update algorithm based on CKF has higher performance than conventional EKF and UKF methods, which constrains the cumulative error of SINS to about 0.2% of the whole walking distance.