Added Heuristics to planner