iio: humidity: hts221: refactor write_with_mask code