drm/tests: hdmi: Fix memory leaks in drm_display_mode_from_cea_vic()
[drm/drm-misc.git] / drivers / iio / adc / imx93_adc.c
blob4ccf4819f1f131f3283bf804424e842705b9bf53
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * NXP i.MX93 ADC driver
5 * Copyright 2023 NXP
6 */
8 #include <linux/bitfield.h>
9 #include <linux/clk.h>
10 #include <linux/completion.h>
11 #include <linux/err.h>
12 #include <linux/iio/iio.h>
13 #include <linux/interrupt.h>
14 #include <linux/io.h>
15 #include <linux/iopoll.h>
16 #include <linux/mod_devicetable.h>
17 #include <linux/module.h>
18 #include <linux/platform_device.h>
19 #include <linux/pm_runtime.h>
20 #include <linux/regulator/consumer.h>
22 #define IMX93_ADC_DRIVER_NAME "imx93-adc"
24 /* Register map definition */
25 #define IMX93_ADC_MCR 0x00
26 #define IMX93_ADC_MSR 0x04
27 #define IMX93_ADC_ISR 0x10
28 #define IMX93_ADC_IMR 0x20
29 #define IMX93_ADC_CIMR0 0x24
30 #define IMX93_ADC_CTR0 0x94
31 #define IMX93_ADC_NCMR0 0xA4
32 #define IMX93_ADC_PCDR0 0x100
33 #define IMX93_ADC_PCDR1 0x104
34 #define IMX93_ADC_PCDR2 0x108
35 #define IMX93_ADC_PCDR3 0x10c
36 #define IMX93_ADC_PCDR4 0x110
37 #define IMX93_ADC_PCDR5 0x114
38 #define IMX93_ADC_PCDR6 0x118
39 #define IMX93_ADC_PCDR7 0x11c
40 #define IMX93_ADC_CALSTAT 0x39C
42 /* ADC bit shift */
43 #define IMX93_ADC_MCR_MODE_MASK BIT(29)
44 #define IMX93_ADC_MCR_NSTART_MASK BIT(24)
45 #define IMX93_ADC_MCR_CALSTART_MASK BIT(14)
46 #define IMX93_ADC_MCR_ADCLKSE_MASK BIT(8)
47 #define IMX93_ADC_MCR_PWDN_MASK BIT(0)
48 #define IMX93_ADC_MSR_CALFAIL_MASK BIT(30)
49 #define IMX93_ADC_MSR_CALBUSY_MASK BIT(29)
50 #define IMX93_ADC_MSR_ADCSTATUS_MASK GENMASK(2, 0)
51 #define IMX93_ADC_ISR_ECH_MASK BIT(0)
52 #define IMX93_ADC_ISR_EOC_MASK BIT(1)
53 #define IMX93_ADC_ISR_EOC_ECH_MASK (IMX93_ADC_ISR_EOC_MASK | \
54 IMX93_ADC_ISR_ECH_MASK)
55 #define IMX93_ADC_IMR_JEOC_MASK BIT(3)
56 #define IMX93_ADC_IMR_JECH_MASK BIT(2)
57 #define IMX93_ADC_IMR_EOC_MASK BIT(1)
58 #define IMX93_ADC_IMR_ECH_MASK BIT(0)
59 #define IMX93_ADC_PCDR_CDATA_MASK GENMASK(11, 0)
61 /* ADC status */
62 #define IMX93_ADC_MSR_ADCSTATUS_IDLE 0
63 #define IMX93_ADC_MSR_ADCSTATUS_POWER_DOWN 1
64 #define IMX93_ADC_MSR_ADCSTATUS_WAIT_STATE 2
65 #define IMX93_ADC_MSR_ADCSTATUS_BUSY_IN_CALIBRATION 3
66 #define IMX93_ADC_MSR_ADCSTATUS_SAMPLE 4
67 #define IMX93_ADC_MSR_ADCSTATUS_CONVERSION 6
69 #define IMX93_ADC_TIMEOUT msecs_to_jiffies(100)
71 struct imx93_adc {
72 struct device *dev;
73 void __iomem *regs;
74 struct clk *ipg_clk;
75 int irq;
76 struct regulator *vref;
77 /* lock to protect against multiple access to the device */
78 struct mutex lock;
79 struct completion completion;
82 #define IMX93_ADC_CHAN(_idx) { \
83 .type = IIO_VOLTAGE, \
84 .indexed = 1, \
85 .channel = (_idx), \
86 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
87 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
88 BIT(IIO_CHAN_INFO_SAMP_FREQ), \
91 static const struct iio_chan_spec imx93_adc_iio_channels[] = {
92 IMX93_ADC_CHAN(0),
93 IMX93_ADC_CHAN(1),
94 IMX93_ADC_CHAN(2),
95 IMX93_ADC_CHAN(3),
96 IMX93_ADC_CHAN(4),
97 IMX93_ADC_CHAN(5),
98 IMX93_ADC_CHAN(6),
99 IMX93_ADC_CHAN(7),
102 static void imx93_adc_power_down(struct imx93_adc *adc)
104 u32 mcr, msr;
105 int ret;
107 mcr = readl(adc->regs + IMX93_ADC_MCR);
108 mcr |= FIELD_PREP(IMX93_ADC_MCR_PWDN_MASK, 1);
109 writel(mcr, adc->regs + IMX93_ADC_MCR);
111 ret = readl_poll_timeout(adc->regs + IMX93_ADC_MSR, msr,
112 ((msr & IMX93_ADC_MSR_ADCSTATUS_MASK) ==
113 IMX93_ADC_MSR_ADCSTATUS_POWER_DOWN),
114 1, 50);
115 if (ret == -ETIMEDOUT)
116 dev_warn(adc->dev,
117 "ADC do not in power down mode, current MSR is %x\n",
118 msr);
121 static void imx93_adc_power_up(struct imx93_adc *adc)
123 u32 mcr;
125 /* bring ADC out of power down state, in idle state */
126 mcr = readl(adc->regs + IMX93_ADC_MCR);
127 mcr &= ~FIELD_PREP(IMX93_ADC_MCR_PWDN_MASK, 1);
128 writel(mcr, adc->regs + IMX93_ADC_MCR);
131 static void imx93_adc_config_ad_clk(struct imx93_adc *adc)
133 u32 mcr;
135 /* put adc in power down mode */
136 imx93_adc_power_down(adc);
138 /* config the AD_CLK equal to bus clock */
139 mcr = readl(adc->regs + IMX93_ADC_MCR);
140 mcr |= FIELD_PREP(IMX93_ADC_MCR_ADCLKSE_MASK, 1);
141 writel(mcr, adc->regs + IMX93_ADC_MCR);
143 imx93_adc_power_up(adc);
146 static int imx93_adc_calibration(struct imx93_adc *adc)
148 u32 mcr, msr;
149 int ret;
151 /* make sure ADC in power down mode */
152 imx93_adc_power_down(adc);
154 /* config SAR controller operating clock */
155 mcr = readl(adc->regs + IMX93_ADC_MCR);
156 mcr &= ~FIELD_PREP(IMX93_ADC_MCR_ADCLKSE_MASK, 1);
157 writel(mcr, adc->regs + IMX93_ADC_MCR);
159 imx93_adc_power_up(adc);
162 * TODO: we use the default TSAMP/NRSMPL/AVGEN in MCR,
163 * can add the setting of these bit if need in future.
166 /* run calibration */
167 mcr = readl(adc->regs + IMX93_ADC_MCR);
168 mcr |= FIELD_PREP(IMX93_ADC_MCR_CALSTART_MASK, 1);
169 writel(mcr, adc->regs + IMX93_ADC_MCR);
171 /* wait calibration to be finished */
172 ret = readl_poll_timeout(adc->regs + IMX93_ADC_MSR, msr,
173 !(msr & IMX93_ADC_MSR_CALBUSY_MASK), 1000, 2000000);
174 if (ret == -ETIMEDOUT) {
175 dev_warn(adc->dev, "ADC do not finish calibration in 2 min!\n");
176 imx93_adc_power_down(adc);
177 return ret;
180 /* check whether calbration is success or not */
181 msr = readl(adc->regs + IMX93_ADC_MSR);
182 if (msr & IMX93_ADC_MSR_CALFAIL_MASK) {
183 dev_warn(adc->dev, "ADC calibration failed!\n");
184 imx93_adc_power_down(adc);
185 return -EAGAIN;
188 return 0;
191 static int imx93_adc_read_channel_conversion(struct imx93_adc *adc,
192 int channel_number,
193 int *result)
195 u32 channel;
196 u32 imr, mcr, pcda;
197 long ret;
199 reinit_completion(&adc->completion);
201 /* config channel mask register */
202 channel = 1 << channel_number;
203 writel(channel, adc->regs + IMX93_ADC_NCMR0);
205 /* TODO: can config desired sample time in CTRn if need */
207 /* config interrupt mask */
208 imr = FIELD_PREP(IMX93_ADC_IMR_EOC_MASK, 1);
209 writel(imr, adc->regs + IMX93_ADC_IMR);
210 writel(channel, adc->regs + IMX93_ADC_CIMR0);
212 /* config one-shot mode */
213 mcr = readl(adc->regs + IMX93_ADC_MCR);
214 mcr &= ~FIELD_PREP(IMX93_ADC_MCR_MODE_MASK, 1);
215 writel(mcr, adc->regs + IMX93_ADC_MCR);
217 /* start normal conversion */
218 mcr = readl(adc->regs + IMX93_ADC_MCR);
219 mcr |= FIELD_PREP(IMX93_ADC_MCR_NSTART_MASK, 1);
220 writel(mcr, adc->regs + IMX93_ADC_MCR);
222 ret = wait_for_completion_interruptible_timeout(&adc->completion,
223 IMX93_ADC_TIMEOUT);
224 if (ret == 0)
225 return -ETIMEDOUT;
227 if (ret < 0)
228 return ret;
230 pcda = readl(adc->regs + IMX93_ADC_PCDR0 + channel_number * 4);
232 *result = FIELD_GET(IMX93_ADC_PCDR_CDATA_MASK, pcda);
234 return ret;
237 static int imx93_adc_read_raw(struct iio_dev *indio_dev,
238 struct iio_chan_spec const *chan,
239 int *val, int *val2, long mask)
241 struct imx93_adc *adc = iio_priv(indio_dev);
242 struct device *dev = adc->dev;
243 int ret;
245 switch (mask) {
246 case IIO_CHAN_INFO_RAW:
247 pm_runtime_get_sync(dev);
248 mutex_lock(&adc->lock);
249 ret = imx93_adc_read_channel_conversion(adc, chan->channel, val);
250 mutex_unlock(&adc->lock);
251 pm_runtime_mark_last_busy(dev);
252 pm_runtime_put_sync_autosuspend(dev);
253 if (ret < 0)
254 return ret;
256 return IIO_VAL_INT;
258 case IIO_CHAN_INFO_SCALE:
259 ret = regulator_get_voltage(adc->vref);
260 if (ret < 0)
261 return ret;
262 *val = ret / 1000;
263 *val2 = 12;
264 return IIO_VAL_FRACTIONAL_LOG2;
266 case IIO_CHAN_INFO_SAMP_FREQ:
267 *val = clk_get_rate(adc->ipg_clk);
268 return IIO_VAL_INT;
270 default:
271 return -EINVAL;
275 static irqreturn_t imx93_adc_isr(int irq, void *dev_id)
277 struct imx93_adc *adc = dev_id;
278 u32 isr, eoc, unexpected;
280 isr = readl(adc->regs + IMX93_ADC_ISR);
282 if (FIELD_GET(IMX93_ADC_ISR_EOC_ECH_MASK, isr)) {
283 eoc = isr & IMX93_ADC_ISR_EOC_ECH_MASK;
284 writel(eoc, adc->regs + IMX93_ADC_ISR);
285 complete(&adc->completion);
288 unexpected = isr & ~IMX93_ADC_ISR_EOC_ECH_MASK;
289 if (unexpected) {
290 writel(unexpected, adc->regs + IMX93_ADC_ISR);
291 dev_err(adc->dev, "Unexpected interrupt 0x%08x.\n", unexpected);
292 return IRQ_NONE;
295 return IRQ_HANDLED;
298 static const struct iio_info imx93_adc_iio_info = {
299 .read_raw = &imx93_adc_read_raw,
302 static int imx93_adc_probe(struct platform_device *pdev)
304 struct imx93_adc *adc;
305 struct iio_dev *indio_dev;
306 struct device *dev = &pdev->dev;
307 int ret;
309 indio_dev = devm_iio_device_alloc(dev, sizeof(*adc));
310 if (!indio_dev)
311 return dev_err_probe(dev, -ENOMEM,
312 "Failed allocating iio device\n");
314 adc = iio_priv(indio_dev);
315 adc->dev = dev;
317 mutex_init(&adc->lock);
318 adc->regs = devm_platform_ioremap_resource(pdev, 0);
319 if (IS_ERR(adc->regs))
320 return dev_err_probe(dev, PTR_ERR(adc->regs),
321 "Failed getting ioremap resource\n");
323 /* The third irq is for ADC conversion usage */
324 adc->irq = platform_get_irq(pdev, 2);
325 if (adc->irq < 0)
326 return adc->irq;
328 adc->ipg_clk = devm_clk_get(dev, "ipg");
329 if (IS_ERR(adc->ipg_clk))
330 return dev_err_probe(dev, PTR_ERR(adc->ipg_clk),
331 "Failed getting clock.\n");
333 adc->vref = devm_regulator_get(dev, "vref");
334 if (IS_ERR(adc->vref))
335 return dev_err_probe(dev, PTR_ERR(adc->vref),
336 "Failed getting reference voltage.\n");
338 ret = regulator_enable(adc->vref);
339 if (ret)
340 return dev_err_probe(dev, ret,
341 "Failed to enable reference voltage.\n");
343 platform_set_drvdata(pdev, indio_dev);
345 init_completion(&adc->completion);
347 indio_dev->name = "imx93-adc";
348 indio_dev->info = &imx93_adc_iio_info;
349 indio_dev->modes = INDIO_DIRECT_MODE;
350 indio_dev->channels = imx93_adc_iio_channels;
351 indio_dev->num_channels = ARRAY_SIZE(imx93_adc_iio_channels);
353 ret = clk_prepare_enable(adc->ipg_clk);
354 if (ret) {
355 dev_err_probe(dev, ret,
356 "Failed to enable ipg clock.\n");
357 goto error_regulator_disable;
360 ret = request_irq(adc->irq, imx93_adc_isr, 0, IMX93_ADC_DRIVER_NAME, adc);
361 if (ret < 0) {
362 dev_err_probe(dev, ret,
363 "Failed requesting irq, irq = %d\n", adc->irq);
364 goto error_ipg_clk_disable;
367 ret = imx93_adc_calibration(adc);
368 if (ret < 0)
369 goto error_free_adc_irq;
371 imx93_adc_config_ad_clk(adc);
373 ret = iio_device_register(indio_dev);
374 if (ret) {
375 dev_err_probe(dev, ret,
376 "Failed to register this iio device.\n");
377 goto error_adc_power_down;
380 pm_runtime_set_active(dev);
381 pm_runtime_set_autosuspend_delay(dev, 50);
382 pm_runtime_use_autosuspend(dev);
383 pm_runtime_enable(dev);
385 return 0;
387 error_adc_power_down:
388 imx93_adc_power_down(adc);
389 error_free_adc_irq:
390 free_irq(adc->irq, adc);
391 error_ipg_clk_disable:
392 clk_disable_unprepare(adc->ipg_clk);
393 error_regulator_disable:
394 regulator_disable(adc->vref);
396 return ret;
399 static void imx93_adc_remove(struct platform_device *pdev)
401 struct iio_dev *indio_dev = platform_get_drvdata(pdev);
402 struct imx93_adc *adc = iio_priv(indio_dev);
403 struct device *dev = adc->dev;
405 /* adc power down need clock on */
406 pm_runtime_get_sync(dev);
408 pm_runtime_disable(dev);
409 pm_runtime_dont_use_autosuspend(dev);
410 pm_runtime_put_noidle(dev);
412 iio_device_unregister(indio_dev);
413 imx93_adc_power_down(adc);
414 free_irq(adc->irq, adc);
415 clk_disable_unprepare(adc->ipg_clk);
416 regulator_disable(adc->vref);
419 static int imx93_adc_runtime_suspend(struct device *dev)
421 struct iio_dev *indio_dev = dev_get_drvdata(dev);
422 struct imx93_adc *adc = iio_priv(indio_dev);
424 imx93_adc_power_down(adc);
425 clk_disable_unprepare(adc->ipg_clk);
426 regulator_disable(adc->vref);
428 return 0;
431 static int imx93_adc_runtime_resume(struct device *dev)
433 struct iio_dev *indio_dev = dev_get_drvdata(dev);
434 struct imx93_adc *adc = iio_priv(indio_dev);
435 int ret;
437 ret = regulator_enable(adc->vref);
438 if (ret) {
439 dev_err(dev,
440 "Can't enable adc reference top voltage, err = %d\n",
441 ret);
442 return ret;
445 ret = clk_prepare_enable(adc->ipg_clk);
446 if (ret) {
447 dev_err(dev, "Could not prepare or enable clock.\n");
448 goto err_disable_reg;
451 imx93_adc_power_up(adc);
453 return 0;
455 err_disable_reg:
456 regulator_disable(adc->vref);
458 return ret;
461 static DEFINE_RUNTIME_DEV_PM_OPS(imx93_adc_pm_ops,
462 imx93_adc_runtime_suspend,
463 imx93_adc_runtime_resume, NULL);
465 static const struct of_device_id imx93_adc_match[] = {
466 { .compatible = "nxp,imx93-adc", },
467 { /* sentinel */ }
469 MODULE_DEVICE_TABLE(of, imx93_adc_match);
471 static struct platform_driver imx93_adc_driver = {
472 .probe = imx93_adc_probe,
473 .remove_new = imx93_adc_remove,
474 .driver = {
475 .name = IMX93_ADC_DRIVER_NAME,
476 .of_match_table = imx93_adc_match,
477 .pm = pm_ptr(&imx93_adc_pm_ops),
481 module_platform_driver(imx93_adc_driver);
483 MODULE_DESCRIPTION("NXP i.MX93 ADC driver");
484 MODULE_AUTHOR("Haibo Chen <haibo.chen@nxp.com>");
485 MODULE_LICENSE("GPL");