ADAPTIVE PATH FOLLOWING ALGORITHM FOR HEAVY-DUTY VEHICLES

A method for controlling a heavy-duty vehicle to follow a reference path (P), comprising determining a goal point along the reference path to be used as a steering reference from a vehicle location in vicinity of the path, where the goal point is distanced along the path by a preview distance measured from a reference location associated with the vehicle location, determining a direction wof a first flow field associated with the reference path, determining whether a lateral deviation of the vehicle location from the reference path exceeds a threshold lateral deviation, and controlling the vehicle in accordance with the direction wof a first flow field if the lateral deviation exceeds the threshold lateral deviation, and otherwise controlling the vehicle in accordance with the direction wof a pipe flow substantially parallel to the reference path or in accordance with an optimization-based path.