gps_follow_waypoints: Increase speeds