Handling the Inconsistency of Relative Map Filter

In [5], a version of Relative Map Filter (RMF) is proposed to solve the simultaneous localization and map building (SLAM) problem. In the RMF, the map states contain only quantities invariant under shift and rotation. The estimation of the map states and their correlations is carried out in an optimal way using the Kalman filter. However, the dependency among the map states is not taken into account, thus the resulting map states are inconsistent. This paper presents two methods to enforce the consistency of the relative map states. The idea is to maintain a geometrically consistent map by solving a set of constraints between the map states. Experimental results obtained by using the proposed methods on real platform data show better performance than those deduced from the original RMF.

[1]  H. Durrant-Whyte,et al.  A sub-optimal algorithm for automatic map building , 1997, Proceedings of the 1997 American Control Conference (Cat. No.97CH36041).

[2]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[3]  Roland Siegwart,et al.  Open challenges in SLAM: an optimal solution based on shift and rotation invariants , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[4]  Roland Siegwart,et al.  Improving the SLAM Convergence with a Relative Map Filter , 2004 .

[5]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[6]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[7]  Martial Hebert,et al.  Invariant filtering for simultaneous localization and mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).