Unscented iSAM: A Consistent Incremental Solution to Cooperative Localization and Target Tracking

Guoquan Huang, Robert Truax, Michael Kaess and John J. Leonard
Conference Paper, European Conference on Mobile Robots (ECMR), September, 2013

View Publication

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.


In this paper, we study the problem of cooperative localization and target tracking (CLATT), i.e., a team of mobile robots use their onboard sensors’ measurements to cooperatively track multiple moving targets, and propose a novel unscented incremental smoothing and mapping (U-iSAM) approach. The proposed method attains reduced linearization errors by using the unscented transformation and correct observability properties by imposing observability constraints on the unscented transformation when computing measurement Jacobians. In particular, we, for the first time ever, analyze the observability properties of the batch maximum a posteriori (MAP)-based CLATT system, and show that in the case of no prior, the Hessian (information) matrix has a nullspace of dimension three. However, this may not be the case when the Jacobians (and thus the Hessian) are computed numerically through the unscented transformation. To ensure that the U- iSAM possesses correct observability (i.e., the nullspace of its Hessian is of dimension three), we project the measurement Jacobians computed by the standard unscented transformation onto the observable subspace. The proposed algorithm is validated through extensive Monte-Carlo simulations.

author = {Guoquan Huang and Robert Truax and Michael Kaess and John J. Leonard},
title = {Unscented iSAM: A Consistent Incremental Solution to Cooperative Localization and Target Tracking},
booktitle = {European Conference on Mobile Robots (ECMR)},
year = {2013},
month = {September},
} 2017-09-13T10:39:16-04:00