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.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Notes
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.
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.
Dijkstra, E. W. (1959). A note on two problems in connexion with graphs. Numerische mathematik, 1(1), 269–271.
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.
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.
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.
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.
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.
Khatib, O. (1986). Real-time obstacle avoidance for manipulators and mobile robots. The International Journal Of Robotics Research, 5(1), 90–98.
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.
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.
Korf, R. E. (1985). Depth-first iterative-deepening: An optimal admissible tree search. Artificial Intelligence, 27(1), 97–109.
Korf, R. E. (1990). Real-time heuristic search. Artificial Intelligence, 42(2–3), 189–211.
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.
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.
Persson, S. M., & Sharf, I. (2014). Sampling-based A* algorithm for robot path-planning. The International Journal of Robotics Research, 33(13), 1683–1708.
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.
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.
Russell, S. J. (1992). Efficient memory-bounded search methods. ECAI, 92, 1–5.
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.
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.
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.
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
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
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
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-020-09956-3