Fixes waypoint tolerance