Working searching
Party Dijkstra now working using indicies outside graph