Iterated Filters for Bearing-Only SLAM

May 2008

Iterated Filters for Bearing-Only SLAM

Authors:

Stephen T. Tully, Hyungpil Moon, George A. Kantor, and Howie Choset
Conference Paper
Proceedings of (ICRA) International Conference on Robotics and Automation

Abstract:

This paper discusses the importance of iteration when performing the measurement update step for the problem of bearing-only SLAM. We focus on an undelayed approach that initializes a landmark after only one bearing measurement. Traditionally, the extended Kalman filter (EKF) has been used for SLAM, but the EKF measurement update rule can often lead to a divergent state estimate due to its inconsistency in linearization. We discuss the flaws of the EKF in this paper, and show that even the well established inverse-depth parametrization for bearing-only SLAM can be affected. We then show that representing the bearing-only update as a numerical optimization problem (solved with an iterative approach such as Gauss-Newton minimization) prevents divergence of the Kalman filter state and produces accurate SLAM results for a bearing-only sensor. More specifically, we propose the use of an iterated Kalman filter to resolve the issues normally associated with the EKF measurement update. Two outdoor mobile robot experiments are discussed to compare algorithm performance.
@conference{Tully-2008-9980,
author = {Stephen T. Tully And Hyungpil Moon And George A. Kantor And Howie Choset},
title = {Iterated Filters for Bearing-Only SLAM},
booktitle = {Proceedings of (ICRA) International Conference on Robotics and Automation},
year = {2008},
month = {May},
pages = {1442 - 1448},
}
Copyright notice: This material is presented to ensure timely dissemination of scholarly and technical work. Copyright and all rights therein are retained by authors or by other copyright holders. All persons copying this information are expected to adhere to the terms and constraints invoked by each author's copyright. These works may not be reposted without the explicit permission of the copyright holder.