Fast Simultaneous Localization and Mapping Based on Iterative Extended Kalman Filter Proposal Distribution and Linear Optimization Resampling
Wang Hong-jian① Wang Jing①② Liu Zhen-ye②
①(College of Automation, Harbin Engineering University, Harbin 150001, China) ②(8357 Research Institute of China Aerospace Science and Industry Group, Tianjin 300308, China)
Abstract：The location estimated accuracy of Autonomous Underwater Vehicle (AUV) and landmarks decrease because of the degeneracy and impoverishment of samples in standard Fast Simultaneous Localization And Mapping (FastSLAM) algorithm. A improved FastSLAM algorithm based on Iterative Extended Kalman Filter (IEKF) proposal distribution and linear optimization resampling is presented in order to solve this issue. The latest observation is integrated with IEKF in order to decrease the sample degeneracy while the new samples are produced by the linear combination of copied samples and some abandoned ones in order to reduce the sample impoverishment. The kinematic model of AUV, feature model and the measurement models of sensors are all established. And then features are extracted with Hough transform to build the global map. The experiment of the improved FastSLAM algorithm with trial data shows that it can avoid the degeneracy and impoverishment of samples effectively and enhance the location estimation accuracy of AUV and landmarks. Moreover, the consistency analysis showed that the method possesses the consistency of long term.
王宏健, 王晶, 刘振业. 基于迭代扩展Kalman滤波建议分布和线性优化重采样的快速同步定位与构图[J]. 电子与信息学报, 2014, 36(2): 318-324.
Wang Hong-Jian, Wang Jing, Liu Zhen-Ye. Fast Simultaneous Localization and Mapping Based on Iterative Extended Kalman Filter Proposal Distribution and Linear Optimization Resampling. , 2014, 36(2): 318-324.
2014, Vol. 36 
