Waypoint Switching ausgearbeitet