Fixed saturate function.