Waypoint switching working. Custom coords working