US Patent 11052943 System and method for controlling a vehicle

A control system is configured to receive a first signal indicative of a current position of a vehicle and a second signal indicative of a desired path for the vehicle. The control system is configured to calculate a virtual path between the current position and a target position on the desired path and to output a third signal indicative of curvature command corresponding to an initial curvature of the virtual path to cause a steering control system of the vehicle to adjust a steering angle of the vehicle. The control is also configured to iteratively receive an updated current position, receive any updates to the desired path, calculate an updated target position, calculate an updated virtual path based on the updated current position and updated desired path, and output an updated curvature command corresponding to a respective initial curvature of the updated virtual path as the vehicle travels across a surface.