An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios

This paper formulates the vehicle navigation task as a constrained optimal control problem with constraints bounding a traversable region of the environment. A model predictive controller iteratively plans an optimal vehicle trajectory through the constrained corridor and uses this trajectory 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 traversable corridor is calculated and driver/controller inputs are scaled accordingly. Simulated and experimental results are presented to demonstrate multiple threat metrics and configurable intervention laws.