Clamp Function Java