Integrated Behavior Planning and Motion Control for Autonomous Vehicles with Traffic Rules Compliance (2304.01041v2)
Abstract: In this article, we propose an optimization-based integrated behavior planning and motion control scheme, which is an interpretable and adaptable urban autonomous driving solution that complies with complex traffic rules while ensuring driving safety. Inherently, to ensure compliance with traffic rules, an innovative design of potential functions (PFs) is presented to characterize various traffic rules related to traffic lights, traversable and non-traversable traffic line markings, etc. These PFs are further incorporated as part of the model predictive control (MPC) formulation. In this sense, high-level behavior planning is attained implicitly along with motion control as an integrated architecture, facilitating flexible maneuvers with safety guarantees. Due to the well-designed objective function of the MPC scheme, our integrated behavior planning and motion control scheme is competent for various urban driving scenarios and able to generate versatile behaviors, such as overtaking with adaptive cruise control, turning in the intersection, and merging in and out of the roundabout. As demonstrated from a series of simulations with challenging scenarios in CARLA, it is noteworthy that the proposed framework admits real-time performance and high generalizability.
- Y. Qi, B. He, R. Wang, L. Wang, and Y. Xu, “Hierarchical motion planning for autonomous vehicles in unstructured dynamic environments,” IEEE Robotics and Automation Letters, vol. 8, no. 2, pp. 496–503, 2022.
- A. Prakash, K. Chitta, and A. Geiger, “Multi-modal fusion transformer for end-to-end autonomous driving,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, 2021, pp. 7077–7087.
- 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.
- Z. Zhang, L. Zhang, J. Deng, M. Wang, Z. Wang, and D. Cao, “An enabling trajectory planning scheme for lane change collision avoidance on highways,” IEEE Transactions on Intelligent Vehicles, 2021.
- 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.
- 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. 23 031–23 042, 2022.
- 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, 2022.
- 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, pp. 1–13, 2023.
- Y. Guan, Y. Ren, Q. Sun, S. E. Li, H. Ma, J. Duan, Y. Dai, and B. Cheng, “Integrated decision and control: toward interpretable and computationally efficient driving intelligence,” IEEE transactions on cybernetics, vol. 53, no. 2, pp. 859–873, 2022.
- Y. E. Sahin, R. Quirynen, and S. Di Cairano, “Autonomous vehicle decision-making and monitoring based on signal temporal logic and mixed-integer programming,” in 2020 American Control Conference (ACC). IEEE, 2020, pp. 454–459.
- F. Eiras, M. Hawasly, S. V. Albrecht, and S. Ramamoorthy, “A two-stage optimization-based motion planner for safe urban driving,” IEEE Transactions on Robotics, vol. 38, no. 2, pp. 822–834, 2021.
- Y. Rasekhipour, A. Khajepour, S.-K. Chen, and B. Litkouhi, “A potential field-based model predictive path-planning controller for autonomous road vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 18, no. 5, pp. 1255–1267, 2016.
- H. Wang, Y. Huang, A. Khajepour, Y. Zhang, Y. Rasekhipour, and D. Cao, “Crash mitigation in motion planning for autonomous vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 20, no. 9, pp. 3313–3323, 2019.
- Y. Ma, P. Zhang, and B. Hu, “Active lane-changing model of vehicle in b-type weaving region based on potential energy field theory,” Physica A: Statistical Mechanics and its Applications, vol. 535, p. 122291, 2019.
- Q. Zhang, L. Qian, L. Liu, L. Ding, and F. Yang, “An integrated framework of autonomous vehicles based on distributed potential field in bev,” in 2022 IEEE International Conference on Robotics and Biomimetics (ROBIO). IEEE, 2022, pp. 1313–1320.
- Y. Yan, J. Wang, Y. Wang, C. Hu, H. Huang, and G. Yin, “A cooperative trajectory planning system based on the passengers’ individual preferences of aggressiveness,” IEEE Transactions on Vehicular Technology, vol. 72, no. 1, pp. 395–406, 2022.
- S. Bae, Y. Kim, J. Guanetti, F. Borrelli, and S. Moura, “Design and implementation of ecological adaptive cruise control for autonomous driving with communication to traffic lights,” in 2019 American Control Conference (ACC). IEEE, 2019, pp. 4628–4634.
- Q. Ge, Q. Sun, S. E. Li, S. Zheng, W. Wu, and X. Chen, “Numerically stable dynamic bicycle model for discrete-time control,” in 2021 IEEE Intelligent Vehicles Symposium Workshops (IV Workshops). IEEE, 2021, pp. 128–134.
- J. A. E. 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.
- T. Weerakoon, K. Ishii, and A. A. F. Nassiraei, “An artificial potential field based mobile robot navigation method to prevent from deadlock,” Journal of Artificial Intelligence and Soft Computing Research, vol. 5, no. 3, pp. 189–203, 2015.
- 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.