xref: /OK3568_Linux_fs/kernel/drivers/iio/adc/ad7923.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * AD7904/AD7914/AD7923/AD7924/AD7908/AD7918/AD7928 SPI ADC driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2011 Analog Devices Inc (from AD7923 Driver)
6*4882a593Smuzhiyun  * Copyright 2012 CS Systemes d'Information
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/device.h>
10*4882a593Smuzhiyun #include <linux/kernel.h>
11*4882a593Smuzhiyun #include <linux/slab.h>
12*4882a593Smuzhiyun #include <linux/sysfs.h>
13*4882a593Smuzhiyun #include <linux/spi/spi.h>
14*4882a593Smuzhiyun #include <linux/regulator/consumer.h>
15*4882a593Smuzhiyun #include <linux/err.h>
16*4882a593Smuzhiyun #include <linux/delay.h>
17*4882a593Smuzhiyun #include <linux/module.h>
18*4882a593Smuzhiyun #include <linux/interrupt.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #include <linux/iio/iio.h>
21*4882a593Smuzhiyun #include <linux/iio/sysfs.h>
22*4882a593Smuzhiyun #include <linux/iio/buffer.h>
23*4882a593Smuzhiyun #include <linux/iio/trigger_consumer.h>
24*4882a593Smuzhiyun #include <linux/iio/triggered_buffer.h>
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define AD7923_WRITE_CR		BIT(11)		/* write control register */
27*4882a593Smuzhiyun #define AD7923_RANGE		BIT(1)		/* range to REFin */
28*4882a593Smuzhiyun #define AD7923_CODING		BIT(0)		/* coding is straight binary */
29*4882a593Smuzhiyun #define AD7923_PM_MODE_AS	(1)		/* auto shutdown */
30*4882a593Smuzhiyun #define AD7923_PM_MODE_FS	(2)		/* full shutdown */
31*4882a593Smuzhiyun #define AD7923_PM_MODE_OPS	(3)		/* normal operation */
32*4882a593Smuzhiyun #define AD7923_SEQUENCE_OFF	(0)		/* no sequence fonction */
33*4882a593Smuzhiyun #define AD7923_SEQUENCE_PROTECT	(2)		/* no interrupt write cycle */
34*4882a593Smuzhiyun #define AD7923_SEQUENCE_ON	(3)		/* continuous sequence */
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun #define AD7923_PM_MODE_WRITE(mode)	((mode) << 4)	 /* write mode */
38*4882a593Smuzhiyun #define AD7923_CHANNEL_WRITE(channel)	((channel) << 6) /* write channel */
39*4882a593Smuzhiyun #define AD7923_SEQUENCE_WRITE(sequence)	((((sequence) & 1) << 3) \
40*4882a593Smuzhiyun 					+ (((sequence) & 2) << 9))
41*4882a593Smuzhiyun 						/* write sequence fonction */
42*4882a593Smuzhiyun /* left shift for CR : bit 11 transmit in first */
43*4882a593Smuzhiyun #define AD7923_SHIFT_REGISTER	4
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun /* val = value, dec = left shift, bits = number of bits of the mask */
46*4882a593Smuzhiyun #define EXTRACT(val, dec, bits)		(((val) >> (dec)) & ((1 << (bits)) - 1))
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun struct ad7923_state {
49*4882a593Smuzhiyun 	struct spi_device		*spi;
50*4882a593Smuzhiyun 	struct spi_transfer		ring_xfer[5];
51*4882a593Smuzhiyun 	struct spi_transfer		scan_single_xfer[2];
52*4882a593Smuzhiyun 	struct spi_message		ring_msg;
53*4882a593Smuzhiyun 	struct spi_message		scan_single_msg;
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 	struct regulator		*reg;
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun 	unsigned int			settings;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 	/*
60*4882a593Smuzhiyun 	 * DMA (thus cache coherency maintenance) requires the
61*4882a593Smuzhiyun 	 * transfer buffers to live in their own cache lines.
62*4882a593Smuzhiyun 	 * Ensure rx_buf can be directly used in iio_push_to_buffers_with_timetamp
63*4882a593Smuzhiyun 	 * Length = 8 channels + 4 extra for 8 byte timestamp
64*4882a593Smuzhiyun 	 */
65*4882a593Smuzhiyun 	__be16				rx_buf[12] ____cacheline_aligned;
66*4882a593Smuzhiyun 	__be16				tx_buf[4];
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun struct ad7923_chip_info {
70*4882a593Smuzhiyun 	const struct iio_chan_spec *channels;
71*4882a593Smuzhiyun 	unsigned int num_channels;
72*4882a593Smuzhiyun };
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun enum ad7923_id {
75*4882a593Smuzhiyun 	AD7904,
76*4882a593Smuzhiyun 	AD7914,
77*4882a593Smuzhiyun 	AD7924,
78*4882a593Smuzhiyun 	AD7908,
79*4882a593Smuzhiyun 	AD7918,
80*4882a593Smuzhiyun 	AD7928
81*4882a593Smuzhiyun };
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun #define AD7923_V_CHAN(index, bits)					\
84*4882a593Smuzhiyun 	{								\
85*4882a593Smuzhiyun 		.type = IIO_VOLTAGE,					\
86*4882a593Smuzhiyun 		.indexed = 1,						\
87*4882a593Smuzhiyun 		.channel = index,					\
88*4882a593Smuzhiyun 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),		\
89*4882a593Smuzhiyun 		.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE),	\
90*4882a593Smuzhiyun 		.address = index,					\
91*4882a593Smuzhiyun 		.scan_index = index,					\
92*4882a593Smuzhiyun 		.scan_type = {						\
93*4882a593Smuzhiyun 			.sign = 'u',					\
94*4882a593Smuzhiyun 			.realbits = (bits),				\
95*4882a593Smuzhiyun 			.storagebits = 16,				\
96*4882a593Smuzhiyun 			.shift = 12 - (bits),				\
97*4882a593Smuzhiyun 			.endianness = IIO_BE,				\
98*4882a593Smuzhiyun 		},							\
99*4882a593Smuzhiyun 	}
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun #define DECLARE_AD7923_CHANNELS(name, bits) \
102*4882a593Smuzhiyun const struct iio_chan_spec name ## _channels[] = { \
103*4882a593Smuzhiyun 	AD7923_V_CHAN(0, bits), \
104*4882a593Smuzhiyun 	AD7923_V_CHAN(1, bits), \
105*4882a593Smuzhiyun 	AD7923_V_CHAN(2, bits), \
106*4882a593Smuzhiyun 	AD7923_V_CHAN(3, bits), \
107*4882a593Smuzhiyun 	IIO_CHAN_SOFT_TIMESTAMP(4), \
108*4882a593Smuzhiyun }
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun #define DECLARE_AD7908_CHANNELS(name, bits) \
111*4882a593Smuzhiyun const struct iio_chan_spec name ## _channels[] = { \
112*4882a593Smuzhiyun 	AD7923_V_CHAN(0, bits), \
113*4882a593Smuzhiyun 	AD7923_V_CHAN(1, bits), \
114*4882a593Smuzhiyun 	AD7923_V_CHAN(2, bits), \
115*4882a593Smuzhiyun 	AD7923_V_CHAN(3, bits), \
116*4882a593Smuzhiyun 	AD7923_V_CHAN(4, bits), \
117*4882a593Smuzhiyun 	AD7923_V_CHAN(5, bits), \
118*4882a593Smuzhiyun 	AD7923_V_CHAN(6, bits), \
119*4882a593Smuzhiyun 	AD7923_V_CHAN(7, bits), \
120*4882a593Smuzhiyun 	IIO_CHAN_SOFT_TIMESTAMP(8), \
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun static DECLARE_AD7923_CHANNELS(ad7904, 8);
124*4882a593Smuzhiyun static DECLARE_AD7923_CHANNELS(ad7914, 10);
125*4882a593Smuzhiyun static DECLARE_AD7923_CHANNELS(ad7924, 12);
126*4882a593Smuzhiyun static DECLARE_AD7908_CHANNELS(ad7908, 8);
127*4882a593Smuzhiyun static DECLARE_AD7908_CHANNELS(ad7918, 10);
128*4882a593Smuzhiyun static DECLARE_AD7908_CHANNELS(ad7928, 12);
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun static const struct ad7923_chip_info ad7923_chip_info[] = {
131*4882a593Smuzhiyun 	[AD7904] = {
132*4882a593Smuzhiyun 		.channels = ad7904_channels,
133*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7904_channels),
134*4882a593Smuzhiyun 	},
135*4882a593Smuzhiyun 	[AD7914] = {
136*4882a593Smuzhiyun 		.channels = ad7914_channels,
137*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7914_channels),
138*4882a593Smuzhiyun 	},
139*4882a593Smuzhiyun 	[AD7924] = {
140*4882a593Smuzhiyun 		.channels = ad7924_channels,
141*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7924_channels),
142*4882a593Smuzhiyun 	},
143*4882a593Smuzhiyun 	[AD7908] = {
144*4882a593Smuzhiyun 		.channels = ad7908_channels,
145*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7908_channels),
146*4882a593Smuzhiyun 	},
147*4882a593Smuzhiyun 	[AD7918] = {
148*4882a593Smuzhiyun 		.channels = ad7918_channels,
149*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7918_channels),
150*4882a593Smuzhiyun 	},
151*4882a593Smuzhiyun 	[AD7928] = {
152*4882a593Smuzhiyun 		.channels = ad7928_channels,
153*4882a593Smuzhiyun 		.num_channels = ARRAY_SIZE(ad7928_channels),
154*4882a593Smuzhiyun 	},
155*4882a593Smuzhiyun };
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun /*
158*4882a593Smuzhiyun  * ad7923_update_scan_mode() setup the spi transfer buffer for the new scan mask
159*4882a593Smuzhiyun  */
ad7923_update_scan_mode(struct iio_dev * indio_dev,const unsigned long * active_scan_mask)160*4882a593Smuzhiyun static int ad7923_update_scan_mode(struct iio_dev *indio_dev,
161*4882a593Smuzhiyun 				   const unsigned long *active_scan_mask)
162*4882a593Smuzhiyun {
163*4882a593Smuzhiyun 	struct ad7923_state *st = iio_priv(indio_dev);
164*4882a593Smuzhiyun 	int i, cmd, len;
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	len = 0;
167*4882a593Smuzhiyun 	/*
168*4882a593Smuzhiyun 	 * For this driver the last channel is always the software timestamp so
169*4882a593Smuzhiyun 	 * skip that one.
170*4882a593Smuzhiyun 	 */
171*4882a593Smuzhiyun 	for_each_set_bit(i, active_scan_mask, indio_dev->num_channels - 1) {
172*4882a593Smuzhiyun 		cmd = AD7923_WRITE_CR | AD7923_CHANNEL_WRITE(i) |
173*4882a593Smuzhiyun 			AD7923_SEQUENCE_WRITE(AD7923_SEQUENCE_OFF) |
174*4882a593Smuzhiyun 			st->settings;
175*4882a593Smuzhiyun 		cmd <<= AD7923_SHIFT_REGISTER;
176*4882a593Smuzhiyun 		st->tx_buf[len++] = cpu_to_be16(cmd);
177*4882a593Smuzhiyun 	}
178*4882a593Smuzhiyun 	/* build spi ring message */
179*4882a593Smuzhiyun 	st->ring_xfer[0].tx_buf = &st->tx_buf[0];
180*4882a593Smuzhiyun 	st->ring_xfer[0].len = len;
181*4882a593Smuzhiyun 	st->ring_xfer[0].cs_change = 1;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	spi_message_init(&st->ring_msg);
184*4882a593Smuzhiyun 	spi_message_add_tail(&st->ring_xfer[0], &st->ring_msg);
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	for (i = 0; i < len; i++) {
187*4882a593Smuzhiyun 		st->ring_xfer[i + 1].rx_buf = &st->rx_buf[i];
188*4882a593Smuzhiyun 		st->ring_xfer[i + 1].len = 2;
189*4882a593Smuzhiyun 		st->ring_xfer[i + 1].cs_change = 1;
190*4882a593Smuzhiyun 		spi_message_add_tail(&st->ring_xfer[i + 1], &st->ring_msg);
191*4882a593Smuzhiyun 	}
192*4882a593Smuzhiyun 	/* make sure last transfer cs_change is not set */
193*4882a593Smuzhiyun 	st->ring_xfer[i + 1].cs_change = 0;
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	return 0;
196*4882a593Smuzhiyun }
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun /*
199*4882a593Smuzhiyun  * ad7923_trigger_handler() bh of trigger launched polling to ring buffer
200*4882a593Smuzhiyun  *
201*4882a593Smuzhiyun  * Currently there is no option in this driver to disable the saving of
202*4882a593Smuzhiyun  * timestamps within the ring.
203*4882a593Smuzhiyun  */
ad7923_trigger_handler(int irq,void * p)204*4882a593Smuzhiyun static irqreturn_t ad7923_trigger_handler(int irq, void *p)
205*4882a593Smuzhiyun {
206*4882a593Smuzhiyun 	struct iio_poll_func *pf = p;
207*4882a593Smuzhiyun 	struct iio_dev *indio_dev = pf->indio_dev;
208*4882a593Smuzhiyun 	struct ad7923_state *st = iio_priv(indio_dev);
209*4882a593Smuzhiyun 	int b_sent;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	b_sent = spi_sync(st->spi, &st->ring_msg);
212*4882a593Smuzhiyun 	if (b_sent)
213*4882a593Smuzhiyun 		goto done;
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 	iio_push_to_buffers_with_timestamp(indio_dev, st->rx_buf,
216*4882a593Smuzhiyun 					   iio_get_time_ns(indio_dev));
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun done:
219*4882a593Smuzhiyun 	iio_trigger_notify_done(indio_dev->trig);
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	return IRQ_HANDLED;
222*4882a593Smuzhiyun }
223*4882a593Smuzhiyun 
ad7923_scan_direct(struct ad7923_state * st,unsigned int ch)224*4882a593Smuzhiyun static int ad7923_scan_direct(struct ad7923_state *st, unsigned int ch)
225*4882a593Smuzhiyun {
226*4882a593Smuzhiyun 	int ret, cmd;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	cmd = AD7923_WRITE_CR | AD7923_CHANNEL_WRITE(ch) |
229*4882a593Smuzhiyun 		AD7923_SEQUENCE_WRITE(AD7923_SEQUENCE_OFF) |
230*4882a593Smuzhiyun 		st->settings;
231*4882a593Smuzhiyun 	cmd <<= AD7923_SHIFT_REGISTER;
232*4882a593Smuzhiyun 	st->tx_buf[0] = cpu_to_be16(cmd);
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	ret = spi_sync(st->spi, &st->scan_single_msg);
235*4882a593Smuzhiyun 	if (ret)
236*4882a593Smuzhiyun 		return ret;
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun 	return be16_to_cpu(st->rx_buf[0]);
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun 
ad7923_get_range(struct ad7923_state * st)241*4882a593Smuzhiyun static int ad7923_get_range(struct ad7923_state *st)
242*4882a593Smuzhiyun {
243*4882a593Smuzhiyun 	int vref;
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 	vref = regulator_get_voltage(st->reg);
246*4882a593Smuzhiyun 	if (vref < 0)
247*4882a593Smuzhiyun 		return vref;
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun 	vref /= 1000;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	if (!(st->settings & AD7923_RANGE))
252*4882a593Smuzhiyun 		vref *= 2;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	return vref;
255*4882a593Smuzhiyun }
256*4882a593Smuzhiyun 
ad7923_read_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int * val,int * val2,long m)257*4882a593Smuzhiyun static int ad7923_read_raw(struct iio_dev *indio_dev,
258*4882a593Smuzhiyun 			   struct iio_chan_spec const *chan,
259*4882a593Smuzhiyun 			   int *val,
260*4882a593Smuzhiyun 			   int *val2,
261*4882a593Smuzhiyun 			   long m)
262*4882a593Smuzhiyun {
263*4882a593Smuzhiyun 	int ret;
264*4882a593Smuzhiyun 	struct ad7923_state *st = iio_priv(indio_dev);
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	switch (m) {
267*4882a593Smuzhiyun 	case IIO_CHAN_INFO_RAW:
268*4882a593Smuzhiyun 		ret = iio_device_claim_direct_mode(indio_dev);
269*4882a593Smuzhiyun 		if (ret)
270*4882a593Smuzhiyun 			return ret;
271*4882a593Smuzhiyun 		ret = ad7923_scan_direct(st, chan->address);
272*4882a593Smuzhiyun 		iio_device_release_direct_mode(indio_dev);
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 		if (ret < 0)
275*4882a593Smuzhiyun 			return ret;
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 		if (chan->address == EXTRACT(ret, 12, 4))
278*4882a593Smuzhiyun 			*val = EXTRACT(ret, chan->scan_type.shift,
279*4882a593Smuzhiyun 				       chan->scan_type.realbits);
280*4882a593Smuzhiyun 		else
281*4882a593Smuzhiyun 			return -EIO;
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 		return IIO_VAL_INT;
284*4882a593Smuzhiyun 	case IIO_CHAN_INFO_SCALE:
285*4882a593Smuzhiyun 		ret = ad7923_get_range(st);
286*4882a593Smuzhiyun 		if (ret < 0)
287*4882a593Smuzhiyun 			return ret;
288*4882a593Smuzhiyun 		*val = ret;
289*4882a593Smuzhiyun 		*val2 = chan->scan_type.realbits;
290*4882a593Smuzhiyun 		return IIO_VAL_FRACTIONAL_LOG2;
291*4882a593Smuzhiyun 	}
292*4882a593Smuzhiyun 	return -EINVAL;
293*4882a593Smuzhiyun }
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun static const struct iio_info ad7923_info = {
296*4882a593Smuzhiyun 	.read_raw = &ad7923_read_raw,
297*4882a593Smuzhiyun 	.update_scan_mode = ad7923_update_scan_mode,
298*4882a593Smuzhiyun };
299*4882a593Smuzhiyun 
ad7923_probe(struct spi_device * spi)300*4882a593Smuzhiyun static int ad7923_probe(struct spi_device *spi)
301*4882a593Smuzhiyun {
302*4882a593Smuzhiyun 	struct ad7923_state *st;
303*4882a593Smuzhiyun 	struct iio_dev *indio_dev;
304*4882a593Smuzhiyun 	const struct ad7923_chip_info *info;
305*4882a593Smuzhiyun 	int ret;
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st));
308*4882a593Smuzhiyun 	if (!indio_dev)
309*4882a593Smuzhiyun 		return -ENOMEM;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	st = iio_priv(indio_dev);
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	spi_set_drvdata(spi, indio_dev);
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	st->spi = spi;
316*4882a593Smuzhiyun 	st->settings = AD7923_CODING | AD7923_RANGE |
317*4882a593Smuzhiyun 			AD7923_PM_MODE_WRITE(AD7923_PM_MODE_OPS);
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	info = &ad7923_chip_info[spi_get_device_id(spi)->driver_data];
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 	indio_dev->name = spi_get_device_id(spi)->name;
322*4882a593Smuzhiyun 	indio_dev->modes = INDIO_DIRECT_MODE;
323*4882a593Smuzhiyun 	indio_dev->channels = info->channels;
324*4882a593Smuzhiyun 	indio_dev->num_channels = info->num_channels;
325*4882a593Smuzhiyun 	indio_dev->info = &ad7923_info;
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	/* Setup default message */
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 	st->scan_single_xfer[0].tx_buf = &st->tx_buf[0];
330*4882a593Smuzhiyun 	st->scan_single_xfer[0].len = 2;
331*4882a593Smuzhiyun 	st->scan_single_xfer[0].cs_change = 1;
332*4882a593Smuzhiyun 	st->scan_single_xfer[1].rx_buf = &st->rx_buf[0];
333*4882a593Smuzhiyun 	st->scan_single_xfer[1].len = 2;
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	spi_message_init(&st->scan_single_msg);
336*4882a593Smuzhiyun 	spi_message_add_tail(&st->scan_single_xfer[0], &st->scan_single_msg);
337*4882a593Smuzhiyun 	spi_message_add_tail(&st->scan_single_xfer[1], &st->scan_single_msg);
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	st->reg = devm_regulator_get(&spi->dev, "refin");
340*4882a593Smuzhiyun 	if (IS_ERR(st->reg))
341*4882a593Smuzhiyun 		return PTR_ERR(st->reg);
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	ret = regulator_enable(st->reg);
344*4882a593Smuzhiyun 	if (ret)
345*4882a593Smuzhiyun 		return ret;
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 	ret = iio_triggered_buffer_setup(indio_dev, NULL,
348*4882a593Smuzhiyun 					 &ad7923_trigger_handler, NULL);
349*4882a593Smuzhiyun 	if (ret)
350*4882a593Smuzhiyun 		goto error_disable_reg;
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	ret = iio_device_register(indio_dev);
353*4882a593Smuzhiyun 	if (ret)
354*4882a593Smuzhiyun 		goto error_cleanup_ring;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	return 0;
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun error_cleanup_ring:
359*4882a593Smuzhiyun 	iio_triggered_buffer_cleanup(indio_dev);
360*4882a593Smuzhiyun error_disable_reg:
361*4882a593Smuzhiyun 	regulator_disable(st->reg);
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	return ret;
364*4882a593Smuzhiyun }
365*4882a593Smuzhiyun 
ad7923_remove(struct spi_device * spi)366*4882a593Smuzhiyun static int ad7923_remove(struct spi_device *spi)
367*4882a593Smuzhiyun {
368*4882a593Smuzhiyun 	struct iio_dev *indio_dev = spi_get_drvdata(spi);
369*4882a593Smuzhiyun 	struct ad7923_state *st = iio_priv(indio_dev);
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 	iio_device_unregister(indio_dev);
372*4882a593Smuzhiyun 	iio_triggered_buffer_cleanup(indio_dev);
373*4882a593Smuzhiyun 	regulator_disable(st->reg);
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	return 0;
376*4882a593Smuzhiyun }
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun static const struct spi_device_id ad7923_id[] = {
379*4882a593Smuzhiyun 	{"ad7904", AD7904},
380*4882a593Smuzhiyun 	{"ad7914", AD7914},
381*4882a593Smuzhiyun 	{"ad7923", AD7924},
382*4882a593Smuzhiyun 	{"ad7924", AD7924},
383*4882a593Smuzhiyun 	{"ad7908", AD7908},
384*4882a593Smuzhiyun 	{"ad7918", AD7918},
385*4882a593Smuzhiyun 	{"ad7928", AD7928},
386*4882a593Smuzhiyun 	{}
387*4882a593Smuzhiyun };
388*4882a593Smuzhiyun MODULE_DEVICE_TABLE(spi, ad7923_id);
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun static const struct of_device_id ad7923_of_match[] = {
391*4882a593Smuzhiyun 	{ .compatible = "adi,ad7904", },
392*4882a593Smuzhiyun 	{ .compatible = "adi,ad7914", },
393*4882a593Smuzhiyun 	{ .compatible = "adi,ad7923", },
394*4882a593Smuzhiyun 	{ .compatible = "adi,ad7924", },
395*4882a593Smuzhiyun 	{ .compatible = "adi,ad7908", },
396*4882a593Smuzhiyun 	{ .compatible = "adi,ad7918", },
397*4882a593Smuzhiyun 	{ .compatible = "adi,ad7928", },
398*4882a593Smuzhiyun 	{ },
399*4882a593Smuzhiyun };
400*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, ad7923_of_match);
401*4882a593Smuzhiyun 
402*4882a593Smuzhiyun static struct spi_driver ad7923_driver = {
403*4882a593Smuzhiyun 	.driver = {
404*4882a593Smuzhiyun 		.name	= "ad7923",
405*4882a593Smuzhiyun 		.of_match_table = ad7923_of_match,
406*4882a593Smuzhiyun 	},
407*4882a593Smuzhiyun 	.probe		= ad7923_probe,
408*4882a593Smuzhiyun 	.remove		= ad7923_remove,
409*4882a593Smuzhiyun 	.id_table	= ad7923_id,
410*4882a593Smuzhiyun };
411*4882a593Smuzhiyun module_spi_driver(ad7923_driver);
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun MODULE_AUTHOR("Michael Hennerich <michael.hennerich@analog.com>");
414*4882a593Smuzhiyun MODULE_AUTHOR("Patrick Vasseur <patrick.vasseur@c-s.fr>");
415*4882a593Smuzhiyun MODULE_DESCRIPTION("Analog Devices AD7923 and similar ADC");
416*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
417