A method of operating a vehicle includes a vehicle controller receiving a driver acceleration/deceleration command for the vehicle's powertrain and determining a torque request corresponding to the driver's acceleration command. The controller shapes the torque request and determines compensated and uncompensated accelerations from the shaped torque request. The compensated acceleration is based on an estimated road grade and an estimated vehicle mass, whereas the uncompensated acceleration is based on a zero road grade and a nominal vehicle mass. A final speed horizon profile is calculated as: a speed-control speed profile based on the uncompensated acceleration if the vehicle's speed is below a preset low vehicle speed; or a torque-control speed profile based on a blend of the compensated and uncompensated accelerations if the vehicle speed exceeds the preset low vehicle speed. The controller commands the powertrain to output a requested axle torque based on the final speed horizon profile.