Fixed bugs
Fixed equality bug
Fixed heuristic to have monotonicity