Skip to main content
Log in

Prioritized planning algorithm for multi-robot collision avoidance based on artificial untraversable vertex

  • Published:
Applied Intelligence Aims and scope Submit manuscript

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.

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
Fig. 20
Fig. 21
Fig. 22
Fig. 23
Fig. 24
Fig. 25
Fig. 26
Fig. 27
Fig. 28
Fig. 29
Fig. 30
Fig. 31
Fig. 32
Fig. 33
Fig. 34
Fig. 35
Fig. 36
Fig. 37
Fig. 38
Fig. 39
Fig. 40
Fig. 41
Fig. 42
Fig. 43
Fig. 44
Fig. 45
Fig. 46
Fig. 47
Fig. 48
Fig. 49
Fig. 50
Fig. 51
Fig. 52
Fig. 53
Fig. 54

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

  1. 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

    Article  Google Scholar 

  2. 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

    Article  MathSciNet  Google Scholar 

  3. Rizk Y, Awad M, Tunstel EW (2019) Cooperative heterogeneous multi-robot systems: a survey. ACM Comput Surv 52(2):1–31

    Article  Google Scholar 

  4. 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

    Article  Google Scholar 

  5. Das PK, Jena PK (2020) Multi-robot path planning using improved particle swarm optimization algorithm through novel evolutionary operators. Appl Soft Comput 106312

  6. 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

    Article  Google Scholar 

  7. 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

    Article  Google Scholar 

  8. 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

    Article  Google Scholar 

  9. Dai X, Jiang L, Zhao Y (2016) Cooperative exploration based on supervisory control of multi-robot systems. Appl Intell 45(1):18–29

    Article  Google Scholar 

  10. 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

    Article  Google Scholar 

  11. Viet HH, Dang VH, Choi S, Chung TC (2015) BoB: an online coverage approach for multi-robot systems. Appl Intell 42(2):157–173

    Article  Google Scholar 

  12. Liu Y, Nejat G (2016) Multirobot cooperative learning for semiautonomous control in urban search and rescue applications. J Field Robot 33(4):512–536

    Article  Google Scholar 

  13. Gans NR, Rogers JG (2021) Cooperative multirobot systems for military applications. Curr Robot Rep:1–7

  14. Kantaros Y, Zavlanos MM (2016) Global planning for multi-robot communication networks in complex environments. IEEE Trans Robot 32(5):1045–1061

    Article  Google Scholar 

  15. 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

    Article  Google Scholar 

  16. 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

    Article  Google Scholar 

  17. Fazlollahtabar H, Hassanli S (2018) Hybrid cost and time path planning for multiple autonomous guided vehicles. Appl Intell 48(2):482–498

    Article  Google Scholar 

  18. 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

    Article  Google Scholar 

  19. 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

    Google Scholar 

  20. 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

    Article  Google Scholar 

  21. 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

    Article  Google Scholar 

  22. Oral T, Polat F (2015) MOD* lite: an incremental path planning algorithm taking care of multiple objectives. IEEE Trans Cybern 46(1):245–257

    Article  Google Scholar 

  23. 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

    Article  MathSciNet  Google Scholar 

  24. 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

  25. 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)

  26. Wei C, Hindriks KV, Jonker CM (2016) Altruistic coordination for multi-robot cooperative pathfinding. Appl Intell 44(2):269–281

    Article  Google Scholar 

  27. 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

    Article  Google Scholar 

  28. Yu J, LaValle SM (2016) Optimal multirobot path planning on graphs: complete algorithms and effective heuristics. IEEE Trans Robot 32(5):1163–1177

    Article  Google Scholar 

  29. Sharon G, Stern R, Felner A, Sturtevant NR (2015) Conflict-based search for optimal multi-agent pathfinding. Artif Intell 219:40–66

    Article  MathSciNet  Google Scholar 

  30. Sharon G, Stern R, Goldenberg M, Felner A (2013) The increasing cost tree search for optimal multi-agent pathfinding. Artif Intell 195:470–495

    Article  MathSciNet  Google Scholar 

  31. Wagner G, Choset H (2015) Subdimensional expansion for multirobot path planning. Artif Intell 219:1–24

    Article  MathSciNet  Google Scholar 

  32. 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

  33. He W, Qi X, Liu L (2021) A novel hybrid particle swarm optimization for multi-UAV cooperate path planning. Appl Intell:1–15

  34. 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

    Article  Google Scholar 

  35. 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

    Article  Google Scholar 

  36. 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

    Article  Google Scholar 

  37. 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

  38. 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

  39. 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

    Article  Google Scholar 

  40. Park H, Hutchinson SA (2017) Fault-tolerant rendezvous of multirobot systems. IEEE Trans Robot 33(3):565–582

    Article  Google Scholar 

  41. 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)

  42. 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

    Article  Google Scholar 

  43. 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

  44. Čá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

    Article  Google Scholar 

  45. 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)

  46. 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

    Article  Google Scholar 

  47. 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

    Article  Google Scholar 

  48. 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

    Google Scholar 

  49. Liu F, Narayanan A (2014) Collision avoidance and swarm robotic group formation. International Journal of Advanced Computer Science 4(2):64–70

    Google Scholar 

  50. Koenig S, Likhachev M (2005) Fast replanning for navigation in unknown terrain. IEEE Trans Robot 21(3):354–363

    Article  Google Scholar 

  51. 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

    Article  Google Scholar 

Download references

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

Authors

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

Correspondence to Tao Zhao.

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

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

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

Download citation

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10489-021-02397-0

Keywords

Navigation