saturation_p fix right at critical point

Signed-off-by: Ian Bell <ian.h.bell@gmail.com>