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_gyro_buffer_postenable(struct iio_dev *indio_dev) { int err; struct st_sensor_data *gdata = iio_priv(indio_dev); gdata->buffer_data = kmalloc(indio_dev->scan_bytes, GFP_KERNEL); if (gdata->buffer_data == NULL) { err = -ENOMEM; goto allocate_memory_error; } err = st_sensors_set_axis_enable(indio_dev, (u8)indio_dev->active_scan_mask[0]); if (err < 0) goto st_gyro_buffer_postenable_error; err = iio_triggered_buffer_postenable(indio_dev); if (err < 0) goto st_gyro_buffer_postenable_error; return err; st_gyro_buffer_postenable_error: kfree(gdata->buffer_data); allocate_memory_error: 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; }