Added waypoint reading functionality