A Dynamical System Approach to Real-time Three-Dimensional Concave Obstacle Avoidance

In this paper, we propose an approach based on Dynamical System (DS) to avoid three-dimensional concave obstacles in real-time. Most three-dimensional concave obstacles can be divided into multiple parts, each of which can be approximated by a convex ellipsoid, and the ellipsoids intersect in pairs. The key of this method is that when the trajectory computed according to the deformed DS reaches a point on the intersection line between two of the convex ellipsoids, the trajectory evolves along the intersection line. We prove that the proposed approach can ensure the impenetrability of the concave obstacles. We validate the effectiveness of the method in the simulations on several different concave objects and experiments on the arm of the UBTECH humanoid robot.

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

[2]  Aude Billard,et al.  Learning Stable Nonlinear Dynamical Systems With Gaussian Mixture Models , 2011, IEEE Transactions on Robotics.

[3]  James J. Kuffner,et al.  Randomized statistical path planning , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[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]  Aude Billard,et al.  Avoidance of Convex and Concave Obstacles With Convergence Ensured Through Contraction , 2019, IEEE Robotics and Automation Letters.

[6]  Tadej Petric,et al.  Smooth continuous transition between tasks on a kinematic control level: Obstacle avoidance as a control problem , 2013, Robotics Auton. Syst..

[7]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[8]  Reid G. Simmons,et al.  The curvature-velocity method for local obstacle avoidance , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[9]  Matteo Saveriano,et al.  Distance based dynamical system modulation for reactive avoidance of moving obstacles , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Matteo Saveriano,et al.  Point cloud based dynamical system modulation for reactive avoidance of convex and concave obstacles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Pradeep K. Khosla,et al.  Real-time obstacle avoidance using harmonic potential functions , 1991, IEEE Trans. Robotics Autom..

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

[13]  Ioannis Iossifidis,et al.  Dynamical Systems Approach for the Autonomous Avoidance of Obstacles and Joint-limits for an Redundant Robot Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

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

[16]  Jean-Jacques E. Slotine,et al.  Real-time path planning using harmonic potentials in dynamic environments , 1997, Proceedings of International Conference on Robotics and Automation.

[17]  Wolfram Burgard,et al.  Online generation of kinodynamic trajectories for non-circular omnidirectional robots , 2011, 2011 IEEE International Conference on Robotics and Automation.

[18]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[19]  Richard M. Murray,et al.  Vehicle motion planning using stream functions , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[20]  Aude Billard,et al.  A dynamical system approach to realtime obstacle avoidance , 2012, Autonomous Robots.

[21]  Stefan Schaal,et al.  Movement reproduction and obstacle avoidance with dynamic movement primitives and potential fields , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.