On Tue, 2020-03-03 at 21:08 +0000, Jonathan Cameron wrote: > [External] > > On Tue, 25 Feb 2020 13:41:51 +0100 > Nuno Sá <nuno.sa@xxxxxxxxxx> wrote: > > > Support ADIS16475 and similar IMU devices. These devices are > > a precision, miniature MEMS inertial measurement unit (IMU) that > > includes a triaxial gyroscope and a triaxial accelerometer. Each > > inertial sensor combines with signal conditioning that optimizes > > dynamic performance. > > > > The driver adds support for the following devices: > > * adis16470, adis16475, adis16477, adis16465, adis16467, > > adis16500, > > adis16505, adis16507. > > > > Signed-off-by: Nuno Sá <nuno.sa@xxxxxxxxxx> > > A few bits and pieces inline. > > Thanks, > > Jonathan > > > > --- > > .../ABI/testing/sysfs-bus-iio-imu-adis16475 | 7 + > > MAINTAINERS | 8 + > > drivers/iio/imu/Kconfig | 13 + > > drivers/iio/imu/Makefile | 1 + > > drivers/iio/imu/adis16475.c | 1304 > > +++++++++++++++++ > > 5 files changed, 1333 insertions(+) > > create mode 100644 Documentation/ABI/testing/sysfs-bus-iio-imu- > > adis16475 > > create mode 100644 drivers/iio/imu/adis16475.c > > > > diff --git a/Documentation/ABI/testing/sysfs-bus-iio-imu-adis16475 > > b/Documentation/ABI/testing/sysfs-bus-iio-imu-adis16475 > > new file mode 100644 > > index 000000000000..e2c3776035ea > > --- /dev/null > > +++ b/Documentation/ABI/testing/sysfs-bus-iio-imu-adis16475 > > @@ -0,0 +1,7 @@ > > +What: /sys/bus/iio/devices/iio:deviceX/burst_mode_ena > > ble > > +KernelVersion: > > +Contact: linux-iio@xxxxxxxxxxxxxxx > > +Description: > > + Use the device burst read mode when reading buffered > > + data. This mode provides a way to read a batch of > > + output data registers, using a continuous stream of > > bits. > > See comment on this below. I'm not keen on this being exposed to > userspace > because it will rarely have any idea how to set it. > > > diff --git a/MAINTAINERS b/MAINTAINERS > > index 8fa40c3eb72a..f11262f1f3bb 100644 > > --- a/MAINTAINERS > > +++ b/MAINTAINERS > > @@ -1008,6 +1008,14 @@ W: > > http://ez.analog.com/community/linux-device-drivers > > F: drivers/iio/imu/adis16460.c > > F: Documentation/devicetree/bindings/iio/imu/adi,adis16460.yaml > > > > +ANALOG DEVICES INC ADIS16475 DRIVER > > +M: Nuno Sa <nuno.sa@xxxxxxxxxx> > > +L: linux-iio@xxxxxxxxxxxxxxx > > +W: http://ez.analog.com/community/linux-device-drivers > > +S: Supported > > +F: drivers/iio/imu/adis16475.c > > +F: Documentation/ABI/testing/sysfs-bus-iio-imu-adis16475 > > + > > ANALOG DEVICES INC ADM1177 DRIVER > > M: Beniamin Bia <beniamin.bia@xxxxxxxxxx> > > M: Michael Hennerich <Michael.Hennerich@xxxxxxxxxx> > > diff --git a/drivers/iio/imu/Kconfig b/drivers/iio/imu/Kconfig > > index 60bb1029e759..fc4123d518bc 100644 > > --- a/drivers/iio/imu/Kconfig > > +++ b/drivers/iio/imu/Kconfig > > @@ -29,6 +29,19 @@ config ADIS16460 > > To compile this driver as a module, choose M here: the module > > will be > > called adis16460. > > > > +config ADIS16475 > > + tristate "Analog Devices ADIS16475 and similar IMU driver" > > + depends on SPI > > + select IIO_ADIS_LIB > > + select IIO_ADIS_LIB_BUFFER if IIO_BUFFER > > + help > > + Say yes here to build support for Analog Devices ADIS16470, > > ADIS16475, > > + ADIS16477, ADIS16465, ADIS16467, ADIS16500, ADIS16505, > > ADIS16507 inertial > > + sensors. > > + > > + To compile this driver as a module, choose M here: the module > > will be > > + called adis16475. > > + > > config ADIS16480 > > tristate "Analog Devices ADIS16480 and similar IMU driver" > > depends on SPI > > diff --git a/drivers/iio/imu/Makefile b/drivers/iio/imu/Makefile > > index 5237fd4bc384..88b2c4555230 100644 > > --- a/drivers/iio/imu/Makefile > > +++ b/drivers/iio/imu/Makefile > > @@ -6,6 +6,7 @@ > > # When adding new entries keep the list in alphabetical order > > obj-$(CONFIG_ADIS16400) += adis16400.o > > obj-$(CONFIG_ADIS16460) += adis16460.o > > +obj-$(CONFIG_ADIS16475) += adis16475.o > > obj-$(CONFIG_ADIS16480) += adis16480.o > > > > adis_lib-y += adis.o > > diff --git a/drivers/iio/imu/adis16475.c > > b/drivers/iio/imu/adis16475.c > > new file mode 100644 > > index 000000000000..f7c637734ec8 > > --- /dev/null > > +++ b/drivers/iio/imu/adis16475.c > > @@ -0,0 +1,1304 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * ADIS16475 IMU driver > > + * > > + * Copyright 2019 Analog Devices Inc. > > + */ > > +#include <asm/unaligned.h> > > +#include <linux/bitfield.h> > > +#include <linux/bitops.h> > > +#include <linux/clk.h> > > +#include <linux/debugfs.h> > > +#include <linux/delay.h> > > +#include <linux/device.h> > > +#include <linux/kernel.h> > > +#include <linux/iio/buffer.h> > > +#include <linux/iio/iio.h> > > +#include <linux/iio/imu/adis.h> > > +#include <linux/iio/sysfs.h> > > +#include <linux/iio/trigger_consumer.h> > > +#include <linux/irq.h> > > +#include <linux/module.h> > > +#include <linux/spi/spi.h> > > + > > +#define ADIS16475_REG_DIAG_STAT 0x02 > > +#define ADIS16475_REG_X_GYRO_L 0x04 > > +#define ADIS16475_REG_Y_GYRO_L 0x08 > > +#define ADIS16475_REG_Z_GYRO_L 0x0C > > +#define ADIS16475_REG_X_ACCEL_L 0x10 > > +#define ADIS16475_REG_Y_ACCEL_L 0x14 > > +#define ADIS16475_REG_Z_ACCEL_L 0x18 > > +#define ADIS16475_REG_TEMP_OUT 0x1c > > +#define ADIS16475_REG_X_GYRO_BIAS_L 0x40 > > +#define ADIS16475_REG_Y_GYRO_BIAS_L 0x44 > > +#define ADIS16475_REG_Z_GYRO_BIAS_L 0x48 > > +#define ADIS16475_REG_X_ACCEL_BIAS_L 0x4c > > +#define ADIS16475_REG_Y_ACCEL_BIAS_L 0x50 > > +#define ADIS16475_REG_Z_ACCEL_BIAS_L 0x54 > > +#define ADIS16475_REG_FILT_CTRL 0x5c > > +#define ADIS16475_FILT_CTRL_MASK GENMASK(2, 0) > > +#define ADIS16475_FILT_CTRL(x) FIELD_PREP(ADIS16475_FI > > LT_CTRL_MASK, x) > > +#define ADIS16475_REG_MSG_CTRL 0x60 > > +#define ADIS16475_MSG_CTRL_DR_POL_MASK BIT(0) > > +#define ADIS16475_MSG_CTRL_DR_POL(x) \ > > + FIELD_PREP(ADIS16475_MSG_CTRL_DR_POL_MA > > SK, x) > > +#define ADIS16475_EXT_CLK_MASK GENMASK(4, 2) > > +#define ADIS16475_EXT_CLK(x) FIELD_PREP(ADIS16475_EX > > T_CLK_MASK, x) > > +#define ADIS16475_REG_UP_SCALE 0x62 > > +#define ADIS16475_REG_DEC_RATE 0x64 > > +#define ADIS16475_REG_GLOB_CMD 0x68 > > +#define ADIS16475_REG_FIRM_REV 0x6c > > +#define ADIS16475_REG_FIRM_DM 0x6e > > +#define ADIS16475_REG_FIRM_Y 0x70 > > +#define ADIS16475_REG_PROD_ID 0x72 > > +#define ADIS16475_REG_SERIAL_NUM 0x74 > > +#define ADIS16475_REG_FLASH_CNT 0x7c > > +#define ADIS16500_BURST32_MASK BIT(9) > > +#define ADIS16500_BURST32(x) FIELD_PREP(ADIS16500_BU > > RST32_MASK, x) > > +/* number of data elements in burst mode */ > > +#define ADIS16475_BURST_MAX_DATA 10 > > +#define ADIS16475_MAX_SCAN_DATA 15 > > + > > +enum clk_mode { > > + ADIS16475_CLK_DIRECT = 1, > > + ADIS16475_CLK_SCALED, > > + ADIS16475_CLK_OUTPUT, > > + ADIS16475_CLK_PULSE = 5, > > +}; > > + > > +struct adis16475_clks { > > + const char *name; > > + enum clk_mode clk_mode; > > + u16 min_rate; > > + u16 max_rate; > > +}; > > + > > +struct adis16475_chip_info { > > + const struct iio_chan_spec *channels; > > + const struct adis16475_clks *clks; > > + const struct adis_data adis_data; > > + u32 num_channels; > > + u32 gyro_max_val; > > + u32 gyro_max_scale; > > + u32 accel_max_val; > > + u32 accel_max_scale; > > + u32 temp_scale; > > + u32 int_clk; > > + u16 max_dec; > > + u8 num_clks; > > + bool has_burst32; > > +}; > > + > > +struct adis16475 { > > + const struct adis16475_chip_info *info; > > + struct adis adis; > > + u32 clk_freq; > > + u32 cached_spi_speed_hz; > > + bool burst32; > > +}; > > + > > +enum { > > + ADIS16475_SCAN_GYRO_X, > > + ADIS16475_SCAN_GYRO_Y, > > + ADIS16475_SCAN_GYRO_Z, > > + ADIS16475_SCAN_ACCEL_X, > > + ADIS16475_SCAN_ACCEL_Y, > > + ADIS16475_SCAN_ACCEL_Z, > > + ADIS16475_SCAN_TEMP, > > + ADIS16475_SCAN_DIAG_S_FLAGS, > > + ADIS16475_SCAN_CRC_FAILURE, > > +}; > > + > > +#ifdef CONFIG_DEBUG_FS > > +static ssize_t adis16475_show_firmware_revision(struct file *file, > > + char __user *userbuf, > > + size_t count, loff_t > > *ppos) > > +{ > > + struct adis16475 *st = file->private_data; > > + char buf[7]; > > + size_t len; > > + u16 rev; > > + int ret; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_REV, > > &rev); > > + if (ret) > > + return ret; > > + > > + len = scnprintf(buf, sizeof(buf), "%x.%x\n", rev >> 8, rev & > > 0xff); > > + > > + return simple_read_from_buffer(userbuf, count, ppos, buf, len); > > +} > > + > > +static const struct file_operations > > adis16475_firmware_revision_fops = { > > + .open = simple_open, > > + .read = adis16475_show_firmware_revision, > > + .llseek = default_llseek, > > + .owner = THIS_MODULE, > > +}; > > + > > +static ssize_t adis16475_show_firmware_date(struct file *file, > > + char __user *userbuf, > > + size_t count, loff_t *ppos) > > +{ > > + struct adis16475 *st = file->private_data; > > + u16 md, year; > > + char buf[12]; > > + size_t len; > > + int ret; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_Y, &year); > > + if (ret) > > + return ret; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_DM, &md); > > + if (ret) > > + return ret; > > + > > + len = snprintf(buf, sizeof(buf), "%.2x-%.2x-%.4x\n", md >> 8, > > md & 0xff, > > + year); > > + > > + return simple_read_from_buffer(userbuf, count, ppos, buf, len); > > +} > > + > > +static const struct file_operations adis16475_firmware_date_fops = > > { > > + .open = simple_open, > > + .read = adis16475_show_firmware_date, > > + .llseek = default_llseek, > > + .owner = THIS_MODULE, > > +}; > > + > > +static int adis16475_show_serial_number(void *arg, u64 *val) > > +{ > > + struct adis16475 *st = arg; > > + u16 serial; > > + int ret; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_SERIAL_NUM, > > &serial); > > + if (ret) > > + return ret; > > + > > + *val = serial; > > + > > + return 0; > > +} > > +DEFINE_SIMPLE_ATTRIBUTE(adis16475_serial_number_fops, > > + adis16475_show_serial_number, NULL, > > "0x%.4llx\n"); > > + > > +static int adis16475_show_product_id(void *arg, u64 *val) > > +{ > > + struct adis16475 *st = arg; > > + u16 prod_id; > > + int ret; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_PROD_ID, > > &prod_id); > > + if (ret) > > + return ret; > > + > > + *val = prod_id; > > + > > + return 0; > > +} > > +DEFINE_SIMPLE_ATTRIBUTE(adis16475_product_id_fops, > > + adis16475_show_product_id, NULL, "%llu\n"); > > + > > +static int adis16475_show_flash_count(void *arg, u64 *val) > > +{ > > + struct adis16475 *st = arg; > > + u32 flash_count; > > + int ret; > > + > > + ret = adis_read_reg_32(&st->adis, ADIS16475_REG_FLASH_CNT, > > + &flash_count); > > + if (ret) > > + return ret; > > + > > + *val = flash_count; > > + > > + return 0; > > +} > > +DEFINE_SIMPLE_ATTRIBUTE(adis16475_flash_count_fops, > > + adis16475_show_flash_count, NULL, "%lld\n"); > > + > > +static int adis16475_debugfs_init(struct iio_dev *indio_dev) > > +{ > > + struct adis16475 *st = iio_priv(indio_dev); > > + > > + debugfs_create_file("serial_number", 0400, indio_dev- > > >debugfs_dentry, > > + st, &adis16475_serial_number_fops); > > + debugfs_create_file("product_id", 0400, indio_dev- > > >debugfs_dentry, st, > > + &adis16475_product_id_fops); > > + debugfs_create_file("flash_count", 0400, indio_dev- > > >debugfs_dentry, st, > > + &adis16475_flash_count_fops); > > + debugfs_create_file("firmware_revision", 0400, > > + indio_dev->debugfs_dentry, st, > > + &adis16475_firmware_revision_fops); > > + debugfs_create_file("firmware_date", 0400, indio_dev- > > >debugfs_dentry, > > + st, &adis16475_firmware_date_fops); > > + return 0; > > +} > > +#else > > +static int adis16475_debugfs_init(struct iio_dev *indio_dev) > > +{ > > + return 0; > > +} > > +#endif > > + > > +static ssize_t adis16475_burst_mode_enable_get(struct device *dev, > > + struct device_attribute > > *attr, > > + char *buf) > > +{ > > + struct adis16475 *st = iio_priv(dev_to_iio_dev(dev)); > > + > > + return sprintf(buf, "%d\n", st->adis.burst->en); > > +} > > + > > +static ssize_t adis16475_burst_mode_enable_set(struct device *dev, > > + struct device_attribute > > *attr, > > + const char *buf, size_t > > len) > > +{ > > + struct adis16475 *st = iio_priv(dev_to_iio_dev(dev)); > > + bool val; > > + int ret; > > + > > + ret = kstrtobool(buf, &val); > > + if (ret) > > + return ret; > > + > > + if (val) > > + /* 1MHz max in burst mode */ > > + st->adis.spi->max_speed_hz = 1000000; > > + else > > + st->adis.spi->max_speed_hz = st->cached_spi_speed_hz; > > + > > + st->adis.burst->en = val; > > + > > + return len; > > +} > > + > > +static IIO_DEVICE_ATTR(burst_mode_enable, 0644, > > + adis16475_burst_mode_enable_get, > > + adis16475_burst_mode_enable_set, 0); > > + > > +static struct attribute *adis16475_attributes[] = { > > + &iio_dev_attr_burst_mode_enable.dev_attr.attr, > > Hmm. Normally we try to avoid exposing this and make the decision > automatically based on which channels are enabled. Hmm. In that case, the decision would probably have to go to the library since it is there that the "preparations" for buffered mode are done. Mostly, the data we are interested in the burst data is gyro, accel and temp. So to make the decision based on which channels are enabled is not that straight. Should we enable it only when all channels are enabled? Some of them (and which)? I guess that the only case where not using burst mode is faster is __maybe__ when only reading one channel (even then Im not sure...). Hence, I'm kind of thinking in the cynical approach :). However, I was also using this to handle the spi max_speed_hz since we have some limitations in burst mode. I have two thoughts here: 1) We handle this in the trigger handler, before doing the spi transfer 2) Just set the spi max_speed_hz to the one allowed by burst mode in the devicetree. Any preference? > If more cynical we decide that no one buys and expensive sensor only > to read a few of it's channels, so we turn on burst mode all the time > :) > > > + NULL, > > +}; > > + > > +static const struct attribute_group adis16495_attribute_group = { > > + .attrs = adis16475_attributes, > > +}; > > + > > +static int adis16475_get_freq(struct adis16475 *st, u32 *freq) > > +{ > > + int ret; > > + u16 dec; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, > > &dec); > > + if (ret) > > + return -EINVAL; > > + > > + *freq = DIV_ROUND_CLOSEST(st->clk_freq, dec + 1); > > + > > + return 0; > > +} > > + > > +static int adis16475_set_freq(struct adis16475 *st, const u32 > > freq) > > +{ > > + u16 dec; > > + > > + if (freq == 0 || freq > st->clk_freq) > > + return -EINVAL; > > + > > + dec = DIV_ROUND_CLOSEST(st->clk_freq, freq); > > + > > + if (dec) > > + dec--; > > + > > + if (dec > st->info->max_dec) > > + dec = st->info->max_dec; > > + > > + return adis_write_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, > > dec); > > +} > > + > > +/* The values are approximated. */ > > +static const u32 adis16475_3db_freqs[] = { > > + [0] = 720, /* Filter disabled, full BW (~720Hz) */ > > + [1] = 360, > > + [2] = 164, > > + [3] = 80, > > + [4] = 40, > > + [5] = 20, > > + [6] = 10, > > + [7] = 10, /* not a valid setting */ > > +}; > > + > > +static int adis16475_get_filter(struct adis16475 *st, u32 *filter) > > +{ > > + u16 filter_sz; > > + int ret; > > + const int mask = ADIS16475_FILT_CTRL_MASK; > > + > > + ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, > > &filter_sz); > > + if (ret) > > + return ret; > > + > > + *filter = adis16475_3db_freqs[filter_sz & mask]; > > + > > + return 0; > > +} > > + > > +static int adis16475_set_filter(struct adis16475 *st, const u32 > > filter) > > +{ > > + int i; > > + > > + for (i = ARRAY_SIZE(adis16475_3db_freqs) - 1; i >= 1; i--) { > > + if (adis16475_3db_freqs[i] >= filter) > > + break; > > + } > > + > > + return adis_write_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, > > + ADIS16475_FILT_CTRL(i)); > > +} > > + > > +static const u32 adis16475_calib_regs[] = { > > + [ADIS16475_SCAN_GYRO_X] = ADIS16475_REG_X_GYRO_BIAS_L, > > + [ADIS16475_SCAN_GYRO_Y] = ADIS16475_REG_Y_GYRO_BIAS_L, > > + [ADIS16475_SCAN_GYRO_Z] = ADIS16475_REG_Z_GYRO_BIAS_L, > > + [ADIS16475_SCAN_ACCEL_X] = ADIS16475_REG_X_ACCEL_BIAS_L, > > + [ADIS16475_SCAN_ACCEL_Y] = ADIS16475_REG_Y_ACCEL_BIAS_L, > > + [ADIS16475_SCAN_ACCEL_Z] = ADIS16475_REG_Z_ACCEL_BIAS_L, > > +}; > > + > > +static int adis16475_read_raw(struct iio_dev *indio_dev, > > + const struct iio_chan_spec *chan, > > + int *val, int *val2, long info) > > +{ > > + struct adis16475 *st = iio_priv(indio_dev); > > + int ret; > > + u32 tmp; > > + > > + switch (info) { > > + case IIO_CHAN_INFO_RAW: > > + return adis_single_conversion(indio_dev, chan, 0, val); > > + case IIO_CHAN_INFO_SCALE: > > + switch (chan->type) { > > + case IIO_ANGL_VEL: > > + *val = st->info->gyro_max_val; > > + *val2 = st->info->gyro_max_scale; > > + return IIO_VAL_FRACTIONAL; > > + case IIO_ACCEL: > > + *val = st->info->accel_max_val; > > + *val2 = st->info->accel_max_scale; > > + return IIO_VAL_FRACTIONAL; > > + case IIO_TEMP: > > + *val = st->info->temp_scale; > > + return IIO_VAL_INT; > > + default: > > + return -EINVAL; > > + } > > + case IIO_CHAN_INFO_CALIBBIAS: > > + ret = adis_read_reg_32(&st->adis, > > + adis16475_calib_regs[chan- > > >scan_index], > > + val); > > + break; > > + case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: > > + ret = adis16475_get_filter(st, val); > > + break; > > + case IIO_CHAN_INFO_SAMP_FREQ: > > + ret = adis16475_get_freq(st, &tmp); > > + if (ret) > > + return ret; > > + > > + *val = tmp / 1000; > > + *val2 = (tmp % 1000) * 1000; > > + return IIO_VAL_INT_PLUS_MICRO; > > + default: > > + return -EINVAL; > > + } > > + > > + if (ret) > > + return ret; > > Better to put this inline after each ret = section and return > directly from those. > As it stands the code paths are rather inconsistent. Got it... > > + > > + return IIO_VAL_INT; > > +} > > + > > +static int adis16475_write_raw(struct iio_dev *indio_dev, > > + const struct iio_chan_spec *chan, > > + int val, int val2, long info) > > +{ > > + struct adis16475 *st = iio_priv(indio_dev); > > + u32 tmp; > > + > > + switch (info) { > > + case IIO_CHAN_INFO_SAMP_FREQ: > > + tmp = val * 1000 + val2 / 1000; > > + return adis16475_set_freq(st, tmp); > > + case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: > > + return adis16475_set_filter(st, val); > > + case IIO_CHAN_INFO_CALIBBIAS: > > + return adis_write_reg_32(&st->adis, > > + adis16475_calib_regs[chan- > > >scan_index], > > + val); > > + default: > > + return -EINVAL; > > + } > > +} > > + > > +#define ADIS16475_MOD_CHAN(_type, _mod, _address, _si, _r_bits, > > _s_bits) \ > > + { \ > > + .type = (_type), \ > > + .modified = 1, \ > > + .channel2 = (_mod), \ > > + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ > > + BIT(IIO_CHAN_INFO_CALIBBIAS), \ > > + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ > > + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ) > > | \ > > + BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY > > ), \ > > + .address = (_address), \ > > + .scan_index = (_si), \ > > + .scan_type = { \ > > + .sign = 's', \ > > + .realbits = (_r_bits), \ > > + .storagebits = (_s_bits), \ > > + .endianness = IIO_BE, \ > > + }, \ > > + } > > + > > +#define ADIS16475_GYRO_CHANNEL(_mod) \ > > + ADIS16475_MOD_CHAN(IIO_ANGL_VEL, IIO_MOD_ ## _mod, \ > > + ADIS16475_REG_ ## _mod ## _GYRO_L, ADIS16475_SCAN_GYRO_ ## > > _mod, 32, \ > > + 32) > > + > > +#define ADIS16475_ACCEL_CHANNEL(_mod) \ > > + ADIS16475_MOD_CHAN(IIO_ACCEL, IIO_MOD_ ## _mod, \ > > + ADIS16475_REG_ ## _mod ## _ACCEL_L, ADIS16475_SCAN_ACCEL_ ## > > _mod, 32, \ > > + 32) > > + > > +#define ADIS16475_TEMP_CHANNEL() { \ > > + .type = IIO_TEMP, \ > > + .indexed = 1, \ > > + .channel = 0, \ > > + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ > > + BIT(IIO_CHAN_INFO_SCALE), \ > > + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ) > > | \ > > + BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY > > ), \ > > + .address = ADIS16475_REG_TEMP_OUT, \ > > + .scan_index = ADIS16475_SCAN_TEMP, \ > > + .scan_type = { \ > > + .sign = 's', \ > > + .realbits = 16, \ > > + .storagebits = 16, \ > > + .endianness = IIO_BE, \ > > + }, \ > > + } > > + > > +static const struct iio_chan_spec adis16475_channels[] = { > > + ADIS16475_GYRO_CHANNEL(X), > > + ADIS16475_GYRO_CHANNEL(Y), > > + ADIS16475_GYRO_CHANNEL(Z), > > + ADIS16475_ACCEL_CHANNEL(X), > > + ADIS16475_ACCEL_CHANNEL(Y), > > + ADIS16475_ACCEL_CHANNEL(Z), > > + ADIS16475_TEMP_CHANNEL(), > > + IIO_CHAN_SOFT_TIMESTAMP(9) > > +}; > > + > > +enum adis16475_variant { > > + ADIS16470, > > + ADIS16475_1, > > + ADIS16475_2, > > + ADIS16475_3, > > + ADIS16477_1, > > + ADIS16477_2, > > + ADIS16477_3, > > + ADIS16465_1, > > + ADIS16465_2, > > + ADIS16465_3, > > + ADIS16467_1, > > + ADIS16467_2, > > + ADIS16467_3, > > + ADIS16500, > > + ADIS16505_1, > > + ADIS16505_2, > > + ADIS16505_3, > > + ADIS16507_1, > > + ADIS16507_2, > > + ADIS16507_3, > > + > > +}; > > + > > +enum { > > + ADIS16475_DIAG_STAT_DATA_PATH = 1, > > + ADIS16475_DIAG_STAT_FLASH_MEM, > > + ADIS16475_DIAG_STAT_SPI, > > + ADIS16475_DIAG_STAT_STANDBY, > > + ADIS16475_DIAG_STAT_SENSOR, > > + ADIS16475_DIAG_STAT_MEMORY, > > + ADIS16475_DIAG_STAT_CLK, > > +}; > > + > > +static const char * const adis16475_status_error_msgs[] = { > > + [ADIS16475_DIAG_STAT_DATA_PATH] = "Data Path Overrun", > > + [ADIS16475_DIAG_STAT_FLASH_MEM] = "Flash memory update > > failure", > > + [ADIS16475_DIAG_STAT_SPI] = "SPI communication error", > > + [ADIS16475_DIAG_STAT_STANDBY] = "Standby mode", > > + [ADIS16475_DIAG_STAT_SENSOR] = "Sensor failure", > > + [ADIS16475_DIAG_STAT_MEMORY] = "Memory failure", > > + [ADIS16475_DIAG_STAT_CLK] = "Clock error", > > +}; > > + > > +static int adis16475_enable_irq(struct adis *adis, bool enable) > > +{ > > + /* > > + * There is no way to gate the data-ready signal internally > > inside the > > + * ADIS16475. We can only control it's polarity... > > + */ > > + if (enable) > > + enable_irq(adis->spi->irq); > > + else > > + disable_irq(adis->spi->irq); > > + > > + return 0; > > +} > > + > > +#define ADIS16475_DATA(_prod_id, _timeouts) > > \ > > +{ > > \ > > + .msc_ctrl_reg = ADIS16475_REG_MSG_CTRL, > > \ > > + .glob_cmd_reg = ADIS16475_REG_GLOB_CMD, > > \ > > + .diag_stat_reg = ADIS16475_REG_DIAG_STAT, \ > > + .prod_id_reg = ADIS16475_REG_PROD_ID, > > \ > > + .prod_id = (_prod_id), > > \ > > + .self_test_mask = BIT(2), \ > > + .self_test_reg = ADIS16475_REG_GLOB_CMD, \ > > + .cs_change_delay = 16, > > \ > > + .read_delay = 5, \ > > + .write_delay = 5, \ > > + .status_error_msgs = adis16475_status_error_msgs, \ > > + .status_error_mask = BIT(ADIS16475_DIAG_STAT_DATA_PATH) | \ > > + BIT(ADIS16475_DIAG_STAT_FLASH_MEM) | > > \ > > + BIT(ADIS16475_DIAG_STAT_SPI) | > > \ > > + BIT(ADIS16475_DIAG_STAT_STANDBY) | \ > > + BIT(ADIS16475_DIAG_STAT_SENSOR) | \ > > + BIT(ADIS16475_DIAG_STAT_MEMORY) | \ > > + BIT(ADIS16475_DIAG_STAT_CLK), > > \ > > + .enable_irq = adis16475_enable_irq, \ > > + .timeouts = (_timeouts), \ > > +} > > + > > +static const struct adis16475_clks adis16475_ext_clks[] = { > > + { "sync", ADIS16475_CLK_OUTPUT, 1900, 2100 }, > > + { "direct-sync", ADIS16475_CLK_DIRECT, 1900, 2100 }, > > + { "scaled-sync", ADIS16475_CLK_SCALED, 1, 128 }, > > + { "pulse-sync", ADIS16475_CLK_PULSE, 1000, 2100 }, > > Rob already commented on this so I'll not bother :) I will change the name to adis16475_sync... > > +}; > > + > > +static const struct adis_timeout adis16475_timeouts = { > > + .reset_ms = 200, > > + .sw_reset_ms = 200, > > + .self_test_ms = 20, > > +}; > > + > > +static const struct adis_timeout adis1650x_timeouts = { > > + .reset_ms = 260, > > + .sw_reset_ms = 260, > > + .self_test_ms = 30, > > +}; > > + > > +static const struct adis16475_chip_info adis16475_chip_info[] = { > > + [ADIS16470] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16470, > > &adis16475_timeouts), > > + }, > > + [ADIS16475_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16475, > > &adis16475_timeouts), > > + }, > > + [ADIS16475_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16475, > > &adis16475_timeouts), > > + }, > > + [ADIS16475_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16475, > > &adis16475_timeouts), > > + }, > > + [ADIS16477_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16477, > > &adis16475_timeouts), > > + }, > > + [ADIS16477_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16477, > > &adis16475_timeouts), > > + }, > > + [ADIS16477_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16477, > > &adis16475_timeouts), > > + }, > > + [ADIS16465_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16465, > > &adis16475_timeouts), > > + }, > > + [ADIS16465_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16465, > > &adis16475_timeouts), > > + }, > > + [ADIS16465_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16465, > > &adis16475_timeouts), > > + }, > > + [ADIS16467_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16467, > > &adis16475_timeouts), > > + }, > > + [ADIS16467_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16467, > > &adis16475_timeouts), > > + }, > > + [ADIS16467_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 1, > > + .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks), > > + .adis_data = ADIS16475_DATA(16467, > > &adis16475_timeouts), > > + }, > > + [ADIS16500] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 392, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16500, > > &adis1650x_timeouts), > > + }, > > + [ADIS16505_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 78, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16505, > > &adis1650x_timeouts), > > + }, > > + [ADIS16505_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 78, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16505, > > &adis1650x_timeouts), > > + }, > > + [ADIS16505_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 78, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16505, > > &adis1650x_timeouts), > > + }, > > + [ADIS16507_1] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), > > + .accel_max_val = 392, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16507, > > &adis1650x_timeouts), > > + }, > > + [ADIS16507_2] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), > > + .accel_max_val = 392, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16507, > > &adis1650x_timeouts), > > + }, > > + [ADIS16507_3] = { > > + .num_channels = ARRAY_SIZE(adis16475_channels), > > + .channels = adis16475_channels, > > + .gyro_max_val = 1, > > + .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), > > + .accel_max_val = 392, > > + .accel_max_scale = 32000 << 16, > > + .temp_scale = 100, > > + .int_clk = 2000, > > + .max_dec = 1999, > > + .clks = adis16475_ext_clks, > > + /* pulse sync not supported */ > > + .num_clks = ARRAY_SIZE(adis16475_ext_clks) - 1, > > + .has_burst32 = true, > > + .adis_data = ADIS16475_DATA(16507, > > &adis1650x_timeouts), > > + }, > > +}; > > + > > +static const struct iio_info adis16475_info = { > > + .read_raw = &adis16475_read_raw, > > + .write_raw = &adis16475_write_raw, > > + .update_scan_mode = adis_update_scan_mode, > > + .attrs = &adis16495_attribute_group, > > + .debugfs_reg_access = adis_debugfs_reg_access, > > +}; > > + > > +static struct adis_burst adis16475_burst = { > > + .en = true, > > + .reg_cmd = ADIS16475_REG_GLOB_CMD, > > + /* > > + * adis_update_scan_mode_burst() sets the burst length in > > respect with > > + * the number of channels and allocates 16 bits for each. > > However, > > + * adis1647x devices also need space for DIAG_STAT, DATA_CNTR > > or > > + * TIME_STAMP (depending on the clock mode but for us these > > bytes are > > + * don't care...) and CRC. > > + */ > > + .extra_len = 3 * sizeof(u16), > > +}; > > + > > +static u16 adis16475_validate_crc(const u8 *buffer, const u16 crc, > > + const bool burst32) > > +{ > > + int i; > > + u16 __crc = 0; > > + > > + /* extra 6 elements for low gyro and accel */ > > + const u16 sz = burst32 ? ADIS16475_BURST_MAX_DATA + 6 : > > + ADIS16475_BURST_MAX_DATA; > > + > > + for (i = 0; i < sz * 2 - 2; i++) > > + __crc += buffer[i]; > > + > > + return (__crc != crc); > > +} > > + > > +static irqreturn_t adis16475_trigger_handler(int irq, void *p) > > +{ > > + struct iio_poll_func *pf = p; > > + struct iio_dev *indio_dev = pf->indio_dev; > > + struct adis16475 *st = iio_priv(indio_dev); > > + struct adis *adis = &st->adis; > > + int ret, bit, i = 0; > > + u16 crc, data[ADIS16475_MAX_SCAN_DATA], *buffer, crc_res; > > + /* offset until the first element after gyro and accel */ > > + const u8 offset = st->burst32 ? 13 : 7; > > + > > + ret = spi_sync(adis->spi, &adis->msg); > > + if (ret) > > + return ret; > > + > > + buffer = (u16 *)adis->buffer; > > + > > + if (!(adis->burst && adis->burst->en)) > > + goto push_to_buffers; > > + > > + /* We always validate the crc to at least print a message */ > > + crc = get_unaligned_be16(&buffer[offset + 2]); > > + crc_res = adis16475_validate_crc((u8 *)adis->buffer, crc, > > + st->burst32); > > + if (crc_res) > > + dev_err(&adis->spi->dev, "Invalid crc\n"); > > + > > + for_each_set_bit(bit, indio_dev->active_scan_mask, > > + indio_dev->masklength) { > > + /* > > + * When burst mode is used, system flags is the first > > data > > + * channel in the sequence, but the scan index is 7. > > + */ > > + switch (bit) { > > + case ADIS16475_SCAN_TEMP: > > + data[i++] = get_unaligned(&buffer[offset]); > > + break; > > + case ADIS16475_SCAN_GYRO_X ... ADIS16475_SCAN_ACCEL_Z: > > + /* > > + * The first 2 bytes on the received data are > > the > > + * DIAG_STAT reg, hence the +1 offset here... > > + */ > > + if (st->burst32) { > > + /* upper 16 */ > > + data[i++] = get_unaligned(&buffer[bit * > > 2 + 2]); > > + /* lower 16 */ > > + data[i++] = get_unaligned(&buffer[bit * > > 2 + 1]); > > + } else { > > + data[i++] = get_unaligned(&buffer[bit + > > 1]); > > + /* lower not used */ > > + data[i++] = 0; > > + } > > + break; > > + } > > + } > > + > > + buffer = data; > > + > > +push_to_buffers: > > + iio_push_to_buffers_with_timestamp(indio_dev, buffer, pf- > > >timestamp); > > I'm not sure data is the right size. It needs to have space to have > an aligned > timestamp at the end. Will double check this... Honestly I did not had the timestamp into account so the size is probably wrong. > > + iio_trigger_notify_done(indio_dev->trig); > > + > > + return IRQ_HANDLED; > > +} > > + > > +static void adis16475_disable_clk(void *data) > > +{ > > + clk_disable_unprepare((struct clk *)data); > > +} > > + > > +static int adis16475_config_ext_clk(struct adis16475 *st) > > +{ > > + int ret; > > + int i; > > + struct device *dev = &st->adis.spi->dev; > > + const struct adis16475_clks *ext_clks = st->info->clks; > > + > > + for (i = 0; i < st->info->num_clks; i++) { > > + u16 mode = ADIS16475_EXT_CLK(ext_clks[i].clk_mode); > > + struct clk *clk = devm_clk_get(dev, ext_clks[i].name); > > + > > + if (IS_ERR(clk) && PTR_ERR(clk) != -ENOENT) > > + return PTR_ERR(clk); > > + else if (IS_ERR(clk)) > > + continue; > > + > > + ret = clk_prepare_enable(clk); > > + if (ret) > > + return ret; > > + > > + ret = devm_add_action_or_reset(dev, > > adis16475_disable_clk, clk); > > + if (ret) > > + return ret; > > + > > + st->clk_freq = clk_get_rate(clk); > > + if (st->clk_freq < ext_clks[i].min_rate || > > + st->clk_freq > ext_clks[i].max_rate) { > > + dev_err(dev, > > + "Clk rate:%u not in a valid range:[%u > > %u]\n", > > + st->clk_freq, ext_clks[i].min_rate, > > + ext_clks[i].max_rate); > > + return -EINVAL; > > + } > > + > > + if (ext_clks[i].clk_mode == ADIS16475_CLK_SCALED) { > > + u16 up_scale; > > + u32 scaled_out_freq = 0; > > + /* > > + * If we are in scaled mode, we must have an > > up_scale. > > + * In scaled mode the allowable input clock > > range is > > + * 1 Hz to 128 Hz, and the allowable output > > range is > > + * 1900 to 2100 Hz. Hence, a scale must be > > given to > > + * get the allowable output. > > + */ > > + device_property_read_u32(dev, "adi,scaled- > > output-hz", > > + &scaled_out_freq); > > + > > + if (scaled_out_freq < 1900 || scaled_out_freq > > > 2100) { > > + dev_err(dev, > > + "Invalid value:%u for > > adi,scaled-output-hz", > > + scaled_out_freq); > > + return -EINVAL; > > + } > > + > > + up_scale = DIV_ROUND_CLOSEST(scaled_out_freq, > > + st->clk_freq); > > + > > + ret = __adis_write_reg_16(&st->adis, > > + ADIS16475_CLK_SCALED, > > + up_scale); > > + if (ret) > > + return ret; > > + > > + st->clk_freq = scaled_out_freq; > > + } > > + /* > > + * Keep in mind that the mask for the clk modes in > > adis1650* > > + * chips is different (1100 instead of 11100). However, > > we > > + * are not configuring BIT(4) in these chips and the > > default > > + * value is 0, so we are fine in doing the below > > operations. > > + * I'm keeping this for simplicity and avoiding extra > > variables > > + * in chip_info. > > + */ > > + ret = __adis_update_bits(&st->adis, > > ADIS16475_REG_MSG_CTRL, > > + ADIS16475_EXT_CLK_MASK, mode); > > + if (ret) > > + return ret; > > + > > + usleep_range(250, 260); > > + > > + break; > > + } > > + > > + if (i == st->info->num_clks) > > + /* internal clk */ > > + st->clk_freq = st->info->int_clk; > > + > > + st->clk_freq *= 1000; > > + > > + return 0; > > +} > > > > +static int adis16475_config_irq_pin(struct adis16475 *st) > > +{ > > + int ret; > > + struct irq_data *desc; > > + u32 irq_type; > > + u16 val = 0; > > + u8 polarity; > > + struct spi_device *spi = st->adis.spi; > > + > > + desc = irq_get_irq_data(spi->irq); > > + if (!desc) { > > + dev_err(&spi->dev, "Could not find IRQ %d\n", spi- > > >irq); > > + return -EINVAL; > > + } > > + /* > > + * It is possible to configure the data ready polarity. > > Furthermore, we > > + * need to update the adis struct if we want data ready as > > active low. > > + */ > > + irq_type = irqd_get_trigger_type(desc); > > + if (irq_type == IRQF_TRIGGER_RISING) { > > + polarity = 1; > > + } else if (irq_type == IRQF_TRIGGER_FALLING) { > > + polarity = 0; > > + st->adis.irq_mask = IRQF_TRIGGER_FALLING; > > + } else { > > + dev_err(&spi->dev, "Invalid interrupt type 0x%x > > specified\n", > > + irq_type); > > + return -EINVAL; > > + } > > + > > + val = ADIS16475_MSG_CTRL_DR_POL(polarity); > > + ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, > > + ADIS16475_MSG_CTRL_DR_POL_MASK, val); > > + if (ret) > > + return ret; > > + /* > > + * There is a delay writing to any bits written to the MSC_CTRL > > + * register. It should not be bigger than 200us, so 250 should > > be more > > + * than enough! > > + */ > > + usleep_range(250, 260); > > + > > + return 0; > > +} > > + > > +static int adis16475_burst_config(struct adis16475 *st) > > +{ > > + const u16 burst32 = ADIS16500_BURST32(1); > > + int ret; > > + > > + st->burst32 = device_property_read_bool(&st->adis.spi->dev, > > + "adi,burst32-enable"); > > + if (!st->burst32) > > + goto burst16; > A forwards goto like this on a non error condition, is a bit unusual. > While it involves more indenting I would still prefer the logic > flipped Honestly I find it more readable (to me) like this. But I do agree it's not that usual. Will change it... > if (st->burst32) { > > } > > > > + > > + if (!st->info->has_burst32) { > > + dev_err(&st->adis.spi->dev, "%s does not support > > burst32 mode\n", > > + spi_get_device_id(st->adis.spi)->name); > > + return -EINVAL; > > + } > > + > > + ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, > > + ADIS16500_BURST32_MASK, burst32); > > + if (ret) > > + return ret; > > + > > + usleep_range(250, 260); > > + /* > > + * In 32bit mode we need extra 2 bytes for all gyro and accel > > + * channels. > > + */ > > + adis16475_burst.extra_len += 6 * sizeof(u16); > > +burst16: > > + st->adis.burst = &adis16475_burst; > > + /* it's enabled by default so spi max speed needs to be 1MHz */ > > + st->cached_spi_speed_hz = st->adis.spi->max_speed_hz; > > + st->adis.spi->max_speed_hz = 1000000; > > + > > + return 0; > > +} > > + > > +static int adis16475_probe(struct spi_device *spi) > > +{ > > + struct iio_dev *indio_dev; > > + struct adis16475 *st; > > + const struct spi_device_id *id = spi_get_device_id(spi); > > + int ret; > > + > > + indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); > > + if (!indio_dev) > > + return -ENOMEM; > > + > > + st = iio_priv(indio_dev); > > + st->info = &adis16475_chip_info[id->driver_data]; > > + spi_set_drvdata(spi, indio_dev); > > + > > + ret = adis_init(&st->adis, indio_dev, spi, &st->info- > > >adis_data); > > + if (ret) > > + return ret; > > + > > + indio_dev->dev.parent = &spi->dev; > > + indio_dev->name = id->name; > > + indio_dev->channels = st->info->channels; > > + indio_dev->num_channels = st->info->num_channels; > > + indio_dev->info = &adis16475_info; > > + indio_dev->modes = INDIO_DIRECT_MODE; > > + > > + ret = __adis_initial_startup(&st->adis); > > + if (ret) > > + return ret; > > + > > + ret = adis16475_burst_config(st); > > + if (ret) > > + return ret; > > + > > + ret = adis16475_config_irq_pin(st); > > + if (ret) > > + return ret; > > + > > + ret = adis16475_config_ext_clk(st); > > + if (ret) > > + return ret; > > + > > + ret = devm_adis_setup_buffer_and_trigger(&st->adis, indio_dev, > > + adis16475_trigger_hand > > ler); > > + if (ret) > > + return ret; > > + > > + adis16475_enable_irq(&st->adis, false); > > + > > + ret = devm_iio_device_register(&spi->dev, indio_dev); > > + if (ret) > > + return ret; > > + > > + adis16475_debugfs_init(indio_dev); > > + > > + return 0; > > +} > > + > > +static const struct spi_device_id adis16475_ids[] = { > > Is it actually possible to instantiate this except by > using the dt table below? If not, then move the 'data' > part into that table and don't provide an spi_device_id > table at all. It's not relevant to the possible ways > of causing the driver to probe. I guess we could use the id table with devicetree even without the dt table (even though it makes no sense). So, I can remove it but I was using the id->name to set the the iio_dev name which I guess is not the right way? What Im thinking is having a name/part number string in chip info that I can use to set the iio dev name. For parts that have the *-[1|2|3] variations I could use the devicetree iio label property. Is this the correct way of handling this? - Nuno Sá > > + { "adis16470", ADIS16470 }, > > + { "adis16475-1", ADIS16475_1 }, > > + { "adis16475-2", ADIS16475_2 }, > > + { "adis16475-3", ADIS16475_3 }, > > + { "adis16477-1", ADIS16477_1 }, > > + { "adis16477-2", ADIS16477_2 }, > > + { "adis16477-3", ADIS16477_3 }, > > + { "adis16465-1", ADIS16465_1 }, > > + { "adis16465-2", ADIS16465_2 }, > > + { "adis16465-3", ADIS16465_3 }, > > + { "adis16467-1", ADIS16467_1 }, > > + { "adis16467-2", ADIS16467_2 }, > > + { "adis16467-3", ADIS16467_3 }, > > + { "adis16500", ADIS16500 }, > > + { "adis16505-1", ADIS16505_1 }, > > + { "adis16505-2", ADIS16505_2 }, > > + { "adis16505-3", ADIS16505_3 }, > > + { "adis16507-1", ADIS16507_1 }, > > + { "adis16507-2", ADIS16507_2 }, > > + { "adis16507-3", ADIS16507_3 }, > > + { } > > +}; > > +MODULE_DEVICE_TABLE(spi, adis16475_ids); > > + > > +static const struct of_device_id adis16475_of_match[] = { > > + { .compatible = "adi,adis16470" }, > > + { .compatible = "adi,adis16475-1" }, > > + { .compatible = "adi,adis16475-2" }, > > + { .compatible = "adi,adis16475-3" }, > > + { .compatible = "adi,adis16477-1" }, > > + { .compatible = "adi,adis16477-2" }, > > + { .compatible = "adi,adis16477-3" }, > > + { .compatible = "adi,adis16465-1" }, > > + { .compatible = "adi,adis16465-2" }, > > + { .compatible = "adi,adis16465-3" }, > > + { .compatible = "adi,adis16467-1" }, > > + { .compatible = "adi,adis16467-2" }, > > + { .compatible = "adi,adis16467-3" }, > > + { .compatible = "adi,adis16500" }, > > + { .compatible = "adi,adis16505-1" }, > > + { .compatible = "adi,adis16505-2" }, > > + { .compatible = "adi,adis16505-3" }, > > + { .compatible = "adi,adis16507-1" }, > > + { .compatible = "adi,adis16507-2" }, > > + { .compatible = "adi,adis16507-3" }, > > + { }, > > +}; > > +MODULE_DEVICE_TABLE(of, adis16475_of_match); > > + > > +static struct spi_driver adis16475_driver = { > > + .driver = { > > + .name = "adis16475", > > + .of_match_table = adis16475_of_match, > > + }, > > + .id_table = adis16475_ids, > > + .probe = adis16475_probe, > > +}; > > +module_spi_driver(adis16475_driver); > > + > > +MODULE_AUTHOR("Nuno Sa <nuno.sa@xxxxxxxxxx>"); > > +MODULE_DESCRIPTION("Analog Devices ADIS16475 IMU driver"); > > +MODULE_LICENSE("GPL");
