Abstract
Multi-robot path planning in 3D environment is a complex and challenging task that needs to consider not only the high quality and safety of the paths, but also the coordination between robots. Aiming at this problem, a collaborative 3D path planning scheme using game theory and particle swarm optimization hybrid method (GTPHM) is presented in paper. Firstly, a cost function is formulated to transform path planning into an optimization problem, for which the multi-robot space motion equation is designed to satisfy the dynamic constraints. Then, a game theory-based multi-robot path planning framework is established, using collision costs and multi-objective heuristic functions as game gains to maintain the game-theoretic interaction between robots. In the improved particle swarm optimization algorithm (PSO), the particle space position transformation method designed according to the three-dimensional space vector, used as a strategy update mechanism based on game theory. For collisions avoidance between robots, each robot adjusts its cooperative strategy based on the behavior of the other robots. Each robot chooses the optimal cooperative strategy, and then gradually approaches the Nash equilibrium. Comparative experimental results show that GTPHM can effectively guide multi-robot to plan a safe and collision-free path from the starting point to the target point in mountain and city complex 3D environment.

























Similar content being viewed by others
Data availability
No datasets were generated or analyzed during the current study.
References
Wei S, Yang-He F, Guang-Quan C, Hong-Lan H, Jin-Cai H, Zhong L, Wei H (2021) Research on multi-aircraft cooperative air combat method based on deep reinforcement learning. Acta Automatica Sinica 47(7):1610–1623. https://doi.org/10.16383/j.aas.c201059
Morris R, Pasareanu CS, Luckow K, Malik W, Ma H, Kumar TS, Koenig S (2016) Planning, scheduling and monitoring for airport surface operations. In: Workshops at the Thirtieth AAAI Conference on Artificial Intelligence
Zhang H, Li Y, Li J, Kumar TS, Koenig S (2022) Mutex propagation in multi-agent path finding for large agents. Proc Int Symp Combin Search 15(1):249–253. https://doi.org/10.1609/socs.v15i1.21776
Madridano Á, Al-Kaff A, Martín D, De La Escalera A (2021) Trajectory planning for multi-robot systems: Methods and applications. Expert Syst Appl 173:114660. https://doi.org/10.1016/j.eswa.2021.114660
Jian Z, Zhang S, Chen S, Nan Z, Zheng N (2021) A global-local coupling two-stage path planning method for mobile robots. IEEE Robotics and Automation Letters 6(3):5349–5356. https://doi.org/10.1109/LRA.2021.3074878
Li H, Long, T, Xu G, Wang Y (2019) Coupling-degree-based heuristic prioritized planning method for UAV swarm path generation. 2019 Chinese Automation Congress (CAC), 3636–3641 https://doi.org/10.1109/CAC48633.2019.8997273
Barer M, Sharon G, Stern R, Felner A (2014) Suboptimal variants of the conflict-based search algorithm for the multi-agent pathfinding problem. In: Proceedings of the International Symposium on Combinatorial Search 5:19–27. https://doi.org/10.1609/socs.v5i1.18315
Standley T (2010) Finding optimal solutions to cooperative pathfinding problems. Proceedings of the AAAI conference on artificial intelligence 24(1):173–178. https://doi.org/10.1609/aaai.v24i1.7564
Sharon G, Stern R, Goldenberg M, Felner A (2013) The increasing cost tree search for optimal multi-agent pathfinding. Artif Intell 195:470–495. https://doi.org/10.1016/j.artint.2012.11.006
Han SD, Rodriguez EJ, Yu J (2018) Sear: A polynomial-time multi-robot path planning algorithm with expected constant-factor optimality guarantee. 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 1–9 https://doi.org/10.1109/IROS.2018.8594417
Chouhan SS, Niyogi R (2017) DiMPP: a complete distributed algorithm for multi-agent path planning. Journal of Experimental & Theoretical Artificial Intelligence 29(6):1129–1148. https://doi.org/10.1080/0952813X.2017.1310142
Den Berg J, Snoeyink J, Lin MC (2009) Centralized path planning for multiple robots: Optimal decoupling into sequential plans. In: Robotics: Science and Systems 2:2–3. https://doi.org/10.15607/rss.2009.v.018
Sharon G, Stern R, Felner A, Sturtevant NR (2015) Conflict-based search for optimal multi-agent pathfinding. Artif Intell 219:40–66. https://doi.org/10.1016/j.artint.2014.11.006
Silver D (2005) Cooperative pathfinding. Proceedings of the aaai conference on artificial intelligence and interactive digital entertainment 1(1):117–122. https://doi.org/10.1609/aiide.v1i1.18726
Li H, Long T, Xu G, Wang Y (2019) Coupling-degree-based heuristic prioritized planning method for UAV swarm path generation. 2019 Chinese Automation Congress (CAC), 3636–3641. https://doi.org/10.1109/CAC48633.2019.8997273
Wu W, Bhattacharya S, Prorok A (2020) Multi-robot path deconfliction through prioritization by path prospects. 2020 IEEE international conference on robotics and automation (ICRA), 9809–9815 https://doi.org/10.1109/ICRA40945.2020.9196813
Jiang J, Wu K (2020) Cooperative pathfinding based on memory-efficient multi-agent RRT*. IEEE Access 8:168743–168750. https://doi.org/10.1109/ACCESS.2020.3023200
Yanmaz E (2023) Joint or decoupled optimization: Multi-UAV path planning for search and rescue. Ad Hoc Netw 138:103018. https://doi.org/10.1016/j.adhoc.2022.103018
Solis I, Motes J, Sandström R, Amato NM (2021) Representation-optimal multi-robot motion planning using conflict-based search. IEEE Robotics and Automation Letters 6(3):4608–4615. https://doi.org/10.48550/arXiv.1909.13352
Wagner G, Choset H (2015) Subdimensional expansion for multirobot path planning. Artif Intell 219:1–24. https://doi.org/10.1016/j.artint.2014.11.001
Van Nguyen L, Phung MD, Ha QP (2022) Game theory-based optimal cooperative path planning for multiple UAVs. IEEE Access 10:108034–108045. https://doi.org/10.1109/ACCESS.2022.3213035
Wu H, Shang H (2020) Potential game for dynamic task allocation in multi-agent system. ISA Trans 102:208–220. https://doi.org/10.1016/j.isatra.2020.03.004
Zheng Y, Wang L, Xi P, Fan W, Han M (2019) Multi-agent path planning algorithm based on ant colony algorithm and game theory. Journal of Computer Applications 39(3):681. https://doi.org/10.1016/j.isatra.2020.03.004
Guo Y, Pan Q, Sun Q, Zhao C, Wang D, Feng M (2019) Cooperative game-based multi-agent path planning with obstacle avoidance. 2019 IEEE 28th International Symposium on Industrial Electronics (ISIE), 1385–1390 https://doi.org/10.1109/ISIE.2019.8781205
Gielis J, Shankar A, Prorok A (2022) A critical review of communications in multi-robot systems. Current robotics reports 3(4):213–225. https://doi.org/10.1007/S43154-022-00090-9
Ajeil FH, Ibraheem IK, Sahib MA, Humaidi AJ (2020) Multi-objective path planning of an autonomous mobile robot using hybrid pso-mfb optimization algorithm. Applied Soft Computing 89:106076
Solis I, Motes J, Qin M, Morales M, Amato NM (2024) Adaptive robot coordination: A subproblem-based approach for hybrid multi-robot motion planning. IEEE Robotics and Automation Letters 9(8):7238–7245. https://doi.org/10.1109/LRA.2024.3420548
Sun Y, Fu L (2018) Real-time game theory based artificial potential field method for multiple unmanned aerial vehicles path planning. In: Proceedings of the 2018 International Technical Meeting of The Institute of Navigation, pp. 521–528. https://doi.org/10.33012/2018.15583
Phung MD, Ha QP (2021) Safety-enhanced UAV path planning with spherical vector-based particle swarm optimization. Appl Soft Comput 107:107376. https://doi.org/10.1016/j.asoc.2021.107376
Jung J-H, Kim D-H (2020) Local path planning of a mobile robot using a novel grid-based potential method. International Journal of Fuzzy Logic and Intelligent Systems 20(1):26–34. https://doi.org/10.5391/IJFIS.2020.20.1.26
Dewangan RK, Shukla A, Godfrey WW (2019) Three dimensional path planning using grey wolf optimizer for UAVs. Appl Intell 49:2201–2217. https://doi.org/10.1007/s10489-018-1384-y
Chai X, Zheng Z, Xiao J, Yan L, Qu B, Wen P, Wang H, Zhou Y, Sun H (2022) Multi-strategy fusion differential evolution algorithm for UAV path planning in complex environment. Aerosp Sci Technol 121:107287. https://doi.org/10.1016/j.ast.2021.107287
Hao K, Zhao J, Yu K, Li C, Wang C (2020) Path planning of mobile robots based on a multi-population migration genetic algorithm. Sensors 20(20):5873. https://doi.org/10.3390/s20205873
Miao C, Chen G, Yan C, Wu Y (2021) Path planning optimization of indoor mobile robot based on adaptive ant colony algorithm. Computers & Industrial Engineering 156:107230. https://doi.org/10.1016/j.cie.2021.107230
Dewang HS, Mohanty PK, Kundu S (2018) A robust path planning for mobile robot using smart particle swarm optimization. Procedia computer science 133:290–297. https://doi.org/10.1016/j.procs.2018.07.036
Paikray H, Das P, Panda S (2021) Optimal multi-robot path planning using particle swarm optimization algorithm improved by sine and cosine algorithms. Arab J Sci Eng 46(4):3357–3381. https://doi.org/10.1007/s13369-020-05046-9
Fu Y, Ding M, Zhou C (2011) Phase angle-encoded and quantum-behaved particle swarm optimization applied to three-dimensional route planning for UAV. IEEE Transactions on Systems, Man, and Cybernetics-Part A: Systems and Humans 42(2):511–526. https://doi.org/10.1109/TSMCA.2011.2159586
Wei-Min Z, Shao-Jun L, Feng Q (2008) \(\theta\)-pso: a new strategy of particle swarm optimization. Journal of Zhejiang University-SCIENCE A 9(6):786–790. https://doi.org/10.1631/jzus.A071278
Sun J, Fang W, Wu X, Palade V, Xu W (2012) Quantum-behaved particle swarm optimization: analysis of individual particle behavior and parameter selection. Evol Comput 20(3):349–393. https://doi.org/10.1109/ACCESS.2020.3023200
Onwubolu GC, Babu B, Clerc M (2004) Discrete particle swarm optimization, illustrated by the traveling salesman problem. New optimization techniques in engineering, 219–239 https://doi.org/10.1007/978-3-540-39930-8_8
Phung MD, Ha QP (2021) Safety-enhanced UAV path planning with spherical vector-based particle swarm optimization. Appl Soft Comput 107:107376. https://doi.org/10.1016/j.asoc.2021.107376
Author information
Authors and Affiliations
Contributions
Authorship indicates the researcher’s contribution to the research and assumes corresponding responsibility. Below are the specific contributions of each author to this manuscript: HQ and WY wrote the text of the manuscript. GZ prepared Fig. 1, 2, 3, 4, 5. XX conducted data analysis and wrote the experimental part. KY directed and revised the study. All authors reviewed the manuscript and agreed to submit a version.
Corresponding author
Ethics declarations
Conflict of interest
The authors declare that there is no conflict of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Qiu, H., Yu, W., Zhang, G. et al. Multi-robot Collaborative 3D Path Planning Based On Game Theory and Particle Swarm Optimization Hybrid Method. J Supercomput 81, 487 (2025). https://doi.org/10.1007/s11227-025-06960-1
Accepted:
Published:
DOI: https://doi.org/10.1007/s11227-025-06960-1