int st_sensors_read_info_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *ch, int *val) { int err; struct st_sensor_data *sdata = iio_priv(indio_dev); mutex_lock(&indio_dev->mlock); if (indio_dev->currentmode == INDIO_BUFFER_TRIGGERED) { err = -EBUSY; goto out; } else { err = st_sensors_set_enable(indio_dev, true); if (err < 0) goto out; msleep((sdata->sensor_settings->bootime * 1000) / sdata->odr); err = st_sensors_read_axis_data(indio_dev, ch, val); if (err < 0) goto out; *val = *val >> ch->scan_type.shift; err = st_sensors_set_enable(indio_dev, false); } out: mutex_unlock(&indio_dev->mlock); return err; }
int st_sensors_init_sensor(struct iio_dev *indio_dev) { int err; struct st_sensor_data *sdata = iio_priv(indio_dev); mutex_init(&sdata->tb.buf_lock); err = st_sensors_set_enable(indio_dev, false); if (err < 0) goto init_error; err = st_sensors_set_fullscale(indio_dev, sdata->current_fullscale->num); if (err < 0) goto init_error; err = st_sensors_set_odr(indio_dev, sdata->odr); if (err < 0) goto init_error; /* set BDU */ err = st_sensors_write_data_with_mask(indio_dev, sdata->sensor->bdu.addr, sdata->sensor->bdu.mask, true); if (err < 0) goto init_error; err = st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS); init_error: return err; }
static int st_press_buffer_preenable(struct iio_dev *indio_dev) { int err; err = st_sensors_set_enable(indio_dev, true); if (err < 0) goto st_press_set_enable_error; err = iio_sw_buffer_preenable(indio_dev); st_press_set_enable_error: return err; }
static int st_press_buffer_predisable(struct iio_dev *indio_dev) { int err; struct st_sensor_data *pdata = iio_priv(indio_dev); err = iio_triggered_buffer_predisable(indio_dev); if (err < 0) goto st_press_buffer_predisable_error; err = st_sensors_set_enable(indio_dev, false); st_press_buffer_predisable_error: kfree(pdata->buffer_data); return err; }
int st_sensors_init_sensor(struct iio_dev *indio_dev, struct st_sensors_platform_data *pdata) { struct st_sensor_data *sdata = iio_priv(indio_dev); struct st_sensors_platform_data *of_pdata; int err = 0; /* If OF/DT pdata exists, it will take precedence of anything else */ of_pdata = st_sensors_of_probe(indio_dev->dev.parent, pdata); if (of_pdata) pdata = of_pdata; if (pdata) { err = st_sensors_set_drdy_int_pin(indio_dev, pdata); if (err < 0) return err; } err = st_sensors_set_enable(indio_dev, false); if (err < 0) return err; if (sdata->current_fullscale) { err = st_sensors_set_fullscale(indio_dev, sdata->current_fullscale->num); if (err < 0) return err; } else dev_info(&indio_dev->dev, "Full-scale not possible\n"); err = st_sensors_set_odr(indio_dev, sdata->odr); if (err < 0) return err; /* set BDU */ err = st_sensors_write_data_with_mask(indio_dev, sdata->sensor_settings->bdu.addr, sdata->sensor_settings->bdu.mask, true); if (err < 0) return err; err = st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS); return err; }
static int st_gyro_buffer_predisable(struct iio_dev *indio_dev) { int err; struct st_sensor_data *gdata = iio_priv(indio_dev); err = iio_triggered_buffer_predisable(indio_dev); if (err < 0) goto st_gyro_buffer_predisable_error; err = st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS); if (err < 0) goto st_gyro_buffer_predisable_error; err = st_sensors_set_enable(indio_dev, false); st_gyro_buffer_predisable_error: kfree(gdata->buffer_data); return err; }
int st_sensors_init_sensor(struct iio_dev *indio_dev, struct st_sensors_platform_data *pdata) { struct st_sensor_data *sdata = iio_priv(indio_dev); struct st_sensors_platform_data *of_pdata; int err = 0; /* If OF/DT pdata exists, it will take precedence of anything else */ of_pdata = st_sensors_of_probe(indio_dev->dev.parent, pdata); if (of_pdata) pdata = of_pdata; if (pdata) { err = st_sensors_set_drdy_int_pin(indio_dev, pdata); if (err < 0) return err; } err = st_sensors_set_enable(indio_dev, false); if (err < 0) return err; /* Disable DRDY, this might be still be enabled after reboot. */ err = st_sensors_set_dataready_irq(indio_dev, false); if (err < 0) return err; if (sdata->current_fullscale) { err = st_sensors_set_fullscale(indio_dev, sdata->current_fullscale->num); if (err < 0) return err; } else dev_info(&indio_dev->dev, "Full-scale not possible\n"); err = st_sensors_set_odr(indio_dev, sdata->odr); if (err < 0) return err; /* set BDU */ if (sdata->sensor_settings->bdu.addr) { err = st_sensors_write_data_with_mask(indio_dev, sdata->sensor_settings->bdu.addr, sdata->sensor_settings->bdu.mask, true); if (err < 0) return err; } if (sdata->int_pin_open_drain) { dev_info(&indio_dev->dev, "set interrupt line to open drain mode\n"); err = st_sensors_write_data_with_mask(indio_dev, sdata->sensor_settings->drdy_irq.addr_od, sdata->sensor_settings->drdy_irq.mask_od, 1); if (err < 0) return err; } err = st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS); return err; }
static int st_gyro_buffer_preenable(struct iio_dev *indio_dev) { return st_sensors_set_enable(indio_dev, true); }