A unified framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles

Abstract

This thesis describes the design of an active safety framework that performs trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios. The vehicle navigation task is formulated as a constrained optimal control problem with the constraints bounding a navigable region of the environment derived from forward -looking sensors. First, a constrained model predictive controller is designed to iteratively plan an optimal or "best-case" vehicle trajectory through the constrained corridor. This "best-case" scenario is then used to establish the minimum threat posed to the vehicle given its current state and driver inputs. Based on this threat assessment, the level of controller intervention required to prevent departure from the navigable corridor is calculated and driver/controller inputs are scaled accordingly. This approach minimizes controller intervention while ensuring that the vehicle does not depart from a navigable 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. Simulated and experimental results are presented to demonstrate the framework's ability to incorporate multiple threat metrics and configurable intervention laws while sharing control with a human driver. Various maneuvers are tested, including lane-keeping, hazard avoidance, and multiple hazard avoidance and show that this framework capable of maintaining vehicle stability while semi-autonomously avoiding road hazards and conceding significant control to the human driver.