Dijkstra, A*, JPS, MinHeap DONE