Lines Matching refs:data
231 static int bmc150_magn_set_power_mode(struct bmc150_magn_data *data,
239 ret = regmap_update_bits(data->regmap, BMC150_MAGN_REG_POWER,
246 return regmap_update_bits(data->regmap,
252 return regmap_update_bits(data->regmap,
262 static int bmc150_magn_set_power_state(struct bmc150_magn_data *data, bool on)
268 ret = pm_runtime_resume_and_get(data->dev);
270 pm_runtime_mark_last_busy(data->dev);
271 ret = pm_runtime_put_autosuspend(data->dev);
275 dev_err(data->dev,
284 static int bmc150_magn_get_odr(struct bmc150_magn_data *data, int *val)
289 ret = regmap_read(data->regmap, BMC150_MAGN_REG_OPMODE_ODR, ®_val);
303 static int bmc150_magn_set_odr(struct bmc150_magn_data *data, int val)
310 ret = regmap_update_bits(data->regmap,
325 static int bmc150_magn_set_max_odr(struct bmc150_magn_data *data, int rep_xy,
331 ret = regmap_read(data->regmap, BMC150_MAGN_REG_REP_XY,
338 ret = regmap_read(data->regmap, BMC150_MAGN_REG_REP_Z,
345 ret = bmc150_magn_get_odr(data, &odr);
352 dev_err(data->dev,
357 data->max_odr = max_odr;
426 static int bmc150_magn_read_xyz(struct bmc150_magn_data *data, s32 *buffer)
434 ret = regmap_bulk_read(data->regmap, BMC150_MAGN_REG_X_L,
444 ret = regmap_bulk_read(data->regmap, BMC150_MAGN_REG_TRIM_START,
460 struct bmc150_magn_data *data = iio_priv(indio_dev);
468 mutex_lock(&data->mutex);
470 ret = bmc150_magn_set_power_state(data, true);
472 mutex_unlock(&data->mutex);
476 ret = bmc150_magn_read_xyz(data, values);
478 bmc150_magn_set_power_state(data, false);
479 mutex_unlock(&data->mutex);
484 ret = bmc150_magn_set_power_state(data, false);
486 mutex_unlock(&data->mutex);
490 mutex_unlock(&data->mutex);
495 * compensation and outputs x/y/z magnetic field data in
502 ret = bmc150_magn_get_odr(data, val);
510 ret = regmap_read(data->regmap, BMC150_MAGN_REG_REP_XY,
517 ret = regmap_read(data->regmap, BMC150_MAGN_REG_REP_Z,
535 struct bmc150_magn_data *data = iio_priv(indio_dev);
540 if (val > data->max_odr)
542 mutex_lock(&data->mutex);
543 ret = bmc150_magn_set_odr(data, val);
544 mutex_unlock(&data->mutex);
552 mutex_lock(&data->mutex);
553 ret = bmc150_magn_set_max_odr(data, val, 0, 0);
555 mutex_unlock(&data->mutex);
558 ret = regmap_update_bits(data->regmap,
563 mutex_unlock(&data->mutex);
568 mutex_lock(&data->mutex);
569 ret = bmc150_magn_set_max_odr(data, 0, val, 0);
571 mutex_unlock(&data->mutex);
574 ret = regmap_update_bits(data->regmap,
579 mutex_unlock(&data->mutex);
594 struct bmc150_magn_data *data = iio_priv(indio_dev);
599 if (bmc150_magn_samp_freq_table[i].freq > data->max_odr)
614 struct bmc150_magn_data *data = iio_priv(indio_dev);
616 return &data->orientation;
674 struct bmc150_magn_data *data = iio_priv(indio_dev);
677 mutex_lock(&data->mutex);
678 ret = bmc150_magn_read_xyz(data, data->scan.chans);
682 iio_push_to_buffers_with_timestamp(indio_dev, &data->scan,
686 mutex_unlock(&data->mutex);
692 static int bmc150_magn_init(struct bmc150_magn_data *data)
697 ret = regulator_bulk_enable(ARRAY_SIZE(data->regulators),
698 data->regulators);
700 dev_err(data->dev, "Failed to enable regulators: %d\n", ret);
709 ret = bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SUSPEND,
712 dev_err(data->dev,
717 ret = regmap_read(data->regmap, BMC150_MAGN_REG_CHIP_ID, &chip_id);
719 dev_err(data->dev, "Failed reading chip id\n");
723 dev_err(data->dev, "Invalid chip id 0x%x\n", chip_id);
727 dev_dbg(data->dev, "Chip id %x\n", chip_id);
730 ret = bmc150_magn_set_odr(data, preset.odr);
732 dev_err(data->dev, "Failed to set ODR to %d\n",
737 ret = regmap_write(data->regmap, BMC150_MAGN_REG_REP_XY,
740 dev_err(data->dev, "Failed to set REP XY to %d\n",
745 ret = regmap_write(data->regmap, BMC150_MAGN_REG_REP_Z,
748 dev_err(data->dev, "Failed to set REP Z to %d\n",
753 ret = bmc150_magn_set_max_odr(data, preset.rep_xy, preset.rep_z,
758 ret = bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_NORMAL,
761 dev_err(data->dev, "Failed to power on device\n");
768 bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SUSPEND, true);
770 regulator_bulk_disable(ARRAY_SIZE(data->regulators), data->regulators);
774 static int bmc150_magn_reset_intr(struct bmc150_magn_data *data)
780 * readout of data registers ends.
782 return regmap_read(data->regmap, BMC150_MAGN_REG_X_L, &tmp);
788 struct bmc150_magn_data *data = iio_priv(indio_dev);
791 if (!data->dready_trigger_on)
794 mutex_lock(&data->mutex);
795 ret = bmc150_magn_reset_intr(data);
796 mutex_unlock(&data->mutex);
798 dev_err(data->dev, "Failed to reset interrupt\n");
805 struct bmc150_magn_data *data = iio_priv(indio_dev);
808 mutex_lock(&data->mutex);
809 if (state == data->dready_trigger_on)
812 ret = regmap_update_bits(data->regmap, BMC150_MAGN_REG_INT_DRDY,
818 data->dready_trigger_on = state;
821 ret = bmc150_magn_reset_intr(data);
825 mutex_unlock(&data->mutex);
830 mutex_unlock(&data->mutex);
841 struct bmc150_magn_data *data = iio_priv(indio_dev);
843 return bmc150_magn_set_power_state(data, true);
848 struct bmc150_magn_data *data = iio_priv(indio_dev);
850 return bmc150_magn_set_power_state(data, false);
872 struct bmc150_magn_data *data;
876 indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
880 data = iio_priv(indio_dev);
882 data->regmap = regmap;
883 data->irq = irq;
884 data->dev = dev;
886 data->regulators[0].supply = "vdd";
887 data->regulators[1].supply = "vddio";
888 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(data->regulators),
889 data->regulators);
893 ret = iio_read_mount_matrix(dev, &data->orientation);
900 mutex_init(&data->mutex);
902 ret = bmc150_magn_init(data);
914 data->dready_trig = devm_iio_trigger_alloc(dev,
918 if (!data->dready_trig) {
924 data->dready_trig->ops = &bmc150_magn_trigger_ops;
925 iio_trigger_set_drvdata(data->dready_trig, indio_dev);
926 ret = iio_trigger_register(data->dready_trig);
937 data->dready_trig);
978 free_irq(irq, data->dready_trig);
980 if (data->dready_trig)
981 iio_trigger_unregister(data->dready_trig);
983 bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SUSPEND, true);
991 struct bmc150_magn_data *data = iio_priv(indio_dev);
1000 if (data->irq > 0)
1001 free_irq(data->irq, data->dready_trig);
1003 if (data->dready_trig)
1004 iio_trigger_unregister(data->dready_trig);
1006 mutex_lock(&data->mutex);
1007 bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SUSPEND, true);
1008 mutex_unlock(&data->mutex);
1010 regulator_bulk_disable(ARRAY_SIZE(data->regulators), data->regulators);
1018 struct bmc150_magn_data *data = iio_priv(indio_dev);
1021 mutex_lock(&data->mutex);
1022 ret = bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SLEEP,
1024 mutex_unlock(&data->mutex);
1033 * Should be called with data->mutex held.
1038 struct bmc150_magn_data *data = iio_priv(indio_dev);
1040 return bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_NORMAL,
1049 struct bmc150_magn_data *data = iio_priv(indio_dev);
1052 mutex_lock(&data->mutex);
1053 ret = bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_SLEEP,
1055 mutex_unlock(&data->mutex);
1063 struct bmc150_magn_data *data = iio_priv(indio_dev);
1066 mutex_lock(&data->mutex);
1067 ret = bmc150_magn_set_power_mode(data, BMC150_MAGN_POWER_MODE_NORMAL,
1069 mutex_unlock(&data->mutex);