Research on slam algorithm of iterated extended Kalman filtering for multi-sensor fusion

Shi Han-hai,He Fa-jiang,Dang Shu-wen,Wang Kang-le
DOI: https://doi.org/10.1145/3162957.3162999
2017-01-01
Abstract:For the problem of the error of EKF in linearization, an iterated extended Kalman filtering algorithm based on IMU and laser sensor for environmental feature matching is proposed. The K-Nearest Neighbor algorithm is applied to match the data obtained by IMU and laser sensor. In the measurement phase, the nonlinear system is linearized multiple by EKF. The simulation results show that the new method effectively reduces the nonlinear error and inhibits the error accumulation caused by IMU. Compared with traditional extended Kalman filtering, the root mean square error of position and azimuth was reduced by 48%, 16% and 29%, respectively. As the result, the navigation accuracy of system is improved and state tracking performance outperforms better than traditional EKF.
What problem does this paper attempt to address?