Update heuristic.cpp