Abstract
This paper presents a method to avoid collisions and deadlocks between mobile robots working collaboratively in a shared physical environment. Based on the shared knowledge of the robot’s direction and coordinates, we define five conflict types between robots and propose a new concept named Artificial Untraversable Vertex (AUV) to resolve the potential conflicts. Since conflict avoidance between robots is typically a real-time process, a heuristic search algorithm D* Lite with fast replanning characteristics is introduced. Once a robot finds that it may collide with another robot while moving along the preplanned path, a new conflict-free path can be calculated based on the AUV and D* Lite. The experimental results demonstrate that the proposed Multi-Robot Path Planning (MRPP) method can effectively avoid collisions and deadlocks between mobile robots.
Similar content being viewed by others
Data availability
All data, models generated or used during the study are available from the corresponding author by request.
Code availability
All codes generated or used during the study are available from the corresponding author by request.
References
Chopra S, Notarstefano G, Rice M, Egerstedt M (2017) A distributed version of the hungarian method for multirobot assignment. IEEE Trans Robot 33(4):932–947
Feng Z, Sun C, Hu G (2016) Robust connectivity preserving rendezvous of multirobot systems under unknown dynamics and disturbances. IEEE Trans Control Netw Syst 4(4):725–735
Rizk Y, Awad M, Tunstel EW (2019) Cooperative heterogeneous multi-robot systems: a survey. ACM Comput Surv 52(2):1–31
Roldán JJ, Garcia-Aunon P, Garzón M, De León J, Del Cerro J, Barrientos A (2016) Heterogeneous multi-robot system for mapping environmental variables of greenhouses. Sensors 16(7):1018
Das PK, Jena PK (2020) Multi-robot path planning using improved particle swarm optimization algorithm through novel evolutionary operators. Appl Soft Comput 106312
Nath A, Arun AR, Niyogi R (2019) A distributed approach for road clearance with multi-robot in urban search and rescue environment. Int J Intell Robot Appl 3(4):392–406
Di Nuovo A, Broz F, Wang N, Belpaeme T, Cangelosi A, Jones R, Dario P (2018) The multi-modal interface of robot-era multi-robot services tailored for the elderly. Intell Serv Robot 11(1):109–126
Nagavarapu SC, Vachhani L, Sinha A (2016) Multi-robot graph exploration and map building with collision avoidance: a decentralized approach. J Intell Robot Syst 83(3):503–523
Dai X, Jiang L, Zhao Y (2016) Cooperative exploration based on supervisory control of multi-robot systems. Appl Intell 45(1):18–29
Li Z, Barenji AV, Jiang J, Zhong RY, Xu G (2020) A mechanism for scheduling multi robot intelligent warehouse system face with dynamic demand. J Intell Manuf 31(2):469–480
Viet HH, Dang VH, Choi S, Chung TC (2015) BoB: an online coverage approach for multi-robot systems. Appl Intell 42(2):157–173
Liu Y, Nejat G (2016) Multirobot cooperative learning for semiautonomous control in urban search and rescue applications. J Field Robot 33(4):512–536
Gans NR, Rogers JG (2021) Cooperative multirobot systems for military applications. Curr Robot Rep:1–7
Kantaros Y, Zavlanos MM (2016) Global planning for multi-robot communication networks in complex environments. IEEE Trans Robot 32(5):1045–1061
Schuster MJ, Schmid K, Brand C, Beetz M (2019) Distributed stereo vision-based 6D localization and mapping for multi-robot teams. J Field Robot 36(2):305–332
Serpen G, Dou C (2015) Automated robotic parking systems: real-time, concurrent and multi-robot path planning in dynamic environments. Appl Intell 42(2):231–251
Fazlollahtabar H, Hassanli S (2018) Hybrid cost and time path planning for multiple autonomous guided vehicles. Appl Intell 48(2):482–498
Paden B, Čáp M, Yong SZ, Yershov D, Frazzoli E (2016) A survey of motion planning and control techniques for self-driving urban vehicles. IEEE Trans Intell Vehic 1(1):33–55
Deplano D, Franceschelli M, Ware S, Rong S, Giua A (2020) A discrete event formulation for multi-robot collision avoidance on pre-planned trajectories. IEEE Access 8:92637–92646
Zhou Y, Hu H, Liu Y, Ding Z (2017) Collision and deadlock avoidance in multirobot systems: a distributed approach. IEEE Trans Syst Man Cyber Syst 47(7):1712–1726
Tran VP, Garratt MA, Petersen IR (2020) Switching formation strategy with the directed dynamic topology for collision avoidance of a multi-robot system in uncertain environments. IET Control Theory & Applications 14(18):2948–2959
Oral T, Polat F (2015) MOD* lite: an incremental path planning algorithm taking care of multiple objectives. IEEE Trans Cybern 46(1):245–257
Zhou Y, Hu H, Liu Y, Lin SW, Ding ZH (2020) A distributed method to avoid higher-order deadlocks in multi-robot systems. Automatica 112:108706
Liu F, Narayanan A (2011) Real time replanning based on a* for collision avoidance in multi-robot systems, In 2011 8th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI), pp. 473–479
Precup RE, Voisan EI, Petriu EM, Tomescu ML, David RC, Szedlak-Stinean AI, Roman RC (2020) Grey wolf optimizer-based approaches to path planning and fuzzy logic-based tracking control for mobile robots. Int J Comput Commun Control 15(3)
Wei C, Hindriks KV, Jonker CM (2016) Altruistic coordination for multi-robot cooperative pathfinding. Appl Intell 44(2):269–281
Chen L, Zhao Y, Zhao H, Zheng B (2021) Non-communication decentralized multi-robot collision avoidance in grid map workspace with double deep Q-network. Sensors 21(3):841
Yu J, LaValle SM (2016) Optimal multirobot path planning on graphs: complete algorithms and effective heuristics. IEEE Trans Robot 32(5):1163–1177
Sharon G, Stern R, Felner A, Sturtevant NR (2015) Conflict-based search for optimal multi-agent pathfinding. Artif Intell 219:40–66
Sharon G, Stern R, Goldenberg M, Felner A (2013) The increasing cost tree search for optimal multi-agent pathfinding. Artif Intell 195:470–495
Wagner G, Choset H (2015) Subdimensional expansion for multirobot path planning. Artif Intell 219:1–24
Long P, Fan T, Liao X, Liu W, Zhang H, Pan J (2018) Towards optimally decentralized multi-robot collision avoidance via deep reinforcement learning, In 2018 IEEE International Conference on Robotics and Automation (ICRA), pp. 6252–6259
He W, Qi X, Liu L (2021) A novel hybrid particle swarm optimization for multi-UAV cooperate path planning. Appl Intell:1–15
Das PK, Behera HS, Jena PK, Panigrahi BK (2016) Multi-robot path planning in a dynamic environment using improved gravitational search algorithm. J Electric Syst Inform Technol 3(2):295–313
Hidalgo-Paniagua A, Vega-Rodríguez MA, Ferruz J, Pavón N (2017) Solving the multi-objective path planning problem in mobile robotics with a firefly-based approach. Soft Comput 21(4):949–964
Precup RE, Petriu EM, Radae MB, Voisan EI, Dragan F (2015) Adaptive charged system search approach to path planning for multiple mobile robots. IFAC-PapersOnLine 48(10):294–299
Zhang Y, Zhnag YN, Liu XD (2019) Path planning of multiple industrial mobile robots based on ant colony algorithm, In Proceedings of 2019 16th International Computer Conference on Wavelet Active Media Technology and Information Processing, pp. 406–409
Contreras-Cruz MA, Lopez-Perez JJ, Ayala-Ramirez V (2017) Distributed path planning for multi-robot teams based on artificial bee colony, In Proceedings of 2017 IEEE Congress on Evolutionary Computation (CEC), pp. 541–548
Jose K, Pratihar DK (2016) Task allocation and collision-free path planning of centralized multi-robots system for industrial plant inspection using heuristic methods. Robot Auton Syst 80:34–42
Park H, Hutchinson SA (2017) Fault-tolerant rendezvous of multirobot systems. IEEE Trans Robot 33(3):565–582
Dewangan RK, Shukla A, Godfrey WW (2017) Survey on prioritized multi robot path planning, In 2017 IEEE international conference on smart technologies and management for computing, communication, controls, energy and materials (ICSTM), pp. 423–428)
Matoui F, Boussaid B, Abdelkrim MN (2019) Distributed path planning of a multi-robot system based on the neighborhood artificial potential field approach. Simulation 95(7):637–657
Ma X, Jiao Z, Wang Z, Panagou D (2016) Decentralized prioritized motion planning for multiple autonomous uavs in 3d polygonal obstacle environments, In 2016 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 292–300
Čáp M, Novák P, Kleiner A, Selecký M (2015) Prioritized planning algorithms for trajectory coordination of multiple mobile robots. IEEE Trans Autom Sci Eng 12(3):835–849
Yakovlev K, Andreychuk A (2017) Any-angle pathfinding for multiple agents based on SIPP algorithm. Proceedings of the International Conference on Automated Planning and Scheduling 27(1)
Zhao T, Li H, Dian S (2020) Multi-robot path planning based on improved artificial potential field and fuzzy inference system. J Intell Fuzzy Syst 39(5):7621–7637
Nazarahari M, Khanmirza E, Doostie S (2019) Multi-objective multi-robot path planning in continuous environment using an enhanced genetic algorithm. Expert Syst Appl 115:106–120
Reyes NH, Barczak AL, Susnjak T, Jordan A (2017) Fast and smooth replanning for navigation in partially unknown terrain: the hybrid fuzzy-D* lite algorithm. In: Robot intelligence technology and applications 4. Pp. 31–41
Liu F, Narayanan A (2014) Collision avoidance and swarm robotic group formation. International Journal of Advanced Computer Science 4(2):64–70
Koenig S, Likhachev M (2005) Fast replanning for navigation in unknown terrain. IEEE Trans Robot 21(3):354–363
Han SD, Yu J (2020) Ddm: fast near-optimal multi-robot path planning using diversified-path and optimal sub-problem solution database heuristics. IEEE Robot Autom Lett 5(2):1350–1357
Funding
This work is supported by the Sichuan Science and Technology Program (2020YFG0115) and Chengdu Science and Technology Program (2019-YF05-00958-SN).
Author information
Authors and Affiliations
Contributions
The study is conceived and designed by Haodong Li. The first draft of the manuscript was written by Haodong Li and Tao Zhao, and revised by Tao Zhao and Songyi Dian. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Conflict of interest
The authors have no conflicts of interest to declare that are relevant to the content of this article.
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
Li, H., Zhao, T. & Dian, S. Prioritized planning algorithm for multi-robot collision avoidance based on artificial untraversable vertex. Appl Intell 52, 429–451 (2022). https://doi.org/10.1007/s10489-021-02397-0
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10489-021-02397-0