imu/inv_icm42600/inv_icm42600_core.c

152 	int ret;
162 	ret = regmap_write(st->map, INV_ICM42600_REG_PWR_MGMT0, val);
163 	if (ret)
164 		return ret;
213 	int ret;
229 		ret = regmap_write(st->map, INV_ICM42600_REG_ACCEL_CONFIG0, val);
230 		if (ret)
231 			return ret;
240 		ret = regmap_write(st->map, INV_ICM42600_REG_GYRO_ACCEL_CONFIG0, val);
241 		if (ret)
242 			return ret;
257 	int ret;
273 		ret = regmap_write(st->map, INV_ICM42600_REG_GYRO_CONFIG0, val);
274 		if (ret)
275 			return ret;
284 		ret = regmap_write(st->map, INV_ICM42600_REG_GYRO_ACCEL_CONFIG0, val);
285 		if (ret)
286 			return ret;
309 	int ret;
314 		ret = regmap_read(st->map, reg, readval);
316 		ret = regmap_write(st->map, reg, writeval);
320 	return ret;
327 	int ret;
334 	ret = regmap_write(st->map, INV_ICM42600_REG_PWR_MGMT0, val);
335 	if (ret)
336 		return ret;
341 	ret = regmap_write(st->map, INV_ICM42600_REG_GYRO_CONFIG0, val);
342 	if (ret)
343 		return ret;
348 	ret = regmap_write(st->map, INV_ICM42600_REG_ACCEL_CONFIG0, val);
349 	if (ret)
350 		return ret;
355 	ret = regmap_write(st->map, INV_ICM42600_REG_GYRO_ACCEL_CONFIG0, val);
356 	if (ret)
357 		return ret;
378 	int ret;
381 	ret = regmap_read(st->map, INV_ICM42600_REG_WHOAMI, &val);
382 	if (ret)
383 		return ret;
392 	ret = regmap_write(st->map, INV_ICM42600_REG_DEVICE_CONFIG,
394 	if (ret)
395 		return ret;
398 	ret = regmap_read(st->map, INV_ICM42600_REG_INT_STATUS, &val);
399 	if (ret)
400 		return ret;
407 	ret = bus_setup(st);
408 	if (ret)
409 		return ret;
412 	ret = regmap_update_bits(st->map, INV_ICM42600_REG_INTF_CONFIG0,
415 	if (ret)
416 		return ret;
436 	int ret;
440 	ret = regmap_read(st->map, INV_ICM42600_REG_INT_STATUS, &status);
441 	if (ret)
450 		ret = inv_icm42600_buffer_fifo_read(st, 0);
451 		if (ret) {
452 			dev_err(dev, "FIFO read error %d\n", ret);
455 		ret = inv_icm42600_buffer_fifo_parse(st);
456 		if (ret)
457 			dev_err(dev, "FIFO parsing error %d\n", ret);
479 	int ret;
504 	ret = regmap_write(st->map, INV_ICM42600_REG_INT_CONFIG, val);
505 	if (ret)
506 		return ret;
509 	ret = regmap_update_bits(st->map, INV_ICM42600_REG_INT_CONFIG1,
511 	if (ret)
512 		return ret;
532 	int ret;
534 	ret = regulator_enable(st->vddio_supply);
535 	if (ret)
536 		return ret;
548 	int ret;
550 	ret = regulator_disable(st->vdd_supply);
551 	if (ret)
552 		dev_err(dev, "failed to disable vdd error %d\n", ret);
559 	int ret;
561 	ret = regulator_disable(st->vddio_supply);
562 	if (ret)
563 		dev_err(dev, "failed to disable vddio error %d\n", ret);
582 	int ret;
611 	ret = iio_read_mount_matrix(dev, &st->orientation);
612 	if (ret) {
613 		dev_err(dev, "failed to retrieve mounting matrix %d\n", ret);
614 		return ret;
625 	ret = regulator_enable(st->vdd_supply);
626 	if (ret)
627 		return ret;
630 	ret = devm_add_action_or_reset(dev, inv_icm42600_disable_vdd_reg, st);
631 	if (ret)
632 		return ret;
634 	ret = inv_icm42600_enable_regulator_vddio(st);
635 	if (ret)
636 		return ret;
638 	ret = devm_add_action_or_reset(dev, inv_icm42600_disable_vddio_reg, st);
639 	if (ret)
640 		return ret;
643 	ret = inv_icm42600_setup(st, bus_setup);
644 	if (ret)
645 		return ret;
647 	ret = inv_icm42600_timestamp_setup(st);
648 	if (ret)
649 		return ret;
651 	ret = inv_icm42600_buffer_init(st);
652 	if (ret)
653 		return ret;
663 	ret = inv_icm42600_irq_init(st, irq, irq_type, open_drain);
664 	if (ret)
665 		return ret;
668 	ret = pm_runtime_set_active(dev);
669 	if (ret)
670 		return ret;
688 	int ret;
696 		ret = 0;
702 		ret = regmap_write(st->map, INV_ICM42600_REG_FIFO_CONFIG,
704 		if (ret)
708 	ret = inv_icm42600_set_pwr_mgmt0(st, INV_ICM42600_SENSOR_MODE_OFF,
711 	if (ret)
718 	return ret;
728 	int ret;
732 	ret = inv_icm42600_enable_regulator_vddio(st);
733 	if (ret)
741 	ret = inv_icm42600_set_pwr_mgmt0(st, st->suspended.gyro,
744 	if (ret)
749 		ret = regmap_write(st->map, INV_ICM42600_REG_FIFO_CONFIG,
754 	return ret;
761 	int ret;
766 	ret = inv_icm42600_set_pwr_mgmt0(st, INV_ICM42600_SENSOR_MODE_OFF,
769 	if (ret)
776 	return ret;
783 	int ret;
787 	ret = inv_icm42600_enable_regulator_vddio(st);
790 	return ret;