Simultaneous Localization and Mapping with Iterative Sparse Extended Information Filter for Autonomous Vehicles

Sensors

Bo He²  Yang Liu²  Diya Dong²  Yue Shen²  Tianhong Yan¹  Rui Nian² 

[1] School of Mechanical and Electrical Engineering, China Jiliang University, 258 Xueyuan Street, Xiasha High-Edu Park, Hangzhou 310018, China; E-Mail:;School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China; E-Mails:

关键词: autonomous vehicles;    autonomous navigation;    SLAM;    SEIF;    consistency;    scalability;    iteration;   

DOI  :  10.3390/s150819852

来源: mdpi

【 摘 要 】

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.

【 授权许可】

CC BY   
© 2015 by the authors; licensee MDPI, Basel, Switzerland.