An Application Research of Kalman Filter Based Algorithms in ECEF Coordinate System for Motion Models of Sensors

摘要

Kalman filter based algorithms such as unscented Kalman filter (UKF), and the unbiased conversion measurement Kalman filter (UCMKF) are the most popular nonlinear filters which used in tracking, navigation, estimation and information fusion. Applying those filters directly in East-North-Up (ENU) coordinates with motion models of sensors causes the degradation or even divergence of filter performance. To address this issue, we first analyzed and discussed the motion model consistency of moving sensor with a constant velocity (CV). Next, we proposed to extend the application of common filter algorithms to Earth Centered Earth Fixed (ECEF) coordinates to filter random errors. We verified the validity of our proposed method by filtering random errors in a constant velocity motion model of radar. The theoretical analysis and simulation results show that the extended algorithms provide better efficiency and compatibility in moving sensors.