SwarmPRM: Probabilistic Roadmap Motion Planning for Large-Scale Swarm Robotic Systems
Abstract: Large-scale swarm robotic systems consisting of numerous cooperative agents show considerable promise for performing autonomous tasks across various sectors. Nonetheless, traditional motion planning approaches often face a trade-off between scalability and solution quality due to the exponential growth of the joint state space of robots. In response, this work proposes SwarmPRM, a hierarchical, scalable, computationally efficient, and risk-aware sampling-based motion planning approach for large-scale swarm robots. SwarmPRM utilizes a Gaussian Mixture Model (GMM) to represent the swarm's macroscopic state and constructs a Probabilistic Roadmap in Gaussian space, referred to as the Gaussian roadmap, to generate a transport trajectory of GMM. This trajectory is then followed by each robot at the microscopic stage. To enhance trajectory safety, SwarmPRM incorporates the conditional value-at-risk (CVaR) in the collision checking process to impart the property of risk awareness to the constructed Gaussian roadmap. SwarmPRM then crafts a linear programming formulation to compute the optimal GMM transport trajectory within this roadmap. Extensive simulations demonstrate that SwarmPRM outperforms state-of-the-art methods in computational efficiency, scalability, and trajectory quality while offering the capability to adjust the risk tolerance of generated trajectories.
- K. McGuire, C. De Wagter, K. Tuyls, H. Kappen, and G. C. de Croon, “Minimal navigation solution for a swarm of tiny flying robots to explore an unknown environment,” Science Robotics, vol. 4, no. 35, p. eaaw9710, 2019.
- D. S. Drew, “Multi-agent systems for search and rescue applications,” Current Robotics Reports, vol. 2, pp. 189–200, 2021.
- F. Schilling, J. Lecoeur, F. Schiano, and D. Floreano, “Learning vision-based flight in drone swarms by imitation,” IEEE Robotics and Automation Letters, vol. 4, no. 4, pp. 4523–4530, 2019.
- E. Soria, F. Schiano, and D. Floreano, “Predictive control of aerial swarms in cluttered environments,” Nature Machine Intelligence, vol. 3, no. 6, pp. 545–554, 2021.
- M. A. Pereira, A. D. Saravanos, O. So, and E. A. Theodorou, “Decentralized safe multi-agent stochastic optimal control using deep fbsdes and admm,” arXiv preprint arXiv:2202.10658, 2022.
- T. Zheng, Q. Han, and H. Lin, “Transporting robotic swarms via mean-field feedback control,” IEEE Transactions on Automatic Control, vol. 67, no. 8, pp. 4170–4177, 2021.
- S. Ma, M. Hou, X. Ye, and H. Zhou, “High-dimensional optimal density control with wasserstein metric matching,” in 2023 62nd IEEE Conference on Decision and Control (CDC). IEEE, 2023, pp. 6813–6818.
- J. Alonso-Mora, S. Baker, and D. Rus, “Multi-robot formation control and object transport in dynamic environments via constrained optimization,” The International Journal of Robotics Research, vol. 36, no. 9, pp. 1000–1021, 2017.
- K. Rudd, G. Foderaro, P. Zhu, and S. Ferrari, “A generalized reduced gradient method for the optimal control of very-large-scale robotic systems,” IEEE transactions on robotics, vol. 33, no. 5, pp. 1226–1232, 2017.
- P. Zhu, C. Liu, and S. Ferrari, “Adaptive online distributed optimal control of very-large-scale robotic systems,” IEEE Transactions on Control of Network Systems, vol. 8, no. 2, pp. 678–689, 2021.
- H. Zhu and J. Alonso-Mora, “Chance-constrained collision avoidance for mavs in dynamic environments,” IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 776–783, 2019.
- A. Hakobyan and I. Yang, “Distributionally robust risk map for learning-based motion planning and control: A semidefinite programming approach,” IEEE Transactions on Robotics, vol. 39, no. 1, pp. 718–737, 2022.
- X. Yang, H. Gao, P. Zhu, and C. Liu, “Risk-aware motion planning for very-large-scale robotics systems using conditional value-at-risk,” in International Conference on Intelligent Robotics and Applications. Springer, 2023, pp. 513–525.
- P. Artzner, F. Delbaen, J.-M. Eber, and D. Heath, “Coherent measures of risk,” Mathematical finance, vol. 9, no. 3, pp. 203–228, 1999.
- S. Karaman and E. Frazzoli, “Sampling-based algorithms for optimal motion planning,” The international journal of robotics research, vol. 30, no. 7, pp. 846–894, 2011.
- M. Čáp, P. Novák, J. Vokrínek, and M. Pěchouček, “Multi-agent rrt: sampling-based cooperative pathfinding,” in Proceedings of the 2013 international conference on Autonomous agents and multi-agent systems, 2013, pp. 1263–1264.
- W. Hönig, J. A. Preiss, T. S. Kumar, G. S. Sukhatme, and N. Ayanian, “Trajectory planning for quadrotor swarms,” IEEE Transactions on Robotics, vol. 34, no. 4, pp. 856–869, 2018.
- R. Shome, K. Solovey, A. Dobson, D. Halperin, and K. E. Bekris, “drrt*: Scalable and informed asymptotically-optimal multi-robot motion planning,” Autonomous Robots, vol. 44, no. 3-4, pp. 443–467, 2020.
- S. LaValle, “Planning algorithms,” Cambridge University Press google schola, vol. 2, pp. 3671–3678, 2006.
- L. Janson, B. Ichter, and M. Pavone, “Deterministic sampling-based motion planning: Optimality, complexity, and performance,” The International Journal of Robotics Research, vol. 37, no. 1, pp. 46–61, 2018.
- Y. Chen, T. T. Georgiou, and A. Tannenbaum, “Optimal transport for gaussian mixture models,” IEEE Access, vol. 7, pp. 6269–6278, 2018.
- G. Auricchio, F. Bassetti, S. Gualandi, and M. Veneroni, “Computing kantorovich-wasserstein distances on d𝑑ditalic_d-dimensional histograms using (d+1)𝑑1(d+1)( italic_d + 1 )-partite graphs,” Advances in Neural Information Processing Systems, vol. 31, 2018.
- H. Gao, P. Wu, Y. Su, K. Zhou, J. Ma, H. Liu, and C. Liu, “Probabilistic visibility-aware trajectory planning for target tracking in cluttered environments,” arXiv preprint arXiv:2306.06363, 2023.
- R. Bhatia, T. Jain, and Y. Lim, “On the bures–wasserstein distance between positive definite matrices,” Expositiones Mathematicae, vol. 37, no. 2, pp. 165–191, 2019.
- L. Janson, E. Schmerling, A. Clark, and M. Pavone, “Fast marching tree: A fast marching sampling-based method for optimal motion planning in many dimensions,” The International journal of robotics research, vol. 34, no. 7, pp. 883–921, 2015.
Paper Prompts
Sign up for free to create and run prompts on this paper.