Incremental, sensor-based motion generation for mobile manipulators in unknown, dynamic environments

We present an incremental method for motion generation in environments with unpredictably moving and initially unknown obstacles. The key to the method is its incremental nature: it locally augments and adapts global motion plans in response to changes in the environment, even if they significantly change the connectivity of the world. The restriction to local changes to a global plan results from the fact that in mobile manipulation, robots can ultimately only rely on their on-board sensors to perceive changes in the world. The proposed method addresses three sub-problems of motion generation with three algorithmic components. The first component reactively adapts plans in response to small, continuous changes. The second augments the plan locally in response to connectivity changes. And the third extracts a global, goal-directed motion from the representation maintained by the first two components. In an experimental evaluation of this method, we show a real-world mobile manipulator executing a whole-body motion task in an initially unknown environment, while incrementally maintaining a plan using only on-board sensors.

[1]  Eiichi Yoshida,et al.  Reactive robot motion using path replanning and deformation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[2]  Kris K. Hauser.  On responsiveness, safety, and completeness in real-time motion planning , 2012, Auton. Robots.

[3]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[4]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[5]  Oliver Brock,et al.  Elastic roadmaps—motion generation for autonomous mobile manipulation , 2010, Auton. Robots.

[6]  Siddhartha S. Srinivasa,et al.  CHOMP: Covariant Hamiltonian optimization for motion planning , 2013, Int. J. Robotics Res..

[7]  Mike Stilman,et al.  Global Manipulation Planning in Robot Joint Space With Task Constraints , 2010, IEEE Transactions on Robotics.

[8]  Jing Xiao,et al.  Real-Time Adaptive Motion Planning (RAMP) of Mobile Manipulators in Dynamic Environments With Unforeseen Changes , 2008, IEEE Transactions on Robotics.

[9]  Marc Toussaint,et al.  Robot trajectory optimization using approximate inference , 2009, ICML '09.

[10]  Florent Lamiraux,et al.  Motion planning for humanoid robots in environments modeled by vision , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[11]  Oliver Brock,et al.  Balancing Exploration and Exploitation in Sampling-Based Motion Planning , 2014, IEEE Transactions on Robotics.

[12]  Steven M. LaValle,et al.  The sampling-based neighborhood graph: an approach to computing and executing feedback motion strategies , 2004, IEEE Transactions on Robotics and Automation.

[13]  Seth Hutchinson,et al.  A Framework for Real-time Path Planning in Changing Environments , 2002, Int. J. Robotics Res..

[14]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[15]  Matei T. Ciocarlie,et al.  Mobile Manipulation in Unstructured Environments: Perception, Planning, and Execution , 2012, IEEE Robotics & Automation Magazine.

[16]  Oussama Khatib,et al.  Elastic bands: connecting path planning and control , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[17]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[18]  Oliver Brock,et al.  Decomposition-based motion planning: a framework for real-time motion planning in high-dimensional configuration spaces , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[19]  Chonhyon Park,et al.  ITOMP: Incremental Trajectory Optimization for Real-Time Replanning in Dynamic Environments , 2012, ICAPS.

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

[21]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[22]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[23]  Oliver Brock,et al.  Sensor-based, task-constrained motion generation under uncertainty , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[24]  O. Brock,et al.  Elastic Strips: A Framework for Motion Generation in Human Environments , 2002, Int. J. Robotics Res..

[25]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Autonomous Robot Vehicles.

[26]  Oussama Khatib,et al.  Synthesis of Whole-Body Behaviors through Hierarchical Control of Behavioral Primitives , 2005, Int. J. Humanoid Robotics.

[27]  Wolfram Burgard,et al.  Efficient grid-based spatial representations for robot navigation in dynamic environments , 2013, Robotics Auton. Syst..