Real-time hierarchical GPS aided visual SLAM on urban environments

Schleicher, David; Bergasa, Luis M.; Ocaña, Manuel; Barea, Rafael; López, Elena
Year: 2009
Type of Publication: In Proceedings
Keywords: Cameras ; Global Positioning System ; Large-scale systems ; Layout ; Navigation ; Portable computers ; Proposals ; Robotics and automation ; Simultaneous localization and mapping ; Vehicles
Book title: Robotics and Automation, 2009. ICRA '09. IEEE International Conference on
Pages: 4381 -4386
Month: May
ISSN: 1050-4729
DOI: 10.1109/ROBOT.2009.5152370
In this paper we present a new real-time hierarchical (topological/metric) Visual SLAM system focusing on the localization of a vehicle in large-scale outdoor urban environments. It is exclusively based on the visual information provided by both a low-cost wide-angle stereo camera and a low-cost GPS. Our approach divides the whole map into local sub-maps identified by the so-called fingerprint (reference poses). At the sub-map level (low level SLAM), 3D sequential mapping of natural landmarks and the vehicle location/orientation are obtained using a top-down Bayesian method to model the dynamic behavior. A higher topological level (high level SLAM) based on references poses has been added to reduce the global accumulated drift, keeping real-time constraints. Using this hierarchical strategy, we keep local consistency of the metric sub-maps, by mean of the EKF, and global consistency by using the topological map and the MultiLevel Relaxation (MLR) algorithm. GPS measurements are integrated at both levels, improving global estimation. Some experimental results for different large-scale urban environments are presented, showing an almost constant processing time.
Hits: 6046