Papers
Topics
Authors
Recent
Search
2000 character limit reached

Improved Consensus ADMM for Cooperative Motion Planning of Large-Scale Connected Autonomous Vehicles with Limited Communication

Published 17 Jan 2024 in cs.RO, cs.MA, cs.SY, and eess.SY | (2401.09032v1)

Abstract: This paper investigates a cooperative motion planning problem for large-scale connected autonomous vehicles (CAVs) under limited communications, which addresses the challenges of high communication and computing resource requirements. Our proposed methodology incorporates a parallel optimization algorithm with improved consensus ADMM considering a more realistic locally connected topology network, and time complexity of O(N) is achieved by exploiting the sparsity in the dual update process. To further enhance the computational efficiency, we employ a lightweight evolution strategy for the dynamic connectivity graph of CAVs, and each sub-problem split from the consensus ADMM only requires managing a small group of CAVs. The proposed method implemented with the receding horizon scheme is validated thoroughly, and comparisons with existing numerical solvers and approaches demonstrate the efficiency of our proposed algorithm. Also, simulations on large-scale cooperative driving tasks involving 80 vehicles are performed in the high-fidelity CARLA simulator, which highlights the remarkable computational efficiency, scalability, and effectiveness of our proposed development. Demonstration videos are available at https://henryhcliu.github.io/icadmm_cmp_carla.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (43)
  1. C. Chang, J. Zhang, K. Zhang, W. Zhong, X. Peng, S. Li, and L. Li, “BEV-V2X: Cooperative birds-eye-view fusion and grid occupancy prediction via V2X-based data sharing,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 11, pp. 4498–4514, 2023.
  2. M. Wegener, F. Herrmann, L. Koch, R. Savelsberg, and J. Andert, “Longitudinal vehicle motion prediction in urban settings with traffic light interaction,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 1, pp. 204–215, 2023.
  3. C. Toumieh and A. Lambert, “Decentralized multi-agent planning using model predictive control and time-aware safe corridors,” IEEE Robotics and Automation Letters, vol. 7, no. 4, pp. 11110–11117, 2022.
  4. W. Xiao, H. Ren, Q. Zhou, H. Li, and R. Lu, “Distributed finite-time containment control for nonlinear multiagent systems with mismatched disturbances,” IEEE Transactions on Cybernetics, vol. 52, no. 7, pp. 6939–6948, 2022.
  5. L.-H. Wen and K.-H. Jo, “Deep learning-based perception systems for autonomous driving: A comprehensive survey,” Neurocomputing, vol. 489, pp. 255–270, 2022.
  6. L. Zhang, Z. Hou, J. Wang, Z. Liu, and W. Li, “Robot navigation with reinforcement learned path generation and fine-tuned motion control,” IEEE Robotics and Automation Letters, vol. 8, no. 8, pp. 4489–4496, 2023.
  7. X. Duan, C. Sun, D. Tian, J. Zhou, and D. Cao, “Cooperative lane-change motion planning for connected and automated vehicle platoons in multi-lane scenarios,” IEEE Transactions on Intelligent Transportation Systems, vol. 24, no. 7, pp. 7073–7091, 2023.
  8. C. Hu, Z. Wang, H. Taghavifar, J. Na, Y. Qin, J. Guo, and C. Wei, “MME-EKF-Based path-tracking control of autonomous vehicles considering input saturation,” IEEE Transactions on Vehicular Technology, vol. 68, no. 6, pp. 5246–5259, 2019.
  9. L. Claussmann, M. Revilloud, D. Gruyer, and S. Glaser, “A review of motion planning for highway autonomous driving,” IEEE Transactions on Intelligent Transportation Systems, vol. 21, no. 5, pp. 1826–1848, 2020.
  10. S. Teng, X. Hu, P. Deng, B. Li, Y. Li, Y. Ai, D. Yang, L. Li, Z. Xuanyuan, F. Zhu, et al., “Motion planning for autonomous driving: The state of the art and future perspectives,” IEEE Transactions on Intelligent Vehicles, 2023.
  11. J. Duan, J. Li, Q. Ge, S. E. Li, M. Bujarbaruah, F. Ma, and D. Zhang, “Relaxed actor-critic with convergence guarantees for continuous-time optimal control of nonlinear systems,” IEEE Transactions on Intelligent Vehicles, vol. 8, no. 5, pp. 3299–3311, 2023.
  12. G. Sartoretti, J. Kerr, Y. Shi, G. Wagner, T. S. Kumar, S. Koenig, and H. Choset, “PRIMAL: Pathfinding via reinforcement and imitation multi-agent learning,” IEEE Robotics and Automation Letters, vol. 4, no. 3, pp. 2378–2385, 2019.
  13. H. Liu, Z. Qu, and R. Zhu, “Solving a multi-robot search problem with bionic SARSA algorithm and artificial potential field,” in 2021 China Automation Congress (CAC), pp. 1830–1835, IEEE, 2021.
  14. M. Klimke, B. Völz, and M. Buchholz, “Cooperative behavior planning for automated driving using graph neural networks,” in 2022 IEEE Intelligent Vehicles Symposium (IV), pp. 167–174, IEEE, 2022.
  15. B. Wang, X. Gong, Y. Wang, P. Lyu, and S. Liang, “Coordination for connected and autonomous vehicles at unsignalized intersections: An iterative learning based collision-free motion planning method,” IEEE Internet of Things Journal, 2023.
  16. B. Li, T. Acarman, Y. Zhang, Y. Ouyang, C. Yaman, Q. Kong, X. Zhong, and X. Peng, “Optimization-based trajectory planning for autonomous parking with irregularly placed obstacles: A lightweight iterative framework,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 8, pp. 11970–11981, 2022.
  17. Y. Lee, M. Cho, and K.-S. Kim, “GPU-parallelized iterative LQR with input constraints for fast collision avoidance of autonomous vehicles,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4797–4804, IEEE, 2022.
  18. C. Mastalli, W. Merkt, J. Marti-Saumell, H. Ferrolho, J. Solà, N. Mansard, and S. Vijayakumar, “A feasibility-driven approach to control-limited DDP,” Autonomous Robots, vol. 46, no. 8, pp. 985–1005, 2022.
  19. Y. Aoyama, G. Boutselis, A. Patel, and E. A. Theodorou, “Constrained differential dynamic programming revisited,” in 2021 IEEE International Conference on Robotics and Automation (ICRA), pp. 9738–9744, IEEE, 2021.
  20. J. Chen, W. Zhan, and M. Tomizuka, “Autonomous driving motion planning with constrained iterative LQR,” IEEE Transactions on Intelligent Vehicles, vol. 4, no. 2, pp. 244–254, 2019.
  21. J. Ma, Z. Cheng, X. Zhang, M. Tomizuka, and T. H. Lee, “Alternating direction method of multipliers for constrained iterative LQR in autonomous driving,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 12, pp. 23031–23042, 2022.
  22. J. Ma, Z. Cheng, X. Zhang, Z. Lin, F. L. Lewis, and T. H. Lee, “Local learning enabled iterative linear quadratic regulator for constrained trajectory planning,” IEEE Transactions on Neural Networks and Learning Systems, vol. 34, no. 9, pp. 5354–5365, 2023.
  23. S. Boyd, N. Parikh, E. Chu, B. Peleato, J. Eckstein, et al., “Distributed optimization and statistical learning via the alternating direction method of multipliers,” Foundations and Trends in Machine Learning, vol. 3, no. 1, pp. 1–122, 2011.
  24. X. Zhang, Z. Cheng, J. Ma, S. Huang, F. L. Lewis, and T. H. Lee, “Semi-definite relaxation-based ADMM for cooperative planning and control of connected autonomous vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 7, pp. 9240–9251, 2021.
  25. G. Banjac, F. Rey, P. Goulart, and J. Lygeros, “Decentralized resource allocation via dual consensus ADMM,” in 2019 American Control Conference (ACC), pp. 2789–2794, IEEE, 2019.
  26. Z. Huang, S. Shen, and J. Ma, “Decentralized iLQR for cooperative trajectory planning of connected autonomous vehicles via dual consensus ADMM,” IEEE Transactions on Intelligent Transportation Systems, 2023.
  27. J. Ye, L. Xiang, and X. Ge, “Spatial-temporal modeling and analysis of reliability and delay in urban V2X networks,” IEEE Transactions on Network Science and Engineering, 2023.
  28. A. I. Rikos, W. Jiang, T. Charalambous, and K. H. Johansson, “Asynchronous distributed optimization via ADMM with efficient communication,” arXiv preprint arXiv:2309.04585, 2023.
  29. O. Shorinwa, T. Halsted, and M. Schwager, “Scalable distributed optimization with separable variables in multi-agent networks,” in 2020 American Control Conference (ACC), pp. 3619–3626, IEEE, 2020.
  30. A. D. Saravanos, Y. Aoyama, H. Zhu, and E. A. Theodorou, “Distributed differential dynamic programming architectures for large-scale multiagent control,” IEEE Transactions on Robotics, 2023.
  31. Z. Sheng, Y. Xu, S. Xue, and D. Li, “Graph-based spatial-temporal convolutional network for vehicle trajectory prediction in autonomous driving,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 10, pp. 17654–17665, 2022.
  32. T. Brüdigam, M. Olbrich, D. Wollherr, and M. Leibold, “Stochastic model predictive control with a safety guarantee for automated driving,” IEEE Transactions on Intelligent Vehicles, 2021.
  33. H. Liu, K. Chen, Y. Li, Z. Huang, J. Duan, and J. Ma, “Integrated behavior planning and motion control for autonomous vehicles with traffic rules compliance,” in 2023 IEEE International Conference on Robotics and Biomimetics (ROBIO), pp. 1995–2002, IEEE, 2023.
  34. Y. Qu, H. Chu, S. Gao, J. Guan, H. Yan, L. Xiao, S. E. Li, and J. Duan, “RL-driven MPPI: Accelerating online control laws calculation with offline policy,” IEEE Transactions on Intelligent Vehicles, pp. 1–12, 2023.
  35. C. E. Luis, M. Vukosavljev, and A. P. Schoellig, “Online trajectory generation with distributed model predictive control for multi-robot motion planning,” IEEE Robotics and Automation Letters, vol. 5, no. 2, pp. 604–611, 2020.
  36. D. Qin, Z. Jin, A. Liu, W.-A. Zhang, and L. Yu, “Asynchronous event-triggered distributed predictive control for multi-agent systems with parameterized synchronization constraints,” IEEE Transactions on Automatic Control, 2023.
  37. Z. Cheng, J. Ma, X. Zhang, C. W. de Silva, and T. H. Lee, “ADMM-based parallel optimization for multi-agent collision-free model predictive control,” arXiv preprint arXiv:2101.09894, 2021.
  38. Y. Tassa, N. Mansard, and E. Todorov, “Control-limited differential dynamic programming,” in 2014 IEEE International Conference on Robotics and Automation (ICRA), pp. 1168–1175, IEEE, 2014.
  39. W. Schwarting, J. Alonso-Mora, L. Paull, S. Karaman, and D. Rus, “Safe nonlinear trajectory generation for parallel autonomy with a dynamic vehicle model,” IEEE Transactions on Intelligent Transportation Systems, vol. 19, no. 9, pp. 2994–3008, 2017.
  40. P. D. Grontas, M. W. Fisher, and F. Dörfler, “Distributed and constrained H22{}_{2}start_FLOATSUBSCRIPT 2 end_FLOATSUBSCRIPT control design via system level synthesis and dual consensus ADMM,” in 2022 IEEE 61st Conference on Decision and Control (CDC), pp. 301–307, IEEE, 2022.
  41. H. Bauschke and P. Combettes, “Convex analysis and monotone operator theory in Hilbert spaces,” CMS books in mathematics, vol. 10, pp. 978–1, 2011.
  42. A. Dosovitskiy, G. Ros, F. Codevilla, A. Lopez, and V. Koltun, “CARLA: An open urban driving simulator,” in Conference on Robot Learning, pp. 1–16, PMLR, 2017.
  43. J. A. Andersson, J. Gillis, G. Horn, J. B. Rawlings, and M. Diehl, “CasADi: a software framework for nonlinear optimization and optimal control,” Mathematical Programming Computation, vol. 11, no. 1, pp. 1–36, 2019.
Citations (5)
View on Semantic Scholar

Summary

No one has generated a summary of this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Sign Up to Summarize

Paper to Video (Beta)

Whiteboard

No one has generated a whiteboard explanation for this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Sign Up to Generate

Open Problems

We haven't generated a list of open problems mentioned in this paper yet.

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

Continue Learning

We haven't generated follow-up questions for this paper yet.

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

Collections

Sign up for free to add this paper to one or more collections.

User Circle Single Streamline Icon: https://streamlinehq.com Sign Up

Tweets

Sign up for free to view the 1 tweet with 0 likes about this paper.

User Circle Single Streamline Icon: https://streamlinehq.com Sign Up for Free