摘要 |
An active safety framework performs trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in a unified, optimal fashion. The vehicle navigation task is formulated as a constrained optimal control problem. A predictive, model-based controller iteratively plans an optimal or best-case vehicle trajectory through the constrained corridor. This best-case scenario is used to establish the minimum threat posed to the vehicle given its current state, current and past driver inputs/performance, and environmental conditions. Based on this threat assessment, the level of controller intervention required to prevent collisions or instability is calculated and driver/controller inputs are scaled accordingly. This approach minimizes controller intervention while ensuring that the vehicle does not depart from a traversable corridor. It also provides a unified architecture into which various vehicle models, actuation modes, trajectory-planning objectives, driver preferences, and levels of autonomy can be seamlessly integrated without changing the underlying controller structure. |