> Triggered buffer support uses the HDC100X's dual acquisition mode > to read both humidity and temperature in one shot. comments below > Signed-off-by: Alison Schofield <amsfield22@xxxxxxxxx> > Cc: Daniel Baluta <daniel.baluta@xxxxxxxxx> > --- > drivers/iio/humidity/Kconfig | 2 + > drivers/iio/humidity/hdc100x.c | 144 +++++++++++++++++++++++++++++++++++++++-- > 2 files changed, 140 insertions(+), 6 deletions(-) > > diff --git a/drivers/iio/humidity/Kconfig b/drivers/iio/humidity/Kconfig > index 738a86d..4883ce1 100644 > --- a/drivers/iio/humidity/Kconfig > +++ b/drivers/iio/humidity/Kconfig > @@ -25,6 +25,8 @@ config DHT11 > config HDC100X > tristate "TI HDC100x relative humidity and temperature sensor" > depends on I2C > + select IIO_BUFFER > + select IIO_TRIGGERED_BUFFER > help > Say yes here to build support for the TI HDC100x series of > relative humidity and temperature sensors. > diff --git a/drivers/iio/humidity/hdc100x.c b/drivers/iio/humidity/hdc100x.c > index a03832a..85325d4 100644 > --- a/drivers/iio/humidity/hdc100x.c > +++ b/drivers/iio/humidity/hdc100x.c > @@ -22,13 +22,19 @@ > > #include <linux/iio/iio.h> > #include <linux/iio/sysfs.h> > +#include <linux/iio/buffer.h> > +#include <linux/iio/trigger_consumer.h> > +#include <linux/iio/triggered_buffer.h> > > #define HDC100X_REG_TEMP 0x00 > #define HDC100X_REG_HUMIDITY 0x01 > > #define HDC100X_REG_CONFIG 0x02 > +#define HDC100X_REG_CONFIG_ACQ_MODE BIT(12) > #define HDC100X_REG_CONFIG_HEATER_EN BIT(13) > > +#define HDC100X_ALL_CHANNEL_MASK GENMASK(1, 0) > + > struct hdc100x_data { > struct i2c_client *client; > struct mutex lock; > @@ -87,20 +93,36 @@ static const struct iio_chan_spec hdc100x_channels[] = { > BIT(IIO_CHAN_INFO_SCALE) | > BIT(IIO_CHAN_INFO_INT_TIME) | > BIT(IIO_CHAN_INFO_OFFSET), > + .scan_index = 0, > + .scan_type = { > + .sign = 's', > + .realbits = 16, > + .storagebits = 16, > + .endianness = IIO_CPU, why not use IIO_BE? this avoids the ugly, open-coded endianness conversion in trigger_handler() > + }, > }, > { > .type = IIO_HUMIDITYRELATIVE, > .address = HDC100X_REG_HUMIDITY, > .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | > BIT(IIO_CHAN_INFO_SCALE) | > - BIT(IIO_CHAN_INFO_INT_TIME) > + BIT(IIO_CHAN_INFO_INT_TIME), > + .scan_index = 1, > + .scan_type = { > + .sign = 'u', > + .realbits = 16, > + .storagebits = 16, > + .endianness = IIO_CPU, > + }, > }, > { > .type = IIO_CURRENT, > .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), > .extend_name = "heater", > .output = 1, > + .scan_index = -1, > }, > + IIO_CHAN_SOFT_TIMESTAMP(3), > }; > > static int hdc100x_update_config(struct hdc100x_data *data, int mask, int val) > @@ -191,18 +213,21 @@ static int hdc100x_read_raw(struct iio_dev *indio_dev, > case IIO_CHAN_INFO_RAW: { > int ret; > > - mutex_lock(&data->lock); > if (chan->type == IIO_CURRENT) { > *val = hdc100x_get_heater_status(data); > ret = IIO_VAL_INT; > } else { > + ret = iio_device_claim_direct_mode(indio_dev); > + if (ret) > + return ret; > + > ret = hdc100x_get_measurement(data, chan); > + iio_device_release_direct_mode(indio_dev); > if (ret >= 0) { > *val = ret; > ret = IIO_VAL_INT; > } > } > - mutex_unlock(&data->lock); > return ret; > } > case IIO_CHAN_INFO_INT_TIME: > @@ -259,6 +284,89 @@ static int hdc100x_write_raw(struct iio_dev *indio_dev, > } > } > > +static int hdc100x_buffer_postenable(struct iio_dev *indio_dev) > +{ > + struct hdc100x_data *data = iio_priv(indio_dev); > + int ret; > + > + /* Buffer is enabled. First set ACQ Mode, then attach poll func */ > + mutex_lock(&data->lock); > + ret = hdc100x_update_config(data, HDC100X_REG_CONFIG_ACQ_MODE, > + HDC100X_REG_CONFIG_ACQ_MODE); > + mutex_unlock(&data->lock); > + if (ret) > + return ret; > + > + return iio_triggered_buffer_postenable(indio_dev); > +} > + > +static int hdc100x_buffer_predisable(struct iio_dev *indio_dev) > +{ > + struct hdc100x_data *data = iio_priv(indio_dev); > + int ret; > + > + /* First detach poll func, then reset ACQ mode. OK to disable buffer */ > + ret = iio_triggered_buffer_predisable(indio_dev); > + if (ret) > + return ret; > + > + mutex_lock(&data->lock); > + ret = hdc100x_update_config(data, HDC100X_REG_CONFIG_ACQ_MODE, 0); > + mutex_unlock(&data->lock); > + return ret; > +} > + > +static const struct iio_buffer_setup_ops hdc_buffer_setup_ops = { > + .preenable = NULL, > + .postenable = hdc100x_buffer_postenable, > + .predisable = hdc100x_buffer_predisable, > + .postdisable = NULL, > +}; > + > +static irqreturn_t hdc100x_trigger_handler(int irq, void *p) > +{ > + struct iio_poll_func *pf = p; > + struct iio_dev *indio_dev = pf->indio_dev; > + struct hdc100x_data *data = iio_priv(indio_dev); > + struct i2c_client *client = data->client; > + int delay = data->adc_int_us[0] + data->adc_int_us[1]; > + int ret, i, bit; > + u8 recv_buf[4]; > + s16 push_buf[8]; /* 2x s16 + padding + 8 byte timestamp */ two different buffers really needed? for ALL_CHANNEL_MASK can read directly to push_buf; why is this a special case anyway? if only first channel set, can read directly to push_buf if only second channel set, have to move data within push_buf don't do endianness conversion if not strictly needed > + > + /* dual read starts at temp register */ > + ret = i2c_smbus_write_byte(client, HDC100X_REG_TEMP); > + if (ret < 0) { > + dev_err(&client->dev, "cannot start measurement\n"); > + goto err; > + } > + usleep_range(delay, delay + 1000); > + > + ret = i2c_master_recv(client, recv_buf, sizeof(recv_buf)); > + if (ret < 0) { > + dev_err(&client->dev, "cannot read sensor data\n"); > + goto err; > + } > + if (*indio_dev->active_scan_mask == HDC100X_ALL_CHANNEL_MASK) { > + push_buf[0] = recv_buf[0] << 8 | recv_buf[1]; > + push_buf[1] = recv_buf[2] << 8 | recv_buf[3]; > + } else { > + i = 0; > + for_each_set_bit(bit, indio_dev->active_scan_mask, loop probably overkill for exactly two channels > + indio_dev->masklength) { > + push_buf[i] = bit ? (recv_buf[2] << 8 | recv_buf[3]) > + : (recv_buf[0] << 8 | recv_buf[1]); > + i++; > + } > + } > + iio_push_to_buffers_with_timestamp(indio_dev, push_buf, > + iio_get_time_ns(indio_dev)); > +err: > + iio_trigger_notify_done(indio_dev->trig); > + > + return IRQ_HANDLED; > +} > + > static const struct iio_info hdc100x_info = { > .read_raw = hdc100x_read_raw, > .write_raw = hdc100x_write_raw, > @@ -271,9 +379,10 @@ static int hdc100x_probe(struct i2c_client *client, > { > struct iio_dev *indio_dev; > struct hdc100x_data *data; > + int ret; > > - if (!i2c_check_functionality(client->adapter, > - I2C_FUNC_SMBUS_WORD_DATA | I2C_FUNC_SMBUS_BYTE)) > + if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_WORD_DATA | > + I2C_FUNC_SMBUS_BYTE | I2C_FUNC_I2C)) > return -EOPNOTSUPP; > > indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); > @@ -296,8 +405,30 @@ static int hdc100x_probe(struct i2c_client *client, > /* be sure we are in a known state */ > hdc100x_set_it_time(data, 0, hdc100x_int_time[0][0]); > hdc100x_set_it_time(data, 1, hdc100x_int_time[1][0]); > + hdc100x_update_config(data, HDC100X_REG_CONFIG_ACQ_MODE, 0); > + > + ret = iio_triggered_buffer_setup(indio_dev, NULL, > + hdc100x_trigger_handler, > + &hdc_buffer_setup_ops); > + if (ret < 0) { > + dev_err(&client->dev, "iio triggered buffer setup failed\n"); > + return ret; > + } > + ret = iio_device_register(indio_dev); > + if (ret < 0) > + iio_triggered_buffer_cleanup(indio_dev); > + > + return ret; > +} > + > +static int hdc100x_remove(struct i2c_client *client) > +{ > + struct iio_dev *indio_dev = i2c_get_clientdata(client); > + > + iio_device_unregister(indio_dev); > + iio_triggered_buffer_cleanup(indio_dev); > > - return devm_iio_device_register(&client->dev, indio_dev); > + return 0; > } > > static const struct i2c_device_id hdc100x_id[] = { > @@ -311,6 +442,7 @@ static struct i2c_driver hdc100x_driver = { > .name = "hdc100x", > }, > .probe = hdc100x_probe, > + .remove = hdc100x_remove, > .id_table = hdc100x_id, > }; > module_i2c_driver(hdc100x_driver); > -- Peter Meerwald-Stadler +43-664-2444418 (mobile) -- To unsubscribe from this list: send the line "unsubscribe linux-iio" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html