Integrated Behavior Planning and Motion Control for Autonomous Vehicles with Traffic Rules Compliance
Preprint
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.Keywords
All Related Versions
This publication has 14 references indexed in Scilit:
- Decentralized iLQR for Cooperative Trajectory Planning of Connected Autonomous Vehicles via Dual Consensus ADMMIEEE Transactions on Intelligent Transportation Systems, 2023
- Hierarchical Motion Planning for Autonomous Vehicles in Unstructured Dynamic EnvironmentsIEEE Robotics and Automation Letters, 2022
- Alternating Direction Method of Multipliers for Constrained Iterative LQR in Autonomous DrivingIEEE Transactions on Intelligent Transportation Systems, 2022
- Local Learning Enabled Iterative Linear Quadratic Regulator for Constrained Trajectory PlanningIEEE Transactions on Neural Networks and Learning Systems, 2022
- Integrated Decision and Control: Toward Interpretable and Computationally Efficient Driving IntelligenceIEEE Transactions on Cybernetics, 2022
- An Enabling Trajectory Planning Scheme for Lane Change Collision Avoidance on HighwaysIEEE Transactions on Intelligent Vehicles, 2021
- Active lane-changing model of vehicle in B-type weaving region based on potential energy field theoryPhysica A: Statistical Mechanics and its Applications, 2019
- Crash Mitigation in Motion Planning for Autonomous VehiclesIEEE Transactions on Intelligent Transportation Systems, 2019
- CasADi: a software framework for nonlinear optimization and optimal controlMathematical Programming Computation, 2018
- A Potential Field-Based Model Predictive Path-Planning Controller for Autonomous Road VehiclesIEEE Transactions on Intelligent Transportation Systems, 2016