Model predictive lane centering control with reference switching and disturbance rejection

Abstract

A model predictive lane centering (MPLC) control system with reference switching and disturbance rejection includes: an MPLC application having control logic that utilizes model predictive control (MPC) for selectively tracking static and dynamic references, adapts MPC weights and constraints for trajectory tracking when the system switches between static and dynamic references. A Kalman filter estimates a lateral force disturbance, a yaw moment disturbance acting upon a vehicle, and a measurement bias corrupting a measured yaw rate. The system detects anomalies in MPC reference trajectory and adjusts actuator constraints in response to detected anomalies. The system actively and continuously adjusts actuator outputs, causing the vehicle to track and follow a current lane center, and on receiving a lane change command, smoothly changes lanes using vehicle actuators to alter position and alter a vehicle trajectory to enter an adjacent lane before returning to tracking and following a center of the adjacent lane.