Exact state and covariance sub-matrix recovery for submap based sparse EIF SLAM algorithm

Publication Type:
Conference Proceeding
Proceedings - IEEE International Conference on Robotics and Automation, 2008, pp. 1868 - 1873
Issue Date:
Full metadata record
This paper provides a novel state vector and covariance sub-matrix recovery algorithm for a recently developed submap based exactly sparse Extended Information Filter (EIF) SLAM algorithm - Sparse Local Submap Joining Filter (SLSJF). The algorithm achieves exact recovery instead of approximate recovery. The recovery algorithm is very efficient because of an incremental Cholesky factorization approach and a natural reordering of the global state vector. Simulation results show that the computation cost of the SLSJF is much lower as compared with the sequential map joining algorithm using Extended Kalman Filter (EKF). The SLSJF with the proposed recovery algorithm is also successfully applied to the Victoria Park data set. ©2008 IEEE.
Please use this identifier to cite or link to this item: