Movable Coordinate Frame Based Simultaneous Localization and Mapping of Intelligent Vehicle

QIAN Jun,YANG Ru-qing,YANG Ming,WU Shun-xi,WANG Chun-xiang
DOI: https://doi.org/10.3321/j.issn:1006-2467.2009.06.001
2009-01-01
Abstract:When an intelligent vehicle enters an unknown environment,it must solve the problem of simultaneous localization and mapping in order to pursue high autonomy.Extended Kalman filter based method is subject to inconsistency when the variance of vehicle's heading angle is big.Based on it,this paper described a movable coordinate frame based method,which transforms the reference frame to where the vehicle is once a new feature is discovered.This transformation makes sure that each feature has small variance at the initialization.In addition,the heading angle keeps small uncertainty since it is only affected by local environment.So the consistency of estimation could be improved.The experimental results of artificial and natural environments show that high quality map can be built as well as accurate vehicle trajectory.
What problem does this paper attempt to address?