Added node and grid
Added Dijkstra search