Survey of Robot 3D Path Planning Algorithms

Robot 3D three-dimension path planning targets for finding an optimal and collision-free path in a 3D workspace while taking into account kinematic constraints including geometric, physical, and temporal constraints. The purpose of path planning, unlike motion planning which must be taken into consideration of dynamics, is to find a kinematically optimal path with the least time as well as model the environment completely. We discuss the fundamentals of these most successful robot 3D path planning algorithms which have been developed in recent years and concentrate on universally applicable algorithms which can be implemented in aerial robots, ground robots, and underwater robots. This paper classifies all the methods into five categories based on their exploring mechanisms and proposes a category, called multifusion based algorithms. For all these algorithms, they are analyzed from a time efficiency and implementable area perspective. Furthermore a comprehensive applicable analysis for each kind of method is presented after considering their merits and weaknesses.

[1]  Mario J. Valenti,et al.  Three-Dimensional Flight Experiments Using On-Line Mixed-Integer Linear Programming Trajectory Optimization , 2007, 2007 American Control Conference.

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

[3]  Sachin Chitta,et al.  MoveIt! [ROS Topics] , 2012, IEEE Robotics Autom. Mag..

[4]  F. Benjamin Zhan,et al.  Shortest Path Algorithms: An Evaluation Using Real Road Networks , 1998, Transp. Sci..

[5]  John H. Holland,et al.  Adaptation in Natural and Artificial Systems: An Introductory Analysis with Applications to Biology, Control, and Artificial Intelligence , 1992 .

[6]  Dayal R. Parhi,et al.  Modified Shuffled Frog Leaping Algorithm based 6DOF Motion for Underwater Mobile Robot , 2013 .

[7]  Juris Vagners,et al.  PARALLEL EVOLUTIONARY ALGORITHMS FOR UAV PATH PLANNING , 2004 .

[8]  Jizhong Xiao,et al.  Path Planning in Complex 3D Environments Using a Probabilistic Roadmap Method , 2013, Int. J. Autom. Comput..

[9]  Salman Mohagheghi,et al.  Particle Swarm Optimization: Basic Concepts, Variants and Applications in Power Systems , 2008, IEEE Transactions on Evolutionary Computation.

[10]  Giorgio Guglieri,et al.  Path Planning Strategies for UAVS in 3D Environments , 2011, Journal of Intelligent & Robotic Systems.

[11]  Narendra Ahuja,et al.  A potential field approach to path planning , 1992, IEEE Trans. Robotics Autom..

[12]  Jianli Yu,et al.  3D path planning for mobile robots using annealing neural network , 2009, 2009 International Conference on Networking, Sensing and Control.

[13]  Marco Dorigo,et al.  Ant system: optimization by a colony of cooperating agents , 1996, IEEE Trans. Syst. Man Cybern. Part B.

[14]  L. Niu,et al.  AN IMPROVED REAL 3 D A * ALGORITHM FOR DIFFICULT PATH FINDING SITUATION , 2008 .

[15]  Sebastian Scherer,et al.  RRT*-AR: Sampling-based alternate routes planning with applications to autonomous emergency landing of a helicopter , 2013, 2013 IEEE International Conference on Robotics and Automation.

[16]  Reza Olfati-Saber,et al.  Flocking for multi-agent dynamic systems: algorithms and theory , 2006, IEEE Transactions on Automatic Control.

[17]  Shaoping Wang,et al.  Modeling and path planning of the City-Climber robot part II: 3D path planning using mixed integer linear programming , 2009, 2009 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[18]  P. Preux,et al.  PreventingPrematureConvergencevia CooperatingGenetic Algorithms , 1997 .

[19]  Jianda Han,et al.  Relative Coordination 3D Trajectory Generation Based on the Trimmed ACO , 2010, 2010 International Conference on Electrical and Control Engineering.

[20]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[21]  Alexander B. Miller,et al.  3D path planning in a threat environment , 2011, IEEE Conference on Decision and Control and European Control Conference.

