Three-Dimensional Shortest Path Planning in the Presence of Polyhedral Obstacles

A new algorithm is presented for solving the three-dimensional shortest path planning (3DSP) problem for a point object moving among convex polyhedral obstacles. It is the first non-approximate three-dimensional path planing algorithm that can deal with more than two polyhedral obstacles. The algorithm extends the visibility graph concept from two dimensions to three dimensions. The two main problems with 3DSP are identifying the edge sequence the shortest path passes through and the turning points of the shortest path. A technique based on projective relationships is presented for identifying the set of visible boundary edges (VBE) corresponding to a given view point over which the shortest path, from the view point to the goal, will pass. VBE are used to construct an initial reduced visibility graph (RVG). Optimization is used to revise the position of the turning points and hence the three-dimensional RVG (3DRVG) and the global shortest path is then selected from the 3DRVG. The algorithm is of computational complexity O(n3vk), where n is the number of verticles, v is the maximum number of vertices on any one obstacle and k is the number of obstacles. The algorithm is applicable only with polyhedral obstacles, as the theorems developed for searching for the turning points of the three-dimensional shortest path are based on straight edges of the obstacles. It needs to be further developed for dealing with arbitrary-shaped obstacles and this would increase the computational complexity. The algorithm is tested using computer simulations and some results are presented.

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

[2]  Narendra Ahuja,et al.  Interference Detection and Collision Avoidance Among Three Dimensional Objects , 1980, AAAI.

[3]  Micha Sharir,et al.  On shortest paths in polyhedral spaces , 1986, STOC '84.

[4]  Bernard Faverjon,et al.  Obstacle avoidance using an octree in the configuration space of a manipulator , 1984, ICRA.

[5]  D. Mount.  On Finding Shortest Paths on Convex Polyhedra. , 1985 .

[6]  Christos H. Papadimitriou,et al.  An Algorithm for Shortest-Path Motion in Three Dimensions , 1985, Inf. Process. Lett..

[7]  Larry S. Davis,et al.  Multiresolution path planning for mobile robots , 1986, IEEE J. Robotics Autom..

[8]  Micha Sharir,et al.  On Shortest Paths in Polyhedral Spaces , 1986, SIAM J. Comput..

[9]  Joseph S. B. Mitchell,et al.  The Discrete Geodesic Problem , 1987, SIAM J. Comput..

[10]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[11]  Hanan Samet,et al.  A hierarchical strategy for path planning among moving obstacles [mobile robot] , 1989, IEEE Trans. Robotics Autom..

[12]  Ioannis G. Tollis,et al.  Path planning in the presence of vertical obstacles , 1990, IEEE Trans. Robotics Autom..

[13]  Yunhui Liu,et al.  Proposal of tangent graph and extended tangent graph for path planning of mobile robots , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[14]  Kang G. Shin,et al.  Shortest path planning in discretized workspaces using dominance relation , 1991, IEEE Trans. Robotics Autom..

[15]  Mahmoud Tarokh.  Fast Path Planning For Robot Manipulators , 1992, Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Robert L. Williams,et al.  Determination of minimum three-dimensional cutting-tool paths in the presence of barriers , 1993 .

[17]  James A. Storer,et al.  A single-exponential upper bound for finding shortest paths in three dimensions , 1994, JACM.