VEHICLE DYNAMICS CONTROL SYSTEM UTILIZING HEADING ERROR AND DERIVATIVE

Systems and methods for controlling a vehicle. The system includes a plurality of sensors and an electronic controller. The electronic controller is configured to receive data from the plurality of sensors and determine a target vehicle travel direction of the vehicle based on the received data. The electronic controller then determines a heading error based on the target travel direction, determines a heading error derivative, and generates a vehicle control command based on the heading error and the heading error derivative.