Try to get one waypoint working