began graph search.  need robot start and end added to graph?