int st_magn_common_probe(struct iio_dev *indio_dev) { struct st_sensor_data *mdata = iio_priv(indio_dev); int irq = mdata->get_irq_data_ready(indio_dev); int err; indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->info = &magn_info; mutex_init(&mdata->tb.buf_lock); st_sensors_power_enable(indio_dev); err = st_sensors_check_device_support(indio_dev, ARRAY_SIZE(st_magn_sensors_settings), st_magn_sensors_settings); if (err < 0) return err; mdata->num_data_channels = ST_MAGN_NUMBER_DATA_CHANNELS; mdata->multiread_bit = mdata->sensor_settings->multi_read_bit; indio_dev->channels = mdata->sensor_settings->ch; indio_dev->num_channels = ST_SENSORS_NUMBER_ALL_CHANNELS; mdata->current_fullscale = (struct st_sensor_fullscale_avl *) &mdata->sensor_settings->fs.fs_avl[0]; mdata->odr = mdata->sensor_settings->odr.odr_avl[0].hz; err = st_sensors_init_sensor(indio_dev, NULL); if (err < 0) return err; err = st_magn_allocate_ring(indio_dev); if (err < 0) return err; if (irq > 0) { err = st_sensors_allocate_trigger(indio_dev, ST_MAGN_TRIGGER_OPS); if (err < 0) goto st_magn_probe_trigger_error; } err = iio_device_register(indio_dev); if (err) goto st_magn_device_register_error; dev_info(&indio_dev->dev, "registered magnetometer %s\n", indio_dev->name); return 0; st_magn_device_register_error: if (irq > 0) st_sensors_deallocate_trigger(indio_dev); st_magn_probe_trigger_error: st_magn_deallocate_ring(indio_dev); return err; }
int st_magn_common_probe(struct iio_dev *indio_dev) { int err; struct st_sensor_data *mdata = iio_priv(indio_dev); indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->info = &magn_info; err = st_sensors_check_device_support(indio_dev, ARRAY_SIZE(st_magn_sensors), st_magn_sensors); if (err < 0) goto st_magn_common_probe_error; mdata->multiread_bit = mdata->sensor->multi_read_bit; indio_dev->channels = mdata->sensor->ch; indio_dev->num_channels = ST_SENSORS_NUMBER_ALL_CHANNELS; mdata->current_fullscale = (struct st_sensor_fullscale_avl *) &mdata->sensor->fs.fs_avl[0]; mdata->odr = mdata->sensor->odr.odr_avl[0].hz; err = st_sensors_init_sensor(indio_dev); if (err < 0) goto st_magn_common_probe_error; if (mdata->get_irq_data_ready(indio_dev) > 0) { err = st_magn_allocate_ring(indio_dev); if (err < 0) goto st_magn_common_probe_error; err = st_sensors_allocate_trigger(indio_dev, NULL); if (err < 0) goto st_magn_probe_trigger_error; } err = iio_device_register(indio_dev); if (err) goto st_magn_device_register_error; return err; st_magn_device_register_error: if (mdata->get_irq_data_ready(indio_dev) > 0) st_sensors_deallocate_trigger(indio_dev); st_magn_probe_trigger_error: if (mdata->get_irq_data_ready(indio_dev) > 0) st_magn_deallocate_ring(indio_dev); st_magn_common_probe_error: return err; }