1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/err.h>
12#include <linux/irq.h>
13#include <linux/interrupt.h>
14#include <linux/platform_device.h>
15#include <linux/slab.h>
16#include <linux/delay.h>
17#include <linux/i2c.h>
18#include <linux/pm.h>
19#include <linux/mfd/palmas.h>
20#include <linux/completion.h>
21#include <linux/of.h>
22#include <linux/of_device.h>
23#include <linux/iio/iio.h>
24#include <linux/iio/machine.h>
25#include <linux/iio/driver.h>
26
27#define MOD_NAME "palmas-gpadc"
28#define PALMAS_ADC_CONVERSION_TIMEOUT (msecs_to_jiffies(5000))
29#define PALMAS_TO_BE_CALCULATED 0
30#define PALMAS_GPADC_TRIMINVALID -1
31
32struct palmas_gpadc_info {
33
34 int x1;
35 int x2;
36 int v1;
37 int v2;
38 u8 trim1_reg;
39 u8 trim2_reg;
40 int gain;
41 int offset;
42 int gain_error;
43 bool is_uncalibrated;
44};
45
46#define PALMAS_ADC_INFO(_chan, _x1, _x2, _v1, _v2, _t1, _t2, _is_uncalibrated) \
47 [PALMAS_ADC_CH_##_chan] = { \
48 .x1 = _x1, \
49 .x2 = _x2, \
50 .v1 = _v1, \
51 .v2 = _v2, \
52 .gain = PALMAS_TO_BE_CALCULATED, \
53 .offset = PALMAS_TO_BE_CALCULATED, \
54 .gain_error = PALMAS_TO_BE_CALCULATED, \
55 .trim1_reg = PALMAS_GPADC_TRIM##_t1, \
56 .trim2_reg = PALMAS_GPADC_TRIM##_t2, \
57 .is_uncalibrated = _is_uncalibrated \
58 }
59
60static struct palmas_gpadc_info palmas_gpadc_info[] = {
61 PALMAS_ADC_INFO(IN0, 2064, 3112, 630, 950, 1, 2, false),
62 PALMAS_ADC_INFO(IN1, 2064, 3112, 630, 950, 1, 2, false),
63 PALMAS_ADC_INFO(IN2, 2064, 3112, 1260, 1900, 3, 4, false),
64 PALMAS_ADC_INFO(IN3, 2064, 3112, 630, 950, 1, 2, false),
65 PALMAS_ADC_INFO(IN4, 2064, 3112, 630, 950, 1, 2, false),
66 PALMAS_ADC_INFO(IN5, 2064, 3112, 630, 950, 1, 2, false),
67 PALMAS_ADC_INFO(IN6, 2064, 3112, 2520, 3800, 5, 6, false),
68 PALMAS_ADC_INFO(IN7, 2064, 3112, 2520, 3800, 7, 8, false),
69 PALMAS_ADC_INFO(IN8, 2064, 3112, 3150, 4750, 9, 10, false),
70 PALMAS_ADC_INFO(IN9, 2064, 3112, 5670, 8550, 11, 12, false),
71 PALMAS_ADC_INFO(IN10, 2064, 3112, 3465, 5225, 13, 14, false),
72 PALMAS_ADC_INFO(IN11, 0, 0, 0, 0, INVALID, INVALID, true),
73 PALMAS_ADC_INFO(IN12, 0, 0, 0, 0, INVALID, INVALID, true),
74 PALMAS_ADC_INFO(IN13, 0, 0, 0, 0, INVALID, INVALID, true),
75 PALMAS_ADC_INFO(IN14, 2064, 3112, 3645, 5225, 15, 16, false),
76 PALMAS_ADC_INFO(IN15, 0, 0, 0, 0, INVALID, INVALID, true),
77};
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98struct palmas_gpadc {
99 struct device *dev;
100 struct palmas *palmas;
101 u8 ch0_current;
102 u8 ch3_current;
103 bool extended_delay;
104 int irq;
105 int irq_auto_0;
106 int irq_auto_1;
107 struct palmas_gpadc_info *adc_info;
108 struct completion conv_completion;
109 struct palmas_adc_wakeup_property wakeup1_data;
110 struct palmas_adc_wakeup_property wakeup2_data;
111 bool wakeup1_enable;
112 bool wakeup2_enable;
113 int auto_conversion_period;
114};
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140static int palmas_disable_auto_conversion(struct palmas_gpadc *adc)
141{
142 int ret;
143
144 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
145 PALMAS_GPADC_CTRL1,
146 PALMAS_GPADC_CTRL1_GPADC_FORCE,
147 PALMAS_GPADC_CTRL1_GPADC_FORCE);
148 if (ret < 0) {
149 dev_err(adc->dev, "GPADC_CTRL1 update failed: %d\n", ret);
150 return ret;
151 }
152
153 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
154 PALMAS_GPADC_AUTO_CTRL,
155 PALMAS_GPADC_AUTO_CTRL_SHUTDOWN_CONV1 |
156 PALMAS_GPADC_AUTO_CTRL_SHUTDOWN_CONV0,
157 0);
158 if (ret < 0) {
159 dev_err(adc->dev, "AUTO_CTRL update failed: %d\n", ret);
160 return ret;
161 }
162
163 udelay(100);
164
165 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
166 PALMAS_GPADC_CTRL1,
167 PALMAS_GPADC_CTRL1_GPADC_FORCE, 0);
168 if (ret < 0)
169 dev_err(adc->dev, "GPADC_CTRL1 update failed: %d\n", ret);
170
171 return ret;
172}
173
174static irqreturn_t palmas_gpadc_irq(int irq, void *data)
175{
176 struct palmas_gpadc *adc = data;
177
178 complete(&adc->conv_completion);
179
180 return IRQ_HANDLED;
181}
182
183static irqreturn_t palmas_gpadc_irq_auto(int irq, void *data)
184{
185 struct palmas_gpadc *adc = data;
186
187 dev_dbg(adc->dev, "Threshold interrupt %d occurs\n", irq);
188 palmas_disable_auto_conversion(adc);
189
190 return IRQ_HANDLED;
191}
192
193static int palmas_gpadc_start_mask_interrupt(struct palmas_gpadc *adc,
194 bool mask)
195{
196 int ret;
197
198 if (!mask)
199 ret = palmas_update_bits(adc->palmas, PALMAS_INTERRUPT_BASE,
200 PALMAS_INT3_MASK,
201 PALMAS_INT3_MASK_GPADC_EOC_SW, 0);
202 else
203 ret = palmas_update_bits(adc->palmas, PALMAS_INTERRUPT_BASE,
204 PALMAS_INT3_MASK,
205 PALMAS_INT3_MASK_GPADC_EOC_SW,
206 PALMAS_INT3_MASK_GPADC_EOC_SW);
207 if (ret < 0)
208 dev_err(adc->dev, "GPADC INT MASK update failed: %d\n", ret);
209
210 return ret;
211}
212
213static int palmas_gpadc_enable(struct palmas_gpadc *adc, int adc_chan,
214 int enable)
215{
216 unsigned int mask, val;
217 int ret;
218
219 if (enable) {
220 val = (adc->extended_delay
221 << PALMAS_GPADC_RT_CTRL_EXTEND_DELAY_SHIFT);
222 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
223 PALMAS_GPADC_RT_CTRL,
224 PALMAS_GPADC_RT_CTRL_EXTEND_DELAY, val);
225 if (ret < 0) {
226 dev_err(adc->dev, "RT_CTRL update failed: %d\n", ret);
227 return ret;
228 }
229
230 mask = (PALMAS_GPADC_CTRL1_CURRENT_SRC_CH0_MASK |
231 PALMAS_GPADC_CTRL1_CURRENT_SRC_CH3_MASK |
232 PALMAS_GPADC_CTRL1_GPADC_FORCE);
233 val = (adc->ch0_current
234 << PALMAS_GPADC_CTRL1_CURRENT_SRC_CH0_SHIFT);
235 val |= (adc->ch3_current
236 << PALMAS_GPADC_CTRL1_CURRENT_SRC_CH3_SHIFT);
237 val |= PALMAS_GPADC_CTRL1_GPADC_FORCE;
238 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
239 PALMAS_GPADC_CTRL1, mask, val);
240 if (ret < 0) {
241 dev_err(adc->dev,
242 "Failed to update current setting: %d\n", ret);
243 return ret;
244 }
245
246 mask = (PALMAS_GPADC_SW_SELECT_SW_CONV0_SEL_MASK |
247 PALMAS_GPADC_SW_SELECT_SW_CONV_EN);
248 val = (adc_chan | PALMAS_GPADC_SW_SELECT_SW_CONV_EN);
249 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
250 PALMAS_GPADC_SW_SELECT, mask, val);
251 if (ret < 0) {
252 dev_err(adc->dev, "SW_SELECT update failed: %d\n", ret);
253 return ret;
254 }
255 } else {
256 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
257 PALMAS_GPADC_SW_SELECT, 0);
258 if (ret < 0)
259 dev_err(adc->dev, "SW_SELECT write failed: %d\n", ret);
260
261 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
262 PALMAS_GPADC_CTRL1,
263 PALMAS_GPADC_CTRL1_GPADC_FORCE, 0);
264 if (ret < 0) {
265 dev_err(adc->dev, "CTRL1 update failed: %d\n", ret);
266 return ret;
267 }
268 }
269
270 return ret;
271}
272
273static int palmas_gpadc_read_prepare(struct palmas_gpadc *adc, int adc_chan)
274{
275 int ret;
276
277 ret = palmas_gpadc_enable(adc, adc_chan, true);
278 if (ret < 0)
279 return ret;
280
281 return palmas_gpadc_start_mask_interrupt(adc, 0);
282}
283
284static void palmas_gpadc_read_done(struct palmas_gpadc *adc, int adc_chan)
285{
286 palmas_gpadc_start_mask_interrupt(adc, 1);
287 palmas_gpadc_enable(adc, adc_chan, false);
288}
289
290static int palmas_gpadc_calibrate(struct palmas_gpadc *adc, int adc_chan)
291{
292 int k;
293 int d1;
294 int d2;
295 int ret;
296 int gain;
297 int x1 = adc->adc_info[adc_chan].x1;
298 int x2 = adc->adc_info[adc_chan].x2;
299 int v1 = adc->adc_info[adc_chan].v1;
300 int v2 = adc->adc_info[adc_chan].v2;
301
302 ret = palmas_read(adc->palmas, PALMAS_TRIM_GPADC_BASE,
303 adc->adc_info[adc_chan].trim1_reg, &d1);
304 if (ret < 0) {
305 dev_err(adc->dev, "TRIM read failed: %d\n", ret);
306 goto scrub;
307 }
308
309 ret = palmas_read(adc->palmas, PALMAS_TRIM_GPADC_BASE,
310 adc->adc_info[adc_chan].trim2_reg, &d2);
311 if (ret < 0) {
312 dev_err(adc->dev, "TRIM read failed: %d\n", ret);
313 goto scrub;
314 }
315
316
317 k = (1000 + (1000 * (d2 - d1)) / (x2 - x1));
318
319
320 gain = ((v2 - v1) * 1000) / (x2 - x1);
321
322 adc->adc_info[adc_chan].gain_error = k;
323 adc->adc_info[adc_chan].gain = gain;
324
325 adc->adc_info[adc_chan].offset = (d1 * 1000) - ((k - 1000) * x1);
326
327scrub:
328 return ret;
329}
330
331static int palmas_gpadc_start_conversion(struct palmas_gpadc *adc, int adc_chan)
332{
333 unsigned int val;
334 int ret;
335
336 init_completion(&adc->conv_completion);
337 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
338 PALMAS_GPADC_SW_SELECT,
339 PALMAS_GPADC_SW_SELECT_SW_START_CONV0,
340 PALMAS_GPADC_SW_SELECT_SW_START_CONV0);
341 if (ret < 0) {
342 dev_err(adc->dev, "SELECT_SW_START write failed: %d\n", ret);
343 return ret;
344 }
345
346 ret = wait_for_completion_timeout(&adc->conv_completion,
347 PALMAS_ADC_CONVERSION_TIMEOUT);
348 if (ret == 0) {
349 dev_err(adc->dev, "conversion not completed\n");
350 return -ETIMEDOUT;
351 }
352
353 ret = palmas_bulk_read(adc->palmas, PALMAS_GPADC_BASE,
354 PALMAS_GPADC_SW_CONV0_LSB, &val, 2);
355 if (ret < 0) {
356 dev_err(adc->dev, "SW_CONV0_LSB read failed: %d\n", ret);
357 return ret;
358 }
359
360 ret = val & 0xFFF;
361
362 return ret;
363}
364
365static int palmas_gpadc_get_calibrated_code(struct palmas_gpadc *adc,
366 int adc_chan, int val)
367{
368 if (!adc->adc_info[adc_chan].is_uncalibrated)
369 val = (val*1000 - adc->adc_info[adc_chan].offset) /
370 adc->adc_info[adc_chan].gain_error;
371
372 if (val < 0) {
373 dev_err(adc->dev, "Mismatch with calibration\n");
374 return 0;
375 }
376
377 val = (val * adc->adc_info[adc_chan].gain) / 1000;
378
379 return val;
380}
381
382static int palmas_gpadc_read_raw(struct iio_dev *indio_dev,
383 struct iio_chan_spec const *chan, int *val, int *val2, long mask)
384{
385 struct palmas_gpadc *adc = iio_priv(indio_dev);
386 int adc_chan = chan->channel;
387 int ret = 0;
388
389 if (adc_chan > PALMAS_ADC_CH_MAX)
390 return -EINVAL;
391
392 mutex_lock(&indio_dev->mlock);
393
394 switch (mask) {
395 case IIO_CHAN_INFO_RAW:
396 case IIO_CHAN_INFO_PROCESSED:
397 ret = palmas_gpadc_read_prepare(adc, adc_chan);
398 if (ret < 0)
399 goto out;
400
401 ret = palmas_gpadc_start_conversion(adc, adc_chan);
402 if (ret < 0) {
403 dev_err(adc->dev,
404 "ADC start conversion failed\n");
405 goto out;
406 }
407
408 if (mask == IIO_CHAN_INFO_PROCESSED)
409 ret = palmas_gpadc_get_calibrated_code(
410 adc, adc_chan, ret);
411
412 *val = ret;
413
414 ret = IIO_VAL_INT;
415 goto out;
416 }
417
418 mutex_unlock(&indio_dev->mlock);
419 return ret;
420
421out:
422 palmas_gpadc_read_done(adc, adc_chan);
423 mutex_unlock(&indio_dev->mlock);
424
425 return ret;
426}
427
428static const struct iio_info palmas_gpadc_iio_info = {
429 .read_raw = palmas_gpadc_read_raw,
430};
431
432#define PALMAS_ADC_CHAN_IIO(chan, _type, chan_info) \
433{ \
434 .datasheet_name = PALMAS_DATASHEET_NAME(chan), \
435 .type = _type, \
436 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
437 BIT(chan_info), \
438 .indexed = 1, \
439 .channel = PALMAS_ADC_CH_##chan, \
440}
441
442static const struct iio_chan_spec palmas_gpadc_iio_channel[] = {
443 PALMAS_ADC_CHAN_IIO(IN0, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
444 PALMAS_ADC_CHAN_IIO(IN1, IIO_TEMP, IIO_CHAN_INFO_RAW),
445 PALMAS_ADC_CHAN_IIO(IN2, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
446 PALMAS_ADC_CHAN_IIO(IN3, IIO_TEMP, IIO_CHAN_INFO_RAW),
447 PALMAS_ADC_CHAN_IIO(IN4, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
448 PALMAS_ADC_CHAN_IIO(IN5, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
449 PALMAS_ADC_CHAN_IIO(IN6, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
450 PALMAS_ADC_CHAN_IIO(IN7, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
451 PALMAS_ADC_CHAN_IIO(IN8, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
452 PALMAS_ADC_CHAN_IIO(IN9, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
453 PALMAS_ADC_CHAN_IIO(IN10, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
454 PALMAS_ADC_CHAN_IIO(IN11, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
455 PALMAS_ADC_CHAN_IIO(IN12, IIO_TEMP, IIO_CHAN_INFO_RAW),
456 PALMAS_ADC_CHAN_IIO(IN13, IIO_TEMP, IIO_CHAN_INFO_RAW),
457 PALMAS_ADC_CHAN_IIO(IN14, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
458 PALMAS_ADC_CHAN_IIO(IN15, IIO_VOLTAGE, IIO_CHAN_INFO_PROCESSED),
459};
460
461static int palmas_gpadc_get_adc_dt_data(struct platform_device *pdev,
462 struct palmas_gpadc_platform_data **gpadc_pdata)
463{
464 struct device_node *np = pdev->dev.of_node;
465 struct palmas_gpadc_platform_data *gp_data;
466 int ret;
467 u32 pval;
468
469 gp_data = devm_kzalloc(&pdev->dev, sizeof(*gp_data), GFP_KERNEL);
470 if (!gp_data)
471 return -ENOMEM;
472
473 ret = of_property_read_u32(np, "ti,channel0-current-microamp", &pval);
474 if (!ret)
475 gp_data->ch0_current = pval;
476
477 ret = of_property_read_u32(np, "ti,channel3-current-microamp", &pval);
478 if (!ret)
479 gp_data->ch3_current = pval;
480
481 gp_data->extended_delay = of_property_read_bool(np,
482 "ti,enable-extended-delay");
483
484 *gpadc_pdata = gp_data;
485
486 return 0;
487}
488
489static int palmas_gpadc_probe(struct platform_device *pdev)
490{
491 struct palmas_gpadc *adc;
492 struct palmas_platform_data *pdata;
493 struct palmas_gpadc_platform_data *gpadc_pdata = NULL;
494 struct iio_dev *indio_dev;
495 int ret, i;
496
497 pdata = dev_get_platdata(pdev->dev.parent);
498
499 if (pdata && pdata->gpadc_pdata)
500 gpadc_pdata = pdata->gpadc_pdata;
501
502 if (!gpadc_pdata && pdev->dev.of_node) {
503 ret = palmas_gpadc_get_adc_dt_data(pdev, &gpadc_pdata);
504 if (ret < 0)
505 return ret;
506 }
507 if (!gpadc_pdata)
508 return -EINVAL;
509
510 indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*adc));
511 if (!indio_dev) {
512 dev_err(&pdev->dev, "iio_device_alloc failed\n");
513 return -ENOMEM;
514 }
515
516 adc = iio_priv(indio_dev);
517 adc->dev = &pdev->dev;
518 adc->palmas = dev_get_drvdata(pdev->dev.parent);
519 adc->adc_info = palmas_gpadc_info;
520 init_completion(&adc->conv_completion);
521 dev_set_drvdata(&pdev->dev, indio_dev);
522
523 adc->auto_conversion_period = gpadc_pdata->auto_conversion_period_ms;
524 adc->irq = palmas_irq_get_virq(adc->palmas, PALMAS_GPADC_EOC_SW_IRQ);
525 if (adc->irq < 0) {
526 dev_err(adc->dev,
527 "get virq failed: %d\n", adc->irq);
528 ret = adc->irq;
529 goto out;
530 }
531 ret = request_threaded_irq(adc->irq, NULL,
532 palmas_gpadc_irq,
533 IRQF_ONESHOT, dev_name(adc->dev),
534 adc);
535 if (ret < 0) {
536 dev_err(adc->dev,
537 "request irq %d failed: %d\n", adc->irq, ret);
538 goto out;
539 }
540
541 if (gpadc_pdata->adc_wakeup1_data) {
542 memcpy(&adc->wakeup1_data, gpadc_pdata->adc_wakeup1_data,
543 sizeof(adc->wakeup1_data));
544 adc->wakeup1_enable = true;
545 adc->irq_auto_0 = platform_get_irq(pdev, 1);
546 ret = request_threaded_irq(adc->irq_auto_0, NULL,
547 palmas_gpadc_irq_auto,
548 IRQF_ONESHOT,
549 "palmas-adc-auto-0", adc);
550 if (ret < 0) {
551 dev_err(adc->dev, "request auto0 irq %d failed: %d\n",
552 adc->irq_auto_0, ret);
553 goto out_irq_free;
554 }
555 }
556
557 if (gpadc_pdata->adc_wakeup2_data) {
558 memcpy(&adc->wakeup2_data, gpadc_pdata->adc_wakeup2_data,
559 sizeof(adc->wakeup2_data));
560 adc->wakeup2_enable = true;
561 adc->irq_auto_1 = platform_get_irq(pdev, 2);
562 ret = request_threaded_irq(adc->irq_auto_1, NULL,
563 palmas_gpadc_irq_auto,
564 IRQF_ONESHOT,
565 "palmas-adc-auto-1", adc);
566 if (ret < 0) {
567 dev_err(adc->dev, "request auto1 irq %d failed: %d\n",
568 adc->irq_auto_1, ret);
569 goto out_irq_auto0_free;
570 }
571 }
572
573
574 if (gpadc_pdata->ch0_current <= 1)
575 adc->ch0_current = PALMAS_ADC_CH0_CURRENT_SRC_0;
576 else if (gpadc_pdata->ch0_current <= 5)
577 adc->ch0_current = PALMAS_ADC_CH0_CURRENT_SRC_5;
578 else if (gpadc_pdata->ch0_current <= 15)
579 adc->ch0_current = PALMAS_ADC_CH0_CURRENT_SRC_15;
580 else
581 adc->ch0_current = PALMAS_ADC_CH0_CURRENT_SRC_20;
582
583
584 if (gpadc_pdata->ch3_current <= 1)
585 adc->ch3_current = PALMAS_ADC_CH3_CURRENT_SRC_0;
586 else if (gpadc_pdata->ch3_current <= 10)
587 adc->ch3_current = PALMAS_ADC_CH3_CURRENT_SRC_10;
588 else if (gpadc_pdata->ch3_current <= 400)
589 adc->ch3_current = PALMAS_ADC_CH3_CURRENT_SRC_400;
590 else
591 adc->ch3_current = PALMAS_ADC_CH3_CURRENT_SRC_800;
592
593 adc->extended_delay = gpadc_pdata->extended_delay;
594
595 indio_dev->name = MOD_NAME;
596 indio_dev->dev.parent = &pdev->dev;
597 indio_dev->info = &palmas_gpadc_iio_info;
598 indio_dev->modes = INDIO_DIRECT_MODE;
599 indio_dev->channels = palmas_gpadc_iio_channel;
600 indio_dev->num_channels = ARRAY_SIZE(palmas_gpadc_iio_channel);
601
602 ret = iio_device_register(indio_dev);
603 if (ret < 0) {
604 dev_err(adc->dev, "iio_device_register() failed: %d\n", ret);
605 goto out_irq_auto1_free;
606 }
607
608 device_set_wakeup_capable(&pdev->dev, 1);
609 for (i = 0; i < PALMAS_ADC_CH_MAX; i++) {
610 if (!(adc->adc_info[i].is_uncalibrated))
611 palmas_gpadc_calibrate(adc, i);
612 }
613
614 if (adc->wakeup1_enable || adc->wakeup2_enable)
615 device_wakeup_enable(&pdev->dev);
616
617 return 0;
618
619out_irq_auto1_free:
620 if (gpadc_pdata->adc_wakeup2_data)
621 free_irq(adc->irq_auto_1, adc);
622out_irq_auto0_free:
623 if (gpadc_pdata->adc_wakeup1_data)
624 free_irq(adc->irq_auto_0, adc);
625out_irq_free:
626 free_irq(adc->irq, adc);
627out:
628 return ret;
629}
630
631static int palmas_gpadc_remove(struct platform_device *pdev)
632{
633 struct iio_dev *indio_dev = dev_to_iio_dev(&pdev->dev);
634 struct palmas_gpadc *adc = iio_priv(indio_dev);
635
636 if (adc->wakeup1_enable || adc->wakeup2_enable)
637 device_wakeup_disable(&pdev->dev);
638 iio_device_unregister(indio_dev);
639 free_irq(adc->irq, adc);
640 if (adc->wakeup1_enable)
641 free_irq(adc->irq_auto_0, adc);
642 if (adc->wakeup2_enable)
643 free_irq(adc->irq_auto_1, adc);
644
645 return 0;
646}
647
648#ifdef CONFIG_PM_SLEEP
649static int palmas_adc_wakeup_configure(struct palmas_gpadc *adc)
650{
651 int adc_period, conv;
652 int i;
653 int ch0 = 0, ch1 = 0;
654 int thres;
655 int ret;
656
657 adc_period = adc->auto_conversion_period;
658 for (i = 0; i < 16; ++i) {
659 if (((1000 * (1 << i)) / 32) < adc_period)
660 continue;
661 }
662 if (i > 0)
663 i--;
664 adc_period = i;
665 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
666 PALMAS_GPADC_AUTO_CTRL,
667 PALMAS_GPADC_AUTO_CTRL_COUNTER_CONV_MASK,
668 adc_period);
669 if (ret < 0) {
670 dev_err(adc->dev, "AUTO_CTRL write failed: %d\n", ret);
671 return ret;
672 }
673
674 conv = 0;
675 if (adc->wakeup1_enable) {
676 int polarity;
677
678 ch0 = adc->wakeup1_data.adc_channel_number;
679 conv |= PALMAS_GPADC_AUTO_CTRL_AUTO_CONV0_EN;
680 if (adc->wakeup1_data.adc_high_threshold > 0) {
681 thres = adc->wakeup1_data.adc_high_threshold;
682 polarity = 0;
683 } else {
684 thres = adc->wakeup1_data.adc_low_threshold;
685 polarity = PALMAS_GPADC_THRES_CONV0_MSB_THRES_CONV0_POL;
686 }
687
688 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
689 PALMAS_GPADC_THRES_CONV0_LSB, thres & 0xFF);
690 if (ret < 0) {
691 dev_err(adc->dev,
692 "THRES_CONV0_LSB write failed: %d\n", ret);
693 return ret;
694 }
695
696 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
697 PALMAS_GPADC_THRES_CONV0_MSB,
698 ((thres >> 8) & 0xF) | polarity);
699 if (ret < 0) {
700 dev_err(adc->dev,
701 "THRES_CONV0_MSB write failed: %d\n", ret);
702 return ret;
703 }
704 }
705
706 if (adc->wakeup2_enable) {
707 int polarity;
708
709 ch1 = adc->wakeup2_data.adc_channel_number;
710 conv |= PALMAS_GPADC_AUTO_CTRL_AUTO_CONV1_EN;
711 if (adc->wakeup2_data.adc_high_threshold > 0) {
712 thres = adc->wakeup2_data.adc_high_threshold;
713 polarity = 0;
714 } else {
715 thres = adc->wakeup2_data.adc_low_threshold;
716 polarity = PALMAS_GPADC_THRES_CONV1_MSB_THRES_CONV1_POL;
717 }
718
719 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
720 PALMAS_GPADC_THRES_CONV1_LSB, thres & 0xFF);
721 if (ret < 0) {
722 dev_err(adc->dev,
723 "THRES_CONV1_LSB write failed: %d\n", ret);
724 return ret;
725 }
726
727 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
728 PALMAS_GPADC_THRES_CONV1_MSB,
729 ((thres >> 8) & 0xF) | polarity);
730 if (ret < 0) {
731 dev_err(adc->dev,
732 "THRES_CONV1_MSB write failed: %d\n", ret);
733 return ret;
734 }
735 }
736
737 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
738 PALMAS_GPADC_AUTO_SELECT, (ch1 << 4) | ch0);
739 if (ret < 0) {
740 dev_err(adc->dev, "AUTO_SELECT write failed: %d\n", ret);
741 return ret;
742 }
743
744 ret = palmas_update_bits(adc->palmas, PALMAS_GPADC_BASE,
745 PALMAS_GPADC_AUTO_CTRL,
746 PALMAS_GPADC_AUTO_CTRL_AUTO_CONV1_EN |
747 PALMAS_GPADC_AUTO_CTRL_AUTO_CONV0_EN, conv);
748 if (ret < 0)
749 dev_err(adc->dev, "AUTO_CTRL write failed: %d\n", ret);
750
751 return ret;
752}
753
754static int palmas_adc_wakeup_reset(struct palmas_gpadc *adc)
755{
756 int ret;
757
758 ret = palmas_write(adc->palmas, PALMAS_GPADC_BASE,
759 PALMAS_GPADC_AUTO_SELECT, 0);
760 if (ret < 0) {
761 dev_err(adc->dev, "AUTO_SELECT write failed: %d\n", ret);
762 return ret;
763 }
764
765 ret = palmas_disable_auto_conversion(adc);
766 if (ret < 0)
767 dev_err(adc->dev, "Disable auto conversion failed: %d\n", ret);
768
769 return ret;
770}
771
772static int palmas_gpadc_suspend(struct device *dev)
773{
774 struct iio_dev *indio_dev = dev_get_drvdata(dev);
775 struct palmas_gpadc *adc = iio_priv(indio_dev);
776 int wakeup = adc->wakeup1_enable || adc->wakeup2_enable;
777 int ret;
778
779 if (!device_may_wakeup(dev) || !wakeup)
780 return 0;
781
782 ret = palmas_adc_wakeup_configure(adc);
783 if (ret < 0)
784 return ret;
785
786 if (adc->wakeup1_enable)
787 enable_irq_wake(adc->irq_auto_0);
788
789 if (adc->wakeup2_enable)
790 enable_irq_wake(adc->irq_auto_1);
791
792 return 0;
793}
794
795static int palmas_gpadc_resume(struct device *dev)
796{
797 struct iio_dev *indio_dev = dev_get_drvdata(dev);
798 struct palmas_gpadc *adc = iio_priv(indio_dev);
799 int wakeup = adc->wakeup1_enable || adc->wakeup2_enable;
800 int ret;
801
802 if (!device_may_wakeup(dev) || !wakeup)
803 return 0;
804
805 ret = palmas_adc_wakeup_reset(adc);
806 if (ret < 0)
807 return ret;
808
809 if (adc->wakeup1_enable)
810 disable_irq_wake(adc->irq_auto_0);
811
812 if (adc->wakeup2_enable)
813 disable_irq_wake(adc->irq_auto_1);
814
815 return 0;
816};
817#endif
818
819static const struct dev_pm_ops palmas_pm_ops = {
820 SET_SYSTEM_SLEEP_PM_OPS(palmas_gpadc_suspend,
821 palmas_gpadc_resume)
822};
823
824static const struct of_device_id of_palmas_gpadc_match_tbl[] = {
825 { .compatible = "ti,palmas-gpadc", },
826 { }
827};
828MODULE_DEVICE_TABLE(of, of_palmas_gpadc_match_tbl);
829
830static struct platform_driver palmas_gpadc_driver = {
831 .probe = palmas_gpadc_probe,
832 .remove = palmas_gpadc_remove,
833 .driver = {
834 .name = MOD_NAME,
835 .pm = &palmas_pm_ops,
836 .of_match_table = of_palmas_gpadc_match_tbl,
837 },
838};
839
840static int __init palmas_gpadc_init(void)
841{
842 return platform_driver_register(&palmas_gpadc_driver);
843}
844module_init(palmas_gpadc_init);
845
846static void __exit palmas_gpadc_exit(void)
847{
848 platform_driver_unregister(&palmas_gpadc_driver);
849}
850module_exit(palmas_gpadc_exit);
851
852MODULE_DESCRIPTION("palmas GPADC driver");
853MODULE_AUTHOR("Pradeep Goudagunta<pgoudagunta@nvidia.com>");
854MODULE_ALIAS("platform:palmas-gpadc");
855MODULE_LICENSE("GPL v2");
856
