Commit | Line | Data |
---|---|---|
fff7352b NS |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* | |
3 | * ADIS16475 IMU driver | |
4 | * | |
5 | * Copyright 2019 Analog Devices Inc. | |
6 | */ | |
7 | #include <linux/bitfield.h> | |
8 | #include <linux/bitops.h> | |
9 | #include <linux/clk.h> | |
10 | #include <linux/debugfs.h> | |
11 | #include <linux/delay.h> | |
12 | #include <linux/device.h> | |
13 | #include <linux/kernel.h> | |
14 | #include <linux/iio/buffer.h> | |
15 | #include <linux/iio/iio.h> | |
16 | #include <linux/iio/imu/adis.h> | |
fff7352b NS |
17 | #include <linux/iio/trigger_consumer.h> |
18 | #include <linux/irq.h> | |
39c024b5 NS |
19 | #include <linux/lcm.h> |
20 | #include <linux/math.h> | |
fff7352b NS |
21 | #include <linux/module.h> |
22 | #include <linux/mod_devicetable.h> | |
23 | #include <linux/property.h> | |
24 | #include <linux/spi/spi.h> | |
25 | ||
26 | #define ADIS16475_REG_DIAG_STAT 0x02 | |
27 | #define ADIS16475_REG_X_GYRO_L 0x04 | |
28 | #define ADIS16475_REG_Y_GYRO_L 0x08 | |
29 | #define ADIS16475_REG_Z_GYRO_L 0x0C | |
30 | #define ADIS16475_REG_X_ACCEL_L 0x10 | |
31 | #define ADIS16475_REG_Y_ACCEL_L 0x14 | |
32 | #define ADIS16475_REG_Z_ACCEL_L 0x18 | |
33 | #define ADIS16475_REG_TEMP_OUT 0x1c | |
34 | #define ADIS16475_REG_X_GYRO_BIAS_L 0x40 | |
35 | #define ADIS16475_REG_Y_GYRO_BIAS_L 0x44 | |
36 | #define ADIS16475_REG_Z_GYRO_BIAS_L 0x48 | |
37 | #define ADIS16475_REG_X_ACCEL_BIAS_L 0x4c | |
38 | #define ADIS16475_REG_Y_ACCEL_BIAS_L 0x50 | |
39 | #define ADIS16475_REG_Z_ACCEL_BIAS_L 0x54 | |
40 | #define ADIS16475_REG_FILT_CTRL 0x5c | |
41 | #define ADIS16475_FILT_CTRL_MASK GENMASK(2, 0) | |
42 | #define ADIS16475_FILT_CTRL(x) FIELD_PREP(ADIS16475_FILT_CTRL_MASK, x) | |
43 | #define ADIS16475_REG_MSG_CTRL 0x60 | |
44 | #define ADIS16475_MSG_CTRL_DR_POL_MASK BIT(0) | |
45 | #define ADIS16475_MSG_CTRL_DR_POL(x) \ | |
46 | FIELD_PREP(ADIS16475_MSG_CTRL_DR_POL_MASK, x) | |
47 | #define ADIS16475_SYNC_MODE_MASK GENMASK(4, 2) | |
48 | #define ADIS16475_SYNC_MODE(x) FIELD_PREP(ADIS16475_SYNC_MODE_MASK, x) | |
49 | #define ADIS16475_REG_UP_SCALE 0x62 | |
50 | #define ADIS16475_REG_DEC_RATE 0x64 | |
51 | #define ADIS16475_REG_GLOB_CMD 0x68 | |
52 | #define ADIS16475_REG_FIRM_REV 0x6c | |
53 | #define ADIS16475_REG_FIRM_DM 0x6e | |
54 | #define ADIS16475_REG_FIRM_Y 0x70 | |
55 | #define ADIS16475_REG_PROD_ID 0x72 | |
56 | #define ADIS16475_REG_SERIAL_NUM 0x74 | |
57 | #define ADIS16475_REG_FLASH_CNT 0x7c | |
58 | #define ADIS16500_BURST32_MASK BIT(9) | |
59 | #define ADIS16500_BURST32(x) FIELD_PREP(ADIS16500_BURST32_MASK, x) | |
60 | /* number of data elements in burst mode */ | |
61 | #define ADIS16475_BURST32_MAX_DATA 32 | |
62 | #define ADIS16475_BURST_MAX_DATA 20 | |
63 | #define ADIS16475_MAX_SCAN_DATA 20 | |
64 | /* spi max speed in brust mode */ | |
65 | #define ADIS16475_BURST_MAX_SPEED 1000000 | |
66 | #define ADIS16475_LSB_DEC_MASK BIT(0) | |
67 | #define ADIS16475_LSB_FIR_MASK BIT(1) | |
68 | ||
69 | enum { | |
70 | ADIS16475_SYNC_DIRECT = 1, | |
71 | ADIS16475_SYNC_SCALED, | |
72 | ADIS16475_SYNC_OUTPUT, | |
73 | ADIS16475_SYNC_PULSE = 5, | |
74 | }; | |
75 | ||
76 | struct adis16475_sync { | |
77 | u16 sync_mode; | |
78 | u16 min_rate; | |
79 | u16 max_rate; | |
80 | }; | |
81 | ||
82 | struct adis16475_chip_info { | |
83 | const struct iio_chan_spec *channels; | |
84 | const struct adis16475_sync *sync; | |
85 | const struct adis_data adis_data; | |
86 | const char *name; | |
87 | u32 num_channels; | |
88 | u32 gyro_max_val; | |
89 | u32 gyro_max_scale; | |
90 | u32 accel_max_val; | |
91 | u32 accel_max_scale; | |
92 | u32 temp_scale; | |
93 | u32 int_clk; | |
94 | u16 max_dec; | |
95 | u8 num_sync; | |
96 | bool has_burst32; | |
97 | }; | |
98 | ||
99 | struct adis16475 { | |
100 | const struct adis16475_chip_info *info; | |
101 | struct adis adis; | |
102 | u32 clk_freq; | |
103 | bool burst32; | |
104 | unsigned long lsb_flag; | |
39c024b5 | 105 | u16 sync_mode; |
fff7352b NS |
106 | /* Alignment needed for the timestamp */ |
107 | __be16 data[ADIS16475_MAX_SCAN_DATA] __aligned(8); | |
108 | }; | |
109 | ||
110 | enum { | |
111 | ADIS16475_SCAN_GYRO_X, | |
112 | ADIS16475_SCAN_GYRO_Y, | |
113 | ADIS16475_SCAN_GYRO_Z, | |
114 | ADIS16475_SCAN_ACCEL_X, | |
115 | ADIS16475_SCAN_ACCEL_Y, | |
116 | ADIS16475_SCAN_ACCEL_Z, | |
117 | ADIS16475_SCAN_TEMP, | |
118 | ADIS16475_SCAN_DIAG_S_FLAGS, | |
119 | ADIS16475_SCAN_CRC_FAILURE, | |
120 | }; | |
121 | ||
39c024b5 NS |
122 | static bool low_rate_allow; |
123 | module_param(low_rate_allow, bool, 0444); | |
124 | MODULE_PARM_DESC(low_rate_allow, | |
125 | "Allow IMU rates below the minimum advisable when external clk is used in SCALED mode (default: N)"); | |
126 | ||
fff7352b NS |
127 | #ifdef CONFIG_DEBUG_FS |
128 | static ssize_t adis16475_show_firmware_revision(struct file *file, | |
129 | char __user *userbuf, | |
130 | size_t count, loff_t *ppos) | |
131 | { | |
132 | struct adis16475 *st = file->private_data; | |
133 | char buf[7]; | |
134 | size_t len; | |
135 | u16 rev; | |
136 | int ret; | |
137 | ||
138 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_REV, &rev); | |
139 | if (ret) | |
140 | return ret; | |
141 | ||
142 | len = scnprintf(buf, sizeof(buf), "%x.%x\n", rev >> 8, rev & 0xff); | |
143 | ||
144 | return simple_read_from_buffer(userbuf, count, ppos, buf, len); | |
145 | } | |
146 | ||
147 | static const struct file_operations adis16475_firmware_revision_fops = { | |
148 | .open = simple_open, | |
149 | .read = adis16475_show_firmware_revision, | |
150 | .llseek = default_llseek, | |
151 | .owner = THIS_MODULE, | |
152 | }; | |
153 | ||
154 | static ssize_t adis16475_show_firmware_date(struct file *file, | |
155 | char __user *userbuf, | |
156 | size_t count, loff_t *ppos) | |
157 | { | |
158 | struct adis16475 *st = file->private_data; | |
159 | u16 md, year; | |
160 | char buf[12]; | |
161 | size_t len; | |
162 | int ret; | |
163 | ||
164 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_Y, &year); | |
165 | if (ret) | |
166 | return ret; | |
167 | ||
168 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FIRM_DM, &md); | |
169 | if (ret) | |
170 | return ret; | |
171 | ||
172 | len = snprintf(buf, sizeof(buf), "%.2x-%.2x-%.4x\n", md >> 8, md & 0xff, | |
173 | year); | |
174 | ||
175 | return simple_read_from_buffer(userbuf, count, ppos, buf, len); | |
176 | } | |
177 | ||
178 | static const struct file_operations adis16475_firmware_date_fops = { | |
179 | .open = simple_open, | |
180 | .read = adis16475_show_firmware_date, | |
181 | .llseek = default_llseek, | |
182 | .owner = THIS_MODULE, | |
183 | }; | |
184 | ||
185 | static int adis16475_show_serial_number(void *arg, u64 *val) | |
186 | { | |
187 | struct adis16475 *st = arg; | |
188 | u16 serial; | |
189 | int ret; | |
190 | ||
191 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_SERIAL_NUM, &serial); | |
192 | if (ret) | |
193 | return ret; | |
194 | ||
195 | *val = serial; | |
196 | ||
197 | return 0; | |
198 | } | |
199 | DEFINE_DEBUGFS_ATTRIBUTE(adis16475_serial_number_fops, | |
200 | adis16475_show_serial_number, NULL, "0x%.4llx\n"); | |
201 | ||
202 | static int adis16475_show_product_id(void *arg, u64 *val) | |
203 | { | |
204 | struct adis16475 *st = arg; | |
205 | u16 prod_id; | |
206 | int ret; | |
207 | ||
208 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_PROD_ID, &prod_id); | |
209 | if (ret) | |
210 | return ret; | |
211 | ||
212 | *val = prod_id; | |
213 | ||
214 | return 0; | |
215 | } | |
216 | DEFINE_DEBUGFS_ATTRIBUTE(adis16475_product_id_fops, | |
217 | adis16475_show_product_id, NULL, "%llu\n"); | |
218 | ||
219 | static int adis16475_show_flash_count(void *arg, u64 *val) | |
220 | { | |
221 | struct adis16475 *st = arg; | |
222 | u32 flash_count; | |
223 | int ret; | |
224 | ||
225 | ret = adis_read_reg_32(&st->adis, ADIS16475_REG_FLASH_CNT, | |
226 | &flash_count); | |
227 | if (ret) | |
228 | return ret; | |
229 | ||
230 | *val = flash_count; | |
231 | ||
232 | return 0; | |
233 | } | |
234 | DEFINE_DEBUGFS_ATTRIBUTE(adis16475_flash_count_fops, | |
235 | adis16475_show_flash_count, NULL, "%lld\n"); | |
236 | ||
237 | static void adis16475_debugfs_init(struct iio_dev *indio_dev) | |
238 | { | |
239 | struct adis16475 *st = iio_priv(indio_dev); | |
b7190859 | 240 | struct dentry *d = iio_get_debugfs_dentry(indio_dev); |
fff7352b NS |
241 | |
242 | debugfs_create_file_unsafe("serial_number", 0400, | |
b7190859 | 243 | d, st, &adis16475_serial_number_fops); |
fff7352b | 244 | debugfs_create_file_unsafe("product_id", 0400, |
b7190859 | 245 | d, st, &adis16475_product_id_fops); |
fff7352b | 246 | debugfs_create_file_unsafe("flash_count", 0400, |
b7190859 | 247 | d, st, &adis16475_flash_count_fops); |
fff7352b | 248 | debugfs_create_file("firmware_revision", 0400, |
b7190859 AA |
249 | d, st, &adis16475_firmware_revision_fops); |
250 | debugfs_create_file("firmware_date", 0400, d, | |
fff7352b NS |
251 | st, &adis16475_firmware_date_fops); |
252 | } | |
253 | #else | |
254 | static void adis16475_debugfs_init(struct iio_dev *indio_dev) | |
255 | { | |
256 | } | |
257 | #endif | |
258 | ||
259 | static int adis16475_get_freq(struct adis16475 *st, u32 *freq) | |
260 | { | |
261 | int ret; | |
262 | u16 dec; | |
39c024b5 NS |
263 | u32 sample_rate = st->clk_freq; |
264 | ||
15aacc98 | 265 | adis_dev_lock(&st->adis); |
39c024b5 NS |
266 | |
267 | if (st->sync_mode == ADIS16475_SYNC_SCALED) { | |
268 | u16 sync_scale; | |
269 | ||
270 | ret = __adis_read_reg_16(&st->adis, ADIS16475_REG_UP_SCALE, &sync_scale); | |
271 | if (ret) | |
272 | goto error; | |
273 | ||
274 | sample_rate = st->clk_freq * sync_scale; | |
275 | } | |
fff7352b | 276 | |
39c024b5 | 277 | ret = __adis_read_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, &dec); |
fff7352b | 278 | if (ret) |
39c024b5 | 279 | goto error; |
fff7352b | 280 | |
15aacc98 | 281 | adis_dev_unlock(&st->adis); |
39c024b5 NS |
282 | |
283 | *freq = DIV_ROUND_CLOSEST(sample_rate, dec + 1); | |
fff7352b NS |
284 | |
285 | return 0; | |
39c024b5 | 286 | error: |
15aacc98 | 287 | adis_dev_unlock(&st->adis); |
39c024b5 | 288 | return ret; |
fff7352b NS |
289 | } |
290 | ||
291 | static int adis16475_set_freq(struct adis16475 *st, const u32 freq) | |
292 | { | |
293 | u16 dec; | |
294 | int ret; | |
39c024b5 | 295 | u32 sample_rate = st->clk_freq; |
fff7352b NS |
296 | |
297 | if (!freq) | |
298 | return -EINVAL; | |
299 | ||
15aacc98 | 300 | adis_dev_lock(&st->adis); |
39c024b5 NS |
301 | /* |
302 | * When using sync scaled mode, the input clock needs to be scaled so that we have | |
303 | * an IMU sample rate between (optimally) 1900 and 2100. After this, we can use the | |
304 | * decimation filter to lower the sampling rate in order to get what the user wants. | |
305 | * Optimally, the user sample rate is a multiple of both the IMU sample rate and | |
306 | * the input clock. Hence, calculating the sync_scale dynamically gives us better | |
307 | * chances of achieving a perfect/integer value for DEC_RATE. The math here is: | |
308 | * 1. lcm of the input clock and the desired output rate. | |
309 | * 2. get the highest multiple of the previous result lower than the adis max rate. | |
310 | * 3. The last result becomes the IMU sample rate. Use that to calculate SYNC_SCALE | |
311 | * and DEC_RATE (to get the user output rate) | |
312 | */ | |
313 | if (st->sync_mode == ADIS16475_SYNC_SCALED) { | |
314 | unsigned long scaled_rate = lcm(st->clk_freq, freq); | |
315 | int sync_scale; | |
316 | ||
317 | /* | |
318 | * If lcm is bigger than the IMU maximum sampling rate there's no perfect | |
319 | * solution. In this case, we get the highest multiple of the input clock | |
320 | * lower than the IMU max sample rate. | |
321 | */ | |
322 | if (scaled_rate > 2100000) | |
323 | scaled_rate = 2100000 / st->clk_freq * st->clk_freq; | |
324 | else | |
325 | scaled_rate = 2100000 / scaled_rate * scaled_rate; | |
326 | ||
327 | /* | |
328 | * This is not an hard requirement but it's not advised to run the IMU | |
e2b39db1 | 329 | * with a sample rate lower than 1900Hz due to possible undersampling |
39c024b5 NS |
330 | * issues. However, there are users that might really want to take the risk. |
331 | * Hence, we provide a module parameter for them. If set, we allow sample | |
e2b39db1 NS |
332 | * rates lower than 1.9KHz. By default, we won't allow this and we just roundup |
333 | * the rate to the next multiple of the input clock bigger than 1.9KHz. This | |
39c024b5 NS |
334 | * is done like this as in some cases (when DEC_RATE is 0) might give |
335 | * us the closest value to the one desired by the user... | |
336 | */ | |
337 | if (scaled_rate < 1900000 && !low_rate_allow) | |
338 | scaled_rate = roundup(1900000, st->clk_freq); | |
339 | ||
340 | sync_scale = scaled_rate / st->clk_freq; | |
341 | ret = __adis_write_reg_16(&st->adis, ADIS16475_REG_UP_SCALE, sync_scale); | |
342 | if (ret) | |
343 | goto error; | |
344 | ||
345 | sample_rate = scaled_rate; | |
346 | } | |
347 | ||
348 | dec = DIV_ROUND_CLOSEST(sample_rate, freq); | |
fff7352b NS |
349 | |
350 | if (dec) | |
351 | dec--; | |
352 | ||
353 | if (dec > st->info->max_dec) | |
354 | dec = st->info->max_dec; | |
355 | ||
9da1b868 | 356 | ret = __adis_write_reg_16(&st->adis, ADIS16475_REG_DEC_RATE, dec); |
fff7352b | 357 | if (ret) |
39c024b5 | 358 | goto error; |
fff7352b | 359 | |
9da1b868 | 360 | adis_dev_unlock(&st->adis); |
fff7352b NS |
361 | /* |
362 | * If decimation is used, then gyro and accel data will have meaningful | |
363 | * bits on the LSB registers. This info is used on the trigger handler. | |
364 | */ | |
365 | assign_bit(ADIS16475_LSB_DEC_MASK, &st->lsb_flag, dec); | |
366 | ||
367 | return 0; | |
39c024b5 | 368 | error: |
15aacc98 | 369 | adis_dev_unlock(&st->adis); |
39c024b5 | 370 | return ret; |
fff7352b NS |
371 | } |
372 | ||
373 | /* The values are approximated. */ | |
374 | static const u32 adis16475_3db_freqs[] = { | |
375 | [0] = 720, /* Filter disabled, full BW (~720Hz) */ | |
376 | [1] = 360, | |
377 | [2] = 164, | |
378 | [3] = 80, | |
379 | [4] = 40, | |
380 | [5] = 20, | |
381 | [6] = 10, | |
382 | }; | |
383 | ||
384 | static int adis16475_get_filter(struct adis16475 *st, u32 *filter) | |
385 | { | |
386 | u16 filter_sz; | |
387 | int ret; | |
388 | const int mask = ADIS16475_FILT_CTRL_MASK; | |
389 | ||
390 | ret = adis_read_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, &filter_sz); | |
391 | if (ret) | |
392 | return ret; | |
393 | ||
394 | *filter = adis16475_3db_freqs[filter_sz & mask]; | |
395 | ||
396 | return 0; | |
397 | } | |
398 | ||
399 | static int adis16475_set_filter(struct adis16475 *st, const u32 filter) | |
400 | { | |
401 | int i = ARRAY_SIZE(adis16475_3db_freqs); | |
402 | int ret; | |
403 | ||
404 | while (--i) { | |
405 | if (adis16475_3db_freqs[i] >= filter) | |
406 | break; | |
407 | } | |
408 | ||
409 | ret = adis_write_reg_16(&st->adis, ADIS16475_REG_FILT_CTRL, | |
410 | ADIS16475_FILT_CTRL(i)); | |
411 | if (ret) | |
412 | return ret; | |
413 | ||
414 | /* | |
415 | * If FIR is used, then gyro and accel data will have meaningful | |
416 | * bits on the LSB registers. This info is used on the trigger handler. | |
417 | */ | |
418 | assign_bit(ADIS16475_LSB_FIR_MASK, &st->lsb_flag, i); | |
419 | ||
420 | return 0; | |
421 | } | |
422 | ||
423 | static const u32 adis16475_calib_regs[] = { | |
424 | [ADIS16475_SCAN_GYRO_X] = ADIS16475_REG_X_GYRO_BIAS_L, | |
425 | [ADIS16475_SCAN_GYRO_Y] = ADIS16475_REG_Y_GYRO_BIAS_L, | |
426 | [ADIS16475_SCAN_GYRO_Z] = ADIS16475_REG_Z_GYRO_BIAS_L, | |
427 | [ADIS16475_SCAN_ACCEL_X] = ADIS16475_REG_X_ACCEL_BIAS_L, | |
428 | [ADIS16475_SCAN_ACCEL_Y] = ADIS16475_REG_Y_ACCEL_BIAS_L, | |
429 | [ADIS16475_SCAN_ACCEL_Z] = ADIS16475_REG_Z_ACCEL_BIAS_L, | |
430 | }; | |
431 | ||
432 | static int adis16475_read_raw(struct iio_dev *indio_dev, | |
433 | const struct iio_chan_spec *chan, | |
434 | int *val, int *val2, long info) | |
435 | { | |
436 | struct adis16475 *st = iio_priv(indio_dev); | |
437 | int ret; | |
438 | u32 tmp; | |
439 | ||
440 | switch (info) { | |
441 | case IIO_CHAN_INFO_RAW: | |
442 | return adis_single_conversion(indio_dev, chan, 0, val); | |
443 | case IIO_CHAN_INFO_SCALE: | |
444 | switch (chan->type) { | |
445 | case IIO_ANGL_VEL: | |
446 | *val = st->info->gyro_max_val; | |
447 | *val2 = st->info->gyro_max_scale; | |
448 | return IIO_VAL_FRACTIONAL; | |
449 | case IIO_ACCEL: | |
450 | *val = st->info->accel_max_val; | |
451 | *val2 = st->info->accel_max_scale; | |
452 | return IIO_VAL_FRACTIONAL; | |
453 | case IIO_TEMP: | |
454 | *val = st->info->temp_scale; | |
455 | return IIO_VAL_INT; | |
456 | default: | |
457 | return -EINVAL; | |
458 | } | |
459 | case IIO_CHAN_INFO_CALIBBIAS: | |
460 | ret = adis_read_reg_32(&st->adis, | |
461 | adis16475_calib_regs[chan->scan_index], | |
462 | val); | |
463 | if (ret) | |
464 | return ret; | |
465 | ||
466 | return IIO_VAL_INT; | |
467 | case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: | |
468 | ret = adis16475_get_filter(st, val); | |
469 | if (ret) | |
470 | return ret; | |
471 | ||
472 | return IIO_VAL_INT; | |
473 | case IIO_CHAN_INFO_SAMP_FREQ: | |
474 | ret = adis16475_get_freq(st, &tmp); | |
475 | if (ret) | |
476 | return ret; | |
477 | ||
478 | *val = tmp / 1000; | |
479 | *val2 = (tmp % 1000) * 1000; | |
480 | return IIO_VAL_INT_PLUS_MICRO; | |
481 | default: | |
482 | return -EINVAL; | |
483 | } | |
484 | } | |
485 | ||
486 | static int adis16475_write_raw(struct iio_dev *indio_dev, | |
487 | const struct iio_chan_spec *chan, | |
488 | int val, int val2, long info) | |
489 | { | |
490 | struct adis16475 *st = iio_priv(indio_dev); | |
491 | u32 tmp; | |
492 | ||
493 | switch (info) { | |
494 | case IIO_CHAN_INFO_SAMP_FREQ: | |
495 | tmp = val * 1000 + val2 / 1000; | |
496 | return adis16475_set_freq(st, tmp); | |
497 | case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: | |
498 | return adis16475_set_filter(st, val); | |
499 | case IIO_CHAN_INFO_CALIBBIAS: | |
500 | return adis_write_reg_32(&st->adis, | |
501 | adis16475_calib_regs[chan->scan_index], | |
502 | val); | |
503 | default: | |
504 | return -EINVAL; | |
505 | } | |
506 | } | |
507 | ||
508 | #define ADIS16475_MOD_CHAN(_type, _mod, _address, _si, _r_bits, _s_bits) \ | |
509 | { \ | |
510 | .type = (_type), \ | |
511 | .modified = 1, \ | |
512 | .channel2 = (_mod), \ | |
513 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ | |
514 | BIT(IIO_CHAN_INFO_CALIBBIAS), \ | |
515 | .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ | |
516 | .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \ | |
517 | BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY), \ | |
518 | .address = (_address), \ | |
519 | .scan_index = (_si), \ | |
520 | .scan_type = { \ | |
521 | .sign = 's', \ | |
522 | .realbits = (_r_bits), \ | |
523 | .storagebits = (_s_bits), \ | |
524 | .endianness = IIO_BE, \ | |
525 | }, \ | |
526 | } | |
527 | ||
528 | #define ADIS16475_GYRO_CHANNEL(_mod) \ | |
529 | ADIS16475_MOD_CHAN(IIO_ANGL_VEL, IIO_MOD_ ## _mod, \ | |
530 | ADIS16475_REG_ ## _mod ## _GYRO_L, \ | |
531 | ADIS16475_SCAN_GYRO_ ## _mod, 32, 32) | |
532 | ||
533 | #define ADIS16475_ACCEL_CHANNEL(_mod) \ | |
534 | ADIS16475_MOD_CHAN(IIO_ACCEL, IIO_MOD_ ## _mod, \ | |
535 | ADIS16475_REG_ ## _mod ## _ACCEL_L, \ | |
536 | ADIS16475_SCAN_ACCEL_ ## _mod, 32, 32) | |
537 | ||
538 | #define ADIS16475_TEMP_CHANNEL() { \ | |
539 | .type = IIO_TEMP, \ | |
540 | .indexed = 1, \ | |
541 | .channel = 0, \ | |
542 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ | |
543 | BIT(IIO_CHAN_INFO_SCALE), \ | |
544 | .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \ | |
545 | BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY), \ | |
546 | .address = ADIS16475_REG_TEMP_OUT, \ | |
547 | .scan_index = ADIS16475_SCAN_TEMP, \ | |
548 | .scan_type = { \ | |
549 | .sign = 's', \ | |
550 | .realbits = 16, \ | |
551 | .storagebits = 16, \ | |
552 | .endianness = IIO_BE, \ | |
553 | }, \ | |
554 | } | |
555 | ||
556 | static const struct iio_chan_spec adis16475_channels[] = { | |
557 | ADIS16475_GYRO_CHANNEL(X), | |
558 | ADIS16475_GYRO_CHANNEL(Y), | |
559 | ADIS16475_GYRO_CHANNEL(Z), | |
560 | ADIS16475_ACCEL_CHANNEL(X), | |
561 | ADIS16475_ACCEL_CHANNEL(Y), | |
562 | ADIS16475_ACCEL_CHANNEL(Z), | |
563 | ADIS16475_TEMP_CHANNEL(), | |
564 | IIO_CHAN_SOFT_TIMESTAMP(7) | |
565 | }; | |
566 | ||
567 | enum adis16475_variant { | |
568 | ADIS16470, | |
569 | ADIS16475_1, | |
570 | ADIS16475_2, | |
571 | ADIS16475_3, | |
572 | ADIS16477_1, | |
573 | ADIS16477_2, | |
574 | ADIS16477_3, | |
575 | ADIS16465_1, | |
576 | ADIS16465_2, | |
577 | ADIS16465_3, | |
578 | ADIS16467_1, | |
579 | ADIS16467_2, | |
580 | ADIS16467_3, | |
581 | ADIS16500, | |
582 | ADIS16505_1, | |
583 | ADIS16505_2, | |
584 | ADIS16505_3, | |
585 | ADIS16507_1, | |
586 | ADIS16507_2, | |
587 | ADIS16507_3, | |
588 | }; | |
589 | ||
590 | enum { | |
591 | ADIS16475_DIAG_STAT_DATA_PATH = 1, | |
592 | ADIS16475_DIAG_STAT_FLASH_MEM, | |
593 | ADIS16475_DIAG_STAT_SPI, | |
594 | ADIS16475_DIAG_STAT_STANDBY, | |
595 | ADIS16475_DIAG_STAT_SENSOR, | |
596 | ADIS16475_DIAG_STAT_MEMORY, | |
597 | ADIS16475_DIAG_STAT_CLK, | |
598 | }; | |
599 | ||
600 | static const char * const adis16475_status_error_msgs[] = { | |
601 | [ADIS16475_DIAG_STAT_DATA_PATH] = "Data Path Overrun", | |
602 | [ADIS16475_DIAG_STAT_FLASH_MEM] = "Flash memory update failure", | |
603 | [ADIS16475_DIAG_STAT_SPI] = "SPI communication error", | |
604 | [ADIS16475_DIAG_STAT_STANDBY] = "Standby mode", | |
605 | [ADIS16475_DIAG_STAT_SENSOR] = "Sensor failure", | |
606 | [ADIS16475_DIAG_STAT_MEMORY] = "Memory failure", | |
607 | [ADIS16475_DIAG_STAT_CLK] = "Clock error", | |
608 | }; | |
609 | ||
fff7352b NS |
610 | #define ADIS16475_DATA(_prod_id, _timeouts) \ |
611 | { \ | |
612 | .msc_ctrl_reg = ADIS16475_REG_MSG_CTRL, \ | |
613 | .glob_cmd_reg = ADIS16475_REG_GLOB_CMD, \ | |
614 | .diag_stat_reg = ADIS16475_REG_DIAG_STAT, \ | |
615 | .prod_id_reg = ADIS16475_REG_PROD_ID, \ | |
616 | .prod_id = (_prod_id), \ | |
617 | .self_test_mask = BIT(2), \ | |
618 | .self_test_reg = ADIS16475_REG_GLOB_CMD, \ | |
619 | .cs_change_delay = 16, \ | |
620 | .read_delay = 5, \ | |
621 | .write_delay = 5, \ | |
622 | .status_error_msgs = adis16475_status_error_msgs, \ | |
623 | .status_error_mask = BIT(ADIS16475_DIAG_STAT_DATA_PATH) | \ | |
624 | BIT(ADIS16475_DIAG_STAT_FLASH_MEM) | \ | |
625 | BIT(ADIS16475_DIAG_STAT_SPI) | \ | |
626 | BIT(ADIS16475_DIAG_STAT_STANDBY) | \ | |
627 | BIT(ADIS16475_DIAG_STAT_SENSOR) | \ | |
628 | BIT(ADIS16475_DIAG_STAT_MEMORY) | \ | |
629 | BIT(ADIS16475_DIAG_STAT_CLK), \ | |
cab85ead | 630 | .unmasked_drdy = true, \ |
fff7352b | 631 | .timeouts = (_timeouts), \ |
0dfaa465 NS |
632 | .burst_reg_cmd = ADIS16475_REG_GLOB_CMD, \ |
633 | .burst_len = ADIS16475_BURST_MAX_DATA, \ | |
256e69ab NS |
634 | .burst_max_len = ADIS16475_BURST32_MAX_DATA, \ |
635 | .burst_max_speed_hz = ADIS16475_BURST_MAX_SPEED \ | |
fff7352b NS |
636 | } |
637 | ||
638 | static const struct adis16475_sync adis16475_sync_mode[] = { | |
639 | { ADIS16475_SYNC_OUTPUT }, | |
640 | { ADIS16475_SYNC_DIRECT, 1900, 2100 }, | |
641 | { ADIS16475_SYNC_SCALED, 1, 128 }, | |
642 | { ADIS16475_SYNC_PULSE, 1000, 2100 }, | |
643 | }; | |
644 | ||
645 | static const struct adis_timeout adis16475_timeouts = { | |
646 | .reset_ms = 200, | |
647 | .sw_reset_ms = 200, | |
648 | .self_test_ms = 20, | |
649 | }; | |
650 | ||
651 | static const struct adis_timeout adis1650x_timeouts = { | |
652 | .reset_ms = 260, | |
653 | .sw_reset_ms = 260, | |
654 | .self_test_ms = 30, | |
655 | }; | |
656 | ||
657 | static const struct adis16475_chip_info adis16475_chip_info[] = { | |
658 | [ADIS16470] = { | |
659 | .name = "adis16470", | |
660 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
661 | .channels = adis16475_channels, | |
662 | .gyro_max_val = 1, | |
663 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
664 | .accel_max_val = 1, | |
665 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
666 | .temp_scale = 100, | |
667 | .int_clk = 2000, | |
668 | .max_dec = 1999, | |
669 | .sync = adis16475_sync_mode, | |
670 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
671 | .adis_data = ADIS16475_DATA(16470, &adis16475_timeouts), | |
672 | }, | |
673 | [ADIS16475_1] = { | |
674 | .name = "adis16475-1", | |
675 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
676 | .channels = adis16475_channels, | |
677 | .gyro_max_val = 1, | |
678 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
679 | .accel_max_val = 1, | |
680 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
681 | .temp_scale = 100, | |
682 | .int_clk = 2000, | |
683 | .max_dec = 1999, | |
684 | .sync = adis16475_sync_mode, | |
685 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
686 | .adis_data = ADIS16475_DATA(16475, &adis16475_timeouts), | |
687 | }, | |
688 | [ADIS16475_2] = { | |
689 | .name = "adis16475-2", | |
690 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
691 | .channels = adis16475_channels, | |
692 | .gyro_max_val = 1, | |
693 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
694 | .accel_max_val = 1, | |
695 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
696 | .temp_scale = 100, | |
697 | .int_clk = 2000, | |
698 | .max_dec = 1999, | |
699 | .sync = adis16475_sync_mode, | |
700 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
701 | .adis_data = ADIS16475_DATA(16475, &adis16475_timeouts), | |
702 | }, | |
703 | [ADIS16475_3] = { | |
704 | .name = "adis16475-3", | |
705 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
706 | .channels = adis16475_channels, | |
707 | .gyro_max_val = 1, | |
708 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
709 | .accel_max_val = 1, | |
710 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
711 | .temp_scale = 100, | |
712 | .int_clk = 2000, | |
713 | .max_dec = 1999, | |
714 | .sync = adis16475_sync_mode, | |
715 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
716 | .adis_data = ADIS16475_DATA(16475, &adis16475_timeouts), | |
717 | }, | |
718 | [ADIS16477_1] = { | |
719 | .name = "adis16477-1", | |
720 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
721 | .channels = adis16475_channels, | |
722 | .gyro_max_val = 1, | |
723 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
724 | .accel_max_val = 1, | |
725 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
726 | .temp_scale = 100, | |
727 | .int_clk = 2000, | |
728 | .max_dec = 1999, | |
729 | .sync = adis16475_sync_mode, | |
730 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
731 | .adis_data = ADIS16475_DATA(16477, &adis16475_timeouts), | |
732 | }, | |
733 | [ADIS16477_2] = { | |
734 | .name = "adis16477-2", | |
735 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
736 | .channels = adis16475_channels, | |
737 | .gyro_max_val = 1, | |
738 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
739 | .accel_max_val = 1, | |
740 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
741 | .temp_scale = 100, | |
742 | .int_clk = 2000, | |
743 | .max_dec = 1999, | |
744 | .sync = adis16475_sync_mode, | |
745 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
746 | .adis_data = ADIS16475_DATA(16477, &adis16475_timeouts), | |
747 | }, | |
748 | [ADIS16477_3] = { | |
749 | .name = "adis16477-3", | |
750 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
751 | .channels = adis16475_channels, | |
752 | .gyro_max_val = 1, | |
753 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
754 | .accel_max_val = 1, | |
755 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
756 | .temp_scale = 100, | |
757 | .int_clk = 2000, | |
758 | .max_dec = 1999, | |
759 | .sync = adis16475_sync_mode, | |
760 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
761 | .adis_data = ADIS16475_DATA(16477, &adis16475_timeouts), | |
762 | }, | |
763 | [ADIS16465_1] = { | |
764 | .name = "adis16465-1", | |
765 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
766 | .channels = adis16475_channels, | |
767 | .gyro_max_val = 1, | |
768 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
769 | .accel_max_val = 1, | |
770 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
771 | .temp_scale = 100, | |
772 | .int_clk = 2000, | |
773 | .max_dec = 1999, | |
774 | .sync = adis16475_sync_mode, | |
775 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
776 | .adis_data = ADIS16475_DATA(16465, &adis16475_timeouts), | |
777 | }, | |
778 | [ADIS16465_2] = { | |
779 | .name = "adis16465-2", | |
780 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
781 | .channels = adis16475_channels, | |
782 | .gyro_max_val = 1, | |
783 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
784 | .accel_max_val = 1, | |
785 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
786 | .temp_scale = 100, | |
787 | .int_clk = 2000, | |
788 | .max_dec = 1999, | |
789 | .sync = adis16475_sync_mode, | |
790 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
791 | .adis_data = ADIS16475_DATA(16465, &adis16475_timeouts), | |
792 | }, | |
793 | [ADIS16465_3] = { | |
794 | .name = "adis16465-3", | |
795 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
796 | .channels = adis16475_channels, | |
797 | .gyro_max_val = 1, | |
798 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
799 | .accel_max_val = 1, | |
800 | .accel_max_scale = IIO_M_S_2_TO_G(4000 << 16), | |
801 | .temp_scale = 100, | |
802 | .int_clk = 2000, | |
803 | .max_dec = 1999, | |
804 | .sync = adis16475_sync_mode, | |
805 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
806 | .adis_data = ADIS16475_DATA(16465, &adis16475_timeouts), | |
807 | }, | |
808 | [ADIS16467_1] = { | |
809 | .name = "adis16467-1", | |
810 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
811 | .channels = adis16475_channels, | |
812 | .gyro_max_val = 1, | |
813 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
814 | .accel_max_val = 1, | |
815 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
816 | .temp_scale = 100, | |
817 | .int_clk = 2000, | |
818 | .max_dec = 1999, | |
819 | .sync = adis16475_sync_mode, | |
820 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
821 | .adis_data = ADIS16475_DATA(16467, &adis16475_timeouts), | |
822 | }, | |
823 | [ADIS16467_2] = { | |
824 | .name = "adis16467-2", | |
825 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
826 | .channels = adis16475_channels, | |
827 | .gyro_max_val = 1, | |
828 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
829 | .accel_max_val = 1, | |
830 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
831 | .temp_scale = 100, | |
832 | .int_clk = 2000, | |
833 | .max_dec = 1999, | |
834 | .sync = adis16475_sync_mode, | |
835 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
836 | .adis_data = ADIS16475_DATA(16467, &adis16475_timeouts), | |
837 | }, | |
838 | [ADIS16467_3] = { | |
839 | .name = "adis16467-3", | |
840 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
841 | .channels = adis16475_channels, | |
842 | .gyro_max_val = 1, | |
843 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
844 | .accel_max_val = 1, | |
845 | .accel_max_scale = IIO_M_S_2_TO_G(800 << 16), | |
846 | .temp_scale = 100, | |
847 | .int_clk = 2000, | |
848 | .max_dec = 1999, | |
849 | .sync = adis16475_sync_mode, | |
850 | .num_sync = ARRAY_SIZE(adis16475_sync_mode), | |
851 | .adis_data = ADIS16475_DATA(16467, &adis16475_timeouts), | |
852 | }, | |
853 | [ADIS16500] = { | |
854 | .name = "adis16500", | |
855 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
856 | .channels = adis16475_channels, | |
857 | .gyro_max_val = 1, | |
858 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
859 | .accel_max_val = 392, | |
860 | .accel_max_scale = 32000 << 16, | |
861 | .temp_scale = 100, | |
862 | .int_clk = 2000, | |
863 | .max_dec = 1999, | |
864 | .sync = adis16475_sync_mode, | |
865 | /* pulse sync not supported */ | |
866 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
867 | .has_burst32 = true, | |
868 | .adis_data = ADIS16475_DATA(16500, &adis1650x_timeouts), | |
869 | }, | |
870 | [ADIS16505_1] = { | |
871 | .name = "adis16505-1", | |
872 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
873 | .channels = adis16475_channels, | |
874 | .gyro_max_val = 1, | |
875 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
876 | .accel_max_val = 78, | |
877 | .accel_max_scale = 32000 << 16, | |
878 | .temp_scale = 100, | |
879 | .int_clk = 2000, | |
880 | .max_dec = 1999, | |
881 | .sync = adis16475_sync_mode, | |
882 | /* pulse sync not supported */ | |
883 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
884 | .has_burst32 = true, | |
885 | .adis_data = ADIS16475_DATA(16505, &adis1650x_timeouts), | |
886 | }, | |
887 | [ADIS16505_2] = { | |
888 | .name = "adis16505-2", | |
889 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
890 | .channels = adis16475_channels, | |
891 | .gyro_max_val = 1, | |
892 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
893 | .accel_max_val = 78, | |
894 | .accel_max_scale = 32000 << 16, | |
895 | .temp_scale = 100, | |
896 | .int_clk = 2000, | |
897 | .max_dec = 1999, | |
898 | .sync = adis16475_sync_mode, | |
899 | /* pulse sync not supported */ | |
900 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
901 | .has_burst32 = true, | |
902 | .adis_data = ADIS16475_DATA(16505, &adis1650x_timeouts), | |
903 | }, | |
904 | [ADIS16505_3] = { | |
905 | .name = "adis16505-3", | |
906 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
907 | .channels = adis16475_channels, | |
908 | .gyro_max_val = 1, | |
909 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
910 | .accel_max_val = 78, | |
911 | .accel_max_scale = 32000 << 16, | |
912 | .temp_scale = 100, | |
913 | .int_clk = 2000, | |
914 | .max_dec = 1999, | |
915 | .sync = adis16475_sync_mode, | |
916 | /* pulse sync not supported */ | |
917 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
918 | .has_burst32 = true, | |
919 | .adis_data = ADIS16475_DATA(16505, &adis1650x_timeouts), | |
920 | }, | |
921 | [ADIS16507_1] = { | |
922 | .name = "adis16507-1", | |
923 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
924 | .channels = adis16475_channels, | |
925 | .gyro_max_val = 1, | |
926 | .gyro_max_scale = IIO_RAD_TO_DEGREE(160 << 16), | |
927 | .accel_max_val = 392, | |
928 | .accel_max_scale = 32000 << 16, | |
929 | .temp_scale = 100, | |
930 | .int_clk = 2000, | |
931 | .max_dec = 1999, | |
932 | .sync = adis16475_sync_mode, | |
933 | /* pulse sync not supported */ | |
934 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
935 | .has_burst32 = true, | |
936 | .adis_data = ADIS16475_DATA(16507, &adis1650x_timeouts), | |
937 | }, | |
938 | [ADIS16507_2] = { | |
939 | .name = "adis16507-2", | |
940 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
941 | .channels = adis16475_channels, | |
942 | .gyro_max_val = 1, | |
943 | .gyro_max_scale = IIO_RAD_TO_DEGREE(40 << 16), | |
944 | .accel_max_val = 392, | |
945 | .accel_max_scale = 32000 << 16, | |
946 | .temp_scale = 100, | |
947 | .int_clk = 2000, | |
948 | .max_dec = 1999, | |
949 | .sync = adis16475_sync_mode, | |
950 | /* pulse sync not supported */ | |
951 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
952 | .has_burst32 = true, | |
953 | .adis_data = ADIS16475_DATA(16507, &adis1650x_timeouts), | |
954 | }, | |
955 | [ADIS16507_3] = { | |
956 | .name = "adis16507-3", | |
957 | .num_channels = ARRAY_SIZE(adis16475_channels), | |
958 | .channels = adis16475_channels, | |
959 | .gyro_max_val = 1, | |
960 | .gyro_max_scale = IIO_RAD_TO_DEGREE(10 << 16), | |
961 | .accel_max_val = 392, | |
962 | .accel_max_scale = 32000 << 16, | |
963 | .temp_scale = 100, | |
964 | .int_clk = 2000, | |
965 | .max_dec = 1999, | |
966 | .sync = adis16475_sync_mode, | |
967 | /* pulse sync not supported */ | |
968 | .num_sync = ARRAY_SIZE(adis16475_sync_mode) - 1, | |
969 | .has_burst32 = true, | |
970 | .adis_data = ADIS16475_DATA(16507, &adis1650x_timeouts), | |
971 | }, | |
972 | }; | |
973 | ||
974 | static const struct iio_info adis16475_info = { | |
975 | .read_raw = &adis16475_read_raw, | |
976 | .write_raw = &adis16475_write_raw, | |
977 | .update_scan_mode = adis_update_scan_mode, | |
978 | .debugfs_reg_access = adis_debugfs_reg_access, | |
979 | }; | |
980 | ||
fff7352b NS |
981 | static bool adis16475_validate_crc(const u8 *buffer, u16 crc, |
982 | const bool burst32) | |
983 | { | |
984 | int i; | |
985 | /* extra 6 elements for low gyro and accel */ | |
986 | const u16 sz = burst32 ? ADIS16475_BURST32_MAX_DATA : | |
987 | ADIS16475_BURST_MAX_DATA; | |
988 | ||
989 | for (i = 0; i < sz - 2; i++) | |
990 | crc -= buffer[i]; | |
991 | ||
992 | return crc == 0; | |
993 | } | |
994 | ||
995 | static void adis16475_burst32_check(struct adis16475 *st) | |
996 | { | |
997 | int ret; | |
998 | struct adis *adis = &st->adis; | |
999 | ||
1000 | if (!st->info->has_burst32) | |
1001 | return; | |
1002 | ||
1003 | if (st->lsb_flag && !st->burst32) { | |
1004 | const u16 en = ADIS16500_BURST32(1); | |
1005 | ||
1006 | ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, | |
1007 | ADIS16500_BURST32_MASK, en); | |
1008 | if (ret) | |
1009 | return; | |
1010 | ||
1011 | st->burst32 = true; | |
1012 | ||
1013 | /* | |
1014 | * In 32-bit mode we need extra 2 bytes for all gyro | |
1015 | * and accel channels. | |
1016 | */ | |
1017 | adis->burst_extra_len = 6 * sizeof(u16); | |
1018 | adis->xfer[1].len += 6 * sizeof(u16); | |
1019 | dev_dbg(&adis->spi->dev, "Enable burst32 mode, xfer:%d", | |
1020 | adis->xfer[1].len); | |
1021 | ||
1022 | } else if (!st->lsb_flag && st->burst32) { | |
1023 | const u16 en = ADIS16500_BURST32(0); | |
1024 | ||
1025 | ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, | |
1026 | ADIS16500_BURST32_MASK, en); | |
1027 | if (ret) | |
1028 | return; | |
1029 | ||
1030 | st->burst32 = false; | |
1031 | ||
1032 | /* Remove the extra bits */ | |
1033 | adis->burst_extra_len = 0; | |
1034 | adis->xfer[1].len -= 6 * sizeof(u16); | |
1035 | dev_dbg(&adis->spi->dev, "Disable burst32 mode, xfer:%d\n", | |
1036 | adis->xfer[1].len); | |
1037 | } | |
1038 | } | |
1039 | ||
1040 | static irqreturn_t adis16475_trigger_handler(int irq, void *p) | |
1041 | { | |
1042 | struct iio_poll_func *pf = p; | |
1043 | struct iio_dev *indio_dev = pf->indio_dev; | |
1044 | struct adis16475 *st = iio_priv(indio_dev); | |
1045 | struct adis *adis = &st->adis; | |
1046 | int ret, bit, i = 0; | |
1047 | __be16 *buffer; | |
1048 | u16 crc; | |
1049 | bool valid; | |
1050 | /* offset until the first element after gyro and accel */ | |
1051 | const u8 offset = st->burst32 ? 13 : 7; | |
fff7352b NS |
1052 | |
1053 | ret = spi_sync(adis->spi, &adis->msg); | |
1054 | if (ret) | |
00a72db7 | 1055 | goto check_burst32; |
fff7352b | 1056 | |
fff7352b NS |
1057 | buffer = adis->buffer; |
1058 | ||
1059 | crc = be16_to_cpu(buffer[offset + 2]); | |
1060 | valid = adis16475_validate_crc(adis->buffer, crc, st->burst32); | |
1061 | if (!valid) { | |
1062 | dev_err(&adis->spi->dev, "Invalid crc\n"); | |
1063 | goto check_burst32; | |
1064 | } | |
1065 | ||
1066 | for_each_set_bit(bit, indio_dev->active_scan_mask, | |
1067 | indio_dev->masklength) { | |
1068 | /* | |
1069 | * When burst mode is used, system flags is the first data | |
1070 | * channel in the sequence, but the scan index is 7. | |
1071 | */ | |
1072 | switch (bit) { | |
1073 | case ADIS16475_SCAN_TEMP: | |
1074 | st->data[i++] = buffer[offset]; | |
1075 | break; | |
1076 | case ADIS16475_SCAN_GYRO_X ... ADIS16475_SCAN_ACCEL_Z: | |
1077 | /* | |
1078 | * The first 2 bytes on the received data are the | |
1079 | * DIAG_STAT reg, hence the +1 offset here... | |
1080 | */ | |
1081 | if (st->burst32) { | |
1082 | /* upper 16 */ | |
1083 | st->data[i++] = buffer[bit * 2 + 2]; | |
1084 | /* lower 16 */ | |
1085 | st->data[i++] = buffer[bit * 2 + 1]; | |
1086 | } else { | |
1087 | st->data[i++] = buffer[bit + 1]; | |
1088 | /* | |
1089 | * Don't bother in doing the manual read if the | |
1090 | * device supports burst32. burst32 will be | |
1091 | * enabled in the next call to | |
1092 | * adis16475_burst32_check()... | |
1093 | */ | |
1094 | if (st->lsb_flag && !st->info->has_burst32) { | |
1095 | u16 val = 0; | |
1096 | const u32 reg = ADIS16475_REG_X_GYRO_L + | |
1097 | bit * 4; | |
1098 | ||
1099 | adis_read_reg_16(adis, reg, &val); | |
1100 | st->data[i++] = cpu_to_be16(val); | |
1101 | } else { | |
1102 | /* lower not used */ | |
1103 | st->data[i++] = 0; | |
1104 | } | |
1105 | } | |
1106 | break; | |
1107 | } | |
1108 | } | |
1109 | ||
1110 | iio_push_to_buffers_with_timestamp(indio_dev, st->data, pf->timestamp); | |
1111 | check_burst32: | |
1112 | /* | |
1113 | * We only check the burst mode at the end of the current capture since | |
1114 | * it takes a full data ready cycle for the device to update the burst | |
1115 | * array. | |
1116 | */ | |
1117 | adis16475_burst32_check(st); | |
1118 | iio_trigger_notify_done(indio_dev->trig); | |
1119 | ||
1120 | return IRQ_HANDLED; | |
1121 | } | |
1122 | ||
fff7352b NS |
1123 | static int adis16475_config_sync_mode(struct adis16475 *st) |
1124 | { | |
1125 | int ret; | |
1126 | struct device *dev = &st->adis.spi->dev; | |
1127 | const struct adis16475_sync *sync; | |
1128 | u32 sync_mode; | |
1129 | ||
1130 | /* default to internal clk */ | |
1131 | st->clk_freq = st->info->int_clk * 1000; | |
1132 | ||
1133 | ret = device_property_read_u32(dev, "adi,sync-mode", &sync_mode); | |
1134 | if (ret) | |
1135 | return 0; | |
1136 | ||
1137 | if (sync_mode >= st->info->num_sync) { | |
1138 | dev_err(dev, "Invalid sync mode: %u for %s\n", sync_mode, | |
1139 | st->info->name); | |
1140 | return -EINVAL; | |
1141 | } | |
1142 | ||
1143 | sync = &st->info->sync[sync_mode]; | |
39c024b5 | 1144 | st->sync_mode = sync->sync_mode; |
fff7352b NS |
1145 | |
1146 | /* All the other modes require external input signal */ | |
1147 | if (sync->sync_mode != ADIS16475_SYNC_OUTPUT) { | |
33dae107 | 1148 | struct clk *clk = devm_clk_get_enabled(dev, NULL); |
fff7352b NS |
1149 | |
1150 | if (IS_ERR(clk)) | |
1151 | return PTR_ERR(clk); | |
1152 | ||
fff7352b NS |
1153 | st->clk_freq = clk_get_rate(clk); |
1154 | if (st->clk_freq < sync->min_rate || | |
1155 | st->clk_freq > sync->max_rate) { | |
1156 | dev_err(dev, | |
1157 | "Clk rate:%u not in a valid range:[%u %u]\n", | |
1158 | st->clk_freq, sync->min_rate, sync->max_rate); | |
1159 | return -EINVAL; | |
1160 | } | |
1161 | ||
1162 | if (sync->sync_mode == ADIS16475_SYNC_SCALED) { | |
1163 | u16 up_scale; | |
39c024b5 | 1164 | |
fff7352b | 1165 | /* |
39c024b5 NS |
1166 | * In sync scaled mode, the IMU sample rate is the clk_freq * sync_scale. |
1167 | * Hence, default the IMU sample rate to the highest multiple of the input | |
1168 | * clock lower than the IMU max sample rate. The optimal range is | |
1169 | * 1900-2100 sps... | |
fff7352b | 1170 | */ |
39c024b5 | 1171 | up_scale = 2100 / st->clk_freq; |
fff7352b NS |
1172 | |
1173 | ret = __adis_write_reg_16(&st->adis, | |
1174 | ADIS16475_REG_UP_SCALE, | |
1175 | up_scale); | |
1176 | if (ret) | |
1177 | return ret; | |
fff7352b NS |
1178 | } |
1179 | ||
1180 | st->clk_freq *= 1000; | |
1181 | } | |
1182 | /* | |
1183 | * Keep in mind that the mask for the clk modes in adis1650* | |
1184 | * chips is different (1100 instead of 11100). However, we | |
1185 | * are not configuring BIT(4) in these chips and the default | |
1186 | * value is 0, so we are fine in doing the below operations. | |
1187 | * I'm keeping this for simplicity and avoiding extra variables | |
1188 | * in chip_info. | |
1189 | */ | |
1190 | ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, | |
1191 | ADIS16475_SYNC_MODE_MASK, sync->sync_mode); | |
1192 | if (ret) | |
1193 | return ret; | |
1194 | ||
1195 | usleep_range(250, 260); | |
1196 | ||
1197 | return 0; | |
1198 | } | |
1199 | ||
1200 | static int adis16475_config_irq_pin(struct adis16475 *st) | |
1201 | { | |
1202 | int ret; | |
1203 | struct irq_data *desc; | |
1204 | u32 irq_type; | |
1205 | u16 val = 0; | |
1206 | u8 polarity; | |
1207 | struct spi_device *spi = st->adis.spi; | |
1208 | ||
1209 | desc = irq_get_irq_data(spi->irq); | |
1210 | if (!desc) { | |
1211 | dev_err(&spi->dev, "Could not find IRQ %d\n", spi->irq); | |
1212 | return -EINVAL; | |
1213 | } | |
1214 | /* | |
1215 | * It is possible to configure the data ready polarity. Furthermore, we | |
1216 | * need to update the adis struct if we want data ready as active low. | |
1217 | */ | |
1218 | irq_type = irqd_get_trigger_type(desc); | |
1219 | if (irq_type == IRQ_TYPE_EDGE_RISING) { | |
1220 | polarity = 1; | |
1221 | st->adis.irq_flag = IRQF_TRIGGER_RISING; | |
1222 | } else if (irq_type == IRQ_TYPE_EDGE_FALLING) { | |
1223 | polarity = 0; | |
1224 | st->adis.irq_flag = IRQF_TRIGGER_FALLING; | |
1225 | } else { | |
1226 | dev_err(&spi->dev, "Invalid interrupt type 0x%x specified\n", | |
1227 | irq_type); | |
1228 | return -EINVAL; | |
1229 | } | |
1230 | ||
1231 | val = ADIS16475_MSG_CTRL_DR_POL(polarity); | |
1232 | ret = __adis_update_bits(&st->adis, ADIS16475_REG_MSG_CTRL, | |
1233 | ADIS16475_MSG_CTRL_DR_POL_MASK, val); | |
1234 | if (ret) | |
1235 | return ret; | |
1236 | /* | |
1237 | * There is a delay writing to any bits written to the MSC_CTRL | |
1238 | * register. It should not be bigger than 200us, so 250 should be more | |
1239 | * than enough! | |
1240 | */ | |
1241 | usleep_range(250, 260); | |
1242 | ||
1243 | return 0; | |
1244 | } | |
1245 | ||
1246 | static const struct of_device_id adis16475_of_match[] = { | |
1247 | { .compatible = "adi,adis16470", | |
1248 | .data = &adis16475_chip_info[ADIS16470] }, | |
1249 | { .compatible = "adi,adis16475-1", | |
1250 | .data = &adis16475_chip_info[ADIS16475_1] }, | |
1251 | { .compatible = "adi,adis16475-2", | |
1252 | .data = &adis16475_chip_info[ADIS16475_2] }, | |
1253 | { .compatible = "adi,adis16475-3", | |
1254 | .data = &adis16475_chip_info[ADIS16475_3] }, | |
1255 | { .compatible = "adi,adis16477-1", | |
1256 | .data = &adis16475_chip_info[ADIS16477_1] }, | |
1257 | { .compatible = "adi,adis16477-2", | |
1258 | .data = &adis16475_chip_info[ADIS16477_2] }, | |
1259 | { .compatible = "adi,adis16477-3", | |
1260 | .data = &adis16475_chip_info[ADIS16477_3] }, | |
1261 | { .compatible = "adi,adis16465-1", | |
1262 | .data = &adis16475_chip_info[ADIS16465_1] }, | |
1263 | { .compatible = "adi,adis16465-2", | |
1264 | .data = &adis16475_chip_info[ADIS16465_2] }, | |
1265 | { .compatible = "adi,adis16465-3", | |
1266 | .data = &adis16475_chip_info[ADIS16465_3] }, | |
1267 | { .compatible = "adi,adis16467-1", | |
1268 | .data = &adis16475_chip_info[ADIS16467_1] }, | |
1269 | { .compatible = "adi,adis16467-2", | |
1270 | .data = &adis16475_chip_info[ADIS16467_2] }, | |
1271 | { .compatible = "adi,adis16467-3", | |
1272 | .data = &adis16475_chip_info[ADIS16467_3] }, | |
1273 | { .compatible = "adi,adis16500", | |
1274 | .data = &adis16475_chip_info[ADIS16500] }, | |
1275 | { .compatible = "adi,adis16505-1", | |
1276 | .data = &adis16475_chip_info[ADIS16505_1] }, | |
1277 | { .compatible = "adi,adis16505-2", | |
1278 | .data = &adis16475_chip_info[ADIS16505_2] }, | |
1279 | { .compatible = "adi,adis16505-3", | |
1280 | .data = &adis16475_chip_info[ADIS16505_3] }, | |
1281 | { .compatible = "adi,adis16507-1", | |
1282 | .data = &adis16475_chip_info[ADIS16507_1] }, | |
1283 | { .compatible = "adi,adis16507-2", | |
1284 | .data = &adis16475_chip_info[ADIS16507_2] }, | |
1285 | { .compatible = "adi,adis16507-3", | |
1286 | .data = &adis16475_chip_info[ADIS16507_3] }, | |
1287 | { }, | |
1288 | }; | |
1289 | MODULE_DEVICE_TABLE(of, adis16475_of_match); | |
1290 | ||
1291 | static int adis16475_probe(struct spi_device *spi) | |
1292 | { | |
1293 | struct iio_dev *indio_dev; | |
1294 | struct adis16475 *st; | |
1295 | int ret; | |
1296 | ||
1297 | indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); | |
1298 | if (!indio_dev) | |
1299 | return -ENOMEM; | |
1300 | ||
1301 | st = iio_priv(indio_dev); | |
fff7352b NS |
1302 | |
1303 | st->info = device_get_match_data(&spi->dev); | |
1304 | if (!st->info) | |
1305 | return -EINVAL; | |
1306 | ||
1307 | ret = adis_init(&st->adis, indio_dev, spi, &st->info->adis_data); | |
1308 | if (ret) | |
1309 | return ret; | |
1310 | ||
fff7352b NS |
1311 | indio_dev->name = st->info->name; |
1312 | indio_dev->channels = st->info->channels; | |
1313 | indio_dev->num_channels = st->info->num_channels; | |
1314 | indio_dev->info = &adis16475_info; | |
1315 | indio_dev->modes = INDIO_DIRECT_MODE; | |
1316 | ||
1317 | ret = __adis_initial_startup(&st->adis); | |
1318 | if (ret) | |
1319 | return ret; | |
1320 | ||
1321 | ret = adis16475_config_irq_pin(st); | |
1322 | if (ret) | |
1323 | return ret; | |
1324 | ||
1325 | ret = adis16475_config_sync_mode(st); | |
1326 | if (ret) | |
1327 | return ret; | |
1328 | ||
1329 | ret = devm_adis_setup_buffer_and_trigger(&st->adis, indio_dev, | |
1330 | adis16475_trigger_handler); | |
1331 | if (ret) | |
1332 | return ret; | |
1333 | ||
fff7352b NS |
1334 | ret = devm_iio_device_register(&spi->dev, indio_dev); |
1335 | if (ret) | |
1336 | return ret; | |
1337 | ||
1338 | adis16475_debugfs_init(indio_dev); | |
1339 | ||
1340 | return 0; | |
1341 | } | |
1342 | ||
1343 | static struct spi_driver adis16475_driver = { | |
1344 | .driver = { | |
1345 | .name = "adis16475", | |
1346 | .of_match_table = adis16475_of_match, | |
1347 | }, | |
1348 | .probe = adis16475_probe, | |
1349 | }; | |
1350 | module_spi_driver(adis16475_driver); | |
1351 | ||
1352 | MODULE_AUTHOR("Nuno Sa <nuno.sa@analog.com>"); | |
1353 | MODULE_DESCRIPTION("Analog Devices ADIS16475 IMU driver"); | |
1354 | MODULE_LICENSE("GPL"); | |
6c9304d6 | 1355 | MODULE_IMPORT_NS(IIO_ADISLIB); |