TTY: move allocations to tty_alloc_driver
[deliverable/linux.git] / drivers / mfd / mc13xxx-core.c
CommitLineData
8e005935
UKK
1/*
2 * Copyright 2009-2010 Pengutronix
3 * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>
4 *
5 * loosely based on an earlier driver that has
6 * Copyright 2009 Pengutronix, Sascha Hauer <s.hauer@pengutronix.de>
7 *
8 * This program is free software; you can redistribute it and/or modify it under
9 * the terms of the GNU General Public License version 2 as published by the
10 * Free Software Foundation.
11 */
8e005935
UKK
12
13#include <linux/slab.h>
14#include <linux/module.h>
15#include <linux/platform_device.h>
16#include <linux/mutex.h>
17#include <linux/interrupt.h>
8e005935
UKK
18#include <linux/mfd/core.h>
19#include <linux/mfd/mc13xxx.h>
876989d5
SG
20#include <linux/of.h>
21#include <linux/of_device.h>
22#include <linux/of_gpio.h>
8e005935 23
a0c7c1d4 24#include "mc13xxx.h"
8e005935 25
8e005935
UKK
26#define MC13XXX_IRQSTAT0 0
27#define MC13XXX_IRQSTAT0_ADCDONEI (1 << 0)
28#define MC13XXX_IRQSTAT0_ADCBISDONEI (1 << 1)
29#define MC13XXX_IRQSTAT0_TSI (1 << 2)
30#define MC13783_IRQSTAT0_WHIGHI (1 << 3)
31#define MC13783_IRQSTAT0_WLOWI (1 << 4)
32#define MC13XXX_IRQSTAT0_CHGDETI (1 << 6)
33#define MC13783_IRQSTAT0_CHGOVI (1 << 7)
34#define MC13XXX_IRQSTAT0_CHGREVI (1 << 8)
35#define MC13XXX_IRQSTAT0_CHGSHORTI (1 << 9)
36#define MC13XXX_IRQSTAT0_CCCVI (1 << 10)
37#define MC13XXX_IRQSTAT0_CHGCURRI (1 << 11)
38#define MC13XXX_IRQSTAT0_BPONI (1 << 12)
39#define MC13XXX_IRQSTAT0_LOBATLI (1 << 13)
40#define MC13XXX_IRQSTAT0_LOBATHI (1 << 14)
41#define MC13783_IRQSTAT0_UDPI (1 << 15)
42#define MC13783_IRQSTAT0_USBI (1 << 16)
43#define MC13783_IRQSTAT0_IDI (1 << 19)
44#define MC13783_IRQSTAT0_SE1I (1 << 21)
45#define MC13783_IRQSTAT0_CKDETI (1 << 22)
46#define MC13783_IRQSTAT0_UDMI (1 << 23)
47
48#define MC13XXX_IRQMASK0 1
49#define MC13XXX_IRQMASK0_ADCDONEM MC13XXX_IRQSTAT0_ADCDONEI
50#define MC13XXX_IRQMASK0_ADCBISDONEM MC13XXX_IRQSTAT0_ADCBISDONEI
51#define MC13XXX_IRQMASK0_TSM MC13XXX_IRQSTAT0_TSI
52#define MC13783_IRQMASK0_WHIGHM MC13783_IRQSTAT0_WHIGHI
53#define MC13783_IRQMASK0_WLOWM MC13783_IRQSTAT0_WLOWI
54#define MC13XXX_IRQMASK0_CHGDETM MC13XXX_IRQSTAT0_CHGDETI
55#define MC13783_IRQMASK0_CHGOVM MC13783_IRQSTAT0_CHGOVI
56#define MC13XXX_IRQMASK0_CHGREVM MC13XXX_IRQSTAT0_CHGREVI
57#define MC13XXX_IRQMASK0_CHGSHORTM MC13XXX_IRQSTAT0_CHGSHORTI
58#define MC13XXX_IRQMASK0_CCCVM MC13XXX_IRQSTAT0_CCCVI
59#define MC13XXX_IRQMASK0_CHGCURRM MC13XXX_IRQSTAT0_CHGCURRI
60#define MC13XXX_IRQMASK0_BPONM MC13XXX_IRQSTAT0_BPONI
61#define MC13XXX_IRQMASK0_LOBATLM MC13XXX_IRQSTAT0_LOBATLI
62#define MC13XXX_IRQMASK0_LOBATHM MC13XXX_IRQSTAT0_LOBATHI
63#define MC13783_IRQMASK0_UDPM MC13783_IRQSTAT0_UDPI
64#define MC13783_IRQMASK0_USBM MC13783_IRQSTAT0_USBI
65#define MC13783_IRQMASK0_IDM MC13783_IRQSTAT0_IDI
66#define MC13783_IRQMASK0_SE1M MC13783_IRQSTAT0_SE1I
67#define MC13783_IRQMASK0_CKDETM MC13783_IRQSTAT0_CKDETI
68#define MC13783_IRQMASK0_UDMM MC13783_IRQSTAT0_UDMI
69
70#define MC13XXX_IRQSTAT1 3
71#define MC13XXX_IRQSTAT1_1HZI (1 << 0)
72#define MC13XXX_IRQSTAT1_TODAI (1 << 1)
73#define MC13783_IRQSTAT1_ONOFD1I (1 << 3)
74#define MC13783_IRQSTAT1_ONOFD2I (1 << 4)
75#define MC13783_IRQSTAT1_ONOFD3I (1 << 5)
76#define MC13XXX_IRQSTAT1_SYSRSTI (1 << 6)
77#define MC13XXX_IRQSTAT1_RTCRSTI (1 << 7)
78#define MC13XXX_IRQSTAT1_PCI (1 << 8)
79#define MC13XXX_IRQSTAT1_WARMI (1 << 9)
80#define MC13XXX_IRQSTAT1_MEMHLDI (1 << 10)
81#define MC13783_IRQSTAT1_PWRRDYI (1 << 11)
82#define MC13XXX_IRQSTAT1_THWARNLI (1 << 12)
83#define MC13XXX_IRQSTAT1_THWARNHI (1 << 13)
84#define MC13XXX_IRQSTAT1_CLKI (1 << 14)
85#define MC13783_IRQSTAT1_SEMAFI (1 << 15)
86#define MC13783_IRQSTAT1_MC2BI (1 << 17)
87#define MC13783_IRQSTAT1_HSDETI (1 << 18)
88#define MC13783_IRQSTAT1_HSLI (1 << 19)
89#define MC13783_IRQSTAT1_ALSPTHI (1 << 20)
90#define MC13783_IRQSTAT1_AHSSHORTI (1 << 21)
91
92#define MC13XXX_IRQMASK1 4
93#define MC13XXX_IRQMASK1_1HZM MC13XXX_IRQSTAT1_1HZI
94#define MC13XXX_IRQMASK1_TODAM MC13XXX_IRQSTAT1_TODAI
95#define MC13783_IRQMASK1_ONOFD1M MC13783_IRQSTAT1_ONOFD1I
96#define MC13783_IRQMASK1_ONOFD2M MC13783_IRQSTAT1_ONOFD2I
97#define MC13783_IRQMASK1_ONOFD3M MC13783_IRQSTAT1_ONOFD3I
98#define MC13XXX_IRQMASK1_SYSRSTM MC13XXX_IRQSTAT1_SYSRSTI
99#define MC13XXX_IRQMASK1_RTCRSTM MC13XXX_IRQSTAT1_RTCRSTI
100#define MC13XXX_IRQMASK1_PCM MC13XXX_IRQSTAT1_PCI
101#define MC13XXX_IRQMASK1_WARMM MC13XXX_IRQSTAT1_WARMI
102#define MC13XXX_IRQMASK1_MEMHLDM MC13XXX_IRQSTAT1_MEMHLDI
103#define MC13783_IRQMASK1_PWRRDYM MC13783_IRQSTAT1_PWRRDYI
104#define MC13XXX_IRQMASK1_THWARNLM MC13XXX_IRQSTAT1_THWARNLI
105#define MC13XXX_IRQMASK1_THWARNHM MC13XXX_IRQSTAT1_THWARNHI
106#define MC13XXX_IRQMASK1_CLKM MC13XXX_IRQSTAT1_CLKI
107#define MC13783_IRQMASK1_SEMAFM MC13783_IRQSTAT1_SEMAFI
108#define MC13783_IRQMASK1_MC2BM MC13783_IRQSTAT1_MC2BI
109#define MC13783_IRQMASK1_HSDETM MC13783_IRQSTAT1_HSDETI
110#define MC13783_IRQMASK1_HSLM MC13783_IRQSTAT1_HSLI
111#define MC13783_IRQMASK1_ALSPTHM MC13783_IRQSTAT1_ALSPTHI
112#define MC13783_IRQMASK1_AHSSHORTM MC13783_IRQSTAT1_AHSSHORTI
113
114#define MC13XXX_REVISION 7
115#define MC13XXX_REVISION_REVMETAL (0x07 << 0)
116#define MC13XXX_REVISION_REVFULL (0x03 << 3)
117#define MC13XXX_REVISION_ICID (0x07 << 6)
118#define MC13XXX_REVISION_FIN (0x03 << 9)
119#define MC13XXX_REVISION_FAB (0x03 << 11)
120#define MC13XXX_REVISION_ICIDCODE (0x3f << 13)
121
fec316d6
UKK
122#define MC13XXX_ADC1 44
123#define MC13XXX_ADC1_ADEN (1 << 0)
124#define MC13XXX_ADC1_RAND (1 << 1)
125#define MC13XXX_ADC1_ADSEL (1 << 3)
126#define MC13XXX_ADC1_ASC (1 << 20)
127#define MC13XXX_ADC1_ADTRIGIGN (1 << 21)
8e005935 128
fec316d6 129#define MC13XXX_ADC2 45
8e005935 130
8e005935
UKK
131void mc13xxx_lock(struct mc13xxx *mc13xxx)
132{
133 if (!mutex_trylock(&mc13xxx->lock)) {
5006fe54 134 dev_dbg(mc13xxx->dev, "wait for %s from %pf\n",
8e005935
UKK
135 __func__, __builtin_return_address(0));
136
137 mutex_lock(&mc13xxx->lock);
138 }
5006fe54 139 dev_dbg(mc13xxx->dev, "%s from %pf\n",
8e005935
UKK
140 __func__, __builtin_return_address(0));
141}
142EXPORT_SYMBOL(mc13xxx_lock);
143
144void mc13xxx_unlock(struct mc13xxx *mc13xxx)
145{
5006fe54 146 dev_dbg(mc13xxx->dev, "%s from %pf\n",
8e005935
UKK
147 __func__, __builtin_return_address(0));
148 mutex_unlock(&mc13xxx->lock);
149}
150EXPORT_SYMBOL(mc13xxx_unlock);
151
8e005935
UKK
152int mc13xxx_reg_read(struct mc13xxx *mc13xxx, unsigned int offset, u32 *val)
153{
8e005935
UKK
154 int ret;
155
156 BUG_ON(!mutex_is_locked(&mc13xxx->lock));
157
158 if (offset > MC13XXX_NUMREGS)
159 return -EINVAL;
160
91b5e741 161 ret = regmap_read(mc13xxx->regmap, offset, val);
5006fe54 162 dev_vdbg(mc13xxx->dev, "[0x%02x] -> 0x%06x\n", offset, *val);
8e005935 163
5006fe54 164 return ret;
8e005935
UKK
165}
166EXPORT_SYMBOL(mc13xxx_reg_read);
167
168int mc13xxx_reg_write(struct mc13xxx *mc13xxx, unsigned int offset, u32 val)
169{
8e005935
UKK
170 BUG_ON(!mutex_is_locked(&mc13xxx->lock));
171
5006fe54 172 dev_vdbg(mc13xxx->dev, "[0x%02x] <- 0x%06x\n", offset, val);
8e005935
UKK
173
174 if (offset > MC13XXX_NUMREGS || val > 0xffffff)
175 return -EINVAL;
176
91b5e741 177 return regmap_write(mc13xxx->regmap, offset, val);
8e005935
UKK
178}
179EXPORT_SYMBOL(mc13xxx_reg_write);
180
181int mc13xxx_reg_rmw(struct mc13xxx *mc13xxx, unsigned int offset,
182 u32 mask, u32 val)
183{
91b5e741 184 BUG_ON(!mutex_is_locked(&mc13xxx->lock));
8e005935 185 BUG_ON(val & ~mask);
91b5e741
MR
186 dev_vdbg(mc13xxx->dev, "[0x%02x] <- 0x%06x (mask: 0x%06x)\n",
187 offset, val, mask);
8e005935 188
91b5e741 189 return regmap_update_bits(mc13xxx->regmap, offset, mask, val);
8e005935
UKK
190}
191EXPORT_SYMBOL(mc13xxx_reg_rmw);
192
193int mc13xxx_irq_mask(struct mc13xxx *mc13xxx, int irq)
194{
195 int ret;
196 unsigned int offmask = irq < 24 ? MC13XXX_IRQMASK0 : MC13XXX_IRQMASK1;
197 u32 irqbit = 1 << (irq < 24 ? irq : irq - 24);
198 u32 mask;
199
200 if (irq < 0 || irq >= MC13XXX_NUM_IRQ)
201 return -EINVAL;
202
203 ret = mc13xxx_reg_read(mc13xxx, offmask, &mask);
204 if (ret)
205 return ret;
206
207 if (mask & irqbit)
208 /* already masked */
209 return 0;
210
211 return mc13xxx_reg_write(mc13xxx, offmask, mask | irqbit);
212}
213EXPORT_SYMBOL(mc13xxx_irq_mask);
214
215int mc13xxx_irq_unmask(struct mc13xxx *mc13xxx, int irq)
216{
217 int ret;
218 unsigned int offmask = irq < 24 ? MC13XXX_IRQMASK0 : MC13XXX_IRQMASK1;
219 u32 irqbit = 1 << (irq < 24 ? irq : irq - 24);
220 u32 mask;
221
222 if (irq < 0 || irq >= MC13XXX_NUM_IRQ)
223 return -EINVAL;
224
225 ret = mc13xxx_reg_read(mc13xxx, offmask, &mask);
226 if (ret)
227 return ret;
228
229 if (!(mask & irqbit))
230 /* already unmasked */
231 return 0;
232
233 return mc13xxx_reg_write(mc13xxx, offmask, mask & ~irqbit);
234}
235EXPORT_SYMBOL(mc13xxx_irq_unmask);
236
237int mc13xxx_irq_status(struct mc13xxx *mc13xxx, int irq,
238 int *enabled, int *pending)
239{
240 int ret;
241 unsigned int offmask = irq < 24 ? MC13XXX_IRQMASK0 : MC13XXX_IRQMASK1;
242 unsigned int offstat = irq < 24 ? MC13XXX_IRQSTAT0 : MC13XXX_IRQSTAT1;
243 u32 irqbit = 1 << (irq < 24 ? irq : irq - 24);
244
245 if (irq < 0 || irq >= MC13XXX_NUM_IRQ)
246 return -EINVAL;
247
248 if (enabled) {
249 u32 mask;
250
251 ret = mc13xxx_reg_read(mc13xxx, offmask, &mask);
252 if (ret)
253 return ret;
254
255 *enabled = mask & irqbit;
256 }
257
258 if (pending) {
259 u32 stat;
260
261 ret = mc13xxx_reg_read(mc13xxx, offstat, &stat);
262 if (ret)
263 return ret;
264
265 *pending = stat & irqbit;
266 }
267
268 return 0;
269}
270EXPORT_SYMBOL(mc13xxx_irq_status);
271
272int mc13xxx_irq_ack(struct mc13xxx *mc13xxx, int irq)
273{
274 unsigned int offstat = irq < 24 ? MC13XXX_IRQSTAT0 : MC13XXX_IRQSTAT1;
275 unsigned int val = 1 << (irq < 24 ? irq : irq - 24);
276
277 BUG_ON(irq < 0 || irq >= MC13XXX_NUM_IRQ);
278
279 return mc13xxx_reg_write(mc13xxx, offstat, val);
280}
281EXPORT_SYMBOL(mc13xxx_irq_ack);
282
283int mc13xxx_irq_request_nounmask(struct mc13xxx *mc13xxx, int irq,
284 irq_handler_t handler, const char *name, void *dev)
285{
286 BUG_ON(!mutex_is_locked(&mc13xxx->lock));
287 BUG_ON(!handler);
288
289 if (irq < 0 || irq >= MC13XXX_NUM_IRQ)
290 return -EINVAL;
291
292 if (mc13xxx->irqhandler[irq])
293 return -EBUSY;
294
295 mc13xxx->irqhandler[irq] = handler;
296 mc13xxx->irqdata[irq] = dev;
297
298 return 0;
299}
300EXPORT_SYMBOL(mc13xxx_irq_request_nounmask);
301
302int mc13xxx_irq_request(struct mc13xxx *mc13xxx, int irq,
303 irq_handler_t handler, const char *name, void *dev)
304{
305 int ret;
306
307 ret = mc13xxx_irq_request_nounmask(mc13xxx, irq, handler, name, dev);
308 if (ret)
309 return ret;
310
311 ret = mc13xxx_irq_unmask(mc13xxx, irq);
312 if (ret) {
313 mc13xxx->irqhandler[irq] = NULL;
314 mc13xxx->irqdata[irq] = NULL;
315 return ret;
316 }
317
318 return 0;
319}
320EXPORT_SYMBOL(mc13xxx_irq_request);
321
322int mc13xxx_irq_free(struct mc13xxx *mc13xxx, int irq, void *dev)
323{
324 int ret;
325 BUG_ON(!mutex_is_locked(&mc13xxx->lock));
326
327 if (irq < 0 || irq >= MC13XXX_NUM_IRQ || !mc13xxx->irqhandler[irq] ||
328 mc13xxx->irqdata[irq] != dev)
329 return -EINVAL;
330
331 ret = mc13xxx_irq_mask(mc13xxx, irq);
332 if (ret)
333 return ret;
334
335 mc13xxx->irqhandler[irq] = NULL;
336 mc13xxx->irqdata[irq] = NULL;
337
338 return 0;
339}
340EXPORT_SYMBOL(mc13xxx_irq_free);
341
342static inline irqreturn_t mc13xxx_irqhandler(struct mc13xxx *mc13xxx, int irq)
343{
344 return mc13xxx->irqhandler[irq](irq, mc13xxx->irqdata[irq]);
345}
346
347/*
348 * returns: number of handled irqs or negative error
349 * locking: holds mc13xxx->lock
350 */
351static int mc13xxx_irq_handle(struct mc13xxx *mc13xxx,
352 unsigned int offstat, unsigned int offmask, int baseirq)
353{
354 u32 stat, mask;
355 int ret = mc13xxx_reg_read(mc13xxx, offstat, &stat);
356 int num_handled = 0;
357
358 if (ret)
359 return ret;
360
361 ret = mc13xxx_reg_read(mc13xxx, offmask, &mask);
362 if (ret)
363 return ret;
364
365 while (stat & ~mask) {
366 int irq = __ffs(stat & ~mask);
367
368 stat &= ~(1 << irq);
369
370 if (likely(mc13xxx->irqhandler[baseirq + irq])) {
371 irqreturn_t handled;
372
373 handled = mc13xxx_irqhandler(mc13xxx, baseirq + irq);
374 if (handled == IRQ_HANDLED)
375 num_handled++;
376 } else {
5006fe54 377 dev_err(mc13xxx->dev,
8e005935
UKK
378 "BUG: irq %u but no handler\n",
379 baseirq + irq);
380
381 mask |= 1 << irq;
382
383 ret = mc13xxx_reg_write(mc13xxx, offmask, mask);
384 }
385 }
386
387 return num_handled;
388}
389
390static irqreturn_t mc13xxx_irq_thread(int irq, void *data)
391{
392 struct mc13xxx *mc13xxx = data;
393 irqreturn_t ret;
394 int handled = 0;
395
396 mc13xxx_lock(mc13xxx);
397
398 ret = mc13xxx_irq_handle(mc13xxx, MC13XXX_IRQSTAT0,
399 MC13XXX_IRQMASK0, 0);
400 if (ret > 0)
401 handled = 1;
402
403 ret = mc13xxx_irq_handle(mc13xxx, MC13XXX_IRQSTAT1,
404 MC13XXX_IRQMASK1, 24);
405 if (ret > 0)
406 handled = 1;
407
408 mc13xxx_unlock(mc13xxx);
409
410 return IRQ_RETVAL(handled);
411}
412
bb3149a9 413static const char *mc13xxx_chipname[] = {
8e005935
UKK
414 [MC13XXX_ID_MC13783] = "mc13783",
415 [MC13XXX_ID_MC13892] = "mc13892",
416};
417
418#define maskval(reg, mask) (((reg) & (mask)) >> __ffs(mask))
5006fe54 419static int mc13xxx_identify(struct mc13xxx *mc13xxx)
8e005935
UKK
420{
421 u32 icid;
422 u32 revision;
8e005935
UKK
423 int ret;
424
5006fe54
MR
425 /*
426 * Get the generation ID from register 46, as apparently some older
427 * IC revisions only have this info at this location. Newer ICs seem to
428 * have both.
429 */
8e005935
UKK
430 ret = mc13xxx_reg_read(mc13xxx, 46, &icid);
431 if (ret)
432 return ret;
433
434 icid = (icid >> 6) & 0x7;
435
436 switch (icid) {
437 case 2:
5006fe54 438 mc13xxx->ictype = MC13XXX_ID_MC13783;
8e005935
UKK
439 break;
440 case 7:
5006fe54 441 mc13xxx->ictype = MC13XXX_ID_MC13892;
8e005935
UKK
442 break;
443 default:
5006fe54 444 mc13xxx->ictype = MC13XXX_ID_INVALID;
8e005935
UKK
445 break;
446 }
447
5006fe54
MR
448 if (mc13xxx->ictype == MC13XXX_ID_MC13783 ||
449 mc13xxx->ictype == MC13XXX_ID_MC13892) {
8e005935 450 ret = mc13xxx_reg_read(mc13xxx, MC13XXX_REVISION, &revision);
8e005935 451
5006fe54 452 dev_info(mc13xxx->dev, "%s: rev: %d.%d, "
8e005935 453 "fin: %d, fab: %d, icid: %d/%d\n",
5006fe54 454 mc13xxx_chipname[mc13xxx->ictype],
8e005935
UKK
455 maskval(revision, MC13XXX_REVISION_REVFULL),
456 maskval(revision, MC13XXX_REVISION_REVMETAL),
457 maskval(revision, MC13XXX_REVISION_FIN),
458 maskval(revision, MC13XXX_REVISION_FAB),
459 maskval(revision, MC13XXX_REVISION_ICID),
460 maskval(revision, MC13XXX_REVISION_ICIDCODE));
461 }
462
5006fe54 463 return (mc13xxx->ictype == MC13XXX_ID_INVALID) ? -ENODEV : 0;
8e005935
UKK
464}
465
466static const char *mc13xxx_get_chipname(struct mc13xxx *mc13xxx)
467{
5006fe54 468 return mc13xxx_chipname[mc13xxx->ictype];
8e005935
UKK
469}
470
8e005935
UKK
471int mc13xxx_get_flags(struct mc13xxx *mc13xxx)
472{
876989d5 473 return mc13xxx->flags;
8e005935
UKK
474}
475EXPORT_SYMBOL(mc13xxx_get_flags);
476
fec316d6
UKK
477#define MC13XXX_ADC1_CHAN0_SHIFT 5
478#define MC13XXX_ADC1_CHAN1_SHIFT 8
1039d762
MT
479#define MC13783_ADC1_ATO_SHIFT 11
480#define MC13783_ADC1_ATOX (1 << 19)
8e005935
UKK
481
482struct mc13xxx_adcdone_data {
483 struct mc13xxx *mc13xxx;
484 struct completion done;
485};
486
fec316d6 487static irqreturn_t mc13xxx_handler_adcdone(int irq, void *data)
8e005935
UKK
488{
489 struct mc13xxx_adcdone_data *adcdone_data = data;
490
491 mc13xxx_irq_ack(adcdone_data->mc13xxx, irq);
492
493 complete_all(&adcdone_data->done);
494
495 return IRQ_HANDLED;
496}
497
fec316d6 498#define MC13XXX_ADC_WORKING (1 << 0)
8e005935 499
fec316d6 500int mc13xxx_adc_do_conversion(struct mc13xxx *mc13xxx, unsigned int mode,
1039d762
MT
501 unsigned int channel, u8 ato, bool atox,
502 unsigned int *sample)
8e005935 503{
8e005935
UKK
504 u32 adc0, adc1, old_adc0;
505 int i, ret;
506 struct mc13xxx_adcdone_data adcdone_data = {
507 .mc13xxx = mc13xxx,
508 };
509 init_completion(&adcdone_data.done);
510
5006fe54 511 dev_dbg(mc13xxx->dev, "%s\n", __func__);
8e005935
UKK
512
513 mc13xxx_lock(mc13xxx);
514
fec316d6 515 if (mc13xxx->adcflags & MC13XXX_ADC_WORKING) {
8e005935
UKK
516 ret = -EBUSY;
517 goto out;
518 }
519
fec316d6 520 mc13xxx->adcflags |= MC13XXX_ADC_WORKING;
8e005935 521
fec316d6 522 mc13xxx_reg_read(mc13xxx, MC13XXX_ADC0, &old_adc0);
8e005935 523
fec316d6
UKK
524 adc0 = MC13XXX_ADC0_ADINC1 | MC13XXX_ADC0_ADINC2;
525 adc1 = MC13XXX_ADC1_ADEN | MC13XXX_ADC1_ADTRIGIGN | MC13XXX_ADC1_ASC;
8e005935
UKK
526
527 if (channel > 7)
fec316d6 528 adc1 |= MC13XXX_ADC1_ADSEL;
8e005935
UKK
529
530 switch (mode) {
fec316d6
UKK
531 case MC13XXX_ADC_MODE_TS:
532 adc0 |= MC13XXX_ADC0_ADREFEN | MC13XXX_ADC0_TSMOD0 |
533 MC13XXX_ADC0_TSMOD1;
534 adc1 |= 4 << MC13XXX_ADC1_CHAN1_SHIFT;
8e005935
UKK
535 break;
536
fec316d6 537 case MC13XXX_ADC_MODE_SINGLE_CHAN:
2161891a 538 adc0 |= old_adc0 & MC13XXX_ADC0_CONFIG_MASK;
fec316d6
UKK
539 adc1 |= (channel & 0x7) << MC13XXX_ADC1_CHAN0_SHIFT;
540 adc1 |= MC13XXX_ADC1_RAND;
8e005935
UKK
541 break;
542
fec316d6 543 case MC13XXX_ADC_MODE_MULT_CHAN:
2161891a 544 adc0 |= old_adc0 & MC13XXX_ADC0_CONFIG_MASK;
fec316d6 545 adc1 |= 4 << MC13XXX_ADC1_CHAN1_SHIFT;
8e005935
UKK
546 break;
547
548 default:
fec316d6 549 mc13xxx_unlock(mc13xxx);
8e005935
UKK
550 return -EINVAL;
551 }
552
1039d762
MT
553 adc1 |= ato << MC13783_ADC1_ATO_SHIFT;
554 if (atox)
555 adc1 |= MC13783_ADC1_ATOX;
5006fe54
MR
556
557 dev_dbg(mc13xxx->dev, "%s: request irq\n", __func__);
fec316d6
UKK
558 mc13xxx_irq_request(mc13xxx, MC13XXX_IRQ_ADCDONE,
559 mc13xxx_handler_adcdone, __func__, &adcdone_data);
560 mc13xxx_irq_ack(mc13xxx, MC13XXX_IRQ_ADCDONE);
8e005935 561
fec316d6
UKK
562 mc13xxx_reg_write(mc13xxx, MC13XXX_ADC0, adc0);
563 mc13xxx_reg_write(mc13xxx, MC13XXX_ADC1, adc1);
8e005935
UKK
564
565 mc13xxx_unlock(mc13xxx);
566
567 ret = wait_for_completion_interruptible_timeout(&adcdone_data.done, HZ);
568
569 if (!ret)
570 ret = -ETIMEDOUT;
571
572 mc13xxx_lock(mc13xxx);
573
fec316d6 574 mc13xxx_irq_free(mc13xxx, MC13XXX_IRQ_ADCDONE, &adcdone_data);
8e005935
UKK
575
576 if (ret > 0)
577 for (i = 0; i < 4; ++i) {
578 ret = mc13xxx_reg_read(mc13xxx,
fec316d6 579 MC13XXX_ADC2, &sample[i]);
8e005935
UKK
580 if (ret)
581 break;
582 }
583
fec316d6 584 if (mode == MC13XXX_ADC_MODE_TS)
8e005935 585 /* restore TSMOD */
fec316d6 586 mc13xxx_reg_write(mc13xxx, MC13XXX_ADC0, old_adc0);
8e005935 587
fec316d6 588 mc13xxx->adcflags &= ~MC13XXX_ADC_WORKING;
8e005935
UKK
589out:
590 mc13xxx_unlock(mc13xxx);
591
592 return ret;
593}
fec316d6 594EXPORT_SYMBOL_GPL(mc13xxx_adc_do_conversion);
8e005935
UKK
595
596static int mc13xxx_add_subdevice_pdata(struct mc13xxx *mc13xxx,
c8a03c96 597 const char *format, void *pdata, size_t pdata_size)
8e005935
UKK
598{
599 char buf[30];
600 const char *name = mc13xxx_get_chipname(mc13xxx);
601
602 struct mfd_cell cell = {
c8a03c96
SO
603 .platform_data = pdata,
604 .pdata_size = pdata_size,
8e005935
UKK
605 };
606
607 /* there is no asnprintf in the kernel :-( */
608 if (snprintf(buf, sizeof(buf), format, name) > sizeof(buf))
609 return -E2BIG;
610
611 cell.name = kmemdup(buf, strlen(buf) + 1, GFP_KERNEL);
612 if (!cell.name)
613 return -ENOMEM;
614
5006fe54 615 return mfd_add_devices(mc13xxx->dev, -1, &cell, 1, NULL, 0);
8e005935
UKK
616}
617
618static int mc13xxx_add_subdevice(struct mc13xxx *mc13xxx, const char *format)
619{
c8a03c96 620 return mc13xxx_add_subdevice_pdata(mc13xxx, format, NULL, 0);
8e005935
UKK
621}
622
876989d5
SG
623#ifdef CONFIG_OF
624static int mc13xxx_probe_flags_dt(struct mc13xxx *mc13xxx)
625{
91b5e741 626 struct device_node *np = mc13xxx->dev->of_node;
876989d5
SG
627
628 if (!np)
629 return -ENODEV;
630
631 if (of_get_property(np, "fsl,mc13xxx-uses-adc", NULL))
632 mc13xxx->flags |= MC13XXX_USE_ADC;
633
634 if (of_get_property(np, "fsl,mc13xxx-uses-codec", NULL))
635 mc13xxx->flags |= MC13XXX_USE_CODEC;
636
637 if (of_get_property(np, "fsl,mc13xxx-uses-rtc", NULL))
638 mc13xxx->flags |= MC13XXX_USE_RTC;
639
640 if (of_get_property(np, "fsl,mc13xxx-uses-touch", NULL))
641 mc13xxx->flags |= MC13XXX_USE_TOUCHSCREEN;
642
643 return 0;
644}
645#else
646static inline int mc13xxx_probe_flags_dt(struct mc13xxx *mc13xxx)
647{
648 return -ENODEV;
649}
650#endif
651
a0c7c1d4 652int mc13xxx_common_init(struct mc13xxx *mc13xxx,
5006fe54 653 struct mc13xxx_platform_data *pdata, int irq)
8e005935 654{
8e005935
UKK
655 int ret;
656
8e005935
UKK
657 mc13xxx_lock(mc13xxx);
658
5006fe54
MR
659 ret = mc13xxx_identify(mc13xxx);
660 if (ret)
8e005935
UKK
661 goto err_revision;
662
663 /* mask all irqs */
664 ret = mc13xxx_reg_write(mc13xxx, MC13XXX_IRQMASK0, 0x00ffffff);
665 if (ret)
666 goto err_mask;
667
668 ret = mc13xxx_reg_write(mc13xxx, MC13XXX_IRQMASK1, 0x00ffffff);
669 if (ret)
670 goto err_mask;
671
5006fe54 672 ret = request_threaded_irq(irq, NULL, mc13xxx_irq_thread,
8e005935
UKK
673 IRQF_ONESHOT | IRQF_TRIGGER_HIGH, "mc13xxx", mc13xxx);
674
675 if (ret) {
676err_mask:
677err_revision:
e1b88eb0 678 mc13xxx_unlock(mc13xxx);
8e005935
UKK
679 kfree(mc13xxx);
680 return ret;
681 }
682
5006fe54
MR
683 mc13xxx->irq = irq;
684
8e005935
UKK
685 mc13xxx_unlock(mc13xxx);
686
876989d5
SG
687 if (mc13xxx_probe_flags_dt(mc13xxx) < 0 && pdata)
688 mc13xxx->flags = pdata->flags;
689
690 if (mc13xxx->flags & MC13XXX_USE_ADC)
8e005935
UKK
691 mc13xxx_add_subdevice(mc13xxx, "%s-adc");
692
876989d5 693 if (mc13xxx->flags & MC13XXX_USE_CODEC)
e3a0871c
PR
694 mc13xxx_add_subdevice_pdata(mc13xxx, "%s-codec",
695 pdata->codec, sizeof(*pdata->codec));
8e005935 696
876989d5 697 if (mc13xxx->flags & MC13XXX_USE_RTC)
8e005935
UKK
698 mc13xxx_add_subdevice(mc13xxx, "%s-rtc");
699
876989d5 700 if (mc13xxx->flags & MC13XXX_USE_TOUCHSCREEN)
1039d762
MT
701 mc13xxx_add_subdevice_pdata(mc13xxx, "%s-ts",
702 &pdata->touch, sizeof(pdata->touch));
8e005935 703
876989d5
SG
704 if (pdata) {
705 mc13xxx_add_subdevice_pdata(mc13xxx, "%s-regulator",
706 &pdata->regulators, sizeof(pdata->regulators));
c8a03c96
SO
707 mc13xxx_add_subdevice_pdata(mc13xxx, "%s-led",
708 pdata->leds, sizeof(*pdata->leds));
30fc7ac3
PR
709 mc13xxx_add_subdevice_pdata(mc13xxx, "%s-pwrbutton",
710 pdata->buttons, sizeof(*pdata->buttons));
876989d5
SG
711 } else {
712 mc13xxx_add_subdevice(mc13xxx, "%s-regulator");
713 mc13xxx_add_subdevice(mc13xxx, "%s-led");
714 mc13xxx_add_subdevice(mc13xxx, "%s-pwrbutton");
715 }
30fc7ac3 716
8e005935
UKK
717 return 0;
718}
a0c7c1d4 719EXPORT_SYMBOL_GPL(mc13xxx_common_init);
8e005935 720
a0c7c1d4 721void mc13xxx_common_cleanup(struct mc13xxx *mc13xxx)
8e005935 722{
5006fe54 723 free_irq(mc13xxx->irq, mc13xxx);
8e005935 724
5006fe54 725 mfd_remove_devices(mc13xxx->dev);
8e005935 726}
a0c7c1d4 727EXPORT_SYMBOL_GPL(mc13xxx_common_cleanup);
8e005935
UKK
728
729MODULE_DESCRIPTION("Core driver for Freescale MC13XXX PMIC");
730MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>");
731MODULE_LICENSE("GPL v2");
This page took 0.161608 seconds and 5 git commands to generate.