Amortized constant time estimation in Pose SLAM and hierarchical SLAM using a mixed Kalman-information filter

The computational bottleneck in all information-based algorithms for simultaneous localization and mapping (SLAM) is the recovery of the state mean and covariance. The mean is needed to evaluate model Jacobians and the covariance is needed to generate data association hypotheses. In general, recover...

Descripción completa

Detalles Bibliográficos
Autores: Ila, Viorela Simona, Porta Pleite, Josep Maria|||0000-0002-5056-1717, Andrade-Cetto, Juan|||0000-0002-6354-8941
Tipo de recurso: artículo
Fecha de publicación:2011
País:España
Institución:Universitat Politècnica de Catalunya (UPC)
Repositorio:UPCommons. Portal del coneixement obert de la UPC
Idioma:inglés
OAI Identifier:oai:upcommons.upc.edu:2117/14111
Acceso en línea:https://hdl.handle.net/2117/14111
https://dx.doi.org/10.1016/j.robot.2011.02.010
Access Level:acceso abierto
Palabra clave:Simultaneous localization and mapping
Pose SLAM
Hierarchical SLAM
Kalman filter
Information filter
SLAM (robòtica)
Àrees temàtiques de la UPC::Informàtica::Robòtica
Descripción
Sumario:The computational bottleneck in all information-based algorithms for simultaneous localization and mapping (SLAM) is the recovery of the state mean and covariance. The mean is needed to evaluate model Jacobians and the covariance is needed to generate data association hypotheses. In general, recovering the state mean and covariance requires the inversion of a matrix with the size of the state, which is computationally too expensive in time and memory for large problems. Exactly sparse state representations, such as that of Pose SLAM, alleviate the cost of state recovery either in time or in memory, but not in both. In this paper, we present an approach to state estimation that is linear both in execution time and in memory footprint at loop closure, and constant otherwise. The method relies on a state representation that combines the Kalman and the information-based approaches. The strategy is valid for any SLAM system that maintains constraints between marginal states at different time slices. This includes both Pose SLAM, the variant of SLAM where only the robot trajectory is estimated, and hierarchical techniques in which submaps are registered with a network of relative geometric constraints.