An Autonomous Driving Framework for Long-term Decision-making and Short-term Trajectory Planning on Frenet Space

Majid Moghadam,Gabriel Hugh Elkaim
DOI: https://doi.org/10.48550/arXiv.2011.13099
2020-11-26
Abstract:In this paper, we present a hierarchical framework for decision-making and planning on highway driving tasks. We utilized intelligent driving models (IDM and MOBIL) to generate long-term decisions based on the traffic situation flowing around the ego. The decisions both maximize ego performance while respecting other vehicles' objectives. Short-term trajectory optimization is performed on the Frenet space to make the calculations invariant to the road's three-dimensional curvatures. A novel obstacle avoidance approach is introduced on the Frenet frame for the moving obstacles. The optimization explores the driving corridors to generate spatiotemporal polynomial trajectories to navigate through the traffic safely and obey the BP commands. The framework also introduces a heuristic supervisor that identifies unexpected situations and recalculates each module in case of a potential emergency. Experiments in CARLA simulation have shown the potential and the scalability of the framework in implementing various driving styles that match human behavior.
Robotics,Systems and Control
What problem does this paper attempt to address?
The problem that this paper attempts to solve is the challenges of long - term decision - making and short - term trajectory planning for autonomous vehicles on highways. Specifically, the author proposes a hierarchical framework to address the following issues: 1. **Intelligent Decision - Making and Planning**: Highway driving tasks require intelligent long - term decisions (such as lane selection, following distance, etc.) and cautious short - term trajectory planning (such as safe lane - changing, obstacle avoidance, etc.) to ensure that autonomous vehicles can drive efficiently and safely. 2. **Traffic Flow Optimization**: It is necessary not only to maximize one's own driving performance but also to respect the goals of other vehicles, thereby improving the overall traffic flow. 3. **Adaptability in Complex Environments**: In a dynamically changing traffic environment, such as in the presence of moving obstacles, how to generate a safe and feasible trajectory is a key issue. 4. **Computational Efficiency and Robustness**: Traditional methods may have problems such as excessive computation time or inability to find solutions when facing complex road conditions. Therefore, a method that can provide reliable solutions within a limited time is required. 5. **Behavioral Diversity**: The ability to achieve different driving styles (such as aggressive, moderate, and conservative) makes the autonomous driving system closer to the behavior patterns of human drivers. To solve these problems, the paper proposes an autonomous driving framework based on Frenet space. It combines intelligent driving models (IDM and MOBIL) to generate long - term decisions and performs short - term trajectory planning in Frenet space through optimization algorithms. At the same time, new obstacle avoidance methods and supervision modules are introduced to improve the safety and reliability of the system. ### Formula Presentation - The acceleration calculation formula in the IDM model: \[ a = a_{\text{max}} \left(1 - \left(\frac{v}{v_0}\right)^{\delta} - \left(\frac{s^*}{s}\right)^2\right) \] where \( s^* = s_0 + T \cdot v + \frac{v \cdot (v - v_{\text{front}})}{2 \sqrt{a_{\text{max}} b_{\text{safe}}}} \) - The lane - changing decision condition in the MOBIL model: \[ \Delta v_{\text{ego}} > p_{\text{coop}} \cdot \Delta v_{\text{adjacent}} \] - In Frenet space, the vehicle position is represented as: \[ \begin{cases} x(s,d) = s_x(s) + d \sin(s'_x(s)) \\ y(s,d) = s_y(s) + d \sin(s'_y(s)) \\ z(s,d) = s_z(s) + d \sin(s'_z(s)) \end{cases} \] These formulas show the key mathematical expressions used in the paper, ensuring the accuracy and readability of the content.