[22]  Zhengrong Liang,et al.  Automatic centerline extraction for virtual colonoscopy , 2002, IEEE Transactions on Medical Imaging.

[23]  M. Florian,et al.  The underwater environment , 1987 .

[24]  Riccardo Poli,et al.  Particle swarm optimization , 1995, Swarm Intelligence.

[25]  Kevin E Lansey,et al.  Optimization of Water Distribution Network Design Using the Shuffled Frog Leaping Algorithm , 2003 .

[26]  Jos F. Sturm,et al.  A Matlab toolbox for optimization over symmetric cones , 1999 .

[27]  Youmin Zhang,et al.  Voronoi-Based Coverage Control for Multi-Quadrotor UAVs , 2011 .

[28]  R. Bhattacharya,et al.  OPTRAGEN: A MATLAB Toolbox for Optimal Trajectory Generation , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[29]  Emilio Frazzoli,et al.  Optimal kinodynamic motion planning using incremental sampling-based methods , 2010, 49th IEEE Conference on Decision and Control (CDC).

[30]  Dinesh Manocha,et al.  Reactive deformation roadmaps: motion planning of multiple robots in dynamic environments , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Michael Ian Shamos,et al.  Closest-point problems , 1975, 16th Annual Symposium on Foundations of Computer Science (sfcs 1975).

[32]  Roland Geraerts,et al.  Planning short paths with clearance using explicit corridors , 2010, 2010 IEEE International Conference on Robotics and Automation.

[33]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[34]  Oliver Brock,et al.  Mobile Manipulation [From the Guest Editors] , 2012, IEEE Robotics Autom. Mag..

[35]  Haibin Duan,et al.  Receding horizon control for multi-UAVs close formation control based on differential evolution , 2010, Science China Information Sciences.

[36]  Amir Ali Ahmadi,et al.  Control design along trajectories with sums of squares programming , 2012, 2013 IEEE International Conference on Robotics and Automation.

[37]  Jizhong Xiao,et al.  3D PRM based real-time path planning for UAV in complex environment , 2012, 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO).

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

[39]  Mohammad Pourmahmood Aghababa,et al.  3D path planning for underwater vehicles using five evolutionary optimization algorithms avoiding static and energetic obstacles , 2012 .

[40]  I. Özkol,et al.  Transonic airfoil design and optimisation by using vibrational genetic algorithm , 2003 .

[41]  Pablo Moscato,et al.  A New Memetic Algorithm for the Asymmetric Traveling Salesman Problem , 2004, J. Heuristics.

[42]  Ibrahim Ozkol,et al.  Vibrational genetic algorithm as a new concept in airfoil design , 2002 .

[43]  Chung G. Kang,et al.  Shortest path routing algorithm using Hopfield neural network , 2001 .

[44]  Stefano Carpin,et al.  A genetic algorithm for nonholonomic motion planning , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[45]  Haibin Duan,et al.  Three-dimension path planning for UCAV using hybrid meta-heuristic ACO-DE algorithm , 2010, Simul. Model. Pract. Theory.

[46]  Youmin Zhang,et al.  Flatness-Based Trajectory Planning/Replanning for a Quadrotor Unmanned Aerial Vehicle , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[47]  Hartmut Noltemeier,et al.  Dynamic Voronoi Diagrams in Motion Planning , 1991, Workshop on Computational Geometry.

[48]  William A. Gruver,et al.  A unified approach for robot motion planning with moving polyhedral obstacles , 1990, IEEE Trans. Syst. Man Cybern..

[49]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..

[50]  Deok-Soo Kim,et al.  Region-expansion for the Voronoi diagram of 3D spheres , 2006, Comput. Aided Des..

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

[52]  I. Michael Ross,et al.  A review of pseudospectral optimal control: From theory to flight , 2012, Annu. Rev. Control..

[53]  Daobo Wang,et al.  Modified shuffled frog leaping algorithm for optimization of UAV flight controller , 2011, Int. J. Intell. Comput. Cybern..

