Papers
Topics
Authors
Recent
Gemini 2.5 Flash
Gemini 2.5 Flash
158 tokens/sec
GPT-4o
7 tokens/sec
Gemini 2.5 Pro Pro
45 tokens/sec
o3 Pro
4 tokens/sec
GPT-4.1 Pro
38 tokens/sec
DeepSeek R1 via Azure Pro
28 tokens/sec
2000 character limit reached

Deadlock Resolution and Recursive Feasibility in MPC-based Multi-robot Trajectory Generation (2202.06071v4)

Published 12 Feb 2022 in cs.RO and cs.MA

Abstract: Online collision-free trajectory generation within a shared workspace is fundamental for most multi-robot applications. However, many widely-used methods based on model predictive control (MPC) lack theoretical guarantees on the feasibility of underlying optimization. Furthermore, when applied in a distributed manner without a central coordinator, deadlocks often occur where several robots block each other indefinitely. Whereas heuristic methods such as introducing random perturbations exist, no profound analyses are given to validate these measures. Towards this end, we propose a systematic method called infinite-horizon model predictive control with deadlock resolution. The MPC is formulated as a convex optimization over the proposed modified buffered Voronoi with warning band. Based on this formulation, the condition of deadlocks is formally analyzed and proven to be analogous to a force equilibrium. A detection-resolution scheme is proposed, which can effectively detect deadlocks online before they even happen. Once detected, it utilizes an adaptive resolution scheme to resolve deadlocks, under which no stable deadlocks can exist under minor conditions. In addition, the proposed planning algorithm ensures recursive feasibility of the underlying optimization at each time step under both input and model constraints, is concurrent for all robots and requires only local communication. Comprehensive simulation and experiment studies are conducted over large-scale multi-robot systems. Significant improvements on success rate are reported, in comparison with other state-of-the-art methods and especially in crowded and high-speed scenarios.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (49)
  1. S.-J. Chung, A. A. Paranjape, P. Dames, S. Shen, and V. Kumar, “A survey on aerial swarm robotics,” IEEE Transactions on Robotics, vol. 34, no. 4, pp. 837–855, 2018.
  2. Z. Zhou, J. Liu, and J. Yu, “A survey of underwater multi-robot systems,” IEEE/CAA Journal of Automatica Sinica, vol. 9, no. 1, pp. 1–18, 2022.
  3. T. Zhang, J. Xiao, L. Li, C. Wang, and G. Xie, “Toward coordination control of multiple fish-like robots: Real-time vision-based pose estimation and tracking via deep neural networks,” IEEE/CAA Journal of Automatica Sinica, vol. 8, no. 12, pp. 1964–1976, 2021.
  4. N. Gafur, V. Yfantis, and M. Ruskowski, “Optimal scheduling and non-cooperative distributed model predictive control for multiple robotic manipulators,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2021, pp. 390–397.
  5. J. Borenstein and Y. Koren, “Real-time obstacle avoidance for fast mobile robots,” IEEE Transactions on systems, Man, and Cybernetics, vol. 19, no. 5, pp. 1179–1187, 1989.
  6. Y. Koren and J. Borenstein, “Potential field methods and their inherent limitations for mobile robot navigation,” vol. 2, 1991, pp. 1398–1404.
  7. J. Alonso-Mora, A. Breitenmoser, P. Beardsley, and R. Siegwart, “Reciprocal collision avoidance for multiple car-like robots,” in IEEE International Conference on Robotics and Automation, 2012, pp. 360–366.
  8. J. van den Berg, M. Lin, and D. Manocha, “Reciprocal velocity obstacles for real-time multi-agent navigation,” in 2008 IEEE International Conference on Robotics and Automation, 2008, pp. 1928–1935.
  9. J. van den Berg, S. J. Guy, M. Lin, and D. Manocha, “Reciprocal n-body collision avoidance,” in 14th International Symposium on Robotics Research (ISSR), vol. 70, 2011, pp. 3–19.
  10. J. Huang, J. Zeng, X. Chi, K. Sreenath, Z. Liu, and H. Su, “Velocity obstacle for polytopic collision avoidance for distributed multi-robot systems,” IEEE Robotics and Automation Letters, vol. 8, no. 6, pp. 3502–3509, 2023.
  11. C. Tomlin, G. Pappas, and S. Sastry, “Conflict resolution for air traffic management: a study in multiagent hybrid systems,” IEEE Transactions on Automatic Control, vol. 43, no. 4, pp. 509–521, 1998.
  12. K. Cole and A. M. Wickenheiser, “Reactive trajectory generation for multiple vehicles in unknown environments with wind disturbances,” IEEE Transactions on Robotics, vol. 34, no. 5, pp. 1333–1348, 2018.
  13. T. Fan, P. Long, W. Liu, and J. Pan, “Distributed multi-robot collision avoidance via deep reinforcement learning for navigation in complex scenarios,” The International Journal of Robotics Research, vol. 39, no. 7, pp. 856–892, 2020.
  14. G. Shi, W. Hönig, X. Shi, Y. Yue, and S.-J. Chung, “Neural-swarm2: Planning and control of heterogeneous multirotor swarms using learned interactions,” IEEE Transactions on Robotics, pp. 1–17, 2021.
  15. Y. F. Chen, M. Liu, M. Everett, and J. P. How, “Decentralized non-communicating multiagent collision avoidance with deep reinforcement learning,” in IEEE International Conference on Robotics and Automation (ICRA), 2017, pp. 285–292.
  16. S. Zhao, D. V. Dimarogonas, Z. Sun, and D. Bauso, “A general approach to coordination control of mobile agents with motion constraints,” IEEE Transactions on Automatic Control, vol. 63, no. 5, pp. 1509–1516, 2018.
  17. D. Panagou, D. M. Stipanović, and P. G. Voulgaris, “Distributed coordination control for multi-robot networks using lyapunov-like barrier functions,” IEEE Transactions on Automatic Control, vol. 61, no. 3, pp. 617–632, 2016.
  18. D. Panagou, M. Turpin, and V. Kumar, “Decentralized goal assignment and safe trajectory generation in multirobot networks via multiple lyapunov functions,” IEEE Transactions on Automatic Control, vol. 65, no. 8, pp. 3365–3380, 2020.
  19. A. Richards, J. How, and IEEE, “Decentralized model predictive control of cooperating uavs,” in 43rd IEEE Conference on Decision and Control, 2004, pp. 4286–4291.
  20. S. El-Ferik, B. A. Siddiqui, and F. L. Lewis, “Distributed nonlinear mpc of multi-agent systems with data compression and random delays,” IEEE Transactions on Automatic Control, vol. 61, no. 3, pp. 817–822, 2016.
  21. V. Cichella, I. Kaminer, C. Walton, N. Hovakimyan, and A. M. Pascoal, “Optimal multivehicle motion planning using bernstein approximants,” IEEE Transactions on Automatic Control, vol. 66, no. 4, pp. 1453–1467, 2021.
  22. F. Augugliaro, A. P. Schoellig, and R. D’Andrea, “Generation of collision-free trajectories for a quadrocopter fleet: A sequential convex programming approach,” in 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2012, pp. 1917–1922.
  23. D. Morgan, G. P. Subramanian, S.-J. Chung, and F. Y. Hadaegh, “Swarm assignment and trajectory optimization using variable-swarm, distributed auction assignment and sequential convex programming,” International Journal of Robotics Research, vol. 35, no. 10, pp. 1261–1285, 2016.
  24. J. Park and H. J. Kim, “Online trajectory planning for multiple quadrotors in dynamic environments using relative safe flight corridor,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 659–666, 2021.
  25. W. Hönig, J. A. Preiss, T. K. 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.
  26. L. Campos-Macias, D. Gomez-Gutierrez, R. Aldana-Lopez, R. de la Guardia, and J. I. Parra-Vilchis, “A hybrid method for online trajectory planning of mobile robots in cluttered environments,” IEEE Robotics and Automation Letters, vol. 2, no. 2, pp. 935–942, 2017.
  27. L. Wang, A. D. Ames, and M. Egerstedt, “Safety barrier certificates for collisions-free multirobot systems,” IEEE Transactions on Robotics, vol. 33, no. 3, pp. 661–674, 2017.
  28. J. Park, D. Kim, G. C. Kim, D. Oh, and H. J. Kim, “Online distributed trajectory planning for quadrotor swarm with feasibility guarantee using linear safe corridor,” IEEE Robotics and Automation Letters, vol. 7, no. 2, pp. 4869–4876, 2022.
  29. J. Alonso-Mora, J. A. DeCastro, V. Raman, D. Rus, and H. Kress-Gazit, “Reactive mission and motion planning with deadlock resolution avoiding dynamic obstacles,” Autonomous Robots, vol. 42, no. 4, pp. 801–824, 2018.
  30. J. Grover, C. Liu, and K. Sycara, “Why does symmetry cause deadlocks?” IFAC-PapersOnLine, vol. 53, no. 2, pp. 9746–9753, 2020, 21st IFAC World Congress.
  31. J. Alonso-Mora, P. Beardsley, and R. Siegwart, “Cooperative collision avoidance for nonholonomic robots,” IEEE Transactions on Robotics, vol. 34, no. 2, pp. 404–420, 2018.
  32. D. Zhou, Z. Wang, S. Bandyopadhyay, and M. Schwager, “Fast, on-line collision avoidance for dynamic vehicles using buffered Voronoi cells,” IEEE Robotics and Automation Letters, vol. 2, no. 2, pp. 1047–1054, 2017.
  33. A. Pierson, W. Schwarting, S. Karaman, and D. Rus, “Weighted buffered voronoi cells for distributed semi-cooperative behavior,” in IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 5611–5617.
  34. M. Abdullhak and A. Vardy, “Deadlock prediction and recovery for distributed collision avoidance with buffered voronoi cells,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2021, pp. 429–436.
  35. K. Garg and D. Panagou, “Finite-time estimation and control for multi-aircraft systems under wind and dynamic obstacles,” Journal of Guidance, Control, and Dynamics, vol. 42, no. 7, pp. 1489–1505, 2019.
  36. J. S. Grover, C. Liu, and K. Sycara, “Deadlock analysis and resolution for multi-robot systems,” in International Workshop on the Algorithmic Foundations of Robotics.   Springer, 2020, pp. 294–312.
  37. J. Grover, C. Liu, and K. Sycara, “The before, during, and after of multi-robot deadlock,” The International Journal of Robotics Research, 2022.
  38. 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.
  39. Y. Chen, M. Cutler, and J. P. How, “Decoupled multiagent path planning via incremental sequential convex programming,” in IEEE International Conference on Robotics and Automation (ICRA), 2015, pp. 5954–5961.
  40. C. E. Luis and A. P. Schoellig, “Trajectory generation for multiagent point-to-point transitions via distributed model predictive control,” IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 375–382, 2019.
  41. J. Park and S. Reveliotis, “Deadlock avoidance in sequential resource allocation systems with multiple resource acquisitions and flexible routings,” IEEE Transactions on Automatic Control, vol. 46, no. 10, pp. 1572–1583, 2001.
  42. S. Reveliotis, “Assessing and restoring “traffic-state order” in open, irreversible, dynamically routed, zone-controlled guidepath-based transport systems,” IEEE Transactions on Automation Science and Engineering, vol. 19, no. 2, pp. 1286–1295, 2022.
  43. E. Roszkowska and S. Reveliotis, “A distributed protocol for motion coordination in free-range vehicular systems,” Automatica, vol. 49, no. 6, pp. 1639–1653, 2013.
  44. Y. Zhou, H. Hu, Y. Liu, S.-W. Lin, and Z. Ding, “A distributed method to avoid higher-order deadlocks in multi-robot systems,” Automatica, vol. 112, p. 108706, 2020.
  45. Z. Xing, X. Chen, X. Wang, W. Wu, and R. Hu, “Collision and deadlock avoidance in multi-robot systems based on glued nodes,” IEEE/CAA Journal of Automatica Sinica, vol. 9, no. 7, pp. 1327–1330, 2022.
  46. J. Tordesillas and J. P. How, “Mader: Trajectory planner in multiagent and dynamic environments,” IEEE Transactions on Robotics, pp. 1–14, 2021.
  47. S. Diamond and S. Boyd, “CVXPY: A Python-embedded modeling language for convex optimization,” Journal of Machine Learning Research, vol. 17, no. 83, pp. 1–5, 2016.
  48. C. E. Luis, “Multiagent planning,” Website, https://github.com/carlosluis/multiagent_planning.
  49. D. Mellinger and V. Kumar, “Minimum snap trajectory generation and control for quadrotors,” in IEEE International Conference on Robotics and Automation, 2011, pp. 2520–2525.
Citations (6)
View on Semantic Scholar

Summary

We haven't generated a summary for this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Summarize Now