Implemented a general Dijkstra search, and an example of it running on a 2D grid