Path planning method with obstacle avoidance for manipulators in dynamic environment

Obstacle avoidance is of great importance for path planning of manipulators in dynamic environment. To help manipulators successfully perform tasks, a method of path planning with obstacle avoidance is proposed in this article. It consists of two consecutive phases, namely, collision detection and obstacle-avoidance path planning. The collision detection is realized by establishing point-cloud model and testing intersection of axis-aligned bounding boxes trees, while obstacle-avoidance path planning is achieved through preplanning a global path and adjusting it in real time. This article has the following contributions. The point-cloud model is of high resolution while the speed of collision detection is improved, and collision points can be found exactly. The preplanned global path is optimized based on the improved D-star algorithm, which reduces inflection points and decreases collision probability. The real-time path adjusting strategy satisfies the requirement of reachability and obstacle avoidance for manipulators in dynamic environment. Simulations and experiments are carried out to evaluate the validity of the proposed method, and the method is available to manipulators of any degree of freedom in dynamic environment.

[1]  Jae-Bok Song,et al.  Collision Detection Algorithm to Distinguish Between Intended Contact and Unexpected Collision , 2012, Adv. Robotics.

[2]  Juan Carlos Arevalo,et al.  Identifying Ground-Robot Impedance to Improve Terrain Adaptability in Running Robots , 2015 .

[3]  Xue Jing Ding,et al.  Research on Collision Detection Algorithm Based on OBB , 2013 .

[4]  Anthony Stentz,et al.  The Focussed D* Algorithm for Real-Time Replanning , 1995, IJCAI.

[5]  N. Jawahar,et al.  Automated Trajectory Planner of Industrial Robot for Pick-and-Place Task , 2013 .

[6]  Yasar Ayaz,et al.  Triangular Geometrized Sampling Heuristics for Fast Optimal Motion Planning , 2015 .

[7]  Anupam Shukla,et al.  Fusion of probabilistic A* algorithm and fuzzy inference system for robotic path planning , 2010, Artificial Intelligence Review.

[8]  Kam K. Leang,et al.  On-board model-based automatic collision avoidance: application in remotely-piloted unmanned aerial vehicles , 2017, Auton. Robots.

[9]  Shui-Nee Chow,et al.  Method of evolving junctions: A new approach to optimal path-planning in 2D environments with moving obstacles , 2017, Int. J. Robotics Res..

[10]  S. Liu,et al.  Obstacle Avoidance Path Planning of Space Manipulator Based on Improved Artificial Potential Field Method , 2014 .

[11]  In Hwan Sul.  Fast cloth collision detection using collision matrix , 2010 .

[12]  Jing Xiao,et al.  An efficient algorithm for real time collision detection involving a continuum manipulator with multiple uniform-curvature sections , 2014, Robotica.

[13]  Mengyin Fu,et al.  Robot manipulator self-identification for surrounding obstacle detection , 2016, Multimedia Tools and Applications.

[14]  Shuxiang Guo,et al.  Collision detection algorithm based on AABB for Minimally Invasive Surgery , 2014, 2014 IEEE International Conference on Mechatronics and Automation.

[15]  Anthony Stentz,et al.  Using interpolation to improve path planning: The Field D* algorithm , 2006, J. Field Robotics.

[16]  Meng Chen,et al.  Dynamic obstacle avoidance for manipulators using distance calculation and discrete detection , 2018 .

[17]  Gang Chen,et al.  Repetitive Motion Planning of Free-Floating Space Manipulators , 2013 .

[18]  Xue Jian,et al.  Adaptive Controller for 6-DOF Parallel Robot Using T-S Fuzzy Inference , 2013 .

[19]  Shuming Gao,et al.  IBCD: a fast collision detection algorithm based on image space using OBB , 2003, Comput. Animat. Virtual Worlds.

[20]  A. Matveev,et al.  Algorithms for collision-free navigation of mobile robots in complex cluttered environments: a survey , 2014, Robotica.

[21]  Gheorghe Leonte Mogan,et al.  Obstacle avoidance of redundant manipulators using neural networks based reinforcement learning , 2012 .

[22]  Lina,et al.  Fuzzy-Appearance Manifold and Fuzzy-Nearest Distance Calculation for Model-Less 3D Pose Estimation of Degraded Face Images , 2013 .

[23]  Li-Yong Shen,et al.  Tool orientation optimization for 5-axis machining with C-space method , 2017 .

[24]  Yu Liu,et al.  Obstacle avoidance for redundant manipulators based on a Novel Gradient Projection Method with a functional scalar , 2010, 2010 IEEE International Conference on Robotics and Biomimetics.

[25]  Tran Duc Tang,et al.  A new collision avoidance strategy and its integration with collision detection for five-axis NC machining , 2015 .

[26]  Jing Xiao,et al.  Detection of robustly collision-free trajectories in unpredictable environments in real-time , 2014, Auton. Robots.