Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * ad2s1210.c support for the ADI Resolver to Digital Converters: AD2S1210
4 *
5 * Copyright (c) 2010-2010 Analog Devices Inc.
6 * Copyright (c) 2023 BayLibre, SAS
7 *
8 * Device register to IIO ABI mapping:
9 *
10 * Register | Addr | IIO ABI (sysfs)
11 * ----------------------------|------|-------------------------------------------
12 * DOS Overrange Threshold | 0x89 | events/in_altvoltage0_thresh_rising_value
13 * DOS Mismatch Threshold | 0x8A | events/in_altvoltage0_mag_rising_value
14 * DOS Reset Maximum Threshold | 0x8B | events/in_altvoltage0_mag_rising_reset_max
15 * DOS Reset Minimum Threshold | 0x8C | events/in_altvoltage0_mag_rising_reset_min
16 * LOT High Threshold | 0x8D | events/in_angl1_thresh_rising_value
17 * LOT Low Threshold [1] | 0x8E | events/in_angl1_thresh_rising_hysteresis
18 * Excitation Frequency | 0x91 | out_altvoltage0_frequency
19 * Control | 0x92 | *as bit fields*
20 * Phase lock range | D5 | events/in_phase0_mag_rising_value
21 * Hysteresis | D4 | in_angl0_hysteresis
22 * Encoder resolution | D3:2 | *not implemented*
23 * Resolution | D1:0 | *device tree: assigned-resolution-bits*
24 * Soft Reset | 0xF0 | [2]
25 * Fault | 0xFF | *not implemented*
26 *
27 * [1]: The value written to the LOT low register is high value minus the
28 * hysteresis.
29 * [2]: Soft reset is performed when `out_altvoltage0_frequency` is written.
30 *
31 * Fault to event mapping:
32 *
33 * Fault | | Channel | Type | Direction
34 * ----------------------------------------|----|---------------------------------
35 * Sine/cosine inputs clipped [3] | D7 | altvoltage1 | mag | either
36 * Sine/cosine inputs below LOS | D6 | altvoltage0 | thresh | falling
37 * Sine/cosine inputs exceed DOS overrange | D5 | altvoltage0 | thresh | rising
38 * Sine/cosine inputs exceed DOS mismatch | D4 | altvoltage0 | mag | rising
39 * Tracking error exceeds LOT | D3 | angl1 | thresh | rising
40 * Velocity exceeds maximum tracking rate | D2 | anglvel0 | mag | rising
41 * Phase error exceeds phase lock range | D1 | phase0 | mag | rising
42 * Configuration parity error | D0 | *writes to kernel log*
43 *
44 * [3]: The chip does not differentiate between fault on sine vs. cosine so
45 * there will also be an event on the altvoltage2 channel.
46 */
47
48#include <linux/bitfield.h>
49#include <linux/bits.h>
50#include <linux/cleanup.h>
51#include <linux/clk.h>
52#include <linux/delay.h>
53#include <linux/device.h>
54#include <linux/gpio/consumer.h>
55#include <linux/module.h>
56#include <linux/mutex.h>
57#include <linux/regmap.h>
58#include <linux/slab.h>
59#include <linux/spi/spi.h>
60#include <linux/sysfs.h>
61#include <linux/types.h>
62
63#include <linux/iio/buffer.h>
64#include <linux/iio/events.h>
65#include <linux/iio/iio.h>
66#include <linux/iio/sysfs.h>
67#include <linux/iio/trigger_consumer.h>
68#include <linux/iio/triggered_buffer.h>
69
70/* control register flags */
71#define AD2S1210_ADDRESS_DATA BIT(7)
72#define AD2S1210_PHASE_LOCK_RANGE_44 BIT(5)
73#define AD2S1210_ENABLE_HYSTERESIS BIT(4)
74#define AD2S1210_SET_ENRES GENMASK(3, 2)
75#define AD2S1210_SET_RES GENMASK(1, 0)
76
77/* fault register flags */
78#define AD2S1210_FAULT_CLIP BIT(7)
79#define AD2S1210_FAULT_LOS BIT(6)
80#define AD2S1210_FAULT_DOS_OVR BIT(5)
81#define AD2S1210_FAULT_DOS_MIS BIT(4)
82#define AD2S1210_FAULT_LOT BIT(3)
83#define AD2S1210_FAULT_VELOCITY BIT(2)
84#define AD2S1210_FAULT_PHASE BIT(1)
85#define AD2S1210_FAULT_CONFIG_PARITY BIT(0)
86
87#define AD2S1210_REG_POSITION_MSB 0x80
88#define AD2S1210_REG_POSITION_LSB 0x81
89#define AD2S1210_REG_VELOCITY_MSB 0x82
90#define AD2S1210_REG_VELOCITY_LSB 0x83
91#define AD2S1210_REG_LOS_THRD 0x88
92#define AD2S1210_REG_DOS_OVR_THRD 0x89
93#define AD2S1210_REG_DOS_MIS_THRD 0x8A
94#define AD2S1210_REG_DOS_RST_MAX_THRD 0x8B
95#define AD2S1210_REG_DOS_RST_MIN_THRD 0x8C
96#define AD2S1210_REG_LOT_HIGH_THRD 0x8D
97#define AD2S1210_REG_LOT_LOW_THRD 0x8E
98#define AD2S1210_REG_EXCIT_FREQ 0x91
99#define AD2S1210_REG_CONTROL 0x92
100#define AD2S1210_REG_SOFT_RESET 0xF0
101#define AD2S1210_REG_FAULT 0xFF
102
103#define AD2S1210_MIN_CLKIN 6144000
104#define AD2S1210_MAX_CLKIN 10240000
105#define AD2S1210_MIN_EXCIT 2000
106#define AD2S1210_DEF_EXCIT 10000
107#define AD2S1210_MAX_EXCIT 20000
108#define AD2S1210_MIN_FCW 0x4
109#define AD2S1210_MAX_FCW 0x50
110
111/* 44 degrees ~= 0.767945 radians */
112#define PHASE_44_DEG_TO_RAD_INT 0
113#define PHASE_44_DEG_TO_RAD_MICRO 767945
114/* 360 degrees ~= 6.283185 radians */
115#define PHASE_360_DEG_TO_RAD_INT 6
116#define PHASE_360_DEG_TO_RAD_MICRO 283185
117
118/* Threshold voltage registers have 1 LSB == 38 mV */
119#define THRESHOLD_MILLIVOLT_PER_LSB 38
120/* max voltage for threshold registers is 0x7F * 38 mV */
121#define THRESHOLD_RANGE_STR "[0 38 4826]"
122
123#define FAULT_ONESHOT(bit, new, old) (new & bit && !(old & bit))
124
125enum ad2s1210_mode {
126 MOD_POS = 0b00,
127 MOD_VEL = 0b01,
128 MOD_RESERVED = 0b10,
129 MOD_CONFIG = 0b11,
130};
131
132enum ad2s1210_resolution {
133 AD2S1210_RES_10 = 0b00,
134 AD2S1210_RES_12 = 0b01,
135 AD2S1210_RES_14 = 0b10,
136 AD2S1210_RES_16 = 0b11,
137};
138
139struct ad2s1210_state {
140 struct mutex lock;
141 struct spi_device *sdev;
142 /** GPIO pin connected to SAMPLE line. */
143 struct gpio_desc *sample_gpio;
144 /** GPIO pins connected to A0 and A1 lines. */
145 struct gpio_descs *mode_gpios;
146 /** Used to access config registers. */
147 struct regmap *regmap;
148 /** The external oscillator frequency in Hz. */
149 unsigned long clkin_hz;
150 /** Available raw hysteresis values based on resolution. */
151 int hysteresis_available[2];
152 /** The selected resolution */
153 enum ad2s1210_resolution resolution;
154 /** Copy of fault register from the previous read. */
155 u8 prev_fault_flags;
156 /** For reading raw sample value via SPI. */
157 struct {
158 __be16 raw;
159 u8 fault;
160 } sample __aligned(IIO_DMA_MINALIGN);
161 /** Scan buffer */
162 struct {
163 __be16 chan[2];
164 /* Ensure timestamp is naturally aligned. */
165 s64 timestamp __aligned(8);
166 } scan;
167 /** SPI transmit buffer. */
168 u8 rx[2];
169 /** SPI receive buffer. */
170 u8 tx[2];
171};
172
173static int ad2s1210_set_mode(struct ad2s1210_state *st, enum ad2s1210_mode mode)
174{
175 struct gpio_descs *gpios = st->mode_gpios;
176 DECLARE_BITMAP(bitmap, 2);
177
178 bitmap[0] = mode;
179
180 return gpiod_set_array_value(gpios->ndescs, gpios->desc, gpios->info,
181 bitmap);
182}
183
184/*
185 * Writes the given data to the given register address.
186 *
187 * If the mode is configurable, the device will first be placed in
188 * configuration mode.
189 */
190static int ad2s1210_regmap_reg_write(void *context, unsigned int reg,
191 unsigned int val)
192{
193 struct ad2s1210_state *st = context;
194 struct spi_transfer xfers[] = {
195 {
196 .len = 1,
197 .rx_buf = &st->rx[0],
198 .tx_buf = &st->tx[0],
199 .cs_change = 1,
200 }, {
201 .len = 1,
202 .rx_buf = &st->rx[1],
203 .tx_buf = &st->tx[1],
204 },
205 };
206 int ret;
207
208 /* values can only be 7 bits, the MSB indicates an address */
209 if (val & ~0x7F)
210 return -EINVAL;
211
212 st->tx[0] = reg;
213 st->tx[1] = val;
214
215 ret = ad2s1210_set_mode(st, MOD_CONFIG);
216 if (ret < 0)
217 return ret;
218
219 ret = spi_sync_transfer(st->sdev, xfers, ARRAY_SIZE(xfers));
220 if (ret < 0)
221 return ret;
222
223 /* soft reset also clears the fault register */
224 if (reg == AD2S1210_REG_SOFT_RESET)
225 st->prev_fault_flags = 0;
226
227 return 0;
228}
229
230/*
231 * Reads value from one of the registers.
232 *
233 * If the mode is configurable, the device will first be placed in
234 * configuration mode.
235 */
236static int ad2s1210_regmap_reg_read(void *context, unsigned int reg,
237 unsigned int *val)
238{
239 struct ad2s1210_state *st = context;
240 struct spi_transfer xfers[] = {
241 {
242 .len = 1,
243 .rx_buf = &st->rx[0],
244 .tx_buf = &st->tx[0],
245 .cs_change = 1,
246 }, {
247 .len = 1,
248 .rx_buf = &st->rx[1],
249 .tx_buf = &st->tx[1],
250 },
251 };
252 int ret;
253
254 ret = ad2s1210_set_mode(st, MOD_CONFIG);
255 if (ret < 0)
256 return ret;
257
258 st->tx[0] = reg;
259 /*
260 * Must be valid register address here otherwise this could write data.
261 * It doesn't matter which one as long as reading doesn't have side-
262 * effects.
263 */
264 st->tx[1] = AD2S1210_REG_CONTROL;
265
266 ret = spi_sync_transfer(st->sdev, xfers, ARRAY_SIZE(xfers));
267 if (ret < 0)
268 return ret;
269
270 /* reading the fault register also clears it */
271 if (reg == AD2S1210_REG_FAULT)
272 st->prev_fault_flags = 0;
273
274 /*
275 * If the D7 bit is set on any read/write register, it indicates a
276 * parity error. The fault register is read-only and the D7 bit means
277 * something else there.
278 */
279 if (reg != AD2S1210_REG_FAULT && st->rx[1] & AD2S1210_ADDRESS_DATA)
280 return -EBADMSG;
281
282 *val = st->rx[1];
283
284 return 0;
285}
286
287/*
288 * Toggles the SAMPLE line on the AD2S1210 to latch in the current position,
289 * velocity, and faults.
290 *
291 * Must be called with lock held.
292 */
293static void ad2s1210_toggle_sample_line(struct ad2s1210_state *st)
294{
295 /*
296 * Datasheet specifies minimum hold time t16 = 2 * tck + 20 ns. So the
297 * longest time needed is when CLKIN is 6.144 MHz, in which case t16
298 * ~= 350 ns. The same delay is also needed before re-asserting the
299 * SAMPLE line.
300 */
301 gpiod_set_value(st->sample_gpio, 1);
302 ndelay(350);
303 gpiod_set_value(st->sample_gpio, 0);
304 ndelay(350);
305}
306
307/*
308 * Sets the excitation frequency and performs software reset.
309 *
310 * Must be called with lock held.
311 */
312static int ad2s1210_reinit_excitation_frequency(struct ad2s1210_state *st,
313 u16 fexcit)
314{
315 /* Map resolution to settle time in milliseconds. */
316 static const int track_time_ms[] = { 10, 20, 25, 60 };
317 unsigned int ignored;
318 int ret;
319 u8 fcw;
320
321 fcw = fexcit * (1 << 15) / st->clkin_hz;
322 if (fcw < AD2S1210_MIN_FCW || fcw > AD2S1210_MAX_FCW)
323 return -ERANGE;
324
325 ret = regmap_write(st->regmap, AD2S1210_REG_EXCIT_FREQ, fcw);
326 if (ret < 0)
327 return ret;
328
329 /*
330 * Software reset reinitializes the excitation frequency output.
331 * It does not reset any of the configuration registers.
332 */
333 ret = regmap_write(st->regmap, AD2S1210_REG_SOFT_RESET, 0);
334 if (ret < 0)
335 return ret;
336
337 /*
338 * Soft reset always triggers some faults due the change in the output
339 * signal so clear the faults too. We need to delay for some time
340 * (what datasheet calls t[track]) to allow things to settle before
341 * clearing the faults.
342 */
343 msleep(track_time_ms[st->resolution] * 8192000 / st->clkin_hz);
344
345 /* Reading the fault register clears the faults. */
346 ret = regmap_read(st->regmap, AD2S1210_REG_FAULT, &ignored);
347 if (ret < 0)
348 return ret;
349
350 /* Have to toggle sample line to get fault output pins to reset. */
351 ad2s1210_toggle_sample_line(st);
352
353 return 0;
354}
355
356static void ad2s1210_push_events(struct iio_dev *indio_dev,
357 u8 flags, s64 timestamp)
358{
359 struct ad2s1210_state *st = iio_priv(indio_dev);
360
361 /* Sine/cosine inputs clipped */
362 if (FAULT_ONESHOT(AD2S1210_FAULT_CLIP, flags, st->prev_fault_flags)) {
363 /*
364 * The chip does not differentiate between fault on sine vs.
365 * cosine channel so we just send an event on both channels.
366 */
367 iio_push_event(indio_dev,
368 IIO_UNMOD_EVENT_CODE(IIO_ALTVOLTAGE, 1,
369 IIO_EV_TYPE_MAG,
370 IIO_EV_DIR_EITHER),
371 timestamp);
372 iio_push_event(indio_dev,
373 IIO_UNMOD_EVENT_CODE(IIO_ALTVOLTAGE, 2,
374 IIO_EV_TYPE_MAG,
375 IIO_EV_DIR_EITHER),
376 timestamp);
377 }
378
379 /* Sine/cosine inputs below LOS threshold */
380 if (FAULT_ONESHOT(AD2S1210_FAULT_LOS, flags, st->prev_fault_flags))
381 iio_push_event(indio_dev,
382 IIO_UNMOD_EVENT_CODE(IIO_ALTVOLTAGE, 0,
383 IIO_EV_TYPE_THRESH,
384 IIO_EV_DIR_FALLING),
385 timestamp);
386
387 /* Sine/cosine inputs exceed DOS overrange threshold */
388 if (FAULT_ONESHOT(AD2S1210_FAULT_DOS_OVR, flags, st->prev_fault_flags))
389 iio_push_event(indio_dev,
390 IIO_UNMOD_EVENT_CODE(IIO_ALTVOLTAGE, 0,
391 IIO_EV_TYPE_THRESH,
392 IIO_EV_DIR_RISING),
393 timestamp);
394
395 /* Sine/cosine inputs exceed DOS mismatch threshold */
396 if (FAULT_ONESHOT(AD2S1210_FAULT_DOS_MIS, flags, st->prev_fault_flags))
397 iio_push_event(indio_dev,
398 IIO_UNMOD_EVENT_CODE(IIO_ALTVOLTAGE, 0,
399 IIO_EV_TYPE_MAG,
400 IIO_EV_DIR_RISING),
401 timestamp);
402
403 /* Tracking error exceeds LOT threshold */
404 if (FAULT_ONESHOT(AD2S1210_FAULT_LOT, flags, st->prev_fault_flags))
405 iio_push_event(indio_dev,
406 IIO_UNMOD_EVENT_CODE(IIO_ANGL, 1,
407 IIO_EV_TYPE_THRESH,
408 IIO_EV_DIR_RISING),
409 timestamp);
410
411 /* Velocity exceeds maximum tracking rate */
412 if (FAULT_ONESHOT(AD2S1210_FAULT_VELOCITY, flags, st->prev_fault_flags))
413 iio_push_event(indio_dev,
414 IIO_UNMOD_EVENT_CODE(IIO_ANGL_VEL, 0,
415 IIO_EV_TYPE_THRESH,
416 IIO_EV_DIR_RISING),
417 timestamp);
418
419 /* Phase error exceeds phase lock range */
420 if (FAULT_ONESHOT(AD2S1210_FAULT_PHASE, flags, st->prev_fault_flags))
421 iio_push_event(indio_dev,
422 IIO_UNMOD_EVENT_CODE(IIO_PHASE, 0,
423 IIO_EV_TYPE_MAG,
424 IIO_EV_DIR_RISING),
425 timestamp);
426
427 /* Configuration parity error */
428 if (FAULT_ONESHOT(AD2S1210_FAULT_CONFIG_PARITY, flags,
429 st->prev_fault_flags))
430 /*
431 * Userspace should also get notified of this via error return
432 * when trying to write to any attribute that writes a register.
433 */
434 dev_err_ratelimited(&indio_dev->dev,
435 "Configuration parity error\n");
436
437 st->prev_fault_flags = flags;
438}
439
440static int ad2s1210_single_conversion(struct iio_dev *indio_dev,
441 struct iio_chan_spec const *chan,
442 int *val)
443{
444 struct ad2s1210_state *st = iio_priv(indio_dev);
445 s64 timestamp;
446 int ret;
447
448 guard(mutex)(&st->lock);
449
450 ad2s1210_toggle_sample_line(st);
451 timestamp = iio_get_time_ns(indio_dev);
452
453 switch (chan->type) {
454 case IIO_ANGL:
455 ret = ad2s1210_set_mode(st, MOD_POS);
456 break;
457 case IIO_ANGL_VEL:
458 ret = ad2s1210_set_mode(st, MOD_VEL);
459 break;
460 default:
461 return -EINVAL;
462 }
463 if (ret < 0)
464 return ret;
465 ret = spi_read(st->sdev, &st->sample, 3);
466 if (ret < 0)
467 return ret;
468
469 switch (chan->type) {
470 case IIO_ANGL:
471 *val = be16_to_cpu(st->sample.raw);
472 ret = IIO_VAL_INT;
473 break;
474 case IIO_ANGL_VEL:
475 *val = (s16)be16_to_cpu(st->sample.raw);
476 ret = IIO_VAL_INT;
477 break;
478 default:
479 return -EINVAL;
480 }
481
482 ad2s1210_push_events(indio_dev, st->sample.fault, timestamp);
483
484 return ret;
485}
486
487static int ad2s1210_get_hysteresis(struct ad2s1210_state *st, int *val)
488{
489 int ret;
490
491 guard(mutex)(&st->lock);
492 ret = regmap_test_bits(st->regmap, AD2S1210_REG_CONTROL,
493 AD2S1210_ENABLE_HYSTERESIS);
494 if (ret < 0)
495 return ret;
496
497 *val = ret << (2 * (AD2S1210_RES_16 - st->resolution));
498 return IIO_VAL_INT;
499}
500
501static int ad2s1210_set_hysteresis(struct ad2s1210_state *st, int val)
502{
503 guard(mutex)(&st->lock);
504 return regmap_update_bits(st->regmap, AD2S1210_REG_CONTROL,
505 AD2S1210_ENABLE_HYSTERESIS,
506 val ? AD2S1210_ENABLE_HYSTERESIS : 0);
507}
508
509static int ad2s1210_get_phase_lock_range(struct ad2s1210_state *st,
510 int *val, int *val2)
511{
512 int ret;
513
514 guard(mutex)(&st->lock);
515 ret = regmap_test_bits(st->regmap, AD2S1210_REG_CONTROL,
516 AD2S1210_PHASE_LOCK_RANGE_44);
517 if (ret < 0)
518 return ret;
519
520 if (ret) {
521 /* 44 degrees as radians */
522 *val = PHASE_44_DEG_TO_RAD_INT;
523 *val2 = PHASE_44_DEG_TO_RAD_MICRO;
524 } else {
525 /* 360 degrees as radians */
526 *val = PHASE_360_DEG_TO_RAD_INT;
527 *val2 = PHASE_360_DEG_TO_RAD_MICRO;
528 }
529
530 return IIO_VAL_INT_PLUS_MICRO;
531}
532
533static int ad2s1210_set_phase_lock_range(struct ad2s1210_state *st,
534 int val, int val2)
535{
536 int deg;
537
538 /* convert radians to degrees - only two allowable values */
539 if (val == PHASE_44_DEG_TO_RAD_INT && val2 == PHASE_44_DEG_TO_RAD_MICRO)
540 deg = 44;
541 else if (val == PHASE_360_DEG_TO_RAD_INT &&
542 val2 == PHASE_360_DEG_TO_RAD_MICRO)
543 deg = 360;
544 else
545 return -EINVAL;
546
547 guard(mutex)(&st->lock);
548 return regmap_update_bits(st->regmap, AD2S1210_REG_CONTROL,
549 AD2S1210_PHASE_LOCK_RANGE_44,
550 deg == 44 ? AD2S1210_PHASE_LOCK_RANGE_44 : 0);
551}
552
553/* map resolution to microradians/LSB for LOT registers */
554static const int ad2s1210_lot_threshold_urad_per_lsb[] = {
555 6184, /* 10-bit: ~0.35 deg/LSB, 45 deg max */
556 2473, /* 12-bit: ~0.14 deg/LSB, 18 deg max */
557 1237, /* 14-bit: ~0.07 deg/LSB, 9 deg max */
558 1237, /* 16-bit: same as 14-bit */
559};
560
561static int ad2s1210_get_voltage_threshold(struct ad2s1210_state *st,
562 unsigned int reg, int *val)
563{
564 unsigned int reg_val;
565 int ret;
566
567 guard(mutex)(&st->lock);
568 ret = regmap_read(st->regmap, reg, ®_val);
569 if (ret < 0)
570 return ret;
571
572 *val = reg_val * THRESHOLD_MILLIVOLT_PER_LSB;
573 return IIO_VAL_INT;
574}
575
576static int ad2s1210_set_voltage_threshold(struct ad2s1210_state *st,
577 unsigned int reg, int val)
578{
579 unsigned int reg_val;
580
581 reg_val = val / THRESHOLD_MILLIVOLT_PER_LSB;
582
583 guard(mutex)(&st->lock);
584 return regmap_write(st->regmap, reg, reg_val);
585}
586
587static int ad2s1210_get_lot_high_threshold(struct ad2s1210_state *st,
588 int *val, int *val2)
589{
590 unsigned int reg_val;
591 int ret;
592
593 guard(mutex)(&st->lock);
594 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_HIGH_THRD, ®_val);
595 if (ret < 0)
596 return ret;
597
598 *val = 0;
599 *val2 = reg_val * ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
600 return IIO_VAL_INT_PLUS_MICRO;
601}
602
603static int ad2s1210_set_lot_high_threshold(struct ad2s1210_state *st,
604 int val, int val2)
605{
606 unsigned int high_reg_val, low_reg_val, hysteresis;
607 int ret;
608
609 /* all valid values are between 0 and pi/4 radians */
610 if (val != 0)
611 return -EINVAL;
612
613 guard(mutex)(&st->lock);
614 /*
615 * We need to read both high and low registers first so we can preserve
616 * the hysteresis.
617 */
618 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_HIGH_THRD, &high_reg_val);
619 if (ret < 0)
620 return ret;
621
622 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_LOW_THRD, &low_reg_val);
623 if (ret < 0)
624 return ret;
625
626 hysteresis = high_reg_val - low_reg_val;
627 high_reg_val = val2 / ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
628 low_reg_val = high_reg_val - hysteresis;
629
630 ret = regmap_write(st->regmap, AD2S1210_REG_LOT_HIGH_THRD, high_reg_val);
631 if (ret < 0)
632 return ret;
633
634 return regmap_write(st->regmap, AD2S1210_REG_LOT_LOW_THRD, low_reg_val);
635}
636
637static int ad2s1210_get_lot_low_threshold(struct ad2s1210_state *st,
638 int *val, int *val2)
639{
640 unsigned int high_reg_val, low_reg_val;
641 int ret;
642
643 guard(mutex)(&st->lock);
644
645 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_HIGH_THRD, &high_reg_val);
646 if (ret < 0)
647 return ret;
648
649 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_LOW_THRD, &low_reg_val);
650 if (ret < 0)
651 return ret;
652
653 /* sysfs value is hysteresis rather than actual low value */
654 *val = 0;
655 *val2 = (high_reg_val - low_reg_val) *
656 ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
657 return IIO_VAL_INT_PLUS_MICRO;
658}
659
660static int ad2s1210_set_lot_low_threshold(struct ad2s1210_state *st,
661 int val, int val2)
662{
663 unsigned int reg_val, hysteresis;
664 int ret;
665
666 /* all valid values are between 0 and pi/4 radians */
667 if (val != 0)
668 return -EINVAL;
669
670 hysteresis = val2 / ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
671
672 guard(mutex)(&st->lock);
673
674 ret = regmap_read(st->regmap, AD2S1210_REG_LOT_HIGH_THRD, ®_val);
675 if (ret < 0)
676 return ret;
677
678 return regmap_write(st->regmap, AD2S1210_REG_LOT_LOW_THRD,
679 reg_val - hysteresis);
680}
681
682static int ad2s1210_get_excitation_frequency(struct ad2s1210_state *st, int *val)
683{
684 unsigned int reg_val;
685 int ret;
686
687 guard(mutex)(&st->lock);
688
689 ret = regmap_read(st->regmap, AD2S1210_REG_EXCIT_FREQ, ®_val);
690 if (ret < 0)
691 return ret;
692
693 *val = reg_val * st->clkin_hz / (1 << 15);
694 return IIO_VAL_INT;
695}
696
697static int ad2s1210_set_excitation_frequency(struct ad2s1210_state *st, int val)
698{
699 if (val < AD2S1210_MIN_EXCIT || val > AD2S1210_MAX_EXCIT)
700 return -EINVAL;
701
702 guard(mutex)(&st->lock);
703 return ad2s1210_reinit_excitation_frequency(st, val);
704}
705
706static const int ad2s1210_velocity_scale[] = {
707 17089132, /* 8.192MHz / (2*pi * 2500 / 2^15) */
708 42722830, /* 8.192MHz / (2*pi * 1000 / 2^15) */
709 85445659, /* 8.192MHz / (2*pi * 500 / 2^15) */
710 341782638, /* 8.192MHz / (2*pi * 125 / 2^15) */
711};
712
713static int ad2s1210_read_raw(struct iio_dev *indio_dev,
714 struct iio_chan_spec const *chan,
715 int *val,
716 int *val2,
717 long mask)
718{
719 struct ad2s1210_state *st = iio_priv(indio_dev);
720
721 switch (mask) {
722 case IIO_CHAN_INFO_RAW:
723 return ad2s1210_single_conversion(indio_dev, chan, val);
724 case IIO_CHAN_INFO_SCALE:
725 switch (chan->type) {
726 case IIO_ANGL:
727 /* approx 0.3 arc min converted to radians */
728 *val = 0;
729 *val2 = 95874;
730 return IIO_VAL_INT_PLUS_NANO;
731 case IIO_ANGL_VEL:
732 *val = st->clkin_hz;
733 *val2 = ad2s1210_velocity_scale[st->resolution];
734 return IIO_VAL_FRACTIONAL;
735 default:
736 return -EINVAL;
737 }
738 case IIO_CHAN_INFO_FREQUENCY:
739 switch (chan->type) {
740 case IIO_ALTVOLTAGE:
741 return ad2s1210_get_excitation_frequency(st, val);
742 default:
743 return -EINVAL;
744 }
745 case IIO_CHAN_INFO_HYSTERESIS:
746 switch (chan->type) {
747 case IIO_ANGL:
748 return ad2s1210_get_hysteresis(st, val);
749 default:
750 return -EINVAL;
751 }
752 default:
753 return -EINVAL;
754 }
755}
756
757static int ad2s1210_read_avail(struct iio_dev *indio_dev,
758 struct iio_chan_spec const *chan,
759 const int **vals, int *type,
760 int *length, long mask)
761{
762 static const int excitation_frequency_available[] = {
763 AD2S1210_MIN_EXCIT,
764 250, /* step */
765 AD2S1210_MAX_EXCIT,
766 };
767
768 struct ad2s1210_state *st = iio_priv(indio_dev);
769
770 switch (mask) {
771 case IIO_CHAN_INFO_FREQUENCY:
772 switch (chan->type) {
773 case IIO_ALTVOLTAGE:
774 *type = IIO_VAL_INT;
775 *vals = excitation_frequency_available;
776 return IIO_AVAIL_RANGE;
777 default:
778 return -EINVAL;
779 }
780 case IIO_CHAN_INFO_HYSTERESIS:
781 switch (chan->type) {
782 case IIO_ANGL:
783 *vals = st->hysteresis_available;
784 *type = IIO_VAL_INT;
785 *length = ARRAY_SIZE(st->hysteresis_available);
786 return IIO_AVAIL_LIST;
787 default:
788 return -EINVAL;
789 }
790 default:
791 return -EINVAL;
792 }
793}
794
795static int ad2s1210_write_raw(struct iio_dev *indio_dev,
796 struct iio_chan_spec const *chan,
797 int val, int val2, long mask)
798{
799 struct ad2s1210_state *st = iio_priv(indio_dev);
800
801 switch (mask) {
802 case IIO_CHAN_INFO_FREQUENCY:
803 switch (chan->type) {
804 case IIO_ALTVOLTAGE:
805 return ad2s1210_set_excitation_frequency(st, val);
806 default:
807 return -EINVAL;
808 }
809 case IIO_CHAN_INFO_HYSTERESIS:
810 switch (chan->type) {
811 case IIO_ANGL:
812 return ad2s1210_set_hysteresis(st, val);
813 default:
814 return -EINVAL;
815 }
816 default:
817 return -EINVAL;
818 }
819}
820
821static const struct iio_event_spec ad2s1210_position_event_spec[] = {
822 {
823 /* Tracking error exceeds LOT threshold fault. */
824 .type = IIO_EV_TYPE_THRESH,
825 .dir = IIO_EV_DIR_RISING,
826 .mask_separate =
827 /* Loss of tracking high threshold. */
828 BIT(IIO_EV_INFO_VALUE) |
829 /* Loss of tracking low threshold. */
830 BIT(IIO_EV_INFO_HYSTERESIS),
831 },
832};
833
834static const struct iio_event_spec ad2s1210_velocity_event_spec[] = {
835 {
836 /* Velocity exceeds maximum tracking rate fault. */
837 .type = IIO_EV_TYPE_MAG,
838 .dir = IIO_EV_DIR_RISING,
839 },
840};
841
842static const struct iio_event_spec ad2s1210_phase_event_spec[] = {
843 {
844 /* Phase error fault. */
845 .type = IIO_EV_TYPE_MAG,
846 .dir = IIO_EV_DIR_RISING,
847 /* Phase lock range. */
848 .mask_separate = BIT(IIO_EV_INFO_VALUE),
849 },
850};
851
852static const struct iio_event_spec ad2s1210_monitor_signal_event_spec[] = {
853 {
854 /* Sine/cosine below LOS threshold fault. */
855 .type = IIO_EV_TYPE_THRESH,
856 .dir = IIO_EV_DIR_FALLING,
857 /* Loss of signal threshold. */
858 .mask_separate = BIT(IIO_EV_INFO_VALUE),
859 },
860 {
861 /* Sine/cosine DOS overrange fault.*/
862 .type = IIO_EV_TYPE_THRESH,
863 .dir = IIO_EV_DIR_RISING,
864 /* Degredation of signal overrange threshold. */
865 .mask_separate = BIT(IIO_EV_INFO_VALUE),
866 },
867 {
868 /* Sine/cosine DOS mismatch fault.*/
869 .type = IIO_EV_TYPE_MAG,
870 .dir = IIO_EV_DIR_RISING,
871 .mask_separate = BIT(IIO_EV_INFO_VALUE),
872 },
873};
874
875static const struct iio_event_spec ad2s1210_sin_cos_event_spec[] = {
876 {
877 /* Sine/cosine clipping fault. */
878 .type = IIO_EV_TYPE_MAG,
879 .dir = IIO_EV_DIR_EITHER,
880 },
881};
882
883static const struct iio_chan_spec ad2s1210_channels[] = {
884 {
885 .type = IIO_ANGL,
886 .indexed = 1,
887 .channel = 0,
888 .scan_index = 0,
889 .scan_type = {
890 .sign = 'u',
891 .realbits = 16,
892 .storagebits = 16,
893 .endianness = IIO_BE,
894 },
895 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
896 BIT(IIO_CHAN_INFO_SCALE) |
897 BIT(IIO_CHAN_INFO_HYSTERESIS),
898 .info_mask_separate_available =
899 BIT(IIO_CHAN_INFO_HYSTERESIS),
900 }, {
901 .type = IIO_ANGL_VEL,
902 .indexed = 1,
903 .channel = 0,
904 .scan_index = 1,
905 .scan_type = {
906 .sign = 's',
907 .realbits = 16,
908 .storagebits = 16,
909 .endianness = IIO_BE,
910 },
911 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
912 BIT(IIO_CHAN_INFO_SCALE),
913 .event_spec = ad2s1210_velocity_event_spec,
914 .num_event_specs = ARRAY_SIZE(ad2s1210_velocity_event_spec),
915 },
916 IIO_CHAN_SOFT_TIMESTAMP(2),
917 {
918 /* used to configure LOT thresholds and get tracking error */
919 .type = IIO_ANGL,
920 .indexed = 1,
921 .channel = 1,
922 .scan_index = -1,
923 .event_spec = ad2s1210_position_event_spec,
924 .num_event_specs = ARRAY_SIZE(ad2s1210_position_event_spec),
925 },
926 {
927 /* used to configure phase lock range and get phase lock error */
928 .type = IIO_PHASE,
929 .indexed = 1,
930 .channel = 0,
931 .scan_index = -1,
932 .event_spec = ad2s1210_phase_event_spec,
933 .num_event_specs = ARRAY_SIZE(ad2s1210_phase_event_spec),
934 }, {
935 /* excitation frequency output */
936 .type = IIO_ALTVOLTAGE,
937 .indexed = 1,
938 .channel = 0,
939 .output = 1,
940 .scan_index = -1,
941 .info_mask_separate = BIT(IIO_CHAN_INFO_FREQUENCY),
942 .info_mask_separate_available = BIT(IIO_CHAN_INFO_FREQUENCY),
943 }, {
944 /* monitor signal */
945 .type = IIO_ALTVOLTAGE,
946 .indexed = 1,
947 .channel = 0,
948 .scan_index = -1,
949 .event_spec = ad2s1210_monitor_signal_event_spec,
950 .num_event_specs = ARRAY_SIZE(ad2s1210_monitor_signal_event_spec),
951 }, {
952 /* sine input */
953 .type = IIO_ALTVOLTAGE,
954 .indexed = 1,
955 .channel = 1,
956 .scan_index = -1,
957 .event_spec = ad2s1210_sin_cos_event_spec,
958 .num_event_specs = ARRAY_SIZE(ad2s1210_sin_cos_event_spec),
959 }, {
960 /* cosine input */
961 .type = IIO_ALTVOLTAGE,
962 .indexed = 1,
963 .channel = 2,
964 .scan_index = -1,
965 .event_spec = ad2s1210_sin_cos_event_spec,
966 .num_event_specs = ARRAY_SIZE(ad2s1210_sin_cos_event_spec),
967 },
968};
969
970static ssize_t event_attr_voltage_reg_show(struct device *dev,
971 struct device_attribute *attr,
972 char *buf)
973{
974 struct ad2s1210_state *st = iio_priv(dev_to_iio_dev(dev));
975 struct iio_dev_attr *iattr = to_iio_dev_attr(attr);
976 unsigned int value;
977 int ret;
978
979 guard(mutex)(&st->lock);
980 ret = regmap_read(st->regmap, iattr->address, &value);
981 if (ret < 0)
982 return ret;
983
984 return sprintf(buf, "%d\n", value * THRESHOLD_MILLIVOLT_PER_LSB);
985}
986
987static ssize_t event_attr_voltage_reg_store(struct device *dev,
988 struct device_attribute *attr,
989 const char *buf, size_t len)
990{
991 struct ad2s1210_state *st = iio_priv(dev_to_iio_dev(dev));
992 struct iio_dev_attr *iattr = to_iio_dev_attr(attr);
993 u16 data;
994 int ret;
995
996 ret = kstrtou16(buf, 10, &data);
997 if (ret)
998 return -EINVAL;
999
1000 guard(mutex)(&st->lock);
1001 ret = regmap_write(st->regmap, iattr->address,
1002 data / THRESHOLD_MILLIVOLT_PER_LSB);
1003 if (ret < 0)
1004 return ret;
1005
1006 return len;
1007}
1008
1009static ssize_t
1010in_angl1_thresh_rising_value_available_show(struct device *dev,
1011 struct device_attribute *attr,
1012 char *buf)
1013{
1014 struct ad2s1210_state *st = iio_priv(dev_to_iio_dev(dev));
1015 int step = ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
1016
1017 return sysfs_emit(buf, "[0 0.%06d 0.%06d]\n", step, step * 0x7F);
1018}
1019
1020static ssize_t
1021in_angl1_thresh_rising_hysteresis_available_show(struct device *dev,
1022 struct device_attribute *attr,
1023 char *buf)
1024{
1025 struct ad2s1210_state *st = iio_priv(dev_to_iio_dev(dev));
1026 int step = ad2s1210_lot_threshold_urad_per_lsb[st->resolution];
1027
1028 return sysfs_emit(buf, "[0 0.%06d 0.%06d]\n", step, step * 0x7F);
1029}
1030
1031static IIO_CONST_ATTR(in_phase0_mag_rising_value_available,
1032 __stringify(PHASE_44_DEG_TO_RAD_INT) "."
1033 __stringify(PHASE_44_DEG_TO_RAD_MICRO) " "
1034 __stringify(PHASE_360_DEG_TO_RAD_INT) "."
1035 __stringify(PHASE_360_DEG_TO_RAD_MICRO));
1036static IIO_CONST_ATTR(in_altvoltage0_thresh_falling_value_available,
1037 THRESHOLD_RANGE_STR);
1038static IIO_CONST_ATTR(in_altvoltage0_thresh_rising_value_available,
1039 THRESHOLD_RANGE_STR);
1040static IIO_CONST_ATTR(in_altvoltage0_mag_rising_value_available,
1041 THRESHOLD_RANGE_STR);
1042static IIO_DEVICE_ATTR(in_altvoltage0_mag_rising_reset_max, 0644,
1043 event_attr_voltage_reg_show, event_attr_voltage_reg_store,
1044 AD2S1210_REG_DOS_RST_MAX_THRD);
1045static IIO_CONST_ATTR(in_altvoltage0_mag_rising_reset_max_available, THRESHOLD_RANGE_STR);
1046static IIO_DEVICE_ATTR(in_altvoltage0_mag_rising_reset_min, 0644,
1047 event_attr_voltage_reg_show, event_attr_voltage_reg_store,
1048 AD2S1210_REG_DOS_RST_MIN_THRD);
1049static IIO_CONST_ATTR(in_altvoltage0_mag_rising_reset_min_available, THRESHOLD_RANGE_STR);
1050static IIO_DEVICE_ATTR_RO(in_angl1_thresh_rising_value_available, 0);
1051static IIO_DEVICE_ATTR_RO(in_angl1_thresh_rising_hysteresis_available, 0);
1052
1053static struct attribute *ad2s1210_event_attributes[] = {
1054 &iio_const_attr_in_phase0_mag_rising_value_available.dev_attr.attr,
1055 &iio_const_attr_in_altvoltage0_thresh_falling_value_available.dev_attr.attr,
1056 &iio_const_attr_in_altvoltage0_thresh_rising_value_available.dev_attr.attr,
1057 &iio_const_attr_in_altvoltage0_mag_rising_value_available.dev_attr.attr,
1058 &iio_dev_attr_in_altvoltage0_mag_rising_reset_max.dev_attr.attr,
1059 &iio_const_attr_in_altvoltage0_mag_rising_reset_max_available.dev_attr.attr,
1060 &iio_dev_attr_in_altvoltage0_mag_rising_reset_min.dev_attr.attr,
1061 &iio_const_attr_in_altvoltage0_mag_rising_reset_min_available.dev_attr.attr,
1062 &iio_dev_attr_in_angl1_thresh_rising_value_available.dev_attr.attr,
1063 &iio_dev_attr_in_angl1_thresh_rising_hysteresis_available.dev_attr.attr,
1064 NULL,
1065};
1066
1067static const struct attribute_group ad2s1210_event_attribute_group = {
1068 .attrs = ad2s1210_event_attributes,
1069};
1070
1071static int ad2s1210_initial(struct ad2s1210_state *st)
1072{
1073 unsigned int data;
1074 int ret;
1075
1076 guard(mutex)(&st->lock);
1077
1078 /* Use default config register value plus resolution from devicetree. */
1079 data = FIELD_PREP(AD2S1210_PHASE_LOCK_RANGE_44, 1);
1080 data |= FIELD_PREP(AD2S1210_ENABLE_HYSTERESIS, 1);
1081 data |= FIELD_PREP(AD2S1210_SET_ENRES, 0x3);
1082 data |= FIELD_PREP(AD2S1210_SET_RES, st->resolution);
1083
1084 ret = regmap_write(st->regmap, AD2S1210_REG_CONTROL, data);
1085 if (ret < 0)
1086 return ret;
1087
1088 return ad2s1210_reinit_excitation_frequency(st, AD2S1210_DEF_EXCIT);
1089}
1090
1091static int ad2s1210_read_label(struct iio_dev *indio_dev,
1092 struct iio_chan_spec const *chan,
1093 char *label)
1094{
1095 if (chan->type == IIO_ANGL) {
1096 if (chan->channel == 0)
1097 return sprintf(label, "position\n");
1098 if (chan->channel == 1)
1099 return sprintf(label, "tracking error\n");
1100 }
1101 if (chan->type == IIO_ANGL_VEL)
1102 return sprintf(label, "velocity\n");
1103 if (chan->type == IIO_PHASE)
1104 return sprintf(label, "synthetic reference\n");
1105 if (chan->type == IIO_ALTVOLTAGE) {
1106 if (chan->output)
1107 return sprintf(label, "excitation\n");
1108 if (chan->channel == 0)
1109 return sprintf(label, "monitor signal\n");
1110 if (chan->channel == 1)
1111 return sprintf(label, "cosine\n");
1112 if (chan->channel == 2)
1113 return sprintf(label, "sine\n");
1114 }
1115
1116 return -EINVAL;
1117}
1118
1119static int ad2s1210_read_event_value(struct iio_dev *indio_dev,
1120 const struct iio_chan_spec *chan,
1121 enum iio_event_type type,
1122 enum iio_event_direction dir,
1123 enum iio_event_info info,
1124 int *val, int *val2)
1125{
1126 struct ad2s1210_state *st = iio_priv(indio_dev);
1127
1128 switch (chan->type) {
1129 case IIO_ANGL:
1130 switch (info) {
1131 case IIO_EV_INFO_VALUE:
1132 return ad2s1210_get_lot_high_threshold(st, val, val2);
1133 case IIO_EV_INFO_HYSTERESIS:
1134 return ad2s1210_get_lot_low_threshold(st, val, val2);
1135 default:
1136 return -EINVAL;
1137 }
1138 case IIO_ALTVOLTAGE:
1139 if (chan->output)
1140 return -EINVAL;
1141 if (type == IIO_EV_TYPE_THRESH && dir == IIO_EV_DIR_FALLING)
1142 return ad2s1210_get_voltage_threshold(st,
1143 AD2S1210_REG_LOS_THRD, val);
1144 if (type == IIO_EV_TYPE_THRESH && dir == IIO_EV_DIR_RISING)
1145 return ad2s1210_get_voltage_threshold(st,
1146 AD2S1210_REG_DOS_OVR_THRD, val);
1147 if (type == IIO_EV_TYPE_MAG)
1148 return ad2s1210_get_voltage_threshold(st,
1149 AD2S1210_REG_DOS_MIS_THRD, val);
1150 return -EINVAL;
1151 case IIO_PHASE:
1152 return ad2s1210_get_phase_lock_range(st, val, val2);
1153 default:
1154 return -EINVAL;
1155 }
1156}
1157
1158static int ad2s1210_write_event_value(struct iio_dev *indio_dev,
1159 const struct iio_chan_spec *chan,
1160 enum iio_event_type type,
1161 enum iio_event_direction dir,
1162 enum iio_event_info info,
1163 int val, int val2)
1164{
1165 struct ad2s1210_state *st = iio_priv(indio_dev);
1166
1167 switch (chan->type) {
1168 case IIO_ANGL:
1169 switch (info) {
1170 case IIO_EV_INFO_VALUE:
1171 return ad2s1210_set_lot_high_threshold(st, val, val2);
1172 case IIO_EV_INFO_HYSTERESIS:
1173 return ad2s1210_set_lot_low_threshold(st, val, val2);
1174 default:
1175 return -EINVAL;
1176 }
1177 case IIO_ALTVOLTAGE:
1178 if (chan->output)
1179 return -EINVAL;
1180 if (type == IIO_EV_TYPE_THRESH && dir == IIO_EV_DIR_FALLING)
1181 return ad2s1210_set_voltage_threshold(st,
1182 AD2S1210_REG_LOS_THRD, val);
1183 if (type == IIO_EV_TYPE_THRESH && dir == IIO_EV_DIR_RISING)
1184 return ad2s1210_set_voltage_threshold(st,
1185 AD2S1210_REG_DOS_OVR_THRD, val);
1186 if (type == IIO_EV_TYPE_MAG)
1187 return ad2s1210_set_voltage_threshold(st,
1188 AD2S1210_REG_DOS_MIS_THRD, val);
1189 return -EINVAL;
1190 case IIO_PHASE:
1191 return ad2s1210_set_phase_lock_range(st, val, val2);
1192 default:
1193 return -EINVAL;
1194 }
1195}
1196
1197static int ad2s1210_read_event_label(struct iio_dev *indio_dev,
1198 struct iio_chan_spec const *chan,
1199 enum iio_event_type type,
1200 enum iio_event_direction dir,
1201 char *label)
1202{
1203 if (chan->type == IIO_ANGL)
1204 return sprintf(label, "LOT\n");
1205 if (chan->type == IIO_ANGL_VEL)
1206 return sprintf(label, "max tracking rate\n");
1207 if (chan->type == IIO_PHASE)
1208 return sprintf(label, "phase lock\n");
1209 if (chan->type == IIO_ALTVOLTAGE) {
1210 if (chan->channel == 0) {
1211 if (type == IIO_EV_TYPE_THRESH &&
1212 dir == IIO_EV_DIR_FALLING)
1213 return sprintf(label, "LOS\n");
1214 if (type == IIO_EV_TYPE_THRESH &&
1215 dir == IIO_EV_DIR_RISING)
1216 return sprintf(label, "DOS overrange\n");
1217 if (type == IIO_EV_TYPE_MAG)
1218 return sprintf(label, "DOS mismatch\n");
1219 }
1220 if (chan->channel == 1 || chan->channel == 2)
1221 return sprintf(label, "clipped\n");
1222 }
1223
1224 return -EINVAL;
1225}
1226
1227static int ad2s1210_debugfs_reg_access(struct iio_dev *indio_dev,
1228 unsigned int reg, unsigned int writeval,
1229 unsigned int *readval)
1230{
1231 struct ad2s1210_state *st = iio_priv(indio_dev);
1232
1233 guard(mutex)(&st->lock);
1234
1235 if (readval)
1236 return regmap_read(st->regmap, reg, readval);
1237
1238 return regmap_write(st->regmap, reg, writeval);
1239}
1240
1241static irqreturn_t ad2s1210_trigger_handler(int irq, void *p)
1242{
1243 struct iio_poll_func *pf = p;
1244 struct iio_dev *indio_dev = pf->indio_dev;
1245 struct ad2s1210_state *st = iio_priv(indio_dev);
1246 size_t chan = 0;
1247 int ret;
1248
1249 guard(mutex)(&st->lock);
1250
1251 memset(&st->scan, 0, sizeof(st->scan));
1252 ad2s1210_toggle_sample_line(st);
1253
1254 if (test_bit(0, indio_dev->active_scan_mask)) {
1255 ret = ad2s1210_set_mode(st, MOD_POS);
1256 if (ret < 0)
1257 goto error_ret;
1258
1259 ret = spi_read(st->sdev, &st->sample, 3);
1260 if (ret < 0)
1261 goto error_ret;
1262
1263 memcpy(&st->scan.chan[chan++], &st->sample.raw, 2);
1264 }
1265
1266 if (test_bit(1, indio_dev->active_scan_mask)) {
1267 ret = ad2s1210_set_mode(st, MOD_VEL);
1268 if (ret < 0)
1269 goto error_ret;
1270
1271 ret = spi_read(st->sdev, &st->sample, 3);
1272 if (ret < 0)
1273 goto error_ret;
1274
1275 memcpy(&st->scan.chan[chan++], &st->sample.raw, 2);
1276 }
1277
1278 ad2s1210_push_events(indio_dev, st->sample.fault, pf->timestamp);
1279 iio_push_to_buffers_with_timestamp(indio_dev, &st->scan, pf->timestamp);
1280
1281error_ret:
1282 iio_trigger_notify_done(indio_dev->trig);
1283
1284 return IRQ_HANDLED;
1285}
1286
1287static const struct iio_info ad2s1210_info = {
1288 .event_attrs = &ad2s1210_event_attribute_group,
1289 .read_raw = ad2s1210_read_raw,
1290 .read_avail = ad2s1210_read_avail,
1291 .write_raw = ad2s1210_write_raw,
1292 .read_label = ad2s1210_read_label,
1293 .read_event_value = ad2s1210_read_event_value,
1294 .write_event_value = ad2s1210_write_event_value,
1295 .read_event_label = ad2s1210_read_event_label,
1296 .debugfs_reg_access = &ad2s1210_debugfs_reg_access,
1297};
1298
1299static int ad2s1210_setup_properties(struct ad2s1210_state *st)
1300{
1301 struct device *dev = &st->sdev->dev;
1302 u32 val;
1303 int ret;
1304
1305 ret = device_property_read_u32(dev, "assigned-resolution-bits", &val);
1306 if (ret < 0)
1307 return dev_err_probe(dev, ret,
1308 "failed to read assigned-resolution-bits property\n");
1309
1310 if (val < 10 || val > 16)
1311 return dev_err_probe(dev, -EINVAL,
1312 "resolution out of range: %u\n", val);
1313
1314 st->resolution = (val - 10) >> 1;
1315 /*
1316 * These are values that correlate to the hysteresis bit in the Control
1317 * register. 0 = disabled, 1 = enabled. When enabled, the actual
1318 * hysteresis is +/- 1 LSB of the raw position value. Which bit is the
1319 * LSB depends on the specified resolution.
1320 */
1321 st->hysteresis_available[0] = 0;
1322 st->hysteresis_available[1] = 1 << (2 * (AD2S1210_RES_16 -
1323 st->resolution));
1324
1325 return 0;
1326}
1327
1328static int ad2s1210_setup_clocks(struct ad2s1210_state *st)
1329{
1330 struct device *dev = &st->sdev->dev;
1331 struct clk *clk;
1332
1333 clk = devm_clk_get_enabled(dev, NULL);
1334 if (IS_ERR(clk))
1335 return dev_err_probe(dev, PTR_ERR(clk), "failed to get clock\n");
1336
1337 st->clkin_hz = clk_get_rate(clk);
1338 if (st->clkin_hz < AD2S1210_MIN_CLKIN || st->clkin_hz > AD2S1210_MAX_CLKIN)
1339 return dev_err_probe(dev, -EINVAL,
1340 "clock frequency out of range: %lu\n",
1341 st->clkin_hz);
1342
1343 return 0;
1344}
1345
1346static int ad2s1210_setup_gpios(struct ad2s1210_state *st)
1347{
1348 struct device *dev = &st->sdev->dev;
1349 struct gpio_descs *resolution_gpios;
1350 DECLARE_BITMAP(bitmap, 2);
1351 int ret;
1352
1353 /* should not be sampling on startup */
1354 st->sample_gpio = devm_gpiod_get(dev, "sample", GPIOD_OUT_LOW);
1355 if (IS_ERR(st->sample_gpio))
1356 return dev_err_probe(dev, PTR_ERR(st->sample_gpio),
1357 "failed to request sample GPIO\n");
1358
1359 /* both pins high means that we start in config mode */
1360 st->mode_gpios = devm_gpiod_get_array(dev, "mode", GPIOD_OUT_HIGH);
1361 if (IS_ERR(st->mode_gpios))
1362 return dev_err_probe(dev, PTR_ERR(st->mode_gpios),
1363 "failed to request mode GPIOs\n");
1364
1365 if (st->mode_gpios->ndescs != 2)
1366 return dev_err_probe(dev, -EINVAL,
1367 "requires exactly 2 mode-gpios\n");
1368
1369 /*
1370 * If resolution gpios are provided, they get set to the required
1371 * resolution, otherwise it is assumed the RES0 and RES1 pins are
1372 * hard-wired to match the resolution indicated in the devicetree.
1373 */
1374 resolution_gpios = devm_gpiod_get_array_optional(dev, "resolution",
1375 GPIOD_ASIS);
1376 if (IS_ERR(resolution_gpios))
1377 return dev_err_probe(dev, PTR_ERR(resolution_gpios),
1378 "failed to request resolution GPIOs\n");
1379
1380 if (resolution_gpios) {
1381 if (resolution_gpios->ndescs != 2)
1382 return dev_err_probe(dev, -EINVAL,
1383 "requires exactly 2 resolution-gpios\n");
1384
1385 bitmap[0] = st->resolution;
1386
1387 ret = gpiod_set_array_value(resolution_gpios->ndescs,
1388 resolution_gpios->desc,
1389 resolution_gpios->info,
1390 bitmap);
1391 if (ret < 0)
1392 return dev_err_probe(dev, ret,
1393 "failed to set resolution gpios\n");
1394 }
1395
1396 return 0;
1397}
1398
1399static const struct regmap_range ad2s1210_regmap_readable_ranges[] = {
1400 regmap_reg_range(AD2S1210_REG_POSITION_MSB, AD2S1210_REG_VELOCITY_LSB),
1401 regmap_reg_range(AD2S1210_REG_LOS_THRD, AD2S1210_REG_LOT_LOW_THRD),
1402 regmap_reg_range(AD2S1210_REG_EXCIT_FREQ, AD2S1210_REG_CONTROL),
1403 regmap_reg_range(AD2S1210_REG_FAULT, AD2S1210_REG_FAULT),
1404};
1405
1406static const struct regmap_access_table ad2s1210_regmap_rd_table = {
1407 .yes_ranges = ad2s1210_regmap_readable_ranges,
1408 .n_yes_ranges = ARRAY_SIZE(ad2s1210_regmap_readable_ranges),
1409};
1410
1411static const struct regmap_range ad2s1210_regmap_writeable_ranges[] = {
1412 regmap_reg_range(AD2S1210_REG_LOS_THRD, AD2S1210_REG_LOT_LOW_THRD),
1413 regmap_reg_range(AD2S1210_REG_EXCIT_FREQ, AD2S1210_REG_CONTROL),
1414 regmap_reg_range(AD2S1210_REG_SOFT_RESET, AD2S1210_REG_SOFT_RESET),
1415 regmap_reg_range(AD2S1210_REG_FAULT, AD2S1210_REG_FAULT),
1416};
1417
1418static const struct regmap_access_table ad2s1210_regmap_wr_table = {
1419 .yes_ranges = ad2s1210_regmap_writeable_ranges,
1420 .n_yes_ranges = ARRAY_SIZE(ad2s1210_regmap_writeable_ranges),
1421};
1422
1423static int ad2s1210_setup_regmap(struct ad2s1210_state *st)
1424{
1425 struct device *dev = &st->sdev->dev;
1426 const struct regmap_config config = {
1427 .reg_bits = 8,
1428 .val_bits = 8,
1429 .disable_locking = true,
1430 .reg_read = ad2s1210_regmap_reg_read,
1431 .reg_write = ad2s1210_regmap_reg_write,
1432 .rd_table = &ad2s1210_regmap_rd_table,
1433 .wr_table = &ad2s1210_regmap_wr_table,
1434 .can_sleep = true,
1435 };
1436
1437 st->regmap = devm_regmap_init(dev, NULL, st, &config);
1438 if (IS_ERR(st->regmap))
1439 return dev_err_probe(dev, PTR_ERR(st->regmap),
1440 "failed to allocate register map\n");
1441
1442 return 0;
1443}
1444
1445static int ad2s1210_probe(struct spi_device *spi)
1446{
1447 struct iio_dev *indio_dev;
1448 struct ad2s1210_state *st;
1449 int ret;
1450
1451 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st));
1452 if (!indio_dev)
1453 return -ENOMEM;
1454 st = iio_priv(indio_dev);
1455
1456 mutex_init(&st->lock);
1457 st->sdev = spi;
1458
1459 ret = ad2s1210_setup_properties(st);
1460 if (ret < 0)
1461 return ret;
1462
1463 ret = ad2s1210_setup_clocks(st);
1464 if (ret < 0)
1465 return ret;
1466
1467 ret = ad2s1210_setup_gpios(st);
1468 if (ret < 0)
1469 return ret;
1470
1471 ret = ad2s1210_setup_regmap(st);
1472 if (ret < 0)
1473 return ret;
1474
1475 ret = ad2s1210_initial(st);
1476 if (ret < 0)
1477 return ret;
1478
1479 indio_dev->info = &ad2s1210_info;
1480 indio_dev->modes = INDIO_DIRECT_MODE;
1481 indio_dev->channels = ad2s1210_channels;
1482 indio_dev->num_channels = ARRAY_SIZE(ad2s1210_channels);
1483 indio_dev->name = spi_get_device_id(spi)->name;
1484
1485 ret = devm_iio_triggered_buffer_setup(&spi->dev, indio_dev,
1486 &iio_pollfunc_store_time,
1487 &ad2s1210_trigger_handler, NULL);
1488 if (ret < 0)
1489 return dev_err_probe(&spi->dev, ret,
1490 "iio triggered buffer setup failed\n");
1491
1492 return devm_iio_device_register(&spi->dev, indio_dev);
1493}
1494
1495static const struct of_device_id ad2s1210_of_match[] = {
1496 { .compatible = "adi,ad2s1210", },
1497 { }
1498};
1499MODULE_DEVICE_TABLE(of, ad2s1210_of_match);
1500
1501static const struct spi_device_id ad2s1210_id[] = {
1502 { "ad2s1210" },
1503 {}
1504};
1505MODULE_DEVICE_TABLE(spi, ad2s1210_id);
1506
1507static struct spi_driver ad2s1210_driver = {
1508 .driver = {
1509 .name = "ad2s1210",
1510 .of_match_table = ad2s1210_of_match,
1511 },
1512 .probe = ad2s1210_probe,
1513 .id_table = ad2s1210_id,
1514};
1515module_spi_driver(ad2s1210_driver);
1516
1517MODULE_AUTHOR("Graff Yang <graff.yang@gmail.com>");
1518MODULE_DESCRIPTION("Analog Devices AD2S1210 Resolver to Digital SPI driver");
1519MODULE_LICENSE("GPL v2");