Replanning in Belief Space for Dynamical Systems : Towards Handling Discrete Changes of Goal Location

This paper presents an online planning/replanning strategy for dynamical systems, in the presence of uncertainty. Online replanning capability allows us to handle discrete changes in the goal location. Multi-query graph-based methods, such as PRM in the deterministic setting, and FIRM in the stochastic setting, are suitable frameworks to serve this purpose. However, in these methods, local planners (along the edges) are responsible to drive the state/belief to the final node of the edge. Nevertheless, for dynamical systems, driving the system belief to a sampled belief is a challenge. In this paper, we provide an overview of the FIRM strategy that extends PRM-based planning to belief space, and sketch the application of it to dynamical/non-stoppable systems where the belief is stabilized to an orbit (periodic path) in belief space instead of a point. The method takes obstacles into account, while it provides a query-independent graph, as a means for online replanning.

[1]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[2]  Daniel Vallejo,et al.  OBPRM: an obstacle-based PRM for 3D workspaces , 1998 .

[3]  Timothy J. Robinson,et al.  Sequential Monte Carlo Methods in Practice , 2003 .

[4]  S. Bittanti,et al.  Periodic Systems: Filtering and Control , 2008 .

[5]  Nicholas Roy,et al.  icLQG: Combining local and global optimization for control in information space , 2009, 2009 IEEE International Conference on Robotics and Automation.

[6]  N. Roy,et al.  The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance , 2009, Int. J. Robotics Res..

[7]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[8]  Pieter Abbeel,et al.  LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information , 2010, Int. J. Robotics Res..

[9]  Nancy M. Amato,et al.  FIRM: Feedback controller-based information-state roadmap - A framework for motion planning under uncertainty , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Suman Chakravorty,et al.  Multi-agent Generalized Probabilistic RoadMaps: MAGPRM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Nancy M. Amato,et al.  On the probabilistic completeness of the sampling-based feedback motion planners in belief space , 2012, 2012 IEEE International Conference on Robotics and Automation.