Safety Tunnel-Based Model Predictive Path-Planning Controller With Potential Functions for Emergency Navigation

Abstract

The potential functions (PFs) have generally shown good performances in real-time path planning with computation efficiency conforming to the requirements of lower control systems in autonomous driving. However, several inherent limitations exist in using the PFs, including a local minimum in specific scenarios and no passage between closely spaced obstacles. Recent studies have focused on conventional scenarios where PFs are assumed to work normally, without malfunctioning, occurring during perilous situations. Therefore, we propose a specific safety tunnel (ST)-based model predictive controller (MPC) combined with PFs (PF-STMPC) to handle path-planning in extreme-emergency traffic scenarios (e.g., emergency braking and lane-changing obstacles). To further guarantee driving safety, we improve PFs with the responsibility-sensitive safety (RSS) model that accurately calculates the minimum safe longitudinal and lateral distances. Furthermore, a sigmoid-based ST is designed for emergency navigation if the PFs fail to plan a safe path due to the aforementioned inherent limitations, enabling the controller with planning functionality if necessary. The ST is embedded in the MPC-based tracking controller as a safe constraint sensitive to surrounding environments (e.g., road structure and obstacles). The proposed PF-STMPC was co-simulated using MATLAB/Simulink and CarSim Simulator under the constant speed condition. Compared with the state-of-the-art method, the proposed method demonstrated better performance in finding a safe path and eliminating severe yawing of the ego-vehicle (82.8% less in sideslip yawing amplitude and 57.7% shorter in the oscillation period of yaw angle) when facing traffic emergencies.