Lines Matching +full:x +full:- +full:axis

1 // SPDX-License-Identifier: GPL-2.0-only
31 #define ADIS16400_XGYRO_OUT 0x04 /* X-axis gyroscope output */
32 #define ADIS16400_YGYRO_OUT 0x06 /* Y-axis gyroscope output */
33 #define ADIS16400_ZGYRO_OUT 0x08 /* Z-axis gyroscope output */
34 #define ADIS16400_XACCL_OUT 0x0A /* X-axis accelerometer output */
35 #define ADIS16400_YACCL_OUT 0x0C /* Y-axis accelerometer output */
36 #define ADIS16400_ZACCL_OUT 0x0E /* Z-axis accelerometer output */
37 #define ADIS16400_XMAGN_OUT 0x10 /* X-axis magnetometer measurement */
38 #define ADIS16400_YMAGN_OUT 0x12 /* Y-axis magnetometer measurement */
39 #define ADIS16400_ZMAGN_OUT 0x14 /* Z-axis magnetometer measurement */
43 #define ADIS16350_XTEMP_OUT 0x10 /* X-axis gyroscope temperature measurement */
44 #define ADIS16350_YTEMP_OUT 0x12 /* Y-axis gyroscope temperature measurement */
45 #define ADIS16350_ZTEMP_OUT 0x14 /* Z-axis gyroscope temperature measurement */
47 #define ADIS16300_PITCH_OUT 0x12 /* X axis inclinometer output measurement */
48 #define ADIS16300_ROLL_OUT 0x14 /* Y axis inclinometer output measurement */
55 #define ADIS16400_XGYRO_OFF 0x1A /* X-axis gyroscope bias offset factor */
56 #define ADIS16400_YGYRO_OFF 0x1C /* Y-axis gyroscope bias offset factor */
57 #define ADIS16400_ZGYRO_OFF 0x1E /* Z-axis gyroscope bias offset factor */
58 #define ADIS16400_XACCL_OFF 0x20 /* X-axis acceleration bias offset factor */
59 #define ADIS16400_YACCL_OFF 0x22 /* Y-axis acceleration bias offset factor */
60 #define ADIS16400_ZACCL_OFF 0x24 /* Z-axis acceleration bias offset factor */
61 #define ADIS16400_XMAGN_HIF 0x26 /* X-axis magnetometer, hard-iron factor */
62 #define ADIS16400_YMAGN_HIF 0x28 /* Y-axis magnetometer, hard-iron factor */
63 #define ADIS16400_ZMAGN_HIF 0x2A /* Z-axis magnetometer, hard-iron factor */
64 #define ADIS16400_XMAGN_SIF 0x2C /* X-axis magnetometer, soft-iron factor */
65 #define ADIS16400_YMAGN_SIF 0x2E /* Y-axis magnetometer, soft-iron factor */
66 #define ADIS16400_ZMAGN_SIF 0x30 /* Z-axis magnetometer, soft-iron factor */
165 * struct adis16400_state - device instance specific data
208 struct adis16400_state *st = file->private_data; in adis16400_show_serial_number()
214 ret = adis_read_reg_16(&st->adis, ADIS16334_LOT_ID1, &lot1); in adis16400_show_serial_number()
218 ret = adis_read_reg_16(&st->adis, ADIS16334_LOT_ID2, &lot2); in adis16400_show_serial_number()
222 ret = adis_read_reg_16(&st->adis, ADIS16334_SERIAL_NUMBER, in adis16400_show_serial_number()
227 len = snprintf(buf, sizeof(buf), "%.4x-%.4x-%.4x\n", lot1, lot2, in adis16400_show_serial_number()
246 ret = adis_read_reg_16(&st->adis, ADIS16400_PRODUCT_ID, &prod_id); in adis16400_show_product_id()
263 ret = adis_read_reg_16(&st->adis, ADIS16400_FLASH_CNT, &flash_count); in adis16400_show_flash_count()
282 if (st->variant->flags & ADIS16400_HAS_SERIAL_NUMBER) in adis16400_debugfs_init()
285 if (st->variant->flags & ADIS16400_HAS_PROD_ID) in adis16400_debugfs_init()
297 ret = __adis_read_reg_16(&st->adis, ADIS16400_SMPL_PRD, &t); in adis16334_get_freq()
321 return __adis_write_reg_16(&st->adis, ADIS16400_SMPL_PRD, t); in adis16334_set_freq()
329 ret = __adis_read_reg_16(&st->adis, ADIS16400_SMPL_PRD, &t); in adis16400_get_freq()
351 t--; in adis16400_set_freq()
357 st->adis.spi->max_speed_hz = ADIS16400_SPI_SLOW; in adis16400_set_freq()
359 st->adis.spi->max_speed_hz = ADIS16400_SPI_FAST; in adis16400_set_freq()
361 return __adis_write_reg_8(&st->adis, ADIS16400_SMPL_PRD, val); in adis16400_set_freq()
381 for (i = ARRAY_SIZE(adis16400_3db_divisors) - 1; i >= 1; i--) { in __adis16400_set_filter()
386 ret = __adis_read_reg_16(&st->adis, ADIS16400_SENS_AVG, &val16); in __adis16400_set_filter()
390 ret = __adis_write_reg_16(&st->adis, ADIS16400_SENS_AVG, in __adis16400_set_filter()
401 ret = adis_write_reg_16(&st->adis, ADIS16400_SLP_CNT, in adis16400_stop_device()
404 dev_err(&indio_dev->dev, in adis16400_stop_device()
418 if (st->variant->flags & ADIS16400_HAS_SLOW_MODE) in adis16400_initial_setup()
419 st->adis.spi->max_speed_hz = ADIS16400_SPI_SLOW; in adis16400_initial_setup()
421 st->adis.spi->max_speed_hz = ADIS16400_SPI_FAST; in adis16400_initial_setup()
422 st->adis.spi->mode = SPI_MODE_3; in adis16400_initial_setup()
423 spi_setup(st->adis.spi); in adis16400_initial_setup()
425 ret = __adis_initial_startup(&st->adis); in adis16400_initial_setup()
429 if (st->variant->flags & ADIS16400_HAS_PROD_ID) { in adis16400_initial_setup()
430 ret = adis_read_reg_16(&st->adis, in adis16400_initial_setup()
435 if (sscanf(indio_dev->name, "adis%u\n", &device_id) != 1) { in adis16400_initial_setup()
436 ret = -EINVAL; in adis16400_initial_setup()
441 dev_warn(&indio_dev->dev, "Device ID(%u) and product ID(%u) do not match.", in adis16400_initial_setup()
444 dev_info(&indio_dev->dev, "%s: prod_id 0x%04x at CS%d (irq %d)\n", in adis16400_initial_setup()
445 indio_dev->name, prod_id, in adis16400_initial_setup()
446 spi_get_chipselect(st->adis.spi, 0), st->adis.spi->irq); in adis16400_initial_setup()
449 if (st->variant->flags & ADIS16400_HAS_SLOW_MODE) { in adis16400_initial_setup()
450 ret = adis_read_reg_16(&st->adis, ADIS16400_SMPL_PRD, &smp_prd); in adis16400_initial_setup()
455 st->adis.spi->max_speed_hz = ADIS16400_SPI_FAST; in adis16400_initial_setup()
456 spi_setup(st->adis.spi); in adis16400_initial_setup()
481 return adis_write_reg_16(&st->adis, in adis16400_write_raw()
482 adis16400_addresses[chan->scan_index], in adis16400_write_raw()
489 adis_dev_auto_scoped_lock(&st->adis) { in adis16400_write_raw()
490 st->filt_int = val; in adis16400_write_raw()
492 sps = st->variant->get_freq(st); in adis16400_write_raw()
504 return -EINVAL; in adis16400_write_raw()
506 adis_dev_auto_scoped_lock(&st->adis) in adis16400_write_raw()
507 return st->variant->set_freq(st, sps); in adis16400_write_raw()
510 return -EINVAL; in adis16400_write_raw()
525 switch (chan->type) { in adis16400_read_raw()
528 *val2 = st->variant->gyro_scale_micro; in adis16400_read_raw()
532 if (chan->channel == 0) { in adis16400_read_raw()
542 *val2 = st->variant->accel_scale_micro; in adis16400_read_raw()
549 *val = st->variant->temp_scale_nano / 1000000; in adis16400_read_raw()
550 *val2 = (st->variant->temp_scale_nano % 1000000); in adis16400_read_raw()
558 return -EINVAL; in adis16400_read_raw()
561 ret = adis_read_reg_16(&st->adis, in adis16400_read_raw()
562 adis16400_addresses[chan->scan_index], &val16); in adis16400_read_raw()
570 *val = st->variant->temp_offset; in adis16400_read_raw()
573 adis_dev_auto_scoped_lock(&st->adis) { in adis16400_read_raw()
578 ret = __adis_read_reg_16(&st->adis, ADIS16400_SENS_AVG, in adis16400_read_raw()
583 ret = st->variant->get_freq(st); in adis16400_read_raw()
592 adis_dev_auto_scoped_lock(&st->adis) { in adis16400_read_raw()
593 ret = st->variant->get_freq(st); in adis16400_read_raw()
601 return -EINVAL; in adis16400_read_raw()
609 struct iio_dev *indio_dev = pf->indio_dev; in adis16400_trigger_handler()
611 struct adis *adis = &st->adis; in adis16400_trigger_handler()
615 ret = spi_sync(adis->spi, &adis->msg); in adis16400_trigger_handler()
617 dev_err(&adis->spi->dev, "Failed to read data: %d\n", ret); in adis16400_trigger_handler()
619 if (st->variant->flags & ADIS16400_BURST_DIAG_STAT) { in adis16400_trigger_handler()
620 buffer = adis->buffer + sizeof(u16); in adis16400_trigger_handler()
625 * buffer->scan_bytes this will be safe. in adis16400_trigger_handler()
628 indio_dev->scan_bytes - sizeof(pf->timestamp), in adis16400_trigger_handler()
629 pf->timestamp); in adis16400_trigger_handler()
632 adis->buffer, in adis16400_trigger_handler()
633 pf->timestamp); in adis16400_trigger_handler()
637 iio_trigger_notify_done(indio_dev->trig); in adis16400_trigger_handler()
729 #define ADIS16400_MOD_TEMP_NAME_X "x"
794 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 14),
797 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 14),
800 ADIS16400_MAGN_CHAN(X, ADIS16400_XMAGN_OUT, 14),
809 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 16),
812 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 16),
820 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 16),
823 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 16),
826 ADIS16400_MAGN_CHAN(X, ADIS16400_XMAGN_OUT, 16),
849 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 14),
852 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 14),
855 ADIS16400_MAGN_CHAN(X, ADIS16400_XMAGN_OUT, 14),
859 ADIS16400_MOD_TEMP_CHAN(X, ADIS16350_XTEMP_OUT, 12),
867 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 14),
868 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 14),
873 ADIS16400_INCLI_CHAN(X, ADIS16300_PITCH_OUT, 13),
879 ADIS16400_GYRO_CHAN(X, ADIS16400_XGYRO_OUT, 14),
882 ADIS16400_ACCEL_CHAN(X, ADIS16400_XACCL_OUT, 14),
890 [ADIS16400_DIAG_STAT_ZACCL_FAIL] = "Z-axis accelerometer self-test failure",
891 [ADIS16400_DIAG_STAT_YACCL_FAIL] = "Y-axis accelerometer self-test failure",
892 [ADIS16400_DIAG_STAT_XACCL_FAIL] = "X-axis accelerometer self-test failure",
893 [ADIS16400_DIAG_STAT_XGYRO_FAIL] = "X-axis gyroscope self-test failure",
894 [ADIS16400_DIAG_STAT_YGYRO_FAIL] = "Y-axis gyroscope self-test failure",
895 [ADIS16400_DIAG_STAT_ZGYRO_FAIL] = "Z-axis gyroscope self-test failure",
1121 const struct adis16400_chip_info *chip_info = st->variant; in adis16400_setup_chan_mask()
1124 for (i = 0; i < chip_info->num_channels; i++) { in adis16400_setup_chan_mask()
1125 const struct iio_chan_spec *ch = &chip_info->channels[i]; in adis16400_setup_chan_mask()
1127 if (ch->scan_index >= 0 && in adis16400_setup_chan_mask()
1128 ch->scan_index != ADIS16400_SCAN_TIMESTAMP) in adis16400_setup_chan_mask()
1129 st->avail_scan_mask[0] |= BIT(ch->scan_index); in adis16400_setup_chan_mask()
1145 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); in adis16400_probe()
1147 return -ENOMEM; in adis16400_probe()
1152 st->variant = spi_get_device_match_data(spi); in adis16400_probe()
1153 indio_dev->name = spi_get_device_id(spi)->name; in adis16400_probe()
1154 indio_dev->channels = st->variant->channels; in adis16400_probe()
1155 indio_dev->num_channels = st->variant->num_channels; in adis16400_probe()
1156 indio_dev->info = &adis16400_info; in adis16400_probe()
1157 indio_dev->modes = INDIO_DIRECT_MODE; in adis16400_probe()
1159 if (!(st->variant->flags & ADIS16400_NO_BURST)) { in adis16400_probe()
1161 indio_dev->available_scan_masks = st->avail_scan_mask; in adis16400_probe()
1164 adis16400_data = &st->variant->adis_data; in adis16400_probe()
1166 ret = adis_init(&st->adis, indio_dev, spi, adis16400_data); in adis16400_probe()
1170 ret = devm_adis_setup_buffer_and_trigger(&st->adis, indio_dev, adis16400_trigger_handler); in adis16400_probe()
1179 ret = devm_add_action_or_reset(&spi->dev, adis16400_stop, indio_dev); in adis16400_probe()
1183 ret = devm_iio_device_register(&spi->dev, indio_dev); in adis16400_probe()