Incremental Multi-Scale Search Algorithm for Dynamic Path Planning With Low Worst-Case Complexity

Path-planning (equivalently, path-finding) problems are fundamental in many applications, such as transportation, VLSI design, robot navigation, and many more. In this paper, we consider dynamic shortest path-planning problems on a graph with a single endpoint pair and with potentially changing edge weights over time. Several algorithms exist in the literature that solve this problem, notably among them the Lifelong Planning algorithm. The algorithm is an incremental search algorithm that replans the path when there are changes in the environment. In numerical experiments, however, it was observed that the performance of is sensitive in the number of vertex expansions required to update the graph when an edge weight value changes or when a vertex is added or deleted. Although, in most cases, the classical requires a relatively small number of updates, in some other cases the amount of work required by the to find the optimal path can be overwhelming. To address this issue, in this paper, we propose an extension of the baseline algorithm, by making efficient use of a multiscale representation of the environment. This multiscale representation allows one to quickly localize the changed edges, and subsequently update the priority queue efficiently. This incremental multiscale ( for short) algorithm leads to an improvement both in terms of robustness and computational complexity-in the worst case-when compared to the classical . Numerical experiments validate the aforementioned claims.

[1]  Xiaoming Huo,et al.  Beamlab and Reproducible Research , 2004, Int. J. Wavelets Multiresolution Inf. Process..

[2]  Hanan Samet,et al.  Neighbor finding techniques for images represented by quadtrees , 1982, Comput. Graph. Image Process..

[3]  I. Jntroductjon Neighbor Finding Techniques for Images Represented by Quadtrees * , 1980 .

[4]  Ariel Felner,et al.  Theta*: Any-Angle Path Planning on Grids , 2007, AAAI.

[5]  Ju-Jang Lee,et al.  Mobile robot navigation using multi-resolution electrostatic potential field , 2005, 31st Annual Conference of IEEE Industrial Electronics Society, 2005. IECON 2005..

[6]  Bruno Sinopoli,et al.  Vision based navigation for an unmanned aerial vehicle , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[7]  Sven Behnke,et al.  Local Multiresolution Path Planning , 2003, RoboCup.

[8]  Dinesh K. Pai,et al.  Multiresolution rough terrain motion planning , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[9]  Panagiotis Tsiotras,et al.  Beamlet-like data processing for accelerated path-planning using multiscale information of the environment , 2010, 49th IEEE Conference on Decision and Control (CDC).

[10]  Thomas H. Cormen,et al.  Introduction to algorithms [2nd ed.] , 2001 .

[11]  P. Tsiotras,et al.  Multiresolution path planning with wavelets: A local replanning approach , 2008, 2008 American Control Conference.

[12]  Anthony Stentz,et al.  A Guide to Heuristic-based Path Planning , 2005 .

[13]  Anthony Stentz Optimal and Efficient Path Planning for Unknown and Dynamic Environments , 1993 .

[14]  Barry Brumitt,et al.  Framed-quadtree path planning for mobile robots operating in sparse environments , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[15]  Maxim Likhachev,et al.  D*lite , 2002, AAAI/IAAI.

[16]  Xiaoming Huo,et al.  Beamlets and Multiscale Image Analysis , 2002 .

[17]  David Furcy,et al.  Lifelong Planning A , 2004, Artif. Intell..

[18]  Adi Botea,et al.  Near Optimal Hierarchical Path-Finding , 2004, J. Game Dev..

[19]  D. Donoho APPLICATIONS OF BEAMLETS TO DETECTION AND EXTRACTION OF LINES , CURVES AND OBJECTS IN VERY NOISY IMAGES , 2001 .

[20]  David Furcy,et al.  Incremental Heuristic Search in Artificial Intelligence , 2004 .

[21]  Efstathios Bakolas,et al.  A hierarchical on-line path planning scheme using wavelets , 2007, 2007 European Control Conference (ECC).

[22]  Kyu Ho Park,et al.  A fast path planning by path graph optimization , 2003, IEEE Trans. Syst. Man Cybern. Part A.

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

[24]  Panagiotis Tsiotras,et al.  Shortest distance problems in graphs using history-dependent transition costs with application to kinodynamic path planning , 2009, 2009 American Control Conference.

[25]  Michael Buro,et al.  HPA* Enhancements , 2007, AIIDE.

[26]  A. Stentz,et al.  The Field D * Algorithm for Improved Path Planning and Replanning in Uniform and Non-Uniform Cost Environments , 2005 .

[27]  Xiaoming Huo,et al.  Beamlet pyramids: a new form of multiresolution analysis suited for extracting lines, curves, and objects from very noisy image data , 2000, SPIE Optics + Photonics.

[28]  Robert E. Tarjan,et al.  Fibonacci heaps and their uses in improved network optimization algorithms , 1984, JACM.