[54]  J. Brian Burns,et al.  Path planning using Laplace's equation , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[55]  Valeri Kroumov,et al.  3D PATH PLANNING FOR MOBILE ROBOTS USING SIMULATED ANNEALING NEURAL NETWORK , 2010 .

[56]  Wolfram Burgard,et al.  Occupancy Grid Models for Robot Mapping in Changing Environments , 2012, AAAI.

[57]  Sterling J. Anderson,et al.  An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios , 2010 .

[58]  Rahul Kala,et al.  Rapidly exploring random graphs: motion planning of multiple mobile robots , 2013, Adv. Robotics.

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

[60]  Daniel Vallejo,et al.  OBPRM: an obstacle-based PRM for 3D workspaces , 1998 .

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

[62]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[63]  M. Vermandel,et al.  Dijkstra's algorithm applied to 3D skeletonization of the brain vascular tree: Evaluation and application to symbolic , 2010, 2010 Annual International Conference of the IEEE Engineering in Medicine and Biology.

[64]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[65]  Jonathan P. How,et al.  Aircraft trajectory planning with collision avoidance using mixed integer linear programming , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[66]  Volker Coors,et al.  IMPLEMENTING 3 D NETWORK ANALYSIS IN 3 D-GIS , 2008 .

[67]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[68]  Arthur Richards,et al.  Chapter 1 MULTITASK ALLOCATION AND PATH PLANNING FOR COOPERATING UAVS , 2001 .

[69]  Donguk Kim,et al.  Topology Representation for the Voronoi Diagram of 3D Spheres , 2009 .

[70]  Ellips Masehian,et al.  Robot Path Planning in 3D Space Using Binary Integer Programming , 2007 .

[71]  Ellips Masehian,et al.  A voronoi diagram-visibility graph-potential field compound algorithm for robot path planning , 2004 .

[72]  Sven Koenig,et al.  Fast replanning for navigation in unknown terrain , 2005, IEEE Transactions on Robotics.

[73]  Lydia E. Kavraki,et al.  Randomized preprocessing of configuration for fast path planning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

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

[75]  Stan C. A. M. Gielen,et al.  Neural Network Dynamics for Path Planning and Obstacle Avoidance , 1995, Neural Networks.

[76]  Ellips Masehian,et al.  A voronoi diagram-visibility graph-potential field compound algorithm for robot path planning , 2004, J. Field Robotics.

[77]  Sven Koenig,et al.  Any-Angle Path Planning , 2013, AI Mag..

[78]  Chaomin Luo,et al.  A real-time cooperative sweeping strategy for multiple cleaning robots , 2002, Proceedings of the IEEE Internatinal Symposium on Intelligent Control.

[79]  Morten Bisgaard,et al.  Generating approximative minimum length paths in 3D for UAVs , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[80]  Zvi Shiller,et al.  Optimal obstacle avoidance based on the Hamilton-Jacobi-Bellman equation , 1994, IEEE Trans. Robotics Autom..

[81]  Oliver Brock,et al.  Planning Long Dynamically-Feasible Maneuvers for Autonomous Vehicles , 2009 .

[82]  A. Cour-Harbo,et al.  Configuration Space and Visibility Graph Generation from Geometric Workspaces for UAVs , 2011 .

[83]  C.S. Ma,et al.  MILP optimal path planning for real-time applications , 2006, 2006 American Control Conference.

[84]  Robin Deits,et al.  Footstep planning on uneven terrain with mixed-integer convex optimization , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[85]  Yang Quan Chen,et al.  Linear and nonlinear model predictive control using a general purpose optimal control problem solver RIOTS 95 , 2008, 2008 Chinese Control and Decision Conference.

[86]  Vijay Kumar,et al.  On the generation of smooth three-dimensional rigid body motions , 1998, IEEE Trans. Robotics Autom..

[87]  Pablo Moscato A memetic approach for the travelling salesman problem implementation of a computational ecology for , 1992 .

[88]  Jizhong Xiao,et al.  A literature review of UAV 3D path planning , 2014, Proceeding of the 11th World Congress on Intelligent Control and Automation.

