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; }
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; }