Change heuristic + Add HashMap nodesWeight