[89]  Jihong Zhu,et al.  A Novel Path Planning Approach Based on AppART and Particle Swarm Optimization , 2005, ISNN.

[90]  N.M. Patrikalakis,et al.  Path Planning of Autonomous Underwater Vehicles for Adaptive Sampling Using Mixed Integer Linear Programming , 2008, IEEE Journal of Oceanic Engineering.

[91]  Thierry Siméon,et al.  Dynamic-Domain RRTs: Efficient Exploration by Controlling the Sampling Domain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[92]  Marc Carreras,et al.  A survey on coverage path planning for robotics , 2013, Robotics Auton. Syst..

[93]  J. Karl Hedrick,et al.  Planning and Estimation An Online Path Planning Framework for Cooperative Search and Localization , 2009 .

[94]  Sven Koenig,et al.  Lazy Theta*: Any-Angle Path Planning and Path Length Analysis in 3D , 2010, SOCS.

[95]  V. Luchnikov,et al.  Voronoi-Delaunay analysis of voids in systems of nonspherical particles. , 1999, Physical review. E, Statistical physics, plasmas, fluids, and related interdisciplinary topics.

[96]  Sven Koenig,et al.  Improved analysis of D* , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[97]  Eliot Winer,et al.  Three-Dimensional Path Planning of Unmanned Aerial Vehicles Using Particle Swarm Optimization , 2006 .

[98]  Y. Volkan Pehlivanoglu,et al.  A new vibrational genetic algorithm enhanced with a Voronoi diagram for path planning of autonomous UAV , 2012 .

[99]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[100]  Yury V. Smirnov,et al.  Hybrid Algorithms for On-Line Search and Combinatorial Optimization Problems , 1997 .

[101]  Ahmed Yousuf Saber,et al.  Scalable unit commitment by memory-bounded ant colony optimization with A∗ local search , 2008 .

[102]  Mauro Birattari,et al.  Dm63 Heuristics for Combinatorial Optimization Ant Colony Optimization Exercises Outline Ant Colony Optimization: the Metaheuristic Application Examples Generalized Assignment Problem (gap) Connection between Aco and Other Metaheuristics Encodings Capacited Vehicle Routing Linear Ordering Ant Colony , 2022 .

[103]  Sven Koenig,et al.  Improved fast replanning for robot navigation in unknown terrain , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[104]  Sangsoo Kim,et al.  Euclidean Voronoi diagrams of 3D spheres and applications to protein structure analysis , 2005 .

[105]  Brian C. Williams,et al.  Conflict-directed A* and its role in model-based embedded systems , 2007, Discret. Appl. Math..

[106]  S. Jaishankar,et al.  3D Off-Line Path Planning For Aerial Vehicle Using Distance Transform Technique , 2011, ICCS.

[107]  Nak Young Chong,et al.  UAV Dynamic Path Planning for Intercepting of a Moving Target: A Review , 2013, FIRA.

[108]  Petros A. Ioannou,et al.  New Potential Functions for Mobile Robot Path Planning , 2000 .

[109]  Alireza Rahimi-Vahed,et al.  A hybrid multi-objective shuffled frog-leaping algorithm for a mixed-model assembly line sequencing problem , 2007, Comput. Ind. Eng..

[110]  Yangquan Chen,et al.  RIOTS―95: a MATLAB toolbox for solving general optimal control problems and its applications to chemical processes , 2002 .

[111]  S.X. Yang,et al.  A neural network approach to complete coverage path planning , 2004, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[112]  B.V.K.V. Kumar,et al.  A neural network architecture for path planning , 1992, [Proceedings 1992] IJCNN International Joint Conference on Neural Networks.

[113]  J. Karl Hedrick,et al.  Autonomous UAV path planning and estimation , 2009, IEEE Robotics & Automation Magazine.

[114]  Shuqing Zhang,et al.  Voronoi diagram and GIS-based 3D path planning , 2009, 2009 17th International Conference on Geoinformatics.

[115]  Flemming Schøler 3D Path Planning for Autonomous Aerial Vehicles in Constrained Spaces , 2012 .