Have you tried reset? (make back up before of waypoint)