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: Article
Keywords: SLAM - Intelligent Vehicles - Computer Vision - Real-Time
Journal: Lecture Notes in Computer Science
Volume: 5717
Number: 2009
Pages: 326-333
Month: September
ISSN: 0302-9743
DOI: 10.1007/978-3-642-04772-5_43
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: 10939