Square-Root Iterated Kalman Filter for Bearing-Only SLAM

November 2007

Square-Root Iterated Kalman Filter for Bearing-Only SLAM

Authors:

Hyungpil Moon, Stephen T. Tully, George A. Kantor, and Howie Choset

Abstract:

This paper presents an undelayed solution to the bearing-only simultaneous localization and mapping problem (SLAM). We employ a square-root iterated Kalman filter for nonlinear state estimation. The proposed technique incorporates a modified Kalman update that is equivalent to a variable-step iterative Gauss-Newton method, and is numerically stable because it maintains a square-root decomposition of the covariance matrix. Although many existing bearingonly algorithms focus on proper initialization of landmark locations, our method allows for arbitrary initialization along the initial measurement ray without sacrificing map accuracy. This is desirable because we require only one filter and the state dimension of that filter need not include numerous temporary hypotheses. For this reason, the proposed algorithm is more computationally efficient than other methods. We demonstrate the feasibility of this approach in simulation and with experiments on mobile robots.
@conference{Moon-2007-17054,
author = {Hyungpil Moon And Stephen T. Tully And George A. Kantor And Howie Choset},
title = {Square-Root Iterated Kalman Filter for Bearing-Only SLAM},
booktitle = {Proceedings of 4th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI '07)},
year = {2007},
month = {November},
}
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.