Adding euclidean and 3d distance heuristics

3d manhattan distance heuristic still needs to be implemented