A hierarchical and adaptive mobile manipulator planner

We present a Hierarchical and Adaptive Mobile Manipulator Planner (HAMP) that plans for both the base and the arm in a judicious manner - allowing the manipulator to change its configuration autonomously when needed if the current arm configuration is in collision with the environment as the mobile manipulator moves along the planned path. This is in contrast to current implemented approaches that are conservative and fold the arm into a fixed home configuration. Our planner first constructs a base roadmap and then for each node in the roadmap it checks for collision status of current manipulator configuration along the edges formed with adjacent nodes, if the current manipulator configuration is in collision, the manipulator C-space is searched for a new reachable configuration such that it is collision-free as the mobile manipulator moves along the edge. We show that HAMP is probabilistically complete. We compared HAMP with full 9D PRM and observed that HAMP outperforms the full 9D PRM in each of the performance criteria, i.e., computational time, percentage of successful attempts, base path length, and most importantly, undesired motions of the arm.

[1]  Maxim Likhachev,et al.  Cart pushing with a mobile manipulation system: Towards navigation with moveable objects , 2011, 2011 IEEE International Conference on Robotics and Automation.

[2]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[3]  Maren Bennewitz,et al.  Navigation in three-dimensional cluttered environments for mobile manipulation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[4]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[5]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

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

[7]  Paolo Fiorini,et al.  Target pose computation for nonholonomic mobile manipulators , 2009, 2009 International Conference on Advanced Robotics.

[8]  Kurt Konolige,et al.  The Office Marathon: Robust navigation in an indoor office environment , 2010, 2010 IEEE International Conference on Robotics and Automation.

[9]  Matei T. Ciocarlie,et al.  Towards Reliable Grasping and Manipulation in Household Environments , 2010, ISER.

[10]  Xiaoping Yun,et al.  Coordinating locomotion and manipulation of a mobile manipulator , 1992, [1992] Proceedings of the 31st IEEE Conference on Decision and Control.

[11]  Ashutosh Saxena,et al.  Robotic Grasping of Novel Objects using Vision , 2008, Int. J. Robotics Res..

[12]  Maxim Likhachev,et al.  Planning with adaptive dimensionality for mobile manipulation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[13]  Jean-Claude Latombe,et al.  On the Probabilistic Foundations of Probabilistic Roadmap Planning , 2006, Int. J. Robotics Res..

[14]  Kostas J. Kyriakopoulos,et al.  Nonholonomic motion planning for mobile manipulators , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  Siddhartha S. Srinivasa,et al.  Manipulation planning on constraint manifolds , 2009, 2009 IEEE International Conference on Robotics and Automation.

[16]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[17]  Kamal K. Gupta,et al.  Path planning with general end-effector constraints , 2007, Robotics Auton. Syst..

[18]  Michael Jenkin,et al.  Exploiting Hierarchical Probabilistic Motion Planning for Robot Reachable Workspace Estimation , 2011 .

[19]  Nico Blodow,et al.  Close-range scene segmentation and reconstruction of 3D point cloud maps for mobile manipulation in domestic environments , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[21]  Jindong Tan,et al.  Unified model approach for planning and control of mobile manipulators , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[22]  Dmitry Berenson,et al.  An optimization approach to planning for mobile manipulation , 2008, 2008 IEEE International Conference on Robotics and Automation.

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

[24]  Yong Yu,et al.  C-space Entropy: A Measure for View Planning and Exploration for General Robot-Sensor Systems in Unknown Environments , 2004, Int. J. Robotics Res..

[25]  Maren Bennewitz,et al.  Adaptive level-of-detail planning for efficient humanoid navigation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[26]  Kamal K. Gupta,et al.  Configuration space based efficient view planning and exploration with occupancy grids , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[28]  Mike Stilman,et al.  Task constrained motion planning in robot joint space , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.