A Random-Finite-Set Approach to Bayesian SLAM
MetadataShow full item record
This paper proposes an integrated Bayesian frame work for feature-based simultaneous localization and map building (SLAM) in the general case of uncertain feature number and data association. By modeling the measurements and feature map as random finite sets (RFSs), a formulation of the feature-based SLAM problem is presented that jointly estimates the number and location of the features, as well as the vehicle trajectory. More concisely, the joint posterior distribution of the set-valued map and vehicle trajectory is propagated forward in time as measurements arrive, thereby incorporating both data association and feature management into a single recursion. Furthermore, the Bayes optimality of the proposed approach is established. A first-order solution, which is coined as the probability hypothesis density (PHD) SLAM filter, is derived, which jointly propagates the posterior PHD of the map and the posterior distribution of the vehicle trajectory. A Rao-Blackwellized (RB) implementation of the PHD-SLAM filter is proposed based on the Gaussian-mixture PHD filter (for the map) and a particle filter (for the vehicle trajectory). Simulated and experimental results demonstrate the merits of the proposed approach, particularly in situations of high clutter and data association ambiguity.
Showing items related by title, author, creator and subject.
Moratuwage, D.; Vo, Ba-Ngu; Wang, D. (2012)In this paper we present a novel hierarchical solution to the Multi-Vehicle SLAM (MVSLAM) problem by extending the recently developed random finite set (RFS) based SLAM filter framework. Instead of fusing control and ...
Adams, M.; Mullane, J.; Vo, Ba-Ngu (2013)In autonomous applications, a vehicle requires reliable estimates of its location and information about the world around it. To capture prior knowledge of the uncertainties in a vehicle's motion response to input commands ...
Moratuwage, D.; Vo, Ba-Ngu; Wang, D.; Wang, H. (2012)In this paper we present a novel solution to the Multi-Vehicle SLAM (MVSLAM) problem by extending the random finite set (RFS) based SLAM filter framework using two recently developed multi-sensor information fusion ...