Path Planning in Complex 3D Environments Using a Probabilistic Roadmap Method

This paper presents a 3D path planning algorithm for an unmanned aerial vehicle (UAV) in complex environments. In this algorithm, the environments are divided into voxels by octree algorithm. In order to satisfy the safety requirement of the UAV, free space is represented by free voxels, which have enough space margin for the UAV to pass through. A bounding box array is created in the whole 3D space to evaluate the free voxel connectivity. The probabilistic roadmap method (PRM) is improved by random sampling in the bounding box array to ensure a more efficient distribution of roadmap nodes in 3D space. According to the connectivity evaluation, the roadmap is used to plan a feasible path by using A* algorithm. Experimental results indicate that the proposed algorithm is valid in complex 3D environments.

[1]  Mingyue Ding,et al.  Phase Angle-Encoded and Quantum-Behaved Particle Swarm Optimization Applied to Three-Dimensional Route Planning for UAV , 2012, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[2]  Stefan Hrabar,et al.  3D path planning and stereo-based obstacle avoidance for rotorcraft UAVs , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Salah Sukkarieh,et al.  3D smooth path planning for a UAV in cluttered natural environments , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Huili Yu,et al.  Vision-based Navigation Frame Mapping and Planning for Collision Avoidance for Miniature Air Vehicles , 2010 .

[5]  Hao Men,et al.  Color point cloud registration with 4D ICP algorithm , 2011, 2011 IEEE International Conference on Robotics and Automation.

[6]  Danwei Wang,et al.  Ground Target Tracking Using UAV with Input Constraints , 2013, J. Intell. Robotic Syst..

[7]  O Hachour,et al.  PATH PLANNING OF AUTONOMOUS MOBILE ROBOT , 2008 .

[8]  Leo Hartman,et al.  Anytime dynamic path-planning with flexible probabilistic roadmaps , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[9]  Dieter Fox,et al.  RGB-D mapping: Using Kinect-style depth cameras for dense 3D modeling of indoor environments , 2012, Int. J. Robotics Res..

[10]  Huosheng Hu,et al.  3D mapping with multi-resolution occupied voxel lists , 2010, Auton. Robots.

[11]  Achim J. Lilienthal,et al.  6D scan registration using depth-interpolated local image features , 2010, Robotics Auton. Syst..

[12]  Michael Bosse,et al.  Place Recognition Using Regional Point Descriptors for 3D Mapping , 2009, FSR.

[13]  David Hsu,et al.  The bridge test for sampling narrow passages with probabilistic roadmap planners , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[14]  D. Erdos,et al.  An experimental UAV system for search and rescue challenge , 2013, IEEE Aerospace and Electronic Systems Magazine.

[15]  Gildardo Sánchez-Ante,et al.  Hybrid PRM Sampling with a Cost-Sensitive Adaptive Strategy , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[16]  Zhuoning Dong,et al.  A hybrid approach of virtual force and A∗ search algorithm for UAV path re-planning , 2011, 2011 6th IEEE Conference on Industrial Electronics and Applications.

[17]  Rosli Omar,et al.  Visibility line based methods for UAV path planning , 2009, 2009 ICCAS-SICE.

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

[19]  Achim J. Lilienthal,et al.  Path planning in 3D environments using the Normal Distributions Transform , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Donald Meagher,et al.  Geometric modeling using octree encoding , 1982, Comput. Graph. Image Process..

[21]  Jizhong Xiao,et al.  An open-source pose estimation system for micro-air vehicles , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[23]  Zhang Qi,et al.  An Improved Heuristic Algorithm for UAV Path Planning in 3D Environment , 2010, 2010 Second International Conference on Intelligent Human-Machine Systems and Cybernetics.

[24]  Mark H. Overmars,et al.  Using Workspace Information as a Guide to Non-uniform Sampling in Probabilistic Roadmap Planners , 2005, Int. J. Robotics Res..

[25]  Mark H. Overmars,et al.  A random approach to motion planning , 1992 .

[26]  Brian C. Williams,et al.  Active detection of drivable surfaces in support of robotic disaster relief missions , 2013, 2013 IEEE Aerospace Conference.

[27]  Nicolas David,et al.  IMPROVING 3D LIDAR POINT CLOUD REGISTRATION USING OPTIMAL NEIGHBORHOOD KNOWLEDGE , 2012 .

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

[29]  Dinesh Manocha,et al.  A hybrid approach for complete motion planning , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[30]  Julian Ryde,et al.  Fast voxel maps with counting bloom filters , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Benjamin J. Southwell,et al.  Human Object Recognition Using Colour and Depth Information from an RGB-D Kinect Sensor , 2013 .

[32]  Zengxi Pan,et al.  Path Planning with a Lazy Significant Edge Algorithm (LSEA) , 2013 .

[33]  Mark H. Overmars,et al.  The Gaussian sampling strategy for probabilistic roadmap planners , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).