Add back the function "get_waypoint"