Simultaneous Localization and Mapping with Iterative Sparse Extended Information Filter for Autonomous Vehicles.
In this paper, a novel iterative sparse extended information filter (ISEIF) was proposed to solve the simultaneous localization and mapping problem (SLAM), which is very crucial for autonomous vehicles. The proposed algorithm solves the measurement update equations with iterative methods adaptively to reduce linearization errors. With the scalability advantage being kept, the consistency and accuracy of SEIF is improved. Simulations and practical experiments were carried out with both a land car benchmark and an autonomous underwater vehicle. Comparisons between iterative SEIF (ISEIF), standard EKF and SEIF are presented. All of the results convincingly show that ISEIF yields more consistent and accurate estimates compared to SEIF and preserves the scalability advantage over EKF, as well.
School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China. bhe@ouc.edu.cn.
Bo
B
He
School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China. oucliuyang@126.com.
Yang
Y
Liu
School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China. dongdiya007@163.com.
Diya
D
Dong
School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China. shenyue@ouc.edu.cn.
Yue
Y
Shen
School of Mechanical and Electrical Engineering, China Jiliang University, 258 Xueyuan Street, Xiasha High-Edu Park, Hangzhou 310018, China. yanth@163.com.
Tianhong
T
Yan
School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China. nianrui_80@163.com.
Rui
R
Nian
SEIF; SLAM; autonomous navigation; autonomous vehicles; consistency; iteration; scalability