Linux-libre 5.3.12-gnu
[librecmc/linux-libre.git] / drivers / iio / adc / sun4i-gpadc-iio.c
1 // SPDX-License-Identifier: GPL-2.0
2 /* ADC driver for sunxi platforms' (A10, A13 and A31) GPADC
3  *
4  * Copyright (c) 2016 Quentin Schulz <quentin.schulz@free-electrons.com>
5  *
6  * The Allwinner SoCs all have an ADC that can also act as a touchscreen
7  * controller and a thermal sensor.
8  * The thermal sensor works only when the ADC acts as a touchscreen controller
9  * and is configured to throw an interrupt every fixed periods of time (let say
10  * every X seconds).
11  * One would be tempted to disable the IP on the hardware side rather than
12  * disabling interrupts to save some power but that resets the internal clock of
13  * the IP, resulting in having to wait X seconds every time we want to read the
14  * value of the thermal sensor.
15  * This is also the reason of using autosuspend in pm_runtime. If there was no
16  * autosuspend, the thermal sensor would need X seconds after every
17  * pm_runtime_get_sync to get a value from the ADC. The autosuspend allows the
18  * thermal sensor to be requested again in a certain time span before it gets
19  * shutdown for not being used.
20  */
21
22 #include <linux/completion.h>
23 #include <linux/interrupt.h>
24 #include <linux/io.h>
25 #include <linux/module.h>
26 #include <linux/of.h>
27 #include <linux/of_device.h>
28 #include <linux/platform_device.h>
29 #include <linux/pm_runtime.h>
30 #include <linux/regmap.h>
31 #include <linux/thermal.h>
32 #include <linux/delay.h>
33
34 #include <linux/iio/iio.h>
35 #include <linux/iio/driver.h>
36 #include <linux/iio/machine.h>
37 #include <linux/mfd/sun4i-gpadc.h>
38
39 static unsigned int sun4i_gpadc_chan_select(unsigned int chan)
40 {
41         return SUN4I_GPADC_CTRL1_ADC_CHAN_SELECT(chan);
42 }
43
44 static unsigned int sun6i_gpadc_chan_select(unsigned int chan)
45 {
46         return SUN6I_GPADC_CTRL1_ADC_CHAN_SELECT(chan);
47 }
48
49 struct gpadc_data {
50         int             temp_offset;
51         int             temp_scale;
52         unsigned int    tp_mode_en;
53         unsigned int    tp_adc_select;
54         unsigned int    (*adc_chan_select)(unsigned int chan);
55         unsigned int    adc_chan_mask;
56 };
57
58 static const struct gpadc_data sun4i_gpadc_data = {
59         .temp_offset = -1932,
60         .temp_scale = 133,
61         .tp_mode_en = SUN4I_GPADC_CTRL1_TP_MODE_EN,
62         .tp_adc_select = SUN4I_GPADC_CTRL1_TP_ADC_SELECT,
63         .adc_chan_select = &sun4i_gpadc_chan_select,
64         .adc_chan_mask = SUN4I_GPADC_CTRL1_ADC_CHAN_MASK,
65 };
66
67 static const struct gpadc_data sun5i_gpadc_data = {
68         .temp_offset = -1447,
69         .temp_scale = 100,
70         .tp_mode_en = SUN4I_GPADC_CTRL1_TP_MODE_EN,
71         .tp_adc_select = SUN4I_GPADC_CTRL1_TP_ADC_SELECT,
72         .adc_chan_select = &sun4i_gpadc_chan_select,
73         .adc_chan_mask = SUN4I_GPADC_CTRL1_ADC_CHAN_MASK,
74 };
75
76 static const struct gpadc_data sun6i_gpadc_data = {
77         .temp_offset = -1623,
78         .temp_scale = 167,
79         .tp_mode_en = SUN6I_GPADC_CTRL1_TP_MODE_EN,
80         .tp_adc_select = SUN6I_GPADC_CTRL1_TP_ADC_SELECT,
81         .adc_chan_select = &sun6i_gpadc_chan_select,
82         .adc_chan_mask = SUN6I_GPADC_CTRL1_ADC_CHAN_MASK,
83 };
84
85 static const struct gpadc_data sun8i_a33_gpadc_data = {
86         .temp_offset = -1662,
87         .temp_scale = 162,
88         .tp_mode_en = SUN8I_GPADC_CTRL1_CHOP_TEMP_EN,
89 };
90
91 struct sun4i_gpadc_iio {
92         struct iio_dev                  *indio_dev;
93         struct completion               completion;
94         int                             temp_data;
95         u32                             adc_data;
96         struct regmap                   *regmap;
97         unsigned int                    fifo_data_irq;
98         atomic_t                        ignore_fifo_data_irq;
99         unsigned int                    temp_data_irq;
100         atomic_t                        ignore_temp_data_irq;
101         const struct gpadc_data         *data;
102         bool                            no_irq;
103         /* prevents concurrent reads of temperature and ADC */
104         struct mutex                    mutex;
105         struct thermal_zone_device      *tzd;
106         struct device                   *sensor_device;
107 };
108
109 #define SUN4I_GPADC_ADC_CHANNEL(_channel, _name) {              \
110         .type = IIO_VOLTAGE,                                    \
111         .indexed = 1,                                           \
112         .channel = _channel,                                    \
113         .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),           \
114         .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE),   \
115         .datasheet_name = _name,                                \
116 }
117
118 static struct iio_map sun4i_gpadc_hwmon_maps[] = {
119         {
120                 .adc_channel_label = "temp_adc",
121                 .consumer_dev_name = "iio_hwmon.0",
122         },
123         { /* sentinel */ },
124 };
125
126 static const struct iio_chan_spec sun4i_gpadc_channels[] = {
127         SUN4I_GPADC_ADC_CHANNEL(0, "adc_chan0"),
128         SUN4I_GPADC_ADC_CHANNEL(1, "adc_chan1"),
129         SUN4I_GPADC_ADC_CHANNEL(2, "adc_chan2"),
130         SUN4I_GPADC_ADC_CHANNEL(3, "adc_chan3"),
131         {
132                 .type = IIO_TEMP,
133                 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
134                                       BIT(IIO_CHAN_INFO_SCALE) |
135                                       BIT(IIO_CHAN_INFO_OFFSET),
136                 .datasheet_name = "temp_adc",
137         },
138 };
139
140 static const struct iio_chan_spec sun4i_gpadc_channels_no_temp[] = {
141         SUN4I_GPADC_ADC_CHANNEL(0, "adc_chan0"),
142         SUN4I_GPADC_ADC_CHANNEL(1, "adc_chan1"),
143         SUN4I_GPADC_ADC_CHANNEL(2, "adc_chan2"),
144         SUN4I_GPADC_ADC_CHANNEL(3, "adc_chan3"),
145 };
146
147 static const struct iio_chan_spec sun8i_a33_gpadc_channels[] = {
148         {
149                 .type = IIO_TEMP,
150                 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
151                                       BIT(IIO_CHAN_INFO_SCALE) |
152                                       BIT(IIO_CHAN_INFO_OFFSET),
153                 .datasheet_name = "temp_adc",
154         },
155 };
156
157 static const struct regmap_config sun4i_gpadc_regmap_config = {
158         .reg_bits = 32,
159         .val_bits = 32,
160         .reg_stride = 4,
161         .fast_io = true,
162 };
163
164 static int sun4i_prepare_for_irq(struct iio_dev *indio_dev, int channel,
165                                  unsigned int irq)
166 {
167         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
168         int ret;
169         u32 reg;
170
171         pm_runtime_get_sync(indio_dev->dev.parent);
172
173         reinit_completion(&info->completion);
174
175         ret = regmap_write(info->regmap, SUN4I_GPADC_INT_FIFOC,
176                            SUN4I_GPADC_INT_FIFOC_TP_FIFO_TRIG_LEVEL(1) |
177                            SUN4I_GPADC_INT_FIFOC_TP_FIFO_FLUSH);
178         if (ret)
179                 return ret;
180
181         ret = regmap_read(info->regmap, SUN4I_GPADC_CTRL1, &reg);
182         if (ret)
183                 return ret;
184
185         if (irq == info->fifo_data_irq) {
186                 ret = regmap_write(info->regmap, SUN4I_GPADC_CTRL1,
187                                    info->data->tp_mode_en |
188                                    info->data->tp_adc_select |
189                                    info->data->adc_chan_select(channel));
190                 /*
191                  * When the IP changes channel, it needs a bit of time to get
192                  * correct values.
193                  */
194                 if ((reg & info->data->adc_chan_mask) !=
195                          info->data->adc_chan_select(channel))
196                         mdelay(10);
197
198         } else {
199                 /*
200                  * The temperature sensor returns valid data only when the ADC
201                  * operates in touchscreen mode.
202                  */
203                 ret = regmap_write(info->regmap, SUN4I_GPADC_CTRL1,
204                                    info->data->tp_mode_en);
205         }
206
207         if (ret)
208                 return ret;
209
210         /*
211          * When the IP changes mode between ADC or touchscreen, it
212          * needs a bit of time to get correct values.
213          */
214         if ((reg & info->data->tp_adc_select) != info->data->tp_adc_select)
215                 mdelay(100);
216
217         return 0;
218 }
219
220 static int sun4i_gpadc_read(struct iio_dev *indio_dev, int channel, int *val,
221                             unsigned int irq)
222 {
223         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
224         int ret;
225
226         mutex_lock(&info->mutex);
227
228         ret = sun4i_prepare_for_irq(indio_dev, channel, irq);
229         if (ret)
230                 goto err;
231
232         enable_irq(irq);
233
234         /*
235          * The temperature sensor throws an interruption periodically (currently
236          * set at periods of ~0.6s in sun4i_gpadc_runtime_resume). A 1s delay
237          * makes sure an interruption occurs in normal conditions. If it doesn't
238          * occur, then there is a timeout.
239          */
240         if (!wait_for_completion_timeout(&info->completion,
241                                          msecs_to_jiffies(1000))) {
242                 ret = -ETIMEDOUT;
243                 goto err;
244         }
245
246         if (irq == info->fifo_data_irq)
247                 *val = info->adc_data;
248         else
249                 *val = info->temp_data;
250
251         ret = 0;
252         pm_runtime_mark_last_busy(indio_dev->dev.parent);
253
254 err:
255         pm_runtime_put_autosuspend(indio_dev->dev.parent);
256         disable_irq(irq);
257         mutex_unlock(&info->mutex);
258
259         return ret;
260 }
261
262 static int sun4i_gpadc_adc_read(struct iio_dev *indio_dev, int channel,
263                                 int *val)
264 {
265         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
266
267         return sun4i_gpadc_read(indio_dev, channel, val, info->fifo_data_irq);
268 }
269
270 static int sun4i_gpadc_temp_read(struct iio_dev *indio_dev, int *val)
271 {
272         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
273
274         if (info->no_irq) {
275                 pm_runtime_get_sync(indio_dev->dev.parent);
276
277                 regmap_read(info->regmap, SUN4I_GPADC_TEMP_DATA, val);
278
279                 pm_runtime_mark_last_busy(indio_dev->dev.parent);
280                 pm_runtime_put_autosuspend(indio_dev->dev.parent);
281
282                 return 0;
283         }
284
285         return sun4i_gpadc_read(indio_dev, 0, val, info->temp_data_irq);
286 }
287
288 static int sun4i_gpadc_temp_offset(struct iio_dev *indio_dev, int *val)
289 {
290         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
291
292         *val = info->data->temp_offset;
293
294         return 0;
295 }
296
297 static int sun4i_gpadc_temp_scale(struct iio_dev *indio_dev, int *val)
298 {
299         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
300
301         *val = info->data->temp_scale;
302
303         return 0;
304 }
305
306 static int sun4i_gpadc_read_raw(struct iio_dev *indio_dev,
307                                 struct iio_chan_spec const *chan, int *val,
308                                 int *val2, long mask)
309 {
310         int ret;
311
312         switch (mask) {
313         case IIO_CHAN_INFO_OFFSET:
314                 ret = sun4i_gpadc_temp_offset(indio_dev, val);
315                 if (ret)
316                         return ret;
317
318                 return IIO_VAL_INT;
319         case IIO_CHAN_INFO_RAW:
320                 if (chan->type == IIO_VOLTAGE)
321                         ret = sun4i_gpadc_adc_read(indio_dev, chan->channel,
322                                                    val);
323                 else
324                         ret = sun4i_gpadc_temp_read(indio_dev, val);
325
326                 if (ret)
327                         return ret;
328
329                 return IIO_VAL_INT;
330         case IIO_CHAN_INFO_SCALE:
331                 if (chan->type == IIO_VOLTAGE) {
332                         /* 3000mV / 4096 * raw */
333                         *val = 0;
334                         *val2 = 732421875;
335                         return IIO_VAL_INT_PLUS_NANO;
336                 }
337
338                 ret = sun4i_gpadc_temp_scale(indio_dev, val);
339                 if (ret)
340                         return ret;
341
342                 return IIO_VAL_INT;
343         default:
344                 return -EINVAL;
345         }
346
347         return -EINVAL;
348 }
349
350 static const struct iio_info sun4i_gpadc_iio_info = {
351         .read_raw = sun4i_gpadc_read_raw,
352 };
353
354 static irqreturn_t sun4i_gpadc_temp_data_irq_handler(int irq, void *dev_id)
355 {
356         struct sun4i_gpadc_iio *info = dev_id;
357
358         if (atomic_read(&info->ignore_temp_data_irq))
359                 goto out;
360
361         if (!regmap_read(info->regmap, SUN4I_GPADC_TEMP_DATA, &info->temp_data))
362                 complete(&info->completion);
363
364 out:
365         return IRQ_HANDLED;
366 }
367
368 static irqreturn_t sun4i_gpadc_fifo_data_irq_handler(int irq, void *dev_id)
369 {
370         struct sun4i_gpadc_iio *info = dev_id;
371
372         if (atomic_read(&info->ignore_fifo_data_irq))
373                 goto out;
374
375         if (!regmap_read(info->regmap, SUN4I_GPADC_DATA, &info->adc_data))
376                 complete(&info->completion);
377
378 out:
379         return IRQ_HANDLED;
380 }
381
382 static int sun4i_gpadc_runtime_suspend(struct device *dev)
383 {
384         struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(dev));
385
386         /* Disable the ADC on IP */
387         regmap_write(info->regmap, SUN4I_GPADC_CTRL1, 0);
388         /* Disable temperature sensor on IP */
389         regmap_write(info->regmap, SUN4I_GPADC_TPR, 0);
390
391         return 0;
392 }
393
394 static int sun4i_gpadc_runtime_resume(struct device *dev)
395 {
396         struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(dev));
397
398         /* clkin = 6MHz */
399         regmap_write(info->regmap, SUN4I_GPADC_CTRL0,
400                      SUN4I_GPADC_CTRL0_ADC_CLK_DIVIDER(2) |
401                      SUN4I_GPADC_CTRL0_FS_DIV(7) |
402                      SUN4I_GPADC_CTRL0_T_ACQ(63));
403         regmap_write(info->regmap, SUN4I_GPADC_CTRL1, info->data->tp_mode_en);
404         regmap_write(info->regmap, SUN4I_GPADC_CTRL3,
405                      SUN4I_GPADC_CTRL3_FILTER_EN |
406                      SUN4I_GPADC_CTRL3_FILTER_TYPE(1));
407         /* period = SUN4I_GPADC_TPR_TEMP_PERIOD * 256 * 16 / clkin; ~0.6s */
408         regmap_write(info->regmap, SUN4I_GPADC_TPR,
409                      SUN4I_GPADC_TPR_TEMP_ENABLE |
410                      SUN4I_GPADC_TPR_TEMP_PERIOD(800));
411
412         return 0;
413 }
414
415 static int sun4i_gpadc_get_temp(void *data, int *temp)
416 {
417         struct sun4i_gpadc_iio *info = data;
418         int val, scale, offset;
419
420         if (sun4i_gpadc_temp_read(info->indio_dev, &val))
421                 return -ETIMEDOUT;
422
423         sun4i_gpadc_temp_scale(info->indio_dev, &scale);
424         sun4i_gpadc_temp_offset(info->indio_dev, &offset);
425
426         *temp = (val + offset) * scale;
427
428         return 0;
429 }
430
431 static const struct thermal_zone_of_device_ops sun4i_ts_tz_ops = {
432         .get_temp = &sun4i_gpadc_get_temp,
433 };
434
435 static const struct dev_pm_ops sun4i_gpadc_pm_ops = {
436         .runtime_suspend = &sun4i_gpadc_runtime_suspend,
437         .runtime_resume = &sun4i_gpadc_runtime_resume,
438 };
439
440 static int sun4i_irq_init(struct platform_device *pdev, const char *name,
441                           irq_handler_t handler, const char *devname,
442                           unsigned int *irq, atomic_t *atomic)
443 {
444         int ret;
445         struct sun4i_gpadc_dev *mfd_dev = dev_get_drvdata(pdev->dev.parent);
446         struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(&pdev->dev));
447
448         /*
449          * Once the interrupt is activated, the IP continuously performs
450          * conversions thus throws interrupts. The interrupt is activated right
451          * after being requested but we want to control when these interrupts
452          * occur thus we disable it right after being requested. However, an
453          * interrupt might occur between these two instructions and we have to
454          * make sure that does not happen, by using atomic flags. We set the
455          * flag before requesting the interrupt and unset it right after
456          * disabling the interrupt. When an interrupt occurs between these two
457          * instructions, reading the atomic flag will tell us to ignore the
458          * interrupt.
459          */
460         atomic_set(atomic, 1);
461
462         ret = platform_get_irq_byname(pdev, name);
463         if (ret < 0) {
464                 dev_err(&pdev->dev, "no %s interrupt registered\n", name);
465                 return ret;
466         }
467
468         ret = regmap_irq_get_virq(mfd_dev->regmap_irqc, ret);
469         if (ret < 0) {
470                 dev_err(&pdev->dev, "failed to get virq for irq %s\n", name);
471                 return ret;
472         }
473
474         *irq = ret;
475         ret = devm_request_any_context_irq(&pdev->dev, *irq, handler, 0,
476                                            devname, info);
477         if (ret < 0) {
478                 dev_err(&pdev->dev, "could not request %s interrupt: %d\n",
479                         name, ret);
480                 return ret;
481         }
482
483         disable_irq(*irq);
484         atomic_set(atomic, 0);
485
486         return 0;
487 }
488
489 static const struct of_device_id sun4i_gpadc_of_id[] = {
490         {
491                 .compatible = "allwinner,sun8i-a33-ths",
492                 .data = &sun8i_a33_gpadc_data,
493         },
494         { /* sentinel */ }
495 };
496
497 static int sun4i_gpadc_probe_dt(struct platform_device *pdev,
498                                 struct iio_dev *indio_dev)
499 {
500         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
501         struct resource *mem;
502         void __iomem *base;
503         int ret;
504
505         info->data = of_device_get_match_data(&pdev->dev);
506         if (!info->data)
507                 return -ENODEV;
508
509         info->no_irq = true;
510         indio_dev->num_channels = ARRAY_SIZE(sun8i_a33_gpadc_channels);
511         indio_dev->channels = sun8i_a33_gpadc_channels;
512
513         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
514         base = devm_ioremap_resource(&pdev->dev, mem);
515         if (IS_ERR(base))
516                 return PTR_ERR(base);
517
518         info->regmap = devm_regmap_init_mmio(&pdev->dev, base,
519                                              &sun4i_gpadc_regmap_config);
520         if (IS_ERR(info->regmap)) {
521                 ret = PTR_ERR(info->regmap);
522                 dev_err(&pdev->dev, "failed to init regmap: %d\n", ret);
523                 return ret;
524         }
525
526         if (IS_ENABLED(CONFIG_THERMAL_OF))
527                 info->sensor_device = &pdev->dev;
528
529         return 0;
530 }
531
532 static int sun4i_gpadc_probe_mfd(struct platform_device *pdev,
533                                  struct iio_dev *indio_dev)
534 {
535         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
536         struct sun4i_gpadc_dev *sun4i_gpadc_dev =
537                 dev_get_drvdata(pdev->dev.parent);
538         int ret;
539
540         info->no_irq = false;
541         info->regmap = sun4i_gpadc_dev->regmap;
542
543         indio_dev->num_channels = ARRAY_SIZE(sun4i_gpadc_channels);
544         indio_dev->channels = sun4i_gpadc_channels;
545
546         info->data = (struct gpadc_data *)platform_get_device_id(pdev)->driver_data;
547
548         /*
549          * Since the controller needs to be in touchscreen mode for its thermal
550          * sensor to operate properly, and that switching between the two modes
551          * needs a delay, always registering in the thermal framework will
552          * significantly slow down the conversion rate of the ADCs.
553          *
554          * Therefore, instead of depending on THERMAL_OF in Kconfig, we only
555          * register the sensor if that option is enabled, eventually leaving
556          * that choice to the user.
557          */
558
559         if (IS_ENABLED(CONFIG_THERMAL_OF)) {
560                 /*
561                  * This driver is a child of an MFD which has a node in the DT
562                  * but not its children, because of DT backward compatibility
563                  * for A10, A13 and A31 SoCs. Therefore, the resulting devices
564                  * of this driver do not have an of_node variable.
565                  * However, its parent (the MFD driver) has an of_node variable
566                  * and since devm_thermal_zone_of_sensor_register uses its first
567                  * argument to match the phandle defined in the node of the
568                  * thermal driver with the of_node of the device passed as first
569                  * argument and the third argument to call ops from
570                  * thermal_zone_of_device_ops, the solution is to use the parent
571                  * device as first argument to match the phandle with its
572                  * of_node, and the device from this driver as third argument to
573                  * return the temperature.
574                  */
575                 info->sensor_device = pdev->dev.parent;
576         } else {
577                 indio_dev->num_channels =
578                         ARRAY_SIZE(sun4i_gpadc_channels_no_temp);
579                 indio_dev->channels = sun4i_gpadc_channels_no_temp;
580         }
581
582         if (IS_ENABLED(CONFIG_THERMAL_OF)) {
583                 ret = sun4i_irq_init(pdev, "TEMP_DATA_PENDING",
584                                      sun4i_gpadc_temp_data_irq_handler,
585                                      "temp_data", &info->temp_data_irq,
586                                      &info->ignore_temp_data_irq);
587                 if (ret < 0)
588                         return ret;
589         }
590
591         ret = sun4i_irq_init(pdev, "FIFO_DATA_PENDING",
592                              sun4i_gpadc_fifo_data_irq_handler, "fifo_data",
593                              &info->fifo_data_irq, &info->ignore_fifo_data_irq);
594         if (ret < 0)
595                 return ret;
596
597         if (IS_ENABLED(CONFIG_THERMAL_OF)) {
598                 ret = iio_map_array_register(indio_dev, sun4i_gpadc_hwmon_maps);
599                 if (ret < 0) {
600                         dev_err(&pdev->dev,
601                                 "failed to register iio map array\n");
602                         return ret;
603                 }
604         }
605
606         return 0;
607 }
608
609 static int sun4i_gpadc_probe(struct platform_device *pdev)
610 {
611         struct sun4i_gpadc_iio *info;
612         struct iio_dev *indio_dev;
613         int ret;
614
615         indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*info));
616         if (!indio_dev)
617                 return -ENOMEM;
618
619         info = iio_priv(indio_dev);
620         platform_set_drvdata(pdev, indio_dev);
621
622         mutex_init(&info->mutex);
623         info->indio_dev = indio_dev;
624         init_completion(&info->completion);
625         indio_dev->name = dev_name(&pdev->dev);
626         indio_dev->dev.parent = &pdev->dev;
627         indio_dev->dev.of_node = pdev->dev.of_node;
628         indio_dev->info = &sun4i_gpadc_iio_info;
629         indio_dev->modes = INDIO_DIRECT_MODE;
630
631         if (pdev->dev.of_node)
632                 ret = sun4i_gpadc_probe_dt(pdev, indio_dev);
633         else
634                 ret = sun4i_gpadc_probe_mfd(pdev, indio_dev);
635
636         if (ret)
637                 return ret;
638
639         pm_runtime_set_autosuspend_delay(&pdev->dev,
640                                          SUN4I_GPADC_AUTOSUSPEND_DELAY);
641         pm_runtime_use_autosuspend(&pdev->dev);
642         pm_runtime_set_suspended(&pdev->dev);
643         pm_runtime_enable(&pdev->dev);
644
645         if (IS_ENABLED(CONFIG_THERMAL_OF)) {
646                 info->tzd = thermal_zone_of_sensor_register(info->sensor_device,
647                                                             0, info,
648                                                             &sun4i_ts_tz_ops);
649                 /*
650                  * Do not fail driver probing when failing to register in
651                  * thermal because no thermal DT node is found.
652                  */
653                 if (IS_ERR(info->tzd) && PTR_ERR(info->tzd) != -ENODEV) {
654                         dev_err(&pdev->dev,
655                                 "could not register thermal sensor: %ld\n",
656                                 PTR_ERR(info->tzd));
657                         return PTR_ERR(info->tzd);
658                 }
659         }
660
661         ret = devm_iio_device_register(&pdev->dev, indio_dev);
662         if (ret < 0) {
663                 dev_err(&pdev->dev, "could not register the device\n");
664                 goto err_map;
665         }
666
667         return 0;
668
669 err_map:
670         if (!info->no_irq && IS_ENABLED(CONFIG_THERMAL_OF))
671                 iio_map_array_unregister(indio_dev);
672
673         pm_runtime_put(&pdev->dev);
674         pm_runtime_disable(&pdev->dev);
675
676         return ret;
677 }
678
679 static int sun4i_gpadc_remove(struct platform_device *pdev)
680 {
681         struct iio_dev *indio_dev = platform_get_drvdata(pdev);
682         struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
683
684         pm_runtime_put(&pdev->dev);
685         pm_runtime_disable(&pdev->dev);
686
687         if (!IS_ENABLED(CONFIG_THERMAL_OF))
688                 return 0;
689
690         thermal_zone_of_sensor_unregister(info->sensor_device, info->tzd);
691
692         if (!info->no_irq)
693                 iio_map_array_unregister(indio_dev);
694
695         return 0;
696 }
697
698 static const struct platform_device_id sun4i_gpadc_id[] = {
699         { "sun4i-a10-gpadc-iio", (kernel_ulong_t)&sun4i_gpadc_data },
700         { "sun5i-a13-gpadc-iio", (kernel_ulong_t)&sun5i_gpadc_data },
701         { "sun6i-a31-gpadc-iio", (kernel_ulong_t)&sun6i_gpadc_data },
702         { /* sentinel */ },
703 };
704 MODULE_DEVICE_TABLE(platform, sun4i_gpadc_id);
705
706 static struct platform_driver sun4i_gpadc_driver = {
707         .driver = {
708                 .name = "sun4i-gpadc-iio",
709                 .of_match_table = sun4i_gpadc_of_id,
710                 .pm = &sun4i_gpadc_pm_ops,
711         },
712         .id_table = sun4i_gpadc_id,
713         .probe = sun4i_gpadc_probe,
714         .remove = sun4i_gpadc_remove,
715 };
716 MODULE_DEVICE_TABLE(of, sun4i_gpadc_of_id);
717
718 module_platform_driver(sun4i_gpadc_driver);
719
720 MODULE_DESCRIPTION("ADC driver for sunxi platforms");
721 MODULE_AUTHOR("Quentin Schulz <quentin.schulz@free-electrons.com>");
722 MODULE_LICENSE("GPL v2");