Real-Time Adaptive Motion Planning (RAMP) of Mobile Manipulators in Dynamic Environments With Unforeseen Changes

This paper introduces a novel and general real-time adaptive motion planning (RAMP) approach suitable for planning trajectories of high-DOF or redundant robots, such as mobile manipulators, in dynamic environments with moving obstacles of unknown trajectories. The RAMP approach enables simultaneous path and trajectory planning and simultaneous planning and execution of motion in real time. It facilitates real-time optimization of trajectories under various optimization criteria, such as minimizing energy and time and maximizing manipulability. It also accommodates partially specified task goals of robots easily. The approach exploits redundancy in redundant robots (such as locomotion versus manipulation in a mobile manipulator) through loose coupling of robot configuration variables to best achieve obstacle avoidance and optimization objectives. The RAMP approach has been implemented and tested in simulation over a diverse set of task environments, including environments with multiple mobile manipulators. The results (and also the accompanying video) show that the RAMP planner, with its high efficiency and flexibility, not only handles a single mobile manipulator well in dynamic environments with various obstacles of unknown motions in addition to static obstacles, but can also readily and effectively plan motions for each mobile manipulator in an environment shared by multiple mobile manipulators and other moving obstacles.

[1]  Tsuneo Yoshikawa,et al.  Manipulability of Robotic Mechanisms , 1985 .

[2]  Paolo Fiorini,et al.  Time optimal trajectory planning in dynamic environments , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[3]  Fuchun Sun,et al.  Evolutionary route planner for unmanned air vehicles , 2005, IEEE Transactions on Robotics.

[4]  Jian-Qiang Yi,et al.  A coordinated and hierarchical path planning approach for mobile manipulators , 2005, 2005 International Conference on Machine Learning and Cybernetics.

[5]  Lei Zhang,et al.  Robust neuro-fuzzy navigation of mobile manipulator among dynamic obstacles , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[6]  Bruce H. Krogh,et al.  Path planning for mobile manipulators for multiple task execution , 1991, IEEE Trans. Robotics Autom..

[7]  G. Swaminathan Robot Motion Planning , 2006 .

[8]  Piero P. Bonissone,et al.  Evolutionary algorithms + domain knowledge = real-world evolutionary computation , 2006, IEEE Transactions on Evolutionary Computation.

[9]  Mark H. Overmars,et al.  Roadmap-based motion planning in dynamic environments , 2005, IEEE Trans. Robotics.

[10]  Jean-Claude Latombe,et al.  On-Line Manipulation Planning for Two Robot Arms in a Dynamic Environment , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[11]  Thomas Bäck,et al.  Evolutionary computation: comments on the history and current state , 1997, IEEE Trans. Evol. Comput..

[12]  Christian Laugier,et al.  High-speed autonomous navigation with motion prediction for unknown moving obstacles , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[13]  Qiang Huang,et al.  Stability control for a mobile manipulator using a potential method , 1994, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS'94).

[14]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[15]  Thierry Siméon,et al.  Path Deformation Roadmaps , 2006, WAFR.

[16]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

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

[18]  Thierry Siméon,et al.  A PRM-based motion planner for dynamically changing environments , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

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

[20]  Zbigniew Michalewicz,et al.  Genetic Algorithms + Data Structures = Evolution Programs , 1996, Springer Berlin Heidelberg.

[21]  Zbigniew Michalewicz,et al.  Genetic algorithms + data structures = evolution programs (3rd ed.) , 1996 .

[22]  S. Dubowsky,et al.  On the Optimal Control of Robotic Manipulators with Actuator Constraints , 1983, 1983 American Control Conference.

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

[24]  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).

[25]  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).

[26]  François G. Pin,et al.  Using minimax approaches to plan optimal task commutation configurations for combined mobile platform-manipulator systems , 1994, IEEE Trans. Robotics Autom..

[27]  Arthur C. Sanderson,et al.  Evolutionary path planning using multiresolution path representation , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[28]  Xiaoming Hu,et al.  Reactive mobile manipulation using dynamic trajectory tracking , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[29]  Jun Ota,et al.  Varying paths and motion profiles in multiple robot motion planning , 1997, Proceedings 1997 IEEE International Symposium on Computational Intelligence in Robotics and Automation CIRA'97. 'Towards New Computational Principles for Robotics and Automation'.

[30]  El-Ghazali Talbi,et al.  The "Ariadne's clew" algorithm: global planning with local methods , 1993, Proceedings of 1993 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '93).

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

[32]  Myung Hwangbo,et al.  Motion planning for a mobile manipulator with imprecise locomotion , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[33]  Zbigniew Michalewicz,et al.  Adaptive evolutionary planner/navigator for mobile robots , 1997, IEEE Trans. Evol. Comput..

[34]  Mark H. Overmars,et al.  Roadmap-based motion planning in dynamic environments , 2004, IEEE Transactions on Robotics.

[35]  Kang G. Shin,et al.  Minimum-time control of robotic manipulators with geometric path constraints , 1985 .

[36]  Jur P. van den Berg,et al.  Anytime path planning and replanning in dynamic environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[37]  Oliver Brock,et al.  Task-consistent obstacle avoidance and motion behavior for mobile manipulation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[38]  Manuela M. Veloso,et al.  Real-time randomized path planning for robot navigation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[39]  Homayoun Seraji,et al.  A Unified Approach to Motion Control of Mobile Manipulators , 1998, Int. J. Robotics Res..

[40]  Sebastian Thrun,et al.  ARA*: Anytime A* with Provable Bounds on Sub-Optimality , 2003, NIPS.

[41]  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).