Information-based compact Pose SLAM
Pose SLAM is the variant of simultaneous localization and map building (SLAM) is the variant of SLAM, in which only the robot trajectory is estimated and where landmarks are only used to produce relative constraints between robot poses. To reduce the computational cost of the information filter form of Pose SLAM and, at the same time, to delay inconsistency as much as possible, we introduce an approach that takes into account only highly informative loop-closure links and nonredundant poses. This approach includes constant time procedures to compute the distance between poses, the expected information gain for each potential link, and the exact marginal covariances while moving in open loop, as well as a procedure to recover the state after a loop closure that, in practical situations, scales linearly in terms of both time and memory. Using these procedures, the robot operates most of the time in open loop, and the cost of the loop closure is amortized over long trajectories. This way, the computational bottleneck shifts to data association, which is the search over the set of previously visited poses to determine good candidates for sensor registration. To speed up data association, we introduce a method to search for neighboring poses whose complexity ranges from logarithmic in the usual case to linear in degenerate situations. The method is based on organizing the pose information in a balanced tree whose internal levels are defined using interval arithmetic. The proposed Pose-SLAM approach is validated through simulations, real mapping sessions, and experiments using standard SLAM data sets. ; This work was supported by projects: 'Ubiquitous networking robotics in urban settings' (E-00938), 'Analysis and motion planning of complex robotic systems' (4802), 'CONSOLIDER-INGENIO 2010 Multimodal interaction in pattern recognition and computer vision' (V-00069), 'Percepción y acción ante incertidumbre' (4803). This work was supported by Project DPI-2007-60858, Project DPI-2008-06022, Project Multimodal Interaction in Pattern Recognition and Computer Vision Consolider-Ingenio 2010, and by the European Union Ubiquitous Networking Robotics in Urban Settings under Project IST-FP6-STREP-045062. The work of V. Ila was supported in part by the Spanish Ministry of Science and Innovation under a Juan de la Cierva Postdoctoral Fellowship. ; Peer Reviewed