Skip to main content
Log in

LTA*: Local tangent based A* for optimal path planning

  • Published:
Autonomous Robots Aims and scope Submit manuscript

Abstract

Optimal path planning on non-convex maps is challenging: sampling-based algorithms (such as RRT) do not provide optimal solution in finite time; approaches based on visibility graphs are computationally expensive, while reduced visibility graphs (e.g., tangent graph) fail on such maps. We leverage a well-established, and surprisingly less utilized in path planning, geometrical property of convex decompositions i.e. a concave shape can be decomposed into multiple convex shapes. We propose a novel local tangent based approach, inspired by such convex decompositions, to path planning in non-convex maps. Although our local tangent approach is inspired by geometric convex decompositions, it does not require complex decomposition process. Our second contribution is an efficient corner detection method which reasons on binary pixel occupancy maps. Combined with our novel local tangent approach, which intelligently selects nodes from these corners, we modify the standard A* algorithm by feeding these nodes to its open list. With our local tangent approach, only small number of selected corners are fed to A* open list which keeps its size small even for larger maps, resulting in lower convergence time. We formally prove the optimality of our solution. Simulation on our own maps and public dataset (MAPF http://mapf.info/) as well as real-world experiments show that our proposed LTA* algorithm gives better convergence time and shorter path length in environments with both convex and concave obstacles.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12
Fig. 13
Fig. 14
Fig. 15
Fig. 16
Fig. 17
Fig. 18
Fig. 19

Similar content being viewed by others

Notes

  1. Code, experimental videos, and environments used in this paper are available online: https://github.com/hastedmat/LTA.

References

  • Adiyatov, O., & Varol, H. A. (2013). Rapidly-exploring random tree based memory efficient motion planning. In 2013 IEEE International Conference on Mechatronics and Automation (ICMA) (pp. 354–359). IEEE.

  • Akgun, B., & Stilman, M. (2011). Sampling heuristics for optimal motion planning in high dimensions. In 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (pp. 2640–2645). IEEE.

  • Arslan, O., & Tsiotras, P. (2013). Use of relaxation methods in sampling-based algorithms for optimal motion planning. In 2013 IEEE International Conference on Robotics and Automation (ICRA) (pp. 2421–2428). IEEE.

  • Chazelle, B. (1984). Convex partitions of polyhedra: A lower bound and worst-case optimal algorithm. SIAM Journal on Computing, 13(3), 488–507.

    Article  MathSciNet  Google Scholar 

  • Chazelle, B., & Dobkin, D. P. (1985). Optimal convex decompositions. In Machine Intelligence and pattern recognition (Vol. 2, pp. 63–133). Elsevier.

  • Choudhury, S., Gammell, J. D., Barfoot, T. D., Srinivasa, S. S., & Scherer, S. (2016). Regionally accelerated batch informed trees (rabit*): A framework to integrate local information into optimal path planning. In 2016 IEEE International Conference on Robotics and Automation (ICRA) (pp. 4207–4214). IEEE.

  • Devaurs, D., Siméon, T., & Cortés, J. (2016). Optimal path planning in complex cost spaces with sampling-based algorithms. IEEE Transactions on Automation Science and Engineering, 13(2), 415–424.

    Article  Google Scholar 

  • Dijkstra, E. W. (1959). A note on two problems in connexion with graphs. Numerische mathematik, 1(1), 269–271.

    Article  MathSciNet  Google Scholar 

  • Gammell, J. D., Srinivasa, S. S., & Barfoot, T. D. (2014). Informed rrt*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic. In 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2014) (pp. 2997–3004). IEEE.

  • Gammell, J. D., Srinivasa, S. S., & Barfoot, T. D. (2015). Batch informed trees (bit*): Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs. In 2015 IEEE International Conference on Robotics and Automation (ICRA) (pp. 3067–3074). IEEE.

  • Ghosh, S. K. (1997). On recognizing and characterizing visibility graphs of simple polygons. Discrete & Computational Geometry, 17(2), 143–162.

    Article  MathSciNet  Google Scholar 

  • Hart, P. E., Nilsson, N. J., & Raphael, B. (1968). A formal basis for the heuristic determination of minimum cost paths. IEEE Transactions on Systems Science and Cybernetics, 4(2), 100–107.

    Article  Google Scholar 

  • Hauer, F., & Tsiotras, P. (2017). Deformable rapidly-exploring random trees. In Proceedings of Robotics: Science and Systems, Cambridge, Massachusetts. https://doi.org/10.15607/RSS.2017.XIII.008.

  • Huang, H. P., & Chung, S. Y. (2004). Dynamic visibility graph for path planning. In 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2004). Proceedings (Vol. 3, pp. 2813–2818). IEEE.

  • Ishida, T. (1998). Real-time search for autonomous agents and multiagent systems. Autonomous Agents and Multi-Agent Systems, 1(2), 139–167.

    Article  Google Scholar 

  • Janson, L., Hu, T., & Pavone, M. (2018). Safe motion planning in unknown environments: Optimality benchmarks and tractable policies. In Proceedings of Robotics: Science and Systems, Pittsburgh, Pennsylvania. https://doi.org/10.15607/RSS.2018.XIV.061.

  • Karaman, S., & Frazzoli, E. (2010). Optimal kinodynamic motion planning using incremental sampling-based methods. In 2010 49th IEEE Conference on Decision and Control (CDC) (pp. 7681–7687). IEEE.

  • Karaman, S., & Frazzoli, E. (2011). Sampling-based algorithms for optimal motion planning. The International Journal of Robotics Research, 30(7), 846–894.

    Article  Google Scholar 

  • Kavraki, L. E., Svestka, P., Latombe, J. C., & Overmars, M. H. (1996). Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Transactions on Robotics and Automation, 12(4), 566–580.

    Article  Google Scholar 

  • Khatib, O. (1986). Real-time obstacle avoidance for manipulators and mobile robots. The International Journal Of Robotics Research, 5(1), 90–98.

    Article  Google Scholar 

  • Kim, J. O., & Khosla, P. K. (1992). Real-time obstacle avoidance using harmonic potential functions. IEEE Transactions on Robotics and Automation, 8(3), 338–349.

    Article  Google Scholar 

  • Koenig, S., & Likhachev, M. (2002). Improved fast replanning for robot navigation in unknown terrain. In IEEE International Conference on Robotics and Automation, 2002. Proceedings. ICRA39;02 (Vol. 1, pp. 968–975). IEEE.

  • Koenig, S., & Likhachev, M. (2006). Real-time adaptive A. In Proceedings of the fifth international joint conference on Autonomous agents and multiagent systems (pp. 281–288). ACM.

  • Koenig, S., Likhachev, M., & Furcy, D. (2004). Lifelong planning A. Artificial Intelligence, 155(1–2), 93–146.

    Article  MathSciNet  Google Scholar 

  • Korf, R. E. (1985). Depth-first iterative-deepening: An optimal admissible tree search. Artificial Intelligence, 27(1), 97–109.

    Article  MathSciNet  Google Scholar 

  • Korf, R. E. (1990). Real-time heuristic search. Artificial Intelligence, 42(2–3), 189–211.

    Article  Google Scholar 

  • LaValle, S. M. (1998). Rapidly-exploring random trees: A new tool for path planning. Report No. TR 98-11, Computer Science Department, Iowa State University. Available at http://janowiec.cs.iastate.edu/papers/rrt.ps.

  • Liu, Y. H., & Arimoto, S. (1992). Path planning using a tangent graph for mobile robots among polygonal and curved obstacles: Communication. The International Journal of Robotics Research, 11(4), 376–382.

    Article  Google Scholar 

  • Lozano-Prez, T., & Wesley, M. A. (1979). An algorithm for planning collision-free paths among polyhedral obstacles. Communications of the ACM, 22(10), 560–570.

    Article  Google Scholar 

  • Persson, S. M., & Sharf, I. (2014). Sampling-based A* algorithm for robot path-planning. The International Journal of Robotics Research, 33(13), 1683–1708.

    Article  Google Scholar 

  • Qureshi, A. H., & Ayaz, Y. (2015). Intelligent bidirectional rapidly-exploring random trees for optimal motion planning in complex cluttered environments. Robotics and Autonomous Systems, 68, 1–11.

    Article  Google Scholar 

  • Rahman, A., & Al-Jumaily, A. (2013). Design and development of a bilateral therapeutic hand device for stroke rehabilitation. International Journal of Advanced Robotic Systems, 10(12), 405.

    Article  Google Scholar 

  • Russell, S. J. (1992). Efficient memory-bounded search methods. ECAI, 92, 1–5.

    Google Scholar 

  • Shi, C., Zhang, M., & Peng, J. (2007). Harmonic potential field method for autonomous ship navigation. In 7th International Conference on ITS Telecommunications. ITST39;07 (pp. 1– 6). IEEE.

  • Stentz, A. (1994). Optimal and efficient path planning for partially-known environments. In 1994 IEEE International Conference on Robotics and Automation. Proceedings (pp. 3310–3317). IEEE.

  • Stern, R., Sturtevant, N. R., Felner, A., Koenig, S., Ma, H., Walker, T. T., et al. (2019). Multi-agent pathfinding: Definitions, variants, and benchmarks. In Symposium on Combinatorial Search (SoCS), pp. 151–158.

  • Sun, X., & Koenig, S. (2007). The fringe-saving A* search algorithm—A feasibility study. IJCAI, 7, 2391–2397.

    Google Scholar 

  • Tang, L., Dian, S., Gu, G., Zhou, K., Wang, S., & Feng, X. (2010). A novel potential field method for obstacle avoidance and path planning of mobile robot. In 2010 3rd IEEE International Conference on Computer Science and Information Technology (ICCSIT) (Vol. 9, pp. 633–637). IEEE.

  • Vadlamudi, S. G., Aine, S., & Chakrabarti, P. P. (2011). Memory-bounded anytime heuristic-search algorithm. IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics), 41(3), 725–735.

    Article  Google Scholar 

  • Webb, D.J., & van den Berg, J. (2013). Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics. In 2013 IEEE International Conference on Robotics and Automation (ICRA) (pp. 5054–5061). IEEE.

  • Yoshizumi, T., Miura, T., & Ishida, T. (2000). A* with partial expansion for large branching factor problems. In AAAI/IAAI, pp. 923– 929.

Download references

Acknowledgements

This research has been funded by Higher Education Commission (HEC), Govt of Pakistan through its research Grant 6025/Federal/NRPU/R&D/HEC/2016.

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Muhammad Latif Anjum.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Zafar, M.M., Anjum, M.L. & Hussain, W. LTA*: Local tangent based A* for optimal path planning. Auton Robot 45, 209–227 (2021). https://doi.org/10.1007/s10514-020-09956-3

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10514-020-09956-3

Keywords

Navigation