fwd_dist now uses heading to maintain straight path