FirstDraft

Added start of breath first search. has data structures for
points(nodes) and edges.