Proactive Emergency Collision Avoidance for Automated Driving in Highway Scenarios

Leila Gharavi,Azita Dabiri,Jelske Verkuijlen,Bart De Schutter,Simone Baldi
2024-09-25
Abstract:Uncertainty in the behavior of other traffic participants is a crucial factor in collision avoidance for automated driving; here, stochastic metrics could avoid overly conservative decisions. This paper introduces a Stochastic Model Predictive Control (SMPC) planner for emergency collision avoidance in highway scenarios to proactively minimize collision risk while ensuring safety through chance constraints. To guarantee that the emergency trajectory can be attained, we incorporate nonlinear tire dynamics in the prediction model of the ego vehicle. Further, we exploit Max-Min-Plus-Scaling (MMPS) approximations of the nonlinearities to avoid conservatism, enforce proactive collision avoidance, and improve computational efficiency in terms of performance and speed. Consequently, our contributions include integrating a dynamic ego vehicle model into the SMPC planner, introducing the MMPS approximation for real-time implementation in emergency scenarios, and integrating SMPC with hybridized chance constraints and risk minimization. We evaluate our SMPC formulation in terms of proactivity and efficiency in various hazardous scenarios. Moreover, we demonstrate the effectiveness of our proposed approach by comparing it with a state-of-the-art SMPC planner and we validate that the generated trajectories can be attained using a high-fidelity vehicle model in IPG CarMaker.
Systems and Control
What problem does this paper attempt to address?
This paper attempts to solve the problem of how autonomous vehicles perform active emergency collision avoidance in highway scenarios. Specifically, the paper focuses on how to reduce conservative decisions while ensuring safety by introducing Stochastic Model Predictive Control (SMPC) in an uncertain traffic environment. To achieve this goal, the paper makes the following key contributions: 1. **Introduction of Non - linear Tire Dynamics**: To ensure that the generated emergency trajectories can be realized, the paper adds non - linear tire dynamics to the prediction model, which makes the prediction of available tire forces more accurate. 2. **Use of Max - Min - Plus - Scaling (MMPS) Approximation**: To reduce computational complexity and improve computational efficiency, the paper adopts the MMPS approximation method to handle non - linear terms. This method can not only avoid overly conservative decisions but also improve performance in real - time applications. 3. **Combination of Mixed Chance Constraints and Risk Minimization**: The paper proposes a framework that combines SMPC with mixed chance constraints and risk minimization to achieve efficient active collision avoidance in various dangerous scenarios. ### Formula Presentation - **State and Input Vectors**: \[ s(k)=\begin{bmatrix}x_{\text{ego}}(k)\\y_{\text{ego}}(k)\\\psi(k)\\v(k)\\\beta(k)\\r(k)\\\delta(k)\end{bmatrix} \] \[ u(k)=\begin{bmatrix}F_{xf}(k)\\F_{xr}(k)\\d\delta(k)\end{bmatrix} \] - **Prediction Model**: \[ \dot{x}_{\text{ego}}=\max\{v, v_0[\cos(\psi + \beta)]_{\text{MMPS}}\} \] \[ \dot{y}_{\text{ego}}=v_0[\sin(\psi + \beta)]_{\text{MMPS}} \] \[ \dot{\psi}=r \] \[ \dot{v}=\frac{F_{xf}+F_{xr}}{m}-\frac{[\delta F_{yf}]_{\text{MMPS}}}{m}+v_0[\beta r]_{\text{MMPS}} \] \[ \dot{\beta}=\frac{[F_{yf}+F_{yr}]_{\text{MMPS}}}{m v_0}-r \] \[ \dot{r}=\frac{l_f\delta_0 F_{xf}}{I_{zz}}+\frac{l_f[F_{yf}]_{\text{MMPS}}}{I_{zz}}-\frac{l_r[F_{yr}]_{\text{MMPS}}}{I_{zz}} \] \[ \dot{\delta}=d\delta \] - **MMPS Approximation of Tire Forces**: \[ [F_y]_{\text{MMPS}}=F_{\max}\min\left(\max\left(\frac{\alpha}{\alpha_s}, - 1\right),1\right) \] - **Collision Risk Function**: \[ P(\tilde{s}(k))=\frac{1}{N_p}\sum_{i = 1}^{N_p}\max_{\eta = 1,\ldots,N_o}[\hat{P}]_{\text{MMPS}}(s(k + i|k)) \] - **Optimization Problem**: \[ \min_{\t