Parallel Optimization with Hard Safety Constraints for Cooperative Planning of Connected Autonomous Vehicles (2303.03090v2)
Abstract: The development of connected autonomous vehicles (CAVs) facilitates the enhancement of traffic efficiency in complicated scenarios. In unsignalized roundabout scenarios, difficulties remain unsolved in developing an effective and efficient coordination strategy for CAVs. In this paper, we formulate the cooperative autonomous driving problem of CAVs in the roundabout scenario as a constrained optimal control problem, and propose a computationally-efficient parallel optimization framework to generate strategies for CAVs such that the travel efficiency is improved with hard safety guarantees. All constraints involved in the roundabout scenario are addressed appropriately with convex approximation, such that the convexity property of the reformulated optimization problem is exhibited. Then, a parallel optimization algorithm is presented to solve the reformulated optimization problem, where an embodied iterative nearest neighbor search strategy to determine the optimal passing sequence in the roundabout scenario. It is noteworthy that the travel efficiency in the roundabout scenario is enhanced and the computation burden is considerably alleviated with the innovation development. We also examine the proposed method in CARLA simulator and perform thorough comparisons with a rule-based baseline and the commonly used IPOPT optimization solver to demonstrate the effectiveness and efficiency of the proposed approach.
- R. Deng, B. Di, and L. Song, “Cooperative collision avoidance for overtaking maneuvers in cellular V2X-based autonomous driving,” IEEE Transactions on Vehicular Technology, vol. 68, no. 5, pp. 4434–4446, 2019.
- C. Liu, C.-W. Lin, S. Shiraishi, and M. Tomizuka, “Distributed conflict resolution for connected autonomous vehicles,” IEEE Transactions on Intelligent Vehicles, vol. 3, no. 1, pp. 18–29, 2017.
- P. Hang, C. Lv, C. Huang, Y. Xing, and Z. Hu, “Cooperative decision making of connected automated vehicles at multi-lane merging zone: A coalitional game approach,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 4, pp. 3829–3841, 2021.
- J. Rios-Torres and A. A. Malikopoulos, “Automated and cooperative vehicle merging at highway on-ramps,” IEEE Transactions on Intelligent Transportation Systems, vol. 18, no. 4, pp. 780–789, 2016.
- J. Ding, L. Li, H. Peng, and Y. Zhang, “A rule-based cooperative merging strategy for connected and automated vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 21, no. 8, pp. 3436–3446, 2019.
- H. Xu, S. Feng, Y. Zhang, and L. Li, “A grouping-based cooperative driving strategy for CAVs merging problems,” IEEE Transactions on Vehicular Technology, vol. 68, no. 6, pp. 6125–6136, 2019.
- A. Mirheli, M. Tajalli, L. Hajibabai, and A. Hajbabaie, “A consensus-based distributed trajectory control in a signal-free intersection,” Transportation Research Part C: Emerging Technologies, vol. 100, pp. 161–176, 2019.
- S. A. Fayazi and A. Vahidi, “Mixed-integer linear programming for optimal scheduling of autonomous vehicle intersection crossing,” IEEE Transactions on Intelligent Vehicles, vol. 3, no. 3, pp. 287–299, 2018.
- J. Chen, B. Yuan, and M. Tomizuka, “Model-free deep reinforcement learning for urban autonomous driving,” in 2019 IEEE Intelligent Transportation Systems Conference (ITSC). IEEE, 2019, pp. 2765–2771.
- Y. Guan, Y. Ren, S. E. Li, Q. Sun, L. Luo, and K. Li, “Centralized cooperation for connected and automated vehicles at intersections by proximal policy optimization,” IEEE Transactions on Vehicular Technology, vol. 69, no. 11, pp. 12 597–12 608, 2020.
- B. Toghi, R. Valiente, D. Sadigh, R. Pedarsani, and Y. P. Fallah, “Cooperative autonomous vehicles that sympathize with human drivers,” in 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2021, pp. 4517–4524.
- X. Pan, B. Chen, S. Timotheou, and S. A. Evangelou, “A convex optimal control framework for autonomous vehicle intersection crossing,” arXiv preprint arXiv:2203.16870, 2022.
- H. Xu, Y. Zhang, L. Li, and W. Li, “Cooperative driving at unsignalized intersections using tree search,” IEEE Transactions on Intelligent Transportation Systems, vol. 21, no. 11, pp. 4563–4571, 2019.
- T. Kessler and A. Knoll, “Cooperative multi-vehicle behavior coordination for autonomous driving,” in 2019 IEEE Intelligent Vehicles Symposium (IV). IEEE, 2019, pp. 1953–1960.
- K. Esterle, T. Kessler, and A. Knoll, “Optimal behavior planning for autonomous driving: A generic mixed-integer formulation,” in 2020 IEEE Intelligent Vehicles Symposium (IV). IEEE, 2020, pp. 1914–1921.
- C. Burger and M. Lauer, “Cooperative multiple vehicle trajectory planning using MIQP,” in 2018 21st International Conference on Intelligent Transportation Systems (ITSC). IEEE, 2018, pp. 602–607.
- S. Boyd, N. Parikh, E. Chu, B. Peleato, and J. a. Eckstein, “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.
- F. Rey, Z. Pan, A. Hauswirth, and J. Lygeros, “Fully decentralized ADMM for coordination and collision avoidance,” in 2018 European Control Conference (ECC). IEEE, 2018, pp. 825–830.
- Z. Wang, Y. Zheng, S. E. Li, K. You, and K. Li, “Parallel optimal control for cooperative automation of large-scale connected vehicles via ADMM,” in 2018 21st International Conference on Intelligent Transportation Systems (ITSC). IEEE, 2018, pp. 1633–1639.
- 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.
- A. D. Saravanos, Y. Aoyama, H. Zhu, and E. A. Theodorou, “Distributed differential dynamic programming architectures for large-scale multi-agent control,” arXiv preprint arXiv:2207.13255, 2022.
- G. Banjac, F. Rey, P. Goulart, and J. Lygeros, “Decentralized resource allocation via dual consensus ADMM,” in 2019 American Control Conference (ACC). IEEE, 2019, pp. 2789–2794.
- Z. Huang, S. Shen, and J. Ma, “Decentralized iLQR for cooperative trajectory planning of connected autonomous vehicles via dual consensus ADMM,” arXiv preprint arXiv:2301.04386, 2023.
- Y. Tassa, N. Mansard, and E. Todorov, “Control-limited differential dynamic programming,” in 2014 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2014, pp. 1168–1175.
- A. Dosovitskiy, G. Ros, F. Codevilla, A. Lopez, and V. Koltun, “CARLA: An open urban driving simulator,” in Conference on Robot Learning. PMLR, 2017, pp. 1–16.
- 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, pp. 1–36, 2019.