SLAP: Simultaneous Localization and Planning Under Uncertainty via Dynamic Replanning in Belief Space
- 2 October 2018
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Robotics
- Vol. 34 (5) , 1195-1214
Abstract
Simultaneous localization and planning (SLAP) is a crucial ability for an autonomous robot operating under uncertainty. In its most general form, SLAP induces a continuous partially observable Markov decision process (POMDP), which needs to be repeatedly solved online. This paper addresses this problem and proposes a dynamic replanning scheme in belief space. The underlying POMDP, which is continuous in state, action, and observation space, is approximated offline via sampling-based methods, but operates in a replanning loop online to admit local improvements to the coarse offline policy. This construct enables the proposed method to combat changing environments and large localization errors, even when the change alters the homotopy class of the optimal trajectory. It further outperforms the state-of-the-art Feedback-based Information RoadMap (FIRM) method by eliminating unnecessary stabilization steps. Applying belief space planning to physical systems brings with it a plethora of challenges. A key focus of this paper is to implement the proposed planner on a physical robot and show the SLAP solution performance under uncertainty, in changing environments and in the presence of large disturbances, such as a kidnapped robot situation.Keywords
This publication has 32 references indexed in Scilit:
- Scaling up Gaussian Belief Space Planning Through Covariance-Free Trajectory Optimization and Automatic Differentiation2015
- Active SLAM and Exploration with Particle Filters Using Kullback-Leibler DivergenceJournal of Intelligent & Robotic Systems, 2013
- Global motion planning under uncertain motion, sensing, and environment mapAutonomous Robots, 2012
- A survey of point-based POMDP solversAutonomous Agents and Multi-Agent Systems, 2012
- Planning under Uncertainty for Robotic Tasks with Mixed ObservabilityThe International Journal of Robotics Research, 2010
- The Belief Roadmap: Efficient Planning in Belief Space by Factoring the CovarianceThe International Journal of Robotics Research, 2009
- On the Probabilistic Foundations of Probabilistic Roadmap PlanningThe International Journal of Robotics Research, 2006
- On the Relationship between Classical Grid Search and Probabilistic RoadmapsThe International Journal of Robotics Research, 2004
- WMR control via dynamic feedback linearization: design, implementation, and experimental validationIEEE Transactions on Control Systems Technology, 2002
- Variance minimization approach for a class of dual control problemsIEEE Transactions on Automatic Control, 2002