1
2
3
4
5
6
7
8#include <common.h>
9#include <errno.h>
10#include <dm.h>
11#include <dm/lists.h>
12#include <dm/device-internal.h>
13#include <dm/uclass-internal.h>
14#include <adc.h>
15#include <power/regulator.h>
16
17DECLARE_GLOBAL_DATA_PTR;
18
19#define ADC_UCLASS_PLATDATA_SIZE sizeof(struct adc_uclass_platdata)
20#define CHECK_NUMBER true
21#define CHECK_MASK (!CHECK_NUMBER)
22
23
24#ifdef CONFIG_SANDBOX_ARCH
25#define sdelay(x) udelay(x)
26#else
27extern void sdelay(unsigned long loops);
28#endif
29
30static int check_channel(struct udevice *dev, int value, bool number_or_mask,
31 const char *caller_function)
32{
33 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
34 unsigned mask = number_or_mask ? (1 << value) : value;
35
36
37
38
39
40
41 if ((uc_pdata->channel_mask >= mask) && (uc_pdata->channel_mask & mask))
42 return 0;
43
44 printf("Error in %s/%s().\nWrong channel selection for device: %s\n",
45 __FILE__, caller_function, dev->name);
46
47 return -EINVAL;
48}
49
50static int adc_supply_enable(struct udevice *dev)
51{
52 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
53 const char *supply_type;
54 int ret = 0;
55
56 if (uc_pdata->vdd_supply) {
57 supply_type = "vdd";
58 ret = regulator_set_enable(uc_pdata->vdd_supply, true);
59 }
60
61 if (!ret && uc_pdata->vss_supply) {
62 supply_type = "vss";
63 ret = regulator_set_enable(uc_pdata->vss_supply, true);
64 }
65
66 if (ret)
67 pr_err("%s: can't enable %s-supply!", dev->name, supply_type);
68
69 return ret;
70}
71
72int adc_data_mask(struct udevice *dev, unsigned int *data_mask)
73{
74 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
75
76 if (!uc_pdata)
77 return -ENOSYS;
78
79 *data_mask = uc_pdata->data_mask;
80 return 0;
81}
82
83int adc_stop(struct udevice *dev)
84{
85 const struct adc_ops *ops = dev_get_driver_ops(dev);
86
87 if (!ops->stop)
88 return -ENOSYS;
89
90 return ops->stop(dev);
91}
92
93int adc_start_channel(struct udevice *dev, int channel)
94{
95 const struct adc_ops *ops = dev_get_driver_ops(dev);
96 int ret;
97
98 if (!ops->start_channel)
99 return -ENOSYS;
100
101 ret = check_channel(dev, channel, CHECK_NUMBER, __func__);
102 if (ret)
103 return ret;
104
105 ret = adc_supply_enable(dev);
106 if (ret)
107 return ret;
108
109 return ops->start_channel(dev, channel);
110}
111
112int adc_start_channels(struct udevice *dev, unsigned int channel_mask)
113{
114 const struct adc_ops *ops = dev_get_driver_ops(dev);
115 int ret;
116
117 if (!ops->start_channels)
118 return -ENOSYS;
119
120 ret = check_channel(dev, channel_mask, CHECK_MASK, __func__);
121 if (ret)
122 return ret;
123
124 ret = adc_supply_enable(dev);
125 if (ret)
126 return ret;
127
128 return ops->start_channels(dev, channel_mask);
129}
130
131int adc_channel_data(struct udevice *dev, int channel, unsigned int *data)
132{
133 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
134 const struct adc_ops *ops = dev_get_driver_ops(dev);
135 unsigned int timeout_us = uc_pdata->data_timeout_us;
136 int ret;
137
138 if (!ops->channel_data)
139 return -ENOSYS;
140
141 ret = check_channel(dev, channel, CHECK_NUMBER, __func__);
142 if (ret)
143 return ret;
144
145 do {
146 ret = ops->channel_data(dev, channel, data);
147 if (!ret || ret != -EBUSY)
148 break;
149
150
151 sdelay(5);
152 } while (timeout_us--);
153
154 return ret;
155}
156
157int adc_channels_data(struct udevice *dev, unsigned int channel_mask,
158 struct adc_channel *channels)
159{
160 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
161 unsigned int timeout_us = uc_pdata->multidata_timeout_us;
162 const struct adc_ops *ops = dev_get_driver_ops(dev);
163 int ret;
164
165 if (!ops->channels_data)
166 return -ENOSYS;
167
168 ret = check_channel(dev, channel_mask, CHECK_MASK, __func__);
169 if (ret)
170 return ret;
171
172 do {
173 ret = ops->channels_data(dev, channel_mask, channels);
174 if (!ret || ret != -EBUSY)
175 break;
176
177
178 sdelay(5);
179 } while (timeout_us--);
180
181 return ret;
182}
183
184int adc_channel_single_shot(const char *name, int channel, unsigned int *data)
185{
186 struct udevice *dev;
187 int ret;
188
189 ret = uclass_get_device_by_name(UCLASS_ADC, name, &dev);
190 if (ret)
191 return ret;
192
193 ret = adc_start_channel(dev, channel);
194 if (ret)
195 return ret;
196
197 ret = adc_channel_data(dev, channel, data);
198 if (ret)
199 return ret;
200
201 return 0;
202}
203
204static int _adc_channels_single_shot(struct udevice *dev,
205 unsigned int channel_mask,
206 struct adc_channel *channels)
207{
208 unsigned int data;
209 int channel, ret;
210
211 for (channel = 0; channel <= ADC_MAX_CHANNEL; channel++) {
212
213 if (!((channel_mask >> channel) & 0x1))
214 continue;
215
216 ret = adc_start_channel(dev, channel);
217 if (ret)
218 return ret;
219
220 ret = adc_channel_data(dev, channel, &data);
221 if (ret)
222 return ret;
223
224 channels->id = channel;
225 channels->data = data;
226 channels++;
227 }
228
229 return 0;
230}
231
232int adc_channels_single_shot(const char *name, unsigned int channel_mask,
233 struct adc_channel *channels)
234{
235 struct udevice *dev;
236 int ret;
237
238 ret = uclass_get_device_by_name(UCLASS_ADC, name, &dev);
239 if (ret)
240 return ret;
241
242 ret = adc_start_channels(dev, channel_mask);
243 if (ret)
244 goto try_manual;
245
246 ret = adc_channels_data(dev, channel_mask, channels);
247 if (ret)
248 return ret;
249
250 return 0;
251
252try_manual:
253 if (ret != -ENOSYS)
254 return ret;
255
256 return _adc_channels_single_shot(dev, channel_mask, channels);
257}
258
259static int adc_vdd_platdata_update(struct udevice *dev)
260{
261 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
262 int ret;
263
264
265
266
267
268
269
270 ret = device_get_supply_regulator(dev, "vdd-supply",
271 &uc_pdata->vdd_supply);
272 if (ret)
273 return ret;
274
275 ret = regulator_get_value(uc_pdata->vdd_supply);
276 if (ret < 0)
277 return ret;
278
279 uc_pdata->vdd_microvolts = ret;
280
281 return 0;
282}
283
284static int adc_vss_platdata_update(struct udevice *dev)
285{
286 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
287 int ret;
288
289 ret = device_get_supply_regulator(dev, "vss-supply",
290 &uc_pdata->vss_supply);
291 if (ret)
292 return ret;
293
294 ret = regulator_get_value(uc_pdata->vss_supply);
295 if (ret < 0)
296 return ret;
297
298 uc_pdata->vss_microvolts = ret;
299
300 return 0;
301}
302
303int adc_vdd_value(struct udevice *dev, int *uV)
304{
305 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
306 int ret, value_sign = uc_pdata->vdd_polarity_negative ? -1 : 1;
307
308 if (!uc_pdata->vdd_supply)
309 goto nodev;
310
311
312 ret = adc_vdd_platdata_update(dev);
313 if (ret)
314 return ret;
315nodev:
316 if (uc_pdata->vdd_microvolts == -ENODATA)
317 return -ENODATA;
318
319 *uV = uc_pdata->vdd_microvolts * value_sign;
320
321 return 0;
322}
323
324int adc_vss_value(struct udevice *dev, int *uV)
325{
326 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
327 int ret, value_sign = uc_pdata->vss_polarity_negative ? -1 : 1;
328
329 if (!uc_pdata->vss_supply)
330 goto nodev;
331
332
333 ret = adc_vss_platdata_update(dev);
334 if (ret)
335 return ret;
336nodev:
337 if (uc_pdata->vss_microvolts == -ENODATA)
338 return -ENODATA;
339
340 *uV = uc_pdata->vss_microvolts * value_sign;
341
342 return 0;
343}
344
345static int adc_vdd_platdata_set(struct udevice *dev)
346{
347 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
348 int ret;
349 char *prop;
350
351 prop = "vdd-polarity-negative";
352 uc_pdata->vdd_polarity_negative = dev_read_bool(dev, prop);
353
354 ret = adc_vdd_platdata_update(dev);
355 if (ret != -ENOENT)
356 return ret;
357
358
359 prop = "vdd-microvolts";
360 uc_pdata->vdd_microvolts = dev_read_u32_default(dev, prop, -ENODATA);
361
362 return 0;
363}
364
365static int adc_vss_platdata_set(struct udevice *dev)
366{
367 struct adc_uclass_platdata *uc_pdata = dev_get_uclass_platdata(dev);
368 int ret;
369 char *prop;
370
371 prop = "vss-polarity-negative";
372 uc_pdata->vss_polarity_negative = dev_read_bool(dev, prop);
373
374 ret = adc_vss_platdata_update(dev);
375 if (ret != -ENOENT)
376 return ret;
377
378
379 prop = "vss-microvolts";
380 uc_pdata->vss_microvolts = dev_read_u32_default(dev, prop, -ENODATA);
381
382 return 0;
383}
384
385static int adc_pre_probe(struct udevice *dev)
386{
387 int ret;
388
389
390 ret = adc_vdd_platdata_set(dev);
391 if (ret)
392 pr_err("%s: Can't update Vdd. Error: %d", dev->name, ret);
393
394
395 ret = adc_vss_platdata_set(dev);
396 if (ret)
397 pr_err("%s: Can't update Vss. Error: %d", dev->name, ret);
398
399 return 0;
400}
401
402UCLASS_DRIVER(adc) = {
403 .id = UCLASS_ADC,
404 .name = "adc",
405 .pre_probe = adc_pre_probe,
406 .per_device_platdata_auto_alloc_size = ADC_UCLASS_PLATDATA_SIZE,
407};
408