Distance Heuristics working - manhattan and euclidean