Detection of robustly collision-free trajectories in unpredictable environments in real-time

One of the ultimate goals in robotics is to make robots of high degrees of freedom (DOF) work autonomously in real world environments. However, real world environments are unpredictable, i.e., how the objects move are usually not known beforehand. Thus, whether a robot trajectory is collision-free or not has to be checked on-line based on sensing as the robot moves. Moreover, in order to guarantee safe motion, the motion uncertainty of the robot has to be taken into account. This paper introduces a general approach to detect if a high-DOF robot trajectory is continuously collision-free even in the presence of robot motion uncertainty in an unpredictable environment in real time. Our method is based on the novel concept of dynamic envelope, which takes advantage of progressive sensing over time without predicting motions of objects in an environment or assuming specific object motion patterns. The introduced approach can be used by general real-time motion planners to check if a candidate robot trajectory is continuously and robustly collision-free (i.e., in spite of uncertainty in the robot motion).

[1]  Han-Pang Huang,et al.  Robot Motion Planning in Dynamic Uncertain Environments , 2011, Adv. Robotics.

[2]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[3]  Kamal K. Gupta,et al.  RRT-SLAM for motion planning with motion and map uncertainty for robot exploration , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Yoshiaki Kuwata,et al.  Robust Constrained Receding Horizon Control for Trajectory Planning , 2005 .

[5]  Jing Xiao,et al.  Real-time Motion Planning of Multiple Mobile Manipulators with a Common Task Objective in Shared Work Environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[6]  A. Richards,et al.  Decentralized robust receding horizon control for multi-vehicle guidance , 2006, 2006 American Control Conference.

[7]  Siddhartha S. Srinivasa,et al.  GATMO: A Generalized Approach to Tracking Movable Objects , 2009, 2009 IEEE International Conference on Robotics and Automation.

[8]  Christian Laugier,et al.  Moving obstacles' motion prediction for autonomous navigation , 2004, ICARCV 2004 8th Control, Automation, Robotics and Vision Conference, 2004..

[9]  Bum Hee Lee,et al.  View-time based moving obstacle avoidance using stochastic prediction of obstacle motion , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[10]  Tomás Lozano-Pérez,et al.  An algorithm for planning collision-free paths among polyhedral obstacles , 1979, CACM.

[11]  Wolfram Burgard,et al.  Coastal navigation-mobile robot navigation with uncertainty in dynamic environments , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[12]  Thierry Fraichard,et al.  Guaranteeing motion safety for robots , 2012, Auton. Robots.

[13]  Thierry Fraichard,et al.  Path planning with uncertainty for car-like robots , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[14]  Frank Wolter,et al.  Exploring Artificial Intelligence in the New Millenium , 2002 .

[15]  Ian D. Walker,et al.  Fault detection for wheeled mobile robots with parametric uncertainty , 2001, 2001 IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Proceedings (Cat. No.01TH8556).

[16]  Elizabeth A. Croft,et al.  Jerk-bounded manipulator trajectory planning: design for real-time applications , 2003, IEEE Trans. Robotics Autom..

[17]  John J. Craig Zhu,et al.  Introduction to robotics mechanics and control , 1991 .

[18]  Gino van den Bergen A Fast and Robust GJK Implementation for Collision Detection of Convex Objects , 1999, J. Graphics, GPU, & Game Tools.

[19]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[20]  Steven M. LaValle,et al.  Robot motion planning in a changing, partially predictable environment , 1994, Proceedings of 1994 9th IEEE International Symposium on Intelligent Control.

[21]  Jing Xiao,et al.  Exact and efficient Collision Detection for a multi-section Continuum Manipulator , 2012, 2012 IEEE International Conference on Robotics and Automation.

[22]  Boris Baginski Efficient dynamic collision detection using expanded geometry models , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.

[23]  Luc Van Gool,et al.  Moving obstacle detection in highly dynamic scenes , 2009, 2009 IEEE International Conference on Robotics and Automation.

[24]  Wolfram Burgard,et al.  Learning Motion Patterns of People for Compliant Robot Motion , 2005, Int. J. Robotics Res..

[25]  James J. Kuffner,et al.  Multipartite RRTs for Rapid Replanning in Dynamic Environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  Jing Xiao,et al.  Practical Motion Planning in Unknown and Unpredictable Environments , 2010, ISER.

[27]  Dinesh Manocha,et al.  I-COLLIDE: an interactive and exact collision detection system for large-scale environments , 1995, I3D '95.

[28]  T. Siméon,et al.  Motion Planning , 2019, Aerial Robotic Manipulation.

[29]  Jing Xiao,et al.  Perceiving guaranteed continuously collision-free robot trajectories in an unknown and unpredictable environment , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[30]  Hirochika Inoue,et al.  The Third International Symposium of Robotics Research , 1986 .

