Lines Matching +full:scaled +full:- +full:output +full:- +full:hz
1 // SPDX-License-Identifier: GPL-2.0
123 …"Allow IMU rates below the minimum advisable when external clk is used in SCALED mode (default: N)…
130 struct adis16475 *st = file->private_data; in adis16475_show_firmware_revision()
136 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_REV, &rev); in adis16475_show_firmware_revision()
156 struct adis16475 *st = file->private_data; in adis16475_show_firmware_date()
162 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_Y, &year); in adis16475_show_firmware_date()
166 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_DM, &md); in adis16475_show_firmware_date()
170 len = snprintf(buf, sizeof(buf), "%.2x-%.2x-%.4x\n", md >> 8, md & 0xff, in adis16475_show_firmware_date()
189 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_SERIAL_NUM, &serial); in adis16475_show_serial_number()
206 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_PROD_ID, &prod_id); in adis16475_show_product_id()
223 ret = adis_read_reg_32(&st->adis, ADIS16475_REG_FLASH_CNT, in adis16475_show_flash_count()
261 u32 sample_rate = st->clk_freq; in adis16475_get_freq()
263 adis_dev_lock(&st->adis); in adis16475_get_freq()
265 if (st->sync_mode == ADIS16475_SYNC_SCALED) { in adis16475_get_freq()
268 ret = __adis_read_reg_16(&st->adis, ADIS16475_REG_UP_SCALE, &sync_scale); in adis16475_get_freq()
272 sample_rate = st->clk_freq * sync_scale; in adis16475_get_freq()
275 ret = __adis_read_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, &dec); in adis16475_get_freq()
279 adis_dev_unlock(&st->adis); in adis16475_get_freq()
285 adis_dev_unlock(&st->adis); in adis16475_get_freq()
293 u32 sample_rate = st->clk_freq; in adis16475_set_freq()
296 return -EINVAL; in adis16475_set_freq()
298 adis_dev_lock(&st->adis); in adis16475_set_freq()
300 * When using sync scaled mode, the input clock needs to be scaled so that we have in adis16475_set_freq()
306 * 1. lcm of the input clock and the desired output rate. in adis16475_set_freq()
309 * and DEC_RATE (to get the user output rate) in adis16475_set_freq()
311 if (st->sync_mode == ADIS16475_SYNC_SCALED) { in adis16475_set_freq()
312 unsigned long scaled_rate = lcm(st->clk_freq, freq); in adis16475_set_freq()
321 scaled_rate = 2100000 / st->clk_freq * st->clk_freq; in adis16475_set_freq()
327 * with a sample rate lower than 1900Hz due to possible undersampling in adis16475_set_freq()
336 scaled_rate = roundup(1900000, st->clk_freq); in adis16475_set_freq()
338 sync_scale = scaled_rate / st->clk_freq; in adis16475_set_freq()
339 ret = __adis_write_reg_16(&st->adis, ADIS16475_REG_UP_SCALE, sync_scale); in adis16475_set_freq()
349 dec--; in adis16475_set_freq()
351 if (dec > st->info->max_dec) in adis16475_set_freq()
352 dec = st->info->max_dec; in adis16475_set_freq()
354 ret = __adis_write_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, dec); in adis16475_set_freq()
358 adis_dev_unlock(&st->adis); in adis16475_set_freq()
363 assign_bit(ADIS16475_LSB_DEC_MASK, &st->lsb_flag, dec); in adis16475_set_freq()
367 adis_dev_unlock(&st->adis); in adis16475_set_freq()
373 [0] = 720, /* Filter disabled, full BW (~720Hz) */
388 ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, &filter_sz); in adis16475_get_filter()
402 while (--i) { in adis16475_set_filter()
407 ret = adis_write_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, in adis16475_set_filter()
416 assign_bit(ADIS16475_LSB_FIR_MASK, &st->lsb_flag, i); in adis16475_set_filter()
442 switch (chan->type) { in adis16475_read_raw()
444 *val = st->info->gyro_max_val; in adis16475_read_raw()
445 *val2 = st->info->gyro_max_scale; in adis16475_read_raw()
448 *val = st->info->accel_max_val; in adis16475_read_raw()
449 *val2 = st->info->accel_max_scale; in adis16475_read_raw()
452 *val = st->info->temp_scale; in adis16475_read_raw()
455 return -EINVAL; in adis16475_read_raw()
458 ret = adis_read_reg_32(&st->adis, in adis16475_read_raw()
459 adis16475_calib_regs[chan->scan_index], in adis16475_read_raw()
480 return -EINVAL; in adis16475_read_raw()
498 return adis_write_reg_32(&st->adis, in adis16475_write_raw()
499 adis16475_calib_regs[chan->scan_index], in adis16475_write_raw()
502 return -EINVAL; in adis16475_write_raw()
672 .name = "adis16475-1",
687 .name = "adis16475-2",
702 .name = "adis16475-3",
717 .name = "adis16477-1",
733 .name = "adis16477-2",
749 .name = "adis16477-3",
765 .name = "adis16465-1",
780 .name = "adis16465-2",
795 .name = "adis16465-3",
810 .name = "adis16467-1",
825 .name = "adis16467-2",
840 .name = "adis16467-3",
867 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
872 .name = "adis16505-1",
884 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
889 .name = "adis16505-2",
901 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
906 .name = "adis16505-3",
918 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
923 .name = "adis16507-1",
935 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
940 .name = "adis16507-2",
952 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
957 .name = "adis16507-3",
969 .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1,
990 for (i = 0; i < sz - 2; i++) in adis16475_validate_crc()
991 crc -= buffer[i]; in adis16475_validate_crc()
999 struct adis *adis = &st->adis; in adis16475_burst32_check()
1001 if (!st->info->has_burst32) in adis16475_burst32_check()
1004 if (st->lsb_flag && !st->burst32) { in adis16475_burst32_check()
1007 ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, in adis16475_burst32_check()
1012 st->burst32 = true; in adis16475_burst32_check()
1015 * In 32-bit mode we need extra 2 bytes for all gyro in adis16475_burst32_check()
1018 adis->burst_extra_len = 6 * sizeof(u16); in adis16475_burst32_check()
1019 adis->xfer[1].len += 6 * sizeof(u16); in adis16475_burst32_check()
1020 dev_dbg(&adis->spi->dev, "Enable burst32 mode, xfer:%d", in adis16475_burst32_check()
1021 adis->xfer[1].len); in adis16475_burst32_check()
1023 } else if (!st->lsb_flag && st->burst32) { in adis16475_burst32_check()
1026 ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, in adis16475_burst32_check()
1031 st->burst32 = false; in adis16475_burst32_check()
1034 adis->burst_extra_len = 0; in adis16475_burst32_check()
1035 adis->xfer[1].len -= 6 * sizeof(u16); in adis16475_burst32_check()
1036 dev_dbg(&adis->spi->dev, "Disable burst32 mode, xfer:%d\n", in adis16475_burst32_check()
1037 adis->xfer[1].len); in adis16475_burst32_check()
1044 struct iio_dev *indio_dev = pf->indio_dev; in adis16475_trigger_handler()
1046 struct adis *adis = &st->adis; in adis16475_trigger_handler()
1052 const u8 offset = st->burst32 ? 13 : 7; in adis16475_trigger_handler()
1054 ret = spi_sync(adis->spi, &adis->msg); in adis16475_trigger_handler()
1058 buffer = adis->buffer; in adis16475_trigger_handler()
1061 valid = adis16475_validate_crc(adis->buffer, crc, st->burst32); in adis16475_trigger_handler()
1063 dev_err(&adis->spi->dev, "Invalid crc\n"); in adis16475_trigger_handler()
1067 for_each_set_bit(bit, indio_dev->active_scan_mask, in adis16475_trigger_handler()
1068 indio_dev->masklength) { in adis16475_trigger_handler()
1075 st->data[i++] = buffer[offset]; in adis16475_trigger_handler()
1082 if (st->burst32) { in adis16475_trigger_handler()
1084 st->data[i++] = buffer[bit * 2 + 2]; in adis16475_trigger_handler()
1086 st->data[i++] = buffer[bit * 2 + 1]; in adis16475_trigger_handler()
1088 st->data[i++] = buffer[bit + 1]; in adis16475_trigger_handler()
1095 if (st->lsb_flag && !st->info->has_burst32) { in adis16475_trigger_handler()
1101 st->data[i++] = cpu_to_be16(val); in adis16475_trigger_handler()
1104 st->data[i++] = 0; in adis16475_trigger_handler()
1111 iio_push_to_buffers_with_timestamp(indio_dev, st->data, pf->timestamp); in adis16475_trigger_handler()
1119 iio_trigger_notify_done(indio_dev->trig); in adis16475_trigger_handler()
1127 struct device *dev = &st->adis.spi->dev; in adis16475_config_sync_mode()
1133 st->clk_freq = st->info->int_clk * 1000; in adis16475_config_sync_mode()
1135 ret = device_property_read_u32(dev, "adi,sync-mode", &sync_mode); in adis16475_config_sync_mode()
1139 if (sync_mode >= st->info->num_sync) { in adis16475_config_sync_mode()
1141 st->info->name); in adis16475_config_sync_mode()
1142 return -EINVAL; in adis16475_config_sync_mode()
1145 sync = &st->info->sync[sync_mode]; in adis16475_config_sync_mode()
1146 st->sync_mode = sync->sync_mode; in adis16475_config_sync_mode()
1149 if (sync->sync_mode != ADIS16475_SYNC_OUTPUT) { in adis16475_config_sync_mode()
1155 st->clk_freq = clk_get_rate(clk); in adis16475_config_sync_mode()
1156 if (st->clk_freq < sync->min_rate || in adis16475_config_sync_mode()
1157 st->clk_freq > sync->max_rate) { in adis16475_config_sync_mode()
1160 st->clk_freq, sync->min_rate, sync->max_rate); in adis16475_config_sync_mode()
1161 return -EINVAL; in adis16475_config_sync_mode()
1164 if (sync->sync_mode == ADIS16475_SYNC_SCALED) { in adis16475_config_sync_mode()
1168 * In sync scaled mode, the IMU sample rate is the clk_freq * sync_scale. in adis16475_config_sync_mode()
1171 * 1900-2100 sps... in adis16475_config_sync_mode()
1173 up_scale = 2100 / st->clk_freq; in adis16475_config_sync_mode()
1175 ret = __adis_write_reg_16(&st->adis, in adis16475_config_sync_mode()
1182 st->clk_freq *= 1000; in adis16475_config_sync_mode()
1192 val = ADIS16475_SYNC_MODE(sync->sync_mode); in adis16475_config_sync_mode()
1193 ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, in adis16475_config_sync_mode()
1210 struct spi_device *spi = st->adis.spi; in adis16475_config_irq_pin()
1212 desc = irq_get_irq_data(spi->irq); in adis16475_config_irq_pin()
1214 dev_err(&spi->dev, "Could not find IRQ %d\n", spi->irq); in adis16475_config_irq_pin()
1215 return -EINVAL; in adis16475_config_irq_pin()
1224 st->adis.irq_flag = IRQF_TRIGGER_RISING; in adis16475_config_irq_pin()
1227 st->adis.irq_flag = IRQF_TRIGGER_FALLING; in adis16475_config_irq_pin()
1229 dev_err(&spi->dev, "Invalid interrupt type 0x%x specified\n", in adis16475_config_irq_pin()
1231 return -EINVAL; in adis16475_config_irq_pin()
1235 ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, in adis16475_config_irq_pin()
1256 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); in adis16475_probe()
1258 return -ENOMEM; in adis16475_probe()
1262 st->info = spi_get_device_match_data(spi); in adis16475_probe()
1263 if (!st->info) in adis16475_probe()
1264 return -EINVAL; in adis16475_probe()
1266 ret = adis_init(&st->adis, indio_dev, spi, &st->info->adis_data); in adis16475_probe()
1270 indio_dev->name = st->info->name; in adis16475_probe()
1271 indio_dev->channels = st->info->channels; in adis16475_probe()
1272 indio_dev->num_channels = st->info->num_channels; in adis16475_probe()
1273 indio_dev->info = &adis16475_info; in adis16475_probe()
1274 indio_dev->modes = INDIO_DIRECT_MODE; in adis16475_probe()
1276 ret = __adis_initial_startup(&st->adis); in adis16475_probe()
1288 ret = devm_adis_setup_buffer_and_trigger(&st->adis, indio_dev, in adis16475_probe()
1293 ret = devm_iio_device_register(&spi->dev, indio_dev); in adis16475_probe()
1305 { .compatible = "adi,adis16475-1",
1307 { .compatible = "adi,adis16475-2",
1309 { .compatible = "adi,adis16475-3",
1311 { .compatible = "adi,adis16477-1",
1313 { .compatible = "adi,adis16477-2",
1315 { .compatible = "adi,adis16477-3",
1317 { .compatible = "adi,adis16465-1",
1319 { .compatible = "adi,adis16465-2",
1321 { .compatible = "adi,adis16465-3",
1323 { .compatible = "adi,adis16467-1",
1325 { .compatible = "adi,adis16467-2",
1327 { .compatible = "adi,adis16467-3",
1331 { .compatible = "adi,adis16505-1",
1333 { .compatible = "adi,adis16505-2",
1335 { .compatible = "adi,adis16505-3",
1337 { .compatible = "adi,adis16507-1",
1339 { .compatible = "adi,adis16507-2",
1341 { .compatible = "adi,adis16507-3",
1349 { "adis16475-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16475_1] },
1350 { "adis16475-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16475_2] },
1351 { "adis16475-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16475_3] },
1352 { "adis16477-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16477_1] },
1353 { "adis16477-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16477_2] },
1354 { "adis16477-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16477_3] },
1355 { "adis16465-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16465_1] },
1356 { "adis16465-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16465_2] },
1357 { "adis16465-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16465_3] },
1358 { "adis16467-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16467_1] },
1359 { "adis16467-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16467_2] },
1360 { "adis16467-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16467_3] },
1362 { "adis16505-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16505_1] },
1363 { "adis16505-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16505_2] },
1364 { "adis16505-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16505_3] },
1365 { "adis16507-1", (kernel_ulong_t)&adis16475_chip_info[ADIS16507_1] },
1366 { "adis16507-2", (kernel_ulong_t)&adis16475_chip_info[ADIS16507_2] },
1367 { "adis16507-3", (kernel_ulong_t)&adis16475_chip_info[ADIS16507_3] },