Better path following from A* waypoints.