int st_press_common_probe(struct iio_dev *indio_dev) { int err; struct st_sensor_data *pdata = iio_priv(indio_dev); indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->info = &press_info; err = st_sensors_check_device_support(indio_dev, ARRAY_SIZE(st_press_sensors), st_press_sensors); if (err < 0) goto st_press_common_probe_error; pdata->num_data_channels = ST_PRESS_NUMBER_DATA_CHANNELS; pdata->multiread_bit = pdata->sensor->multi_read_bit; indio_dev->channels = pdata->sensor->ch; indio_dev->num_channels = ARRAY_SIZE(st_press_channels); pdata->current_fullscale = (struct st_sensor_fullscale_avl *) &pdata->sensor->fs.fs_avl[0]; pdata->odr = pdata->sensor->odr.odr_avl[0].hz; err = st_sensors_init_sensor(indio_dev); if (err < 0) goto st_press_common_probe_error; if (pdata->get_irq_data_ready(indio_dev) > 0) { err = st_press_allocate_ring(indio_dev); if (err < 0) goto st_press_common_probe_error; err = st_sensors_allocate_trigger(indio_dev, ST_PRESS_TRIGGER_OPS); if (err < 0) goto st_press_probe_trigger_error; } err = iio_device_register(indio_dev); if (err) goto st_press_device_register_error; return err; st_press_device_register_error: if (pdata->get_irq_data_ready(indio_dev) > 0) st_sensors_deallocate_trigger(indio_dev); st_press_probe_trigger_error: if (pdata->get_irq_data_ready(indio_dev) > 0) st_press_deallocate_ring(indio_dev); st_press_common_probe_error: return err; }
int st_press_common_probe(struct iio_dev *indio_dev) { struct st_sensor_data *press_data = iio_priv(indio_dev); int irq = press_data->get_irq_data_ready(indio_dev); int err; indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->info = &press_info; mutex_init(&press_data->tb.buf_lock); err = st_sensors_power_enable(indio_dev); if (err) return err; err = st_sensors_check_device_support(indio_dev, ARRAY_SIZE(st_press_sensors_settings), st_press_sensors_settings); if (err < 0) goto st_press_power_off; /* * Skip timestamping channel while declaring available channels to * common st_sensor layer. Look at st_sensors_get_buffer_element() to * see how timestamps are explicitly pushed as last samples block * element. */ press_data->num_data_channels = press_data->sensor_settings->num_ch - 1; press_data->multiread_bit = press_data->sensor_settings->multi_read_bit; indio_dev->channels = press_data->sensor_settings->ch; indio_dev->num_channels = press_data->sensor_settings->num_ch; press_data->current_fullscale = (struct st_sensor_fullscale_avl *) &press_data->sensor_settings->fs.fs_avl[0]; press_data->odr = press_data->sensor_settings->odr.odr_avl[0].hz; /* Some devices don't support a data ready pin. */ if (!press_data->dev->platform_data && press_data->sensor_settings->drdy_irq.addr) press_data->dev->platform_data = (struct st_sensors_platform_data *)&default_press_pdata; err = st_sensors_init_sensor(indio_dev, press_data->dev->platform_data); if (err < 0) goto st_press_power_off; err = st_press_allocate_ring(indio_dev); if (err < 0) goto st_press_power_off; if (irq > 0) { err = st_sensors_allocate_trigger(indio_dev, ST_PRESS_TRIGGER_OPS); if (err < 0) goto st_press_probe_trigger_error; } err = iio_device_register(indio_dev); if (err) goto st_press_device_register_error; dev_info(&indio_dev->dev, "registered pressure sensor %s\n", indio_dev->name); return err; st_press_device_register_error: if (irq > 0) st_sensors_deallocate_trigger(indio_dev); st_press_probe_trigger_error: st_press_deallocate_ring(indio_dev); st_press_power_off: st_sensors_power_disable(indio_dev); return err; }
int st_press_common_probe(struct iio_dev *indio_dev) { struct st_sensor_data *press_data = iio_priv(indio_dev); int irq = press_data->get_irq_data_ready(indio_dev); int err; indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->info = &press_info; mutex_init(&press_data->tb.buf_lock); st_sensors_power_enable(indio_dev); err = st_sensors_check_device_support(indio_dev, ARRAY_SIZE(st_press_sensors_settings), st_press_sensors_settings); if (err < 0) return err; press_data->num_data_channels = ST_PRESS_NUMBER_DATA_CHANNELS; press_data->multiread_bit = press_data->sensor_settings->multi_read_bit; indio_dev->channels = press_data->sensor_settings->ch; indio_dev->num_channels = press_data->sensor_settings->num_ch; if (press_data->sensor_settings->fs.addr != 0) press_data->current_fullscale = (struct st_sensor_fullscale_avl *) &press_data->sensor_settings->fs.fs_avl[0]; press_data->odr = press_data->sensor_settings->odr.odr_avl[0].hz; /* Some devices don't support a data ready pin. */ if (!press_data->dev->platform_data && press_data->sensor_settings->drdy_irq.addr) press_data->dev->platform_data = (struct st_sensors_platform_data *)&default_press_pdata; err = st_sensors_init_sensor(indio_dev, press_data->dev->platform_data); if (err < 0) return err; err = st_press_allocate_ring(indio_dev); if (err < 0) return err; if (irq > 0) { err = st_sensors_allocate_trigger(indio_dev, ST_PRESS_TRIGGER_OPS); if (err < 0) goto st_press_probe_trigger_error; } err = iio_device_register(indio_dev); if (err) goto st_press_device_register_error; dev_info(&indio_dev->dev, "registered pressure sensor %s\n", indio_dev->name); return err; st_press_device_register_error: if (irq > 0) st_sensors_deallocate_trigger(indio_dev); st_press_probe_trigger_error: st_press_deallocate_ring(indio_dev); return err; }