15 	struct inv_mpu6050_state  *st = iio_priv(indio_dev);  in inv_scan_query_mpu6050()  local
24 		st->chip_config.temp_fifo_enable = true;  in inv_scan_query_mpu6050()
28 	st->chip_config.gyro_fifo_enable =  in inv_scan_query_mpu6050()
36 	st->chip_config.accl_fifo_enable =  in inv_scan_query_mpu6050()
44 	st->chip_config.temp_fifo_enable =  in inv_scan_query_mpu6050()
48 	if (st->chip_config.gyro_fifo_enable)  in inv_scan_query_mpu6050()
50 	if (st->chip_config.accl_fifo_enable)  in inv_scan_query_mpu6050()
52 	if (st->chip_config.temp_fifo_enable)  in inv_scan_query_mpu6050()
60 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_scan_query_mpu9x50()  local
66 	if (st->magn_disabled)  in inv_scan_query_mpu9x50()
69 	st->chip_config.magn_fifo_enable =  in inv_scan_query_mpu9x50()
76 	if (st->chip_config.magn_fifo_enable)  in inv_scan_query_mpu9x50()
84 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_scan_query()  local
86 	switch (st->chip_type) {  in inv_scan_query()
96 static unsigned int inv_compute_skip_samples(const struct inv_mpu6050_state *st)  in inv_compute_skip_samples()  argument
101 	if (st->chip_config.magn_fifo_enable)  in inv_compute_skip_samples()
107 int inv_mpu6050_prepare_fifo(struct inv_mpu6050_state *st, bool enable)  in inv_mpu6050_prepare_fifo()  argument
114 		inv_sensors_timestamp_reset(&st->timestamp);  in inv_mpu6050_prepare_fifo()
116 		d = st->chip_config.user_ctrl | INV_MPU6050_BIT_FIFO_RST;  in inv_mpu6050_prepare_fifo()
117 		ret = regmap_write(st->map, st->reg->user_ctrl, d);  in inv_mpu6050_prepare_fifo()
122 		if (st->chip_config.gyro_fifo_enable)  in inv_mpu6050_prepare_fifo()
124 		if (st->chip_config.accl_fifo_enable)  in inv_mpu6050_prepare_fifo()
126 		if (st->chip_config.temp_fifo_enable)  in inv_mpu6050_prepare_fifo()
128 		if (st->chip_config.magn_fifo_enable)  in inv_mpu6050_prepare_fifo()
130 		ret = regmap_write(st->map, st->reg->fifo_en, d);  in inv_mpu6050_prepare_fifo()
134 		d = st->chip_config.user_ctrl | INV_MPU6050_BIT_FIFO_EN;  in inv_mpu6050_prepare_fifo()
135 		ret = regmap_write(st->map, st->reg->user_ctrl, d);  in inv_mpu6050_prepare_fifo()
139 		ret = regmap_update_bits(st->map, st->reg->int_enable,  in inv_mpu6050_prepare_fifo()
143 		ret = regmap_update_bits(st->map, st->reg->int_enable,  in inv_mpu6050_prepare_fifo()
147 		ret = regmap_write(st->map, st->reg->fifo_en, 0);  in inv_mpu6050_prepare_fifo()
151 		ret = regmap_write(st->map, st->reg->user_ctrl,  in inv_mpu6050_prepare_fifo()
152 				   st->chip_config.user_ctrl);  in inv_mpu6050_prepare_fifo()
165 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_mpu6050_set_enable()  local
166 	struct device *pdev = regmap_get_device(st->map);  in inv_mpu6050_set_enable()
179 		result = inv_mpu6050_switch_engine(st, false, ~scan & ~INV_MPU6050_SENSOR_WOM);  in inv_mpu6050_set_enable()
182 		result = inv_mpu6050_switch_engine(st, true, scan);  in inv_mpu6050_set_enable()
185 		st->skip_samples = inv_compute_skip_samples(st);  in inv_mpu6050_set_enable()
186 		result = inv_mpu6050_prepare_fifo(st, true);  in inv_mpu6050_set_enable()
190 		st->chip_config.gyro_fifo_enable = 0;  in inv_mpu6050_set_enable()
191 		st->chip_config.accl_fifo_enable = 0;  in inv_mpu6050_set_enable()
192 		st->chip_config.temp_fifo_enable = 0;  in inv_mpu6050_set_enable()
193 		st->chip_config.magn_fifo_enable = 0;  in inv_mpu6050_set_enable()
194 		result = inv_mpu6050_prepare_fifo(st, false);  in inv_mpu6050_set_enable()
217 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_mpu_data_rdy_trigger_set_state()  local
220 	mutex_lock(&st->lock);  in inv_mpu_data_rdy_trigger_set_state()
222 	mutex_unlock(&st->lock);  in inv_mpu_data_rdy_trigger_set_state()
234 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_mpu6050_interrupt_timestamp()  local
236 	st->it_timestamp = iio_get_time_ns(indio_dev);  in inv_mpu6050_interrupt_timestamp()
244 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_mpu6050_interrupt_handle()  local
249 	switch (st->chip_type) {  in inv_mpu6050_interrupt_handle()
273 	scoped_guard(mutex, &st->lock) {  in inv_mpu6050_interrupt_handle()
275 		result = regmap_read(st->map, st->reg->int_status, &int_status);  in inv_mpu6050_interrupt_handle()
277 			dev_err(regmap_get_device(st->map), "failed to ack interrupt\n");  in inv_mpu6050_interrupt_handle()
282 		if (st->chip_config.wom_en && (int_status & wom_bits)) {  in inv_mpu6050_interrupt_handle()
285 			iio_push_event(indio_dev, ev_code, st->it_timestamp);  in inv_mpu6050_interrupt_handle()
292 		indio_dev->pollfunc->timestamp = st->it_timestamp;  in inv_mpu6050_interrupt_handle()
293 		iio_trigger_poll_nested(st->trig);  in inv_mpu6050_interrupt_handle()
302 	struct inv_mpu6050_state *st = iio_priv(indio_dev);  in inv_mpu6050_probe_trigger()  local
304 	st->trig = devm_iio_trigger_alloc(&indio_dev->dev,  in inv_mpu6050_probe_trigger()
308 	if (!st->trig)  in inv_mpu6050_probe_trigger()
312 	ret = devm_request_threaded_irq(&indio_dev->dev, st->irq,  in inv_mpu6050_probe_trigger()
319 	st->trig->dev.parent = regmap_get_device(st->map);  in inv_mpu6050_probe_trigger()
320 	st->trig->ops = &inv_mpu_trigger_ops;  in inv_mpu6050_probe_trigger()
321 	iio_trigger_set_drvdata(st->trig, indio_dev);  in inv_mpu6050_probe_trigger()
323 	ret = devm_iio_trigger_register(&indio_dev->dev, st->trig);  in inv_mpu6050_probe_trigger()
327 	indio_dev->trig = iio_trigger_get(st->trig);  in inv_mpu6050_probe_trigger()