Think I have A* algorithm going. Need to get collection of Segments.