A swath tracking system for an off-road vehicle includes a control system with a processor and a memory. The control system is configured to receive a plurality of vehicle location points and a current vehicle state, wherein the current vehicle state comprises a current vehicle location, generate a planned vehicle path through one or more of the plurality of vehicle location points, generate a correction path from the current vehicle location to a point along the planned vehicle path ahead of the current vehicle location along a direction of travel, generate a blended path by blending the planned vehicle path and the correction path based at least in part on an assigned weight, wherein the assigned weight is based at least in part on a heading error, a distance between the current vehicle location and the planned path, or a combination thereof, and guide the off-road vehicle along the blended path.