Added hasNextWaypoint()
Added command functions