dijkstra working for 3d (though it crushes). working on optimization now