1
2
3
4
5
6
7
8
9#include <linux/interrupt.h>
10#include <linux/device.h>
11#include <linux/kernel.h>
12#include <linux/slab.h>
13#include <linux/sysfs.h>
14#include <linux/spi/spi.h>
15#include <linux/regulator/consumer.h>
16#include <linux/err.h>
17#include <linux/sched.h>
18#include <linux/delay.h>
19
20#include <linux/iio/iio.h>
21#include <linux/iio/sysfs.h>
22#include <linux/iio/buffer.h>
23#include <linux/iio/trigger.h>
24#include <linux/iio/trigger_consumer.h>
25#include <linux/iio/triggered_buffer.h>
26#include <linux/iio/adc/ad_sigma_delta.h>
27
28#include "ad7192.h"
29
30
31#define AD7192_REG_COMM 0
32#define AD7192_REG_STAT 0
33#define AD7192_REG_MODE 1
34#define AD7192_REG_CONF 2
35#define AD7192_REG_DATA 3
36#define AD7192_REG_ID 4
37#define AD7192_REG_GPOCON 5
38#define AD7192_REG_OFFSET 6
39
40#define AD7192_REG_FULLSALE 7
41
42
43
44#define AD7192_COMM_WEN BIT(7)
45#define AD7192_COMM_WRITE 0
46#define AD7192_COMM_READ BIT(6)
47#define AD7192_COMM_ADDR(x) (((x) & 0x7) << 3)
48#define AD7192_COMM_CREAD BIT(2)
49
50
51#define AD7192_STAT_RDY BIT(7)
52#define AD7192_STAT_ERR BIT(6)
53#define AD7192_STAT_NOREF BIT(5)
54#define AD7192_STAT_PARITY BIT(4)
55#define AD7192_STAT_CH3 BIT(2)
56#define AD7192_STAT_CH2 BIT(1)
57#define AD7192_STAT_CH1 BIT(0)
58
59
60#define AD7192_MODE_SEL(x) (((x) & 0x7) << 21)
61#define AD7192_MODE_SEL_MASK (0x7 << 21)
62#define AD7192_MODE_DAT_STA BIT(20)
63#define AD7192_MODE_CLKSRC(x) (((x) & 0x3) << 18)
64#define AD7192_MODE_SINC3 BIT(15)
65#define AD7192_MODE_ACX BIT(14)
66#define AD7192_MODE_ENPAR BIT(13)
67#define AD7192_MODE_CLKDIV BIT(12)
68#define AD7192_MODE_SCYCLE BIT(11)
69#define AD7192_MODE_REJ60 BIT(10)
70#define AD7192_MODE_RATE(x) ((x) & 0x3FF)
71
72
73#define AD7192_MODE_CONT 0
74#define AD7192_MODE_SINGLE 1
75#define AD7192_MODE_IDLE 2
76#define AD7192_MODE_PWRDN 3
77#define AD7192_MODE_CAL_INT_ZERO 4
78#define AD7192_MODE_CAL_INT_FULL 5
79#define AD7192_MODE_CAL_SYS_ZERO 6
80#define AD7192_MODE_CAL_SYS_FULL 7
81
82
83#define AD7192_CLK_EXT_MCLK1_2 0
84
85#define AD7192_CLK_EXT_MCLK2 1
86#define AD7192_CLK_INT 2
87
88#define AD7192_CLK_INT_CO 3
89
90
91
92
93#define AD7192_CONF_CHOP BIT(23)
94#define AD7192_CONF_REFSEL BIT(20)
95#define AD7192_CONF_CHAN(x) (((1 << (x)) & 0xFF) << 8)
96#define AD7192_CONF_CHAN_MASK (0xFF << 8)
97#define AD7192_CONF_BURN BIT(7)
98#define AD7192_CONF_REFDET BIT(6)
99#define AD7192_CONF_BUF BIT(4)
100#define AD7192_CONF_UNIPOLAR BIT(3)
101#define AD7192_CONF_GAIN(x) ((x) & 0x7)
102
103#define AD7192_CH_AIN1P_AIN2M 0
104#define AD7192_CH_AIN3P_AIN4M 1
105#define AD7192_CH_TEMP 2
106#define AD7192_CH_AIN2P_AIN2M 3
107#define AD7192_CH_AIN1 4
108#define AD7192_CH_AIN2 5
109#define AD7192_CH_AIN3 6
110#define AD7192_CH_AIN4 7
111
112
113#define ID_AD7190 0x4
114#define ID_AD7192 0x0
115#define ID_AD7195 0x6
116#define AD7192_ID_MASK 0x0F
117
118
119#define AD7192_GPOCON_BPDSW BIT(6)
120#define AD7192_GPOCON_GP32EN BIT(5)
121#define AD7192_GPOCON_GP10EN BIT(4)
122#define AD7192_GPOCON_P3DAT BIT(3)
123#define AD7192_GPOCON_P2DAT BIT(2)
124#define AD7192_GPOCON_P1DAT BIT(1)
125#define AD7192_GPOCON_P0DAT BIT(0)
126
127#define AD7192_INT_FREQ_MHZ 4915200
128
129
130
131
132
133
134
135
136
137struct ad7192_state {
138 struct regulator *reg;
139 u16 int_vref_mv;
140 u32 mclk;
141 u32 f_order;
142 u32 mode;
143 u32 conf;
144 u32 scale_avail[8][2];
145 u8 gpocon;
146 u8 devid;
147
148 struct ad_sigma_delta sd;
149};
150
151static struct ad7192_state *ad_sigma_delta_to_ad7192(struct ad_sigma_delta *sd)
152{
153 return container_of(sd, struct ad7192_state, sd);
154}
155
156static int ad7192_set_channel(struct ad_sigma_delta *sd, unsigned int channel)
157{
158 struct ad7192_state *st = ad_sigma_delta_to_ad7192(sd);
159
160 st->conf &= ~AD7192_CONF_CHAN_MASK;
161 st->conf |= AD7192_CONF_CHAN(channel);
162
163 return ad_sd_write_reg(&st->sd, AD7192_REG_CONF, 3, st->conf);
164}
165
166static int ad7192_set_mode(struct ad_sigma_delta *sd,
167 enum ad_sigma_delta_mode mode)
168{
169 struct ad7192_state *st = ad_sigma_delta_to_ad7192(sd);
170
171 st->mode &= ~AD7192_MODE_SEL_MASK;
172 st->mode |= AD7192_MODE_SEL(mode);
173
174 return ad_sd_write_reg(&st->sd, AD7192_REG_MODE, 3, st->mode);
175}
176
177static const struct ad_sigma_delta_info ad7192_sigma_delta_info = {
178 .set_channel = ad7192_set_channel,
179 .set_mode = ad7192_set_mode,
180 .has_registers = true,
181 .addr_shift = 3,
182 .read_mask = BIT(6),
183};
184
185static const struct ad_sd_calib_data ad7192_calib_arr[8] = {
186 {AD7192_MODE_CAL_INT_ZERO, AD7192_CH_AIN1},
187 {AD7192_MODE_CAL_INT_FULL, AD7192_CH_AIN1},
188 {AD7192_MODE_CAL_INT_ZERO, AD7192_CH_AIN2},
189 {AD7192_MODE_CAL_INT_FULL, AD7192_CH_AIN2},
190 {AD7192_MODE_CAL_INT_ZERO, AD7192_CH_AIN3},
191 {AD7192_MODE_CAL_INT_FULL, AD7192_CH_AIN3},
192 {AD7192_MODE_CAL_INT_ZERO, AD7192_CH_AIN4},
193 {AD7192_MODE_CAL_INT_FULL, AD7192_CH_AIN4}
194};
195
196static int ad7192_calibrate_all(struct ad7192_state *st)
197{
198 return ad_sd_calibrate_all(&st->sd, ad7192_calib_arr,
199 ARRAY_SIZE(ad7192_calib_arr));
200}
201
202static int ad7192_setup(struct ad7192_state *st,
203 const struct ad7192_platform_data *pdata)
204{
205 struct iio_dev *indio_dev = spi_get_drvdata(st->sd.spi);
206 unsigned long long scale_uv;
207 int i, ret, id;
208 u8 ones[6];
209
210
211 memset(&ones, 0xFF, 6);
212 ret = spi_write(st->sd.spi, &ones, 6);
213 if (ret < 0)
214 goto out;
215 usleep_range(500, 1000);
216
217
218 ret = ad_sd_read_reg(&st->sd, AD7192_REG_ID, 1, &id);
219 if (ret)
220 goto out;
221
222 id &= AD7192_ID_MASK;
223
224 if (id != st->devid)
225 dev_warn(&st->sd.spi->dev, "device ID query failed (0x%X)\n",
226 id);
227
228 switch (pdata->clock_source_sel) {
229 case AD7192_CLK_EXT_MCLK1_2:
230 case AD7192_CLK_EXT_MCLK2:
231 st->mclk = AD7192_INT_FREQ_MHZ;
232 break;
233 case AD7192_CLK_INT:
234 case AD7192_CLK_INT_CO:
235 if (pdata->ext_clk_hz)
236 st->mclk = pdata->ext_clk_hz;
237 else
238 st->mclk = AD7192_INT_FREQ_MHZ;
239 break;
240 default:
241 ret = -EINVAL;
242 goto out;
243 }
244
245 st->mode = AD7192_MODE_SEL(AD7192_MODE_IDLE) |
246 AD7192_MODE_CLKSRC(pdata->clock_source_sel) |
247 AD7192_MODE_RATE(480);
248
249 st->conf = AD7192_CONF_GAIN(0);
250
251 if (pdata->rej60_en)
252 st->mode |= AD7192_MODE_REJ60;
253
254 if (pdata->sinc3_en)
255 st->mode |= AD7192_MODE_SINC3;
256
257 if (pdata->refin2_en && (st->devid != ID_AD7195))
258 st->conf |= AD7192_CONF_REFSEL;
259
260 if (pdata->chop_en) {
261 st->conf |= AD7192_CONF_CHOP;
262 if (pdata->sinc3_en)
263 st->f_order = 3;
264 else
265 st->f_order = 4;
266 } else {
267 st->f_order = 1;
268 }
269
270 if (pdata->buf_en)
271 st->conf |= AD7192_CONF_BUF;
272
273 if (pdata->unipolar_en)
274 st->conf |= AD7192_CONF_UNIPOLAR;
275
276 if (pdata->burnout_curr_en)
277 st->conf |= AD7192_CONF_BURN;
278
279 ret = ad_sd_write_reg(&st->sd, AD7192_REG_MODE, 3, st->mode);
280 if (ret)
281 goto out;
282
283 ret = ad_sd_write_reg(&st->sd, AD7192_REG_CONF, 3, st->conf);
284 if (ret)
285 goto out;
286
287 ret = ad7192_calibrate_all(st);
288 if (ret)
289 goto out;
290
291
292 for (i = 0; i < ARRAY_SIZE(st->scale_avail); i++) {
293 scale_uv = ((u64)st->int_vref_mv * 100000000)
294 >> (indio_dev->channels[0].scan_type.realbits -
295 ((st->conf & AD7192_CONF_UNIPOLAR) ? 0 : 1));
296 scale_uv >>= i;
297
298 st->scale_avail[i][1] = do_div(scale_uv, 100000000) * 10;
299 st->scale_avail[i][0] = scale_uv;
300 }
301
302 return 0;
303out:
304 dev_err(&st->sd.spi->dev, "setup failed\n");
305 return ret;
306}
307
308static ssize_t ad7192_read_frequency(struct device *dev,
309 struct device_attribute *attr,
310 char *buf)
311{
312 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
313 struct ad7192_state *st = iio_priv(indio_dev);
314
315 return sprintf(buf, "%d\n", st->mclk /
316 (st->f_order * 1024 * AD7192_MODE_RATE(st->mode)));
317}
318
319static ssize_t ad7192_write_frequency(struct device *dev,
320 struct device_attribute *attr,
321 const char *buf,
322 size_t len)
323{
324 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
325 struct ad7192_state *st = iio_priv(indio_dev);
326 unsigned long lval;
327 int div, ret;
328
329 ret = kstrtoul(buf, 10, &lval);
330 if (ret)
331 return ret;
332 if (lval == 0)
333 return -EINVAL;
334
335 mutex_lock(&indio_dev->mlock);
336 if (iio_buffer_enabled(indio_dev)) {
337 mutex_unlock(&indio_dev->mlock);
338 return -EBUSY;
339 }
340
341 div = st->mclk / (lval * st->f_order * 1024);
342 if (div < 1 || div > 1023) {
343 ret = -EINVAL;
344 goto out;
345 }
346
347 st->mode &= ~AD7192_MODE_RATE(-1);
348 st->mode |= AD7192_MODE_RATE(div);
349 ad_sd_write_reg(&st->sd, AD7192_REG_MODE, 3, st->mode);
350
351out:
352 mutex_unlock(&indio_dev->mlock);
353
354 return ret ? ret : len;
355}
356
357static IIO_DEV_ATTR_SAMP_FREQ(S_IWUSR | S_IRUGO,
358 ad7192_read_frequency,
359 ad7192_write_frequency);
360
361static ssize_t
362ad7192_show_scale_available(struct device *dev,
363 struct device_attribute *attr, char *buf)
364{
365 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
366 struct ad7192_state *st = iio_priv(indio_dev);
367 int i, len = 0;
368
369 for (i = 0; i < ARRAY_SIZE(st->scale_avail); i++)
370 len += sprintf(buf + len, "%d.%09u ", st->scale_avail[i][0],
371 st->scale_avail[i][1]);
372
373 len += sprintf(buf + len, "\n");
374
375 return len;
376}
377
378static IIO_DEVICE_ATTR_NAMED(in_v_m_v_scale_available,
379 in_voltage-voltage_scale_available,
380 S_IRUGO, ad7192_show_scale_available, NULL, 0);
381
382static IIO_DEVICE_ATTR(in_voltage_scale_available, S_IRUGO,
383 ad7192_show_scale_available, NULL, 0);
384
385static ssize_t ad7192_show_ac_excitation(struct device *dev,
386 struct device_attribute *attr,
387 char *buf)
388{
389 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
390 struct ad7192_state *st = iio_priv(indio_dev);
391
392 return sprintf(buf, "%d\n", !!(st->mode & AD7192_MODE_ACX));
393}
394
395static ssize_t ad7192_show_bridge_switch(struct device *dev,
396 struct device_attribute *attr,
397 char *buf)
398{
399 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
400 struct ad7192_state *st = iio_priv(indio_dev);
401
402 return sprintf(buf, "%d\n", !!(st->gpocon & AD7192_GPOCON_BPDSW));
403}
404
405static ssize_t ad7192_set(struct device *dev,
406 struct device_attribute *attr,
407 const char *buf,
408 size_t len)
409{
410 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
411 struct ad7192_state *st = iio_priv(indio_dev);
412 struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
413 int ret;
414 bool val;
415
416 ret = strtobool(buf, &val);
417 if (ret < 0)
418 return ret;
419
420 mutex_lock(&indio_dev->mlock);
421 if (iio_buffer_enabled(indio_dev)) {
422 mutex_unlock(&indio_dev->mlock);
423 return -EBUSY;
424 }
425
426 switch ((u32)this_attr->address) {
427 case AD7192_REG_GPOCON:
428 if (val)
429 st->gpocon |= AD7192_GPOCON_BPDSW;
430 else
431 st->gpocon &= ~AD7192_GPOCON_BPDSW;
432
433 ad_sd_write_reg(&st->sd, AD7192_REG_GPOCON, 1, st->gpocon);
434 break;
435 case AD7192_REG_MODE:
436 if (val)
437 st->mode |= AD7192_MODE_ACX;
438 else
439 st->mode &= ~AD7192_MODE_ACX;
440
441 ad_sd_write_reg(&st->sd, AD7192_REG_MODE, 3, st->mode);
442 break;
443 default:
444 ret = -EINVAL;
445 }
446
447 mutex_unlock(&indio_dev->mlock);
448
449 return ret ? ret : len;
450}
451
452static IIO_DEVICE_ATTR(bridge_switch_en, S_IRUGO | S_IWUSR,
453 ad7192_show_bridge_switch, ad7192_set,
454 AD7192_REG_GPOCON);
455
456static IIO_DEVICE_ATTR(ac_excitation_en, S_IRUGO | S_IWUSR,
457 ad7192_show_ac_excitation, ad7192_set,
458 AD7192_REG_MODE);
459
460static struct attribute *ad7192_attributes[] = {
461 &iio_dev_attr_sampling_frequency.dev_attr.attr,
462 &iio_dev_attr_in_v_m_v_scale_available.dev_attr.attr,
463 &iio_dev_attr_in_voltage_scale_available.dev_attr.attr,
464 &iio_dev_attr_bridge_switch_en.dev_attr.attr,
465 &iio_dev_attr_ac_excitation_en.dev_attr.attr,
466 NULL
467};
468
469static const struct attribute_group ad7192_attribute_group = {
470 .attrs = ad7192_attributes,
471};
472
473static struct attribute *ad7195_attributes[] = {
474 &iio_dev_attr_sampling_frequency.dev_attr.attr,
475 &iio_dev_attr_in_v_m_v_scale_available.dev_attr.attr,
476 &iio_dev_attr_in_voltage_scale_available.dev_attr.attr,
477 &iio_dev_attr_bridge_switch_en.dev_attr.attr,
478 NULL
479};
480
481static const struct attribute_group ad7195_attribute_group = {
482 .attrs = ad7195_attributes,
483};
484
485static unsigned int ad7192_get_temp_scale(bool unipolar)
486{
487 return unipolar ? 2815 * 2 : 2815;
488}
489
490static int ad7192_read_raw(struct iio_dev *indio_dev,
491 struct iio_chan_spec const *chan,
492 int *val,
493 int *val2,
494 long m)
495{
496 struct ad7192_state *st = iio_priv(indio_dev);
497 bool unipolar = !!(st->conf & AD7192_CONF_UNIPOLAR);
498
499 switch (m) {
500 case IIO_CHAN_INFO_RAW:
501 return ad_sigma_delta_single_conversion(indio_dev, chan, val);
502 case IIO_CHAN_INFO_SCALE:
503 switch (chan->type) {
504 case IIO_VOLTAGE:
505 mutex_lock(&indio_dev->mlock);
506 *val = st->scale_avail[AD7192_CONF_GAIN(st->conf)][0];
507 *val2 = st->scale_avail[AD7192_CONF_GAIN(st->conf)][1];
508 mutex_unlock(&indio_dev->mlock);
509 return IIO_VAL_INT_PLUS_NANO;
510 case IIO_TEMP:
511 *val = 0;
512 *val2 = 1000000000 / ad7192_get_temp_scale(unipolar);
513 return IIO_VAL_INT_PLUS_NANO;
514 default:
515 return -EINVAL;
516 }
517 case IIO_CHAN_INFO_OFFSET:
518 if (!unipolar)
519 *val = -(1 << (chan->scan_type.realbits - 1));
520 else
521 *val = 0;
522
523 if (chan->type == IIO_TEMP)
524 *val -= 273 * ad7192_get_temp_scale(unipolar);
525 return IIO_VAL_INT;
526 }
527
528 return -EINVAL;
529}
530
531static int ad7192_write_raw(struct iio_dev *indio_dev,
532 struct iio_chan_spec const *chan,
533 int val,
534 int val2,
535 long mask)
536{
537 struct ad7192_state *st = iio_priv(indio_dev);
538 int ret, i;
539 unsigned int tmp;
540
541 mutex_lock(&indio_dev->mlock);
542 if (iio_buffer_enabled(indio_dev)) {
543 mutex_unlock(&indio_dev->mlock);
544 return -EBUSY;
545 }
546
547 switch (mask) {
548 case IIO_CHAN_INFO_SCALE:
549 ret = -EINVAL;
550 for (i = 0; i < ARRAY_SIZE(st->scale_avail); i++)
551 if (val2 == st->scale_avail[i][1]) {
552 ret = 0;
553 tmp = st->conf;
554 st->conf &= ~AD7192_CONF_GAIN(-1);
555 st->conf |= AD7192_CONF_GAIN(i);
556 if (tmp == st->conf)
557 break;
558 ad_sd_write_reg(&st->sd, AD7192_REG_CONF,
559 3, st->conf);
560 ad7192_calibrate_all(st);
561 break;
562 }
563 break;
564 default:
565 ret = -EINVAL;
566 }
567
568 mutex_unlock(&indio_dev->mlock);
569
570 return ret;
571}
572
573static int ad7192_write_raw_get_fmt(struct iio_dev *indio_dev,
574 struct iio_chan_spec const *chan,
575 long mask)
576{
577 return IIO_VAL_INT_PLUS_NANO;
578}
579
580static const struct iio_info ad7192_info = {
581 .read_raw = &ad7192_read_raw,
582 .write_raw = &ad7192_write_raw,
583 .write_raw_get_fmt = &ad7192_write_raw_get_fmt,
584 .attrs = &ad7192_attribute_group,
585 .validate_trigger = ad_sd_validate_trigger,
586 .driver_module = THIS_MODULE,
587};
588
589static const struct iio_info ad7195_info = {
590 .read_raw = &ad7192_read_raw,
591 .write_raw = &ad7192_write_raw,
592 .write_raw_get_fmt = &ad7192_write_raw_get_fmt,
593 .attrs = &ad7195_attribute_group,
594 .validate_trigger = ad_sd_validate_trigger,
595 .driver_module = THIS_MODULE,
596};
597
598static const struct iio_chan_spec ad7192_channels[] = {
599 AD_SD_DIFF_CHANNEL(0, 1, 2, AD7192_CH_AIN1P_AIN2M, 24, 32, 0),
600 AD_SD_DIFF_CHANNEL(1, 3, 4, AD7192_CH_AIN3P_AIN4M, 24, 32, 0),
601 AD_SD_TEMP_CHANNEL(2, AD7192_CH_TEMP, 24, 32, 0),
602 AD_SD_SHORTED_CHANNEL(3, 2, AD7192_CH_AIN2P_AIN2M, 24, 32, 0),
603 AD_SD_CHANNEL(4, 1, AD7192_CH_AIN1, 24, 32, 0),
604 AD_SD_CHANNEL(5, 2, AD7192_CH_AIN2, 24, 32, 0),
605 AD_SD_CHANNEL(6, 3, AD7192_CH_AIN3, 24, 32, 0),
606 AD_SD_CHANNEL(7, 4, AD7192_CH_AIN4, 24, 32, 0),
607 IIO_CHAN_SOFT_TIMESTAMP(8),
608};
609
610static int ad7192_probe(struct spi_device *spi)
611{
612 const struct ad7192_platform_data *pdata = dev_get_platdata(&spi->dev);
613 struct ad7192_state *st;
614 struct iio_dev *indio_dev;
615 int ret, voltage_uv = 0;
616
617 if (!pdata) {
618 dev_err(&spi->dev, "no platform data?\n");
619 return -ENODEV;
620 }
621
622 if (!spi->irq) {
623 dev_err(&spi->dev, "no IRQ?\n");
624 return -ENODEV;
625 }
626
627 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st));
628 if (!indio_dev)
629 return -ENOMEM;
630
631 st = iio_priv(indio_dev);
632
633 st->reg = devm_regulator_get(&spi->dev, "vcc");
634 if (!IS_ERR(st->reg)) {
635 ret = regulator_enable(st->reg);
636 if (ret)
637 return ret;
638
639 voltage_uv = regulator_get_voltage(st->reg);
640 }
641
642 if (pdata->vref_mv)
643 st->int_vref_mv = pdata->vref_mv;
644 else if (voltage_uv)
645 st->int_vref_mv = voltage_uv / 1000;
646 else
647 dev_warn(&spi->dev, "reference voltage undefined\n");
648
649 spi_set_drvdata(spi, indio_dev);
650 st->devid = spi_get_device_id(spi)->driver_data;
651 indio_dev->dev.parent = &spi->dev;
652 indio_dev->name = spi_get_device_id(spi)->name;
653 indio_dev->modes = INDIO_DIRECT_MODE;
654 indio_dev->channels = ad7192_channels;
655 indio_dev->num_channels = ARRAY_SIZE(ad7192_channels);
656 if (st->devid == ID_AD7195)
657 indio_dev->info = &ad7195_info;
658 else
659 indio_dev->info = &ad7192_info;
660
661 ad_sd_init(&st->sd, indio_dev, spi, &ad7192_sigma_delta_info);
662
663 ret = ad_sd_setup_buffer_and_trigger(indio_dev);
664 if (ret)
665 goto error_disable_reg;
666
667 ret = ad7192_setup(st, pdata);
668 if (ret)
669 goto error_remove_trigger;
670
671 ret = iio_device_register(indio_dev);
672 if (ret < 0)
673 goto error_remove_trigger;
674 return 0;
675
676error_remove_trigger:
677 ad_sd_cleanup_buffer_and_trigger(indio_dev);
678error_disable_reg:
679 if (!IS_ERR(st->reg))
680 regulator_disable(st->reg);
681
682 return ret;
683}
684
685static int ad7192_remove(struct spi_device *spi)
686{
687 struct iio_dev *indio_dev = spi_get_drvdata(spi);
688 struct ad7192_state *st = iio_priv(indio_dev);
689
690 iio_device_unregister(indio_dev);
691 ad_sd_cleanup_buffer_and_trigger(indio_dev);
692
693 if (!IS_ERR(st->reg))
694 regulator_disable(st->reg);
695
696 return 0;
697}
698
699static const struct spi_device_id ad7192_id[] = {
700 {"ad7190", ID_AD7190},
701 {"ad7192", ID_AD7192},
702 {"ad7195", ID_AD7195},
703 {}
704};
705MODULE_DEVICE_TABLE(spi, ad7192_id);
706
707static struct spi_driver ad7192_driver = {
708 .driver = {
709 .name = "ad7192",
710 },
711 .probe = ad7192_probe,
712 .remove = ad7192_remove,
713 .id_table = ad7192_id,
714};
715module_spi_driver(ad7192_driver);
716
717MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
718MODULE_DESCRIPTION("Analog Devices AD7190, AD7192, AD7195 ADC");
719MODULE_LICENSE("GPL v2");
720