Abstract:Automated vehicles require efficient and safe planning to maneuver in uncertain environments. Largely this uncertainty is caused by other traffic participants, e.g., surrounding vehicles. Future motion of surrounding vehicles is often difficult to predict. Whereas robust control approaches achieve safe, yet conservative motion planning for automated vehicles, Stochastic Model Predictive Control (SMPC) provides efficient planning in the presence of uncertainty. Probabilistic constraints are applied to ensure that the maximal risk remains below a predefined level. However, safety cannot be ensured as probabilistic constraints may be violated, which is not acceptable for automated vehicles. Here, we propose an efficient trajectory planning framework with safety guarantees for automated vehicles. SMPC is applied to obtain efficient vehicle trajectories for a finite horizon. Based on the first optimized SMPC input, a guaranteed safe backup trajectory is planned using reachable sets. This backup is used to overwrite the SMPC input if necessary for safety. Recursive feasibility of the safe SMPC algorithm is proved. Highway simulations show the effectiveness of the proposed method regarding performance and safety.

What problem does this paper attempt to address?

The problem that this paper attempts to solve is how to plan vehicle trajectories efficiently and safely in autonomous driving. Specifically, autonomous vehicles need to carry out effective path planning in an uncertain environment to avoid collisions with other traffic participants (such as surrounding vehicles). This uncertainty mainly stems from the difficulty in predicting the future movements of other traffic participants. Although robust control methods can achieve safe but conservative motion planning, and Stochastic Model Predictive Control (SMPC) can provide efficient planning in the presence of uncertainty, SMPC cannot fully guarantee safety because probability constraints may be violated. For this reason, the author proposes a method that combines SMPC and Fail - Safe Trajectory Planning (FTP), called SMPC+FTP. This method ensures the safety and efficiency of vehicle trajectories through the following steps: 1. **SMPC part**: Use SMPC to generate efficient vehicle trajectories within a limited time range. SMPC takes into account the uncertainty in the environment and ensures that the maximum risk is below a predefined level through probability constraints. 2. **FTP part**: Based on the first optimized SMPC input, use reachable sets to plan a backup trajectory that guarantees safety. If a safe backup trajectory can still be found after applying the first SMPC input, then apply the SMPC input; otherwise, apply the backup trajectory to ensure safety. 3. **Recursive feasibility**: Prove the recursive feasibility of the proposed SMPC+FTP method, that is, if there is a solution at one time step, there must also be a solution at the next time step. 4. **Simulation verification**: Verify the effectiveness of this method through highway simulation experiments, demonstrating its advantages in performance and safety. In conclusion, the main contribution of this paper is to propose a new SMPC+FTP method that can efficiently and safely plan the trajectories of autonomous vehicles in an uncertain environment.

Stochastic Model Predictive Control with a Safety Guarantee for Automated Driving: Extended Version

Stochastic Model Predictive Control for Urban Traffic Networks

Safe and Non-Conservative Trajectory Planning for Autonomous Driving Handling Unanticipated Behaviors of Traffic Participants

Predictive Control for Autonomous Driving with Uncertain, Multi-modal Predictions

Distributed Stochastic Model Predictive Control for a Microscopic Interactive Traffic Model

Robust Car-Following Control of Connected and Autonomous Vehicles: A Stochastic Model Predictive Control Approach

Drive with Quantified Risk: A Probabilistic Approach for Occlusion-Aware Trajectory Planning

Proactive Emergency Collision Avoidance for Automated Driving in Highway Scenarios

Safe Stochastic Model Predictive Control

Risk in Stochastic and Robust Model Predictive Path-Following Control for Vehicular Motion Planning

Adaptive Fault Tolerant Control for Safe Autonomous Driving Using Learning-based Model Predictive Control

Application Of Stochastic Model Predictive Control To Modeling Driver Steering Skills

Safety-Dominant Stochastic Model Predictive Decision-Making Considering Obstacle Trajectory Uncertainties for Intelligent Vehicles

A Stochastic Nonlinear Model Predictive Control with an Uncertainty Propagation Horizon for Autonomous Vehicle Motion Control

A Safe Control Architecture Based on Robust Model Predictive Control for Autonomous Driving

A Novel Stochastic Model Predictive Control Considering Predictable Disturbance With Application to Personalized Adaptive Cruise Control

Safe Motion Planning and Control Framework for Automated Vehicles with Zonotopic TRMPC

A Stochastic Model Predictive Control Approach for Modelling Human Driver Steering Control

Long Horizon Risk-Averse Motion Planning: a Model-Predictive Approach

Surrogate-Driven Multi-Objective Predictive Control for Electric Vehicular Platoon

Probabilistically safe controllers based on control barrier functions and scenario model predictive control