Semi-Autonomous Avoidance of Moving Hazards for Passenger Vehicles

This paper presents a method for semi-autonomous hazard avoidance in the presence of unknown moving obstacles and unpredictable driver inputs. This method iteratively predicts the motion and anticipated intersection of the host vehicle with both static and dynamic hazards and excludes projected collision states from a traversable corridor. A model predictive controller iteratively replans a stability-optimal trajectory through the navigable region of the environment while a threat assessor and semi-autonomous control law modulate driver and controller inputs to maintain stability, preserve controllability, and ensure safe hazard avoidance. The efficacy of this approach is demonstrated through both simulated and experimental results using a semi-autonomously controlled Jaguar S-Type.