[31]  Panos E. Trahanias,et al.  Predictive autonomous robot navigation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[33]  Mark H. Overmars,et al.  Planning Time-Minimal Safe Paths Amidst Unpredictably Moving Obstacles , 2008, Int. J. Robotics Res..

[34]  Arthur C. Sanderson,et al.  Robot motion planning for sensor-based control with uncertainties , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[35]  Yoshiaki Shirai,et al.  Modeling motion uncertainty of moving obstacles for robot motion planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

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

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

[38]  N. H. C. Yung,et al.  Behavior Prediction Based on Obstacle Motion Patterns in Dynamically Changing Environments , 2008, 2008 IEEE/WIC/ACM International Conference on Web Intelligence and Intelligent Agent Technology.

[39]  Achim Schweikard,et al.  Polynomial time collision detection for manipulator paths specified by joint motions , 1991, IEEE Trans. Robotics Autom..

[40]  Nicholas Roy,et al.  Adapting probabilistic roadmaps to handle uncertain maps , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[41]  Jing Xiao,et al.  An efficient algorithm for on-line determination of collision-free configuration-time points directly from sensor data , 2010, 2010 IEEE International Conference on Robotics and Automation.

[42]  W. Press,et al.  Numerical Recipes: The Art of Scientific Computing , 1987 .

[43]  Gino van den Bergen Proximity Queries and Penetration Depth Computation on 3D Game Objects , 2001 .

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

[45]  David Hsu,et al.  Motion planning under uncertainty for robotic tasks with long time horizons , 2010, Int. J. Robotics Res..

[46]  J. Latombe,et al.  Adaptive dynamic collision checking for single and multiple articulated robots in complex environments , 2005, IEEE Transactions on Robotics.

[47]  T. J. Dekker,et al.  Two Efficient Algorithms with Guaranteed Convergence for Finding a Zero of a Function , 1975, TOMS.

[48]  Torsten Kröger,et al.  On-Line Trajectory Generation in Robotic Systems - Basic Concepts for Instantaneous Reactions to Unforeseen (Sensor) Events , 2010, Springer Tracts in Advanced Robotics.

[49]  Richard P. Brent,et al.  An Algorithm with Guaranteed Convergence for Finding a Zero of a Function , 1971, Comput. J..

[50]  Kai-Tai Song,et al.  Environment prediction for a mobile robot in a dynamic environment , 1997, IEEE Trans. Robotics Autom..

[51]  Hajime Asama,et al.  Inevitable collision states. A step towards safer robots? , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[52]  Darius Burschka,et al.  Real-time reactive motion generation based on variable attractor dynamics and shaped velocities , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[53]  Dinesh Manocha,et al.  Probabilistic Collision Detection Between Noisy Point Clouds Using Robust Classification , 2011, ISRR.

[54]  Ming C. Lin,et al.  Collision Detection between Geometric Models: A Survey , 1998 .

[55]  Ashraf Elnagar,et al.  An adaptive motion prediction model for trajectory planner systems , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[56]  D. Le,et al.  An efficient derivative-free method for solving nonlinear equations , 1985, TOMS.

[57]  Stephen Cameron,et al.  Collision detection by four-dimensional intersection testing , 1990, IEEE Trans. Robotics Autom..

[58]  Ashraf Elnagar,et al.  Motion prediction of moving objects based on autoregressive model , 1998, IEEE Trans. Syst. Man Cybern. Part A.

[59]  Oliver Brock,et al.  Elastic Roadmaps: Globally Task-Consistent Motion for Autonomous Mobile Manipulation in Dynamic Environments , 2006, Robotics: Science and Systems.

[60]  Keum-Shik Hong,et al.  Robust configuration control of a mobile robot with uncertainties , 2011, 2011 8th Asian Control Conference (ASCC).

[61]  Joseph ORourke,et al.  Computational Geometry in C Second Edition , 1998 .

[62]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[63]  Maxim Likhachev,et al.  Time-bounded lattice for efficient planning in dynamic environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[64]  Carme Torras,et al.  3D collision detection: a survey , 2001, Comput. Graph..

[65]  Yoshiaki Shirai,et al.  Mobile robot motion planning considering the motion uncertainty of moving obstacles , 1999, IEEE SMC'99 Conference Proceedings. 1999 IEEE International Conference on Systems, Man, and Cybernetics (Cat. No.99CH37028).

[66]  Dinesh Manocha,et al.  Fast continuous collision detection for articulated models , 2004, SM '04.

[67]  R. W. Brockett,et al.  Asymptotic stability and feedback stabilization , 1982 .

[68]  F. Large,et al.  Using non-linear velocity obstacles to plan motions in a dynamic environment , 2002, 7th International Conference on Control, Automation, Robotics and Vision, 2002. ICARCV 2002..