drm/tests: hdmi: Fix memory leaks in drm_display_mode_from_cea_vic()
[drm/drm-misc.git] / drivers / iio / adc / berlin2-adc.c
blobfa04e0a5f64553b1574968acbcef8cd47746bd74
1 /*
2 * Marvell Berlin2 ADC driver
4 * Copyright (C) 2015 Marvell Technology Group Ltd.
6 * Antoine Tenart <antoine.tenart@free-electrons.com>
8 * This file is licensed under the terms of the GNU General Public
9 * License version 2. This program is licensed "as is" without any
10 * warranty of any kind, whether express or implied.
13 #include <linux/iio/iio.h>
14 #include <linux/iio/driver.h>
15 #include <linux/iio/machine.h>
16 #include <linux/interrupt.h>
17 #include <linux/kernel.h>
18 #include <linux/mod_devicetable.h>
19 #include <linux/module.h>
20 #include <linux/of.h>
21 #include <linux/platform_device.h>
22 #include <linux/slab.h>
23 #include <linux/mfd/syscon.h>
24 #include <linux/regmap.h>
25 #include <linux/sched.h>
26 #include <linux/wait.h>
28 #define BERLIN2_SM_CTRL 0x14
29 #define BERLIN2_SM_CTRL_SM_SOC_INT BIT(1)
30 #define BERLIN2_SM_CTRL_SOC_SM_INT BIT(2)
31 #define BERLIN2_SM_CTRL_ADC_SEL(x) ((x) << 5) /* 0-15 */
32 #define BERLIN2_SM_CTRL_ADC_SEL_MASK GENMASK(8, 5)
33 #define BERLIN2_SM_CTRL_ADC_POWER BIT(9)
34 #define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV2 (0x0 << 10)
35 #define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV3 (0x1 << 10)
36 #define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV4 (0x2 << 10)
37 #define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV8 (0x3 << 10)
38 #define BERLIN2_SM_CTRL_ADC_CLKSEL_MASK GENMASK(11, 10)
39 #define BERLIN2_SM_CTRL_ADC_START BIT(12)
40 #define BERLIN2_SM_CTRL_ADC_RESET BIT(13)
41 #define BERLIN2_SM_CTRL_ADC_BANDGAP_RDY BIT(14)
42 #define BERLIN2_SM_CTRL_ADC_CONT_SINGLE (0x0 << 15)
43 #define BERLIN2_SM_CTRL_ADC_CONT_CONTINUOUS (0x1 << 15)
44 #define BERLIN2_SM_CTRL_ADC_BUFFER_EN BIT(16)
45 #define BERLIN2_SM_CTRL_ADC_VREF_EXT (0x0 << 17)
46 #define BERLIN2_SM_CTRL_ADC_VREF_INT (0x1 << 17)
47 #define BERLIN2_SM_CTRL_ADC_ROTATE BIT(19)
48 #define BERLIN2_SM_CTRL_TSEN_EN BIT(20)
49 #define BERLIN2_SM_CTRL_TSEN_CLK_SEL_125 (0x0 << 21) /* 1.25 MHz */
50 #define BERLIN2_SM_CTRL_TSEN_CLK_SEL_250 (0x1 << 21) /* 2.5 MHz */
51 #define BERLIN2_SM_CTRL_TSEN_MODE_0_125 (0x0 << 22) /* 0-125 C */
52 #define BERLIN2_SM_CTRL_TSEN_MODE_10_50 (0x1 << 22) /* 10-50 C */
53 #define BERLIN2_SM_CTRL_TSEN_RESET BIT(29)
54 #define BERLIN2_SM_ADC_DATA 0x20
55 #define BERLIN2_SM_ADC_MASK GENMASK(9, 0)
56 #define BERLIN2_SM_ADC_STATUS 0x1c
57 #define BERLIN2_SM_ADC_STATUS_DATA_RDY(x) BIT(x) /* 0-15 */
58 #define BERLIN2_SM_ADC_STATUS_DATA_RDY_MASK GENMASK(15, 0)
59 #define BERLIN2_SM_ADC_STATUS_INT_EN(x) (BIT(x) << 16) /* 0-15 */
60 #define BERLIN2_SM_ADC_STATUS_INT_EN_MASK GENMASK(31, 16)
61 #define BERLIN2_SM_TSEN_STATUS 0x24
62 #define BERLIN2_SM_TSEN_STATUS_DATA_RDY BIT(0)
63 #define BERLIN2_SM_TSEN_STATUS_INT_EN BIT(1)
64 #define BERLIN2_SM_TSEN_DATA 0x28
65 #define BERLIN2_SM_TSEN_MASK GENMASK(9, 0)
66 #define BERLIN2_SM_TSEN_CTRL 0x74
67 #define BERLIN2_SM_TSEN_CTRL_START BIT(8)
68 #define BERLIN2_SM_TSEN_CTRL_SETTLING_4 (0x0 << 21) /* 4 us */
69 #define BERLIN2_SM_TSEN_CTRL_SETTLING_12 (0x1 << 21) /* 12 us */
70 #define BERLIN2_SM_TSEN_CTRL_SETTLING_MASK BIT(21)
71 #define BERLIN2_SM_TSEN_CTRL_TRIM(x) ((x) << 22)
72 #define BERLIN2_SM_TSEN_CTRL_TRIM_MASK GENMASK(25, 22)
74 struct berlin2_adc_priv {
75 struct regmap *regmap;
76 struct mutex lock;
77 wait_queue_head_t wq;
78 bool data_available;
79 int data;
82 #define BERLIN2_ADC_CHANNEL(n, t) \
83 { \
84 .channel = n, \
85 .datasheet_name = "channel"#n, \
86 .type = t, \
87 .indexed = 1, \
88 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
91 static const struct iio_chan_spec berlin2_adc_channels[] = {
92 BERLIN2_ADC_CHANNEL(0, IIO_VOLTAGE), /* external input */
93 BERLIN2_ADC_CHANNEL(1, IIO_VOLTAGE), /* external input */
94 BERLIN2_ADC_CHANNEL(2, IIO_VOLTAGE), /* external input */
95 BERLIN2_ADC_CHANNEL(3, IIO_VOLTAGE), /* external input */
96 BERLIN2_ADC_CHANNEL(4, IIO_VOLTAGE), /* reserved */
97 BERLIN2_ADC_CHANNEL(5, IIO_VOLTAGE), /* reserved */
98 { /* temperature sensor */
99 .channel = 6,
100 .datasheet_name = "channel6",
101 .type = IIO_TEMP,
102 .indexed = 0,
103 .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
105 BERLIN2_ADC_CHANNEL(7, IIO_VOLTAGE), /* reserved */
106 IIO_CHAN_SOFT_TIMESTAMP(8), /* timestamp */
109 static int berlin2_adc_read(struct iio_dev *indio_dev, int channel)
111 struct berlin2_adc_priv *priv = iio_priv(indio_dev);
112 int data, ret;
114 mutex_lock(&priv->lock);
116 /* Enable the interrupts */
117 regmap_write(priv->regmap, BERLIN2_SM_ADC_STATUS,
118 BERLIN2_SM_ADC_STATUS_INT_EN(channel));
120 /* Configure the ADC */
121 regmap_update_bits(priv->regmap, BERLIN2_SM_CTRL,
122 BERLIN2_SM_CTRL_ADC_RESET |
123 BERLIN2_SM_CTRL_ADC_SEL_MASK |
124 BERLIN2_SM_CTRL_ADC_START,
125 BERLIN2_SM_CTRL_ADC_SEL(channel) |
126 BERLIN2_SM_CTRL_ADC_START);
128 ret = wait_event_interruptible_timeout(priv->wq, priv->data_available,
129 msecs_to_jiffies(1000));
131 /* Disable the interrupts */
132 regmap_clear_bits(priv->regmap, BERLIN2_SM_ADC_STATUS,
133 BERLIN2_SM_ADC_STATUS_INT_EN(channel));
135 if (ret == 0)
136 ret = -ETIMEDOUT;
137 if (ret < 0) {
138 mutex_unlock(&priv->lock);
139 return ret;
142 regmap_clear_bits(priv->regmap, BERLIN2_SM_CTRL,
143 BERLIN2_SM_CTRL_ADC_START);
145 data = priv->data;
146 priv->data_available = false;
148 mutex_unlock(&priv->lock);
150 return data;
153 static int berlin2_adc_tsen_read(struct iio_dev *indio_dev)
155 struct berlin2_adc_priv *priv = iio_priv(indio_dev);
156 int data, ret;
158 mutex_lock(&priv->lock);
160 /* Enable interrupts */
161 regmap_write(priv->regmap, BERLIN2_SM_TSEN_STATUS,
162 BERLIN2_SM_TSEN_STATUS_INT_EN);
164 /* Configure the ADC */
165 regmap_update_bits(priv->regmap, BERLIN2_SM_CTRL,
166 BERLIN2_SM_CTRL_TSEN_RESET |
167 BERLIN2_SM_CTRL_ADC_ROTATE,
168 BERLIN2_SM_CTRL_ADC_ROTATE);
170 /* Configure the temperature sensor */
171 regmap_update_bits(priv->regmap, BERLIN2_SM_TSEN_CTRL,
172 BERLIN2_SM_TSEN_CTRL_TRIM_MASK |
173 BERLIN2_SM_TSEN_CTRL_SETTLING_MASK |
174 BERLIN2_SM_TSEN_CTRL_START,
175 BERLIN2_SM_TSEN_CTRL_TRIM(3) |
176 BERLIN2_SM_TSEN_CTRL_SETTLING_12 |
177 BERLIN2_SM_TSEN_CTRL_START);
179 ret = wait_event_interruptible_timeout(priv->wq, priv->data_available,
180 msecs_to_jiffies(1000));
182 /* Disable interrupts */
183 regmap_clear_bits(priv->regmap, BERLIN2_SM_TSEN_STATUS,
184 BERLIN2_SM_TSEN_STATUS_INT_EN);
186 if (ret == 0)
187 ret = -ETIMEDOUT;
188 if (ret < 0) {
189 mutex_unlock(&priv->lock);
190 return ret;
193 regmap_clear_bits(priv->regmap, BERLIN2_SM_TSEN_CTRL,
194 BERLIN2_SM_TSEN_CTRL_START);
196 data = priv->data;
197 priv->data_available = false;
199 mutex_unlock(&priv->lock);
201 return data;
204 static int berlin2_adc_read_raw(struct iio_dev *indio_dev,
205 struct iio_chan_spec const *chan, int *val,
206 int *val2, long mask)
208 int temp;
210 switch (mask) {
211 case IIO_CHAN_INFO_RAW:
212 if (chan->type != IIO_VOLTAGE)
213 return -EINVAL;
215 *val = berlin2_adc_read(indio_dev, chan->channel);
216 if (*val < 0)
217 return *val;
219 return IIO_VAL_INT;
220 case IIO_CHAN_INFO_PROCESSED:
221 if (chan->type != IIO_TEMP)
222 return -EINVAL;
224 temp = berlin2_adc_tsen_read(indio_dev);
225 if (temp < 0)
226 return temp;
228 if (temp > 2047)
229 temp -= 4096;
231 /* Convert to milli Celsius */
232 *val = ((temp * 100000) / 264 - 270000);
233 return IIO_VAL_INT;
234 default:
235 break;
238 return -EINVAL;
241 static irqreturn_t berlin2_adc_irq(int irq, void *private)
243 struct berlin2_adc_priv *priv = iio_priv(private);
244 unsigned val;
246 regmap_read(priv->regmap, BERLIN2_SM_ADC_STATUS, &val);
247 if (val & BERLIN2_SM_ADC_STATUS_DATA_RDY_MASK) {
248 regmap_read(priv->regmap, BERLIN2_SM_ADC_DATA, &priv->data);
249 priv->data &= BERLIN2_SM_ADC_MASK;
251 val &= ~BERLIN2_SM_ADC_STATUS_DATA_RDY_MASK;
252 regmap_write(priv->regmap, BERLIN2_SM_ADC_STATUS, val);
254 priv->data_available = true;
255 wake_up_interruptible(&priv->wq);
258 return IRQ_HANDLED;
261 static irqreturn_t berlin2_adc_tsen_irq(int irq, void *private)
263 struct berlin2_adc_priv *priv = iio_priv(private);
264 unsigned val;
266 regmap_read(priv->regmap, BERLIN2_SM_TSEN_STATUS, &val);
267 if (val & BERLIN2_SM_TSEN_STATUS_DATA_RDY) {
268 regmap_read(priv->regmap, BERLIN2_SM_TSEN_DATA, &priv->data);
269 priv->data &= BERLIN2_SM_TSEN_MASK;
271 val &= ~BERLIN2_SM_TSEN_STATUS_DATA_RDY;
272 regmap_write(priv->regmap, BERLIN2_SM_TSEN_STATUS, val);
274 priv->data_available = true;
275 wake_up_interruptible(&priv->wq);
278 return IRQ_HANDLED;
281 static const struct iio_info berlin2_adc_info = {
282 .read_raw = berlin2_adc_read_raw,
285 static void berlin2_adc_powerdown(void *regmap)
287 regmap_clear_bits(regmap, BERLIN2_SM_CTRL, BERLIN2_SM_CTRL_ADC_POWER);
291 static int berlin2_adc_probe(struct platform_device *pdev)
293 struct iio_dev *indio_dev;
294 struct berlin2_adc_priv *priv;
295 struct device_node *parent_np = of_get_parent(pdev->dev.of_node);
296 int irq, tsen_irq;
297 int ret;
299 indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*priv));
300 if (!indio_dev) {
301 of_node_put(parent_np);
302 return -ENOMEM;
305 priv = iio_priv(indio_dev);
307 priv->regmap = syscon_node_to_regmap(parent_np);
308 of_node_put(parent_np);
309 if (IS_ERR(priv->regmap))
310 return PTR_ERR(priv->regmap);
312 irq = platform_get_irq_byname(pdev, "adc");
313 if (irq < 0)
314 return irq;
316 tsen_irq = platform_get_irq_byname(pdev, "tsen");
317 if (tsen_irq < 0)
318 return tsen_irq;
320 ret = devm_request_irq(&pdev->dev, irq, berlin2_adc_irq, 0,
321 pdev->dev.driver->name, indio_dev);
322 if (ret)
323 return ret;
325 ret = devm_request_irq(&pdev->dev, tsen_irq, berlin2_adc_tsen_irq,
326 0, pdev->dev.driver->name, indio_dev);
327 if (ret)
328 return ret;
330 init_waitqueue_head(&priv->wq);
331 mutex_init(&priv->lock);
333 indio_dev->name = dev_name(&pdev->dev);
334 indio_dev->modes = INDIO_DIRECT_MODE;
335 indio_dev->info = &berlin2_adc_info;
337 indio_dev->channels = berlin2_adc_channels;
338 indio_dev->num_channels = ARRAY_SIZE(berlin2_adc_channels);
340 /* Power up the ADC */
341 regmap_set_bits(priv->regmap, BERLIN2_SM_CTRL,
342 BERLIN2_SM_CTRL_ADC_POWER);
344 ret = devm_add_action_or_reset(&pdev->dev, berlin2_adc_powerdown,
345 priv->regmap);
346 if (ret)
347 return ret;
349 return devm_iio_device_register(&pdev->dev, indio_dev);
352 static const struct of_device_id berlin2_adc_match[] = {
353 { .compatible = "marvell,berlin2-adc", },
356 MODULE_DEVICE_TABLE(of, berlin2_adc_match);
358 static struct platform_driver berlin2_adc_driver = {
359 .driver = {
360 .name = "berlin2-adc",
361 .of_match_table = berlin2_adc_match,
363 .probe = berlin2_adc_probe,
365 module_platform_driver(berlin2_adc_driver);
367 MODULE_AUTHOR("Antoine Tenart <antoine.tenart@free-electrons.com>");
368 MODULE_DESCRIPTION("Marvell Berlin2 ADC driver");
369 MODULE_LICENSE("GPL v2");