Updated Dstar so that it updates the heuristic values after change