?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / mfd / max8925-core.c
blobca881efedf75a43f7543e19d506702ab1518e0ec
1 /*
2 * Base driver for Maxim MAX8925
3 *
4 * Copyright (C) 2009-2010 Marvell International Ltd.
5 * Haojian Zhuang <haojian.zhuang@marvell.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
11
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/i2c.h>
15 #include <linux/irq.h>
16 #include <linux/interrupt.h>
17 #include <linux/platform_device.h>
18 #include <linux/mfd/core.h>
19 #include <linux/mfd/max8925.h>
20
21 static struct resource backlight_resources[] = {
22 {
23 .name = "max8925-backlight",
24 .start = MAX8925_WLED_MODE_CNTL,
25 .end = MAX8925_WLED_CNTL,
26 .flags = IORESOURCE_IO,
27 },
28 };
29
30 static struct mfd_cell backlight_devs[] = {
31 {
32 .name = "max8925-backlight",
33 .num_resources = 1,
34 .resources = &backlight_resources[0],
35 .id = -1,
36 },
37 };
38
39 static struct resource touch_resources[] = {
40 {
41 .name = "max8925-tsc",
42 .start = MAX8925_TSC_IRQ,
43 .end = MAX8925_ADC_RES_END,
44 .flags = IORESOURCE_IO,
45 },
46 };
47
48 static struct mfd_cell touch_devs[] = {
49 {
50 .name = "max8925-touch",
51 .num_resources = 1,
52 .resources = &touch_resources[0],
53 .id = -1,
54 },
55 };
56
57 static struct resource power_supply_resources[] = {
58 {
59 .name = "max8925-power",
60 .start = MAX8925_CHG_IRQ1,
61 .end = MAX8925_CHG_IRQ1_MASK,
62 .flags = IORESOURCE_IO,
63 },
64 };
65
66 static struct mfd_cell power_devs[] = {
67 {
68 .name = "max8925-power",
69 .num_resources = 1,
70 .resources = &power_supply_resources[0],
71 .id = -1,
72 },
73 };
74
75 static struct resource rtc_resources[] = {
76 {
77 .name = "max8925-rtc",
78 .start = MAX8925_RTC_IRQ,
79 .end = MAX8925_RTC_IRQ_MASK,
80 .flags = IORESOURCE_IO,
81 },
82 };
83
84 static struct mfd_cell rtc_devs[] = {
85 {
86 .name = "max8925-rtc",
87 .num_resources = 1,
88 .resources = &rtc_resources[0],
89 .id = -1,
90 },
91 };
92
93 static struct resource onkey_resources[] = {
94 {
95 .name = "max8925-onkey",
96 .start = MAX8925_IRQ_GPM_SW_R,
97 .end = MAX8925_IRQ_GPM_SW_R,
98 .flags = IORESOURCE_IRQ,
99 }, {
100 .name = "max8925-onkey",
101 .start = MAX8925_IRQ_GPM_SW_F,
102 .end = MAX8925_IRQ_GPM_SW_F,
103 .flags = IORESOURCE_IRQ,
104 },
105 };
106
107 static struct mfd_cell onkey_devs[] = {
108 {
109 .name = "max8925-onkey",
110 .num_resources = 2,
111 .resources = &onkey_resources[0],
112 .id = -1,
113 },
114 };
115
116 #define MAX8925_REG_RESOURCE(_start, _end) \
117 { \
118 .start = MAX8925_##_start, \
119 .end = MAX8925_##_end, \
120 .flags = IORESOURCE_IO, \
121 }
122
123 static struct resource regulator_resources[] = {
124 MAX8925_REG_RESOURCE(SDCTL1, SDCTL1),
125 MAX8925_REG_RESOURCE(SDCTL2, SDCTL2),
126 MAX8925_REG_RESOURCE(SDCTL3, SDCTL3),
127 MAX8925_REG_RESOURCE(LDOCTL1, LDOCTL1),
128 MAX8925_REG_RESOURCE(LDOCTL2, LDOCTL2),
129 MAX8925_REG_RESOURCE(LDOCTL3, LDOCTL3),
130 MAX8925_REG_RESOURCE(LDOCTL4, LDOCTL4),
131 MAX8925_REG_RESOURCE(LDOCTL5, LDOCTL5),
132 MAX8925_REG_RESOURCE(LDOCTL6, LDOCTL6),
133 MAX8925_REG_RESOURCE(LDOCTL7, LDOCTL7),
134 MAX8925_REG_RESOURCE(LDOCTL8, LDOCTL8),
135 MAX8925_REG_RESOURCE(LDOCTL9, LDOCTL9),
136 MAX8925_REG_RESOURCE(LDOCTL10, LDOCTL10),
137 MAX8925_REG_RESOURCE(LDOCTL11, LDOCTL11),
138 MAX8925_REG_RESOURCE(LDOCTL12, LDOCTL12),
139 MAX8925_REG_RESOURCE(LDOCTL13, LDOCTL13),
140 MAX8925_REG_RESOURCE(LDOCTL14, LDOCTL14),
141 MAX8925_REG_RESOURCE(LDOCTL15, LDOCTL15),
142 MAX8925_REG_RESOURCE(LDOCTL16, LDOCTL16),
143 MAX8925_REG_RESOURCE(LDOCTL17, LDOCTL17),
144 MAX8925_REG_RESOURCE(LDOCTL18, LDOCTL18),
145 MAX8925_REG_RESOURCE(LDOCTL19, LDOCTL19),
146 MAX8925_REG_RESOURCE(LDOCTL20, LDOCTL20),
147 };
148
149 #define MAX8925_REG_DEVS(_id) \
150 { \
151 .name = "max8925-regulator", \
152 .num_resources = 1, \
153 .resources = &regulator_resources[MAX8925_ID_##_id], \
154 .id = MAX8925_ID_##_id, \
155 }
156
157 static struct mfd_cell regulator_devs[] = {
158 MAX8925_REG_DEVS(SD1),
159 MAX8925_REG_DEVS(SD2),
160 MAX8925_REG_DEVS(SD3),
161 MAX8925_REG_DEVS(LDO1),
162 MAX8925_REG_DEVS(LDO2),
163 MAX8925_REG_DEVS(LDO3),
164 MAX8925_REG_DEVS(LDO4),
165 MAX8925_REG_DEVS(LDO5),
166 MAX8925_REG_DEVS(LDO6),
167 MAX8925_REG_DEVS(LDO7),
168 MAX8925_REG_DEVS(LDO8),
169 MAX8925_REG_DEVS(LDO9),
170 MAX8925_REG_DEVS(LDO10),
171 MAX8925_REG_DEVS(LDO11),
172 MAX8925_REG_DEVS(LDO12),
173 MAX8925_REG_DEVS(LDO13),
174 MAX8925_REG_DEVS(LDO14),
175 MAX8925_REG_DEVS(LDO15),
176 MAX8925_REG_DEVS(LDO16),
177 MAX8925_REG_DEVS(LDO17),
178 MAX8925_REG_DEVS(LDO18),
179 MAX8925_REG_DEVS(LDO19),
180 MAX8925_REG_DEVS(LDO20),
181 };
182
183 enum {
184 FLAGS_ADC = 1, /* register in ADC component */
185 FLAGS_RTC, /* register in RTC component */
186 };
187
188 struct max8925_irq_data {
189 int reg;
190 int mask_reg;
191 int enable; /* enable or not */
192 int offs; /* bit offset in mask register */
193 int flags;
194 int tsc_irq;
195 };
196
197 static struct max8925_irq_data max8925_irqs[] = {
198 [MAX8925_IRQ_VCHG_DC_OVP] = {
199 .reg = MAX8925_CHG_IRQ1,
200 .mask_reg = MAX8925_CHG_IRQ1_MASK,
201 .offs = 1 << 0,
202 },
203 [MAX8925_IRQ_VCHG_DC_F] = {
204 .reg = MAX8925_CHG_IRQ1,
205 .mask_reg = MAX8925_CHG_IRQ1_MASK,
206 .offs = 1 << 1,
207 },
208 [MAX8925_IRQ_VCHG_DC_R] = {
209 .reg = MAX8925_CHG_IRQ1,
210 .mask_reg = MAX8925_CHG_IRQ1_MASK,
211 .offs = 1 << 2,
212 },
213 [MAX8925_IRQ_VCHG_THM_OK_R] = {
214 .reg = MAX8925_CHG_IRQ2,
215 .mask_reg = MAX8925_CHG_IRQ2_MASK,
216 .offs = 1 << 0,
217 },
218 [MAX8925_IRQ_VCHG_THM_OK_F] = {
219 .reg = MAX8925_CHG_IRQ2,
220 .mask_reg = MAX8925_CHG_IRQ2_MASK,
221 .offs = 1 << 1,
222 },
223 [MAX8925_IRQ_VCHG_SYSLOW_F] = {
224 .reg = MAX8925_CHG_IRQ2,
225 .mask_reg = MAX8925_CHG_IRQ2_MASK,
226 .offs = 1 << 2,
227 },
228 [MAX8925_IRQ_VCHG_SYSLOW_R] = {
229 .reg = MAX8925_CHG_IRQ2,
230 .mask_reg = MAX8925_CHG_IRQ2_MASK,
231 .offs = 1 << 3,
232 },
233 [MAX8925_IRQ_VCHG_RST] = {
234 .reg = MAX8925_CHG_IRQ2,
235 .mask_reg = MAX8925_CHG_IRQ2_MASK,
236 .offs = 1 << 4,
237 },
238 [MAX8925_IRQ_VCHG_DONE] = {
239 .reg = MAX8925_CHG_IRQ2,
240 .mask_reg = MAX8925_CHG_IRQ2_MASK,
241 .offs = 1 << 5,
242 },
243 [MAX8925_IRQ_VCHG_TOPOFF] = {
244 .reg = MAX8925_CHG_IRQ2,
245 .mask_reg = MAX8925_CHG_IRQ2_MASK,
246 .offs = 1 << 6,
247 },
248 [MAX8925_IRQ_VCHG_TMR_FAULT] = {
249 .reg = MAX8925_CHG_IRQ2,
250 .mask_reg = MAX8925_CHG_IRQ2_MASK,
251 .offs = 1 << 7,
252 },
253 [MAX8925_IRQ_GPM_RSTIN] = {
254 .reg = MAX8925_ON_OFF_IRQ1,
255 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
256 .offs = 1 << 0,
257 },
258 [MAX8925_IRQ_GPM_MPL] = {
259 .reg = MAX8925_ON_OFF_IRQ1,
260 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
261 .offs = 1 << 1,
262 },
263 [MAX8925_IRQ_GPM_SW_3SEC] = {
264 .reg = MAX8925_ON_OFF_IRQ1,
265 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
266 .offs = 1 << 2,
267 },
268 [MAX8925_IRQ_GPM_EXTON_F] = {
269 .reg = MAX8925_ON_OFF_IRQ1,
270 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
271 .offs = 1 << 3,
272 },
273 [MAX8925_IRQ_GPM_EXTON_R] = {
274 .reg = MAX8925_ON_OFF_IRQ1,
275 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
276 .offs = 1 << 4,
277 },
278 [MAX8925_IRQ_GPM_SW_1SEC] = {
279 .reg = MAX8925_ON_OFF_IRQ1,
280 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
281 .offs = 1 << 5,
282 },
283 [MAX8925_IRQ_GPM_SW_F] = {
284 .reg = MAX8925_ON_OFF_IRQ1,
285 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
286 .offs = 1 << 6,
287 },
288 [MAX8925_IRQ_GPM_SW_R] = {
289 .reg = MAX8925_ON_OFF_IRQ1,
290 .mask_reg = MAX8925_ON_OFF_IRQ1_MASK,
291 .offs = 1 << 7,
292 },
293 [MAX8925_IRQ_GPM_SYSCKEN_F] = {
294 .reg = MAX8925_ON_OFF_IRQ2,
295 .mask_reg = MAX8925_ON_OFF_IRQ2_MASK,
296 .offs = 1 << 0,
297 },
298 [MAX8925_IRQ_GPM_SYSCKEN_R] = {
299 .reg = MAX8925_ON_OFF_IRQ2,
300 .mask_reg = MAX8925_ON_OFF_IRQ2_MASK,
301 .offs = 1 << 1,
302 },
303 [MAX8925_IRQ_RTC_ALARM1] = {
304 .reg = MAX8925_RTC_IRQ,
305 .mask_reg = MAX8925_RTC_IRQ_MASK,
306 .offs = 1 << 2,
307 .flags = FLAGS_RTC,
308 },
309 [MAX8925_IRQ_RTC_ALARM0] = {
310 .reg = MAX8925_RTC_IRQ,
311 .mask_reg = MAX8925_RTC_IRQ_MASK,
312 .offs = 1 << 3,
313 .flags = FLAGS_RTC,
314 },
315 [MAX8925_IRQ_TSC_STICK] = {
316 .reg = MAX8925_TSC_IRQ,
317 .mask_reg = MAX8925_TSC_IRQ_MASK,
318 .offs = 1 << 0,
319 .flags = FLAGS_ADC,
320 .tsc_irq = 1,
321 },
322 [MAX8925_IRQ_TSC_NSTICK] = {
323 .reg = MAX8925_TSC_IRQ,
324 .mask_reg = MAX8925_TSC_IRQ_MASK,
325 .offs = 1 << 1,
326 .flags = FLAGS_ADC,
327 .tsc_irq = 1,
328 },
329 };
330
331 static inline struct max8925_irq_data *irq_to_max8925(struct max8925_chip *chip,
332 int irq)
333 {
334 return &max8925_irqs[irq - chip->irq_base];
335 }
336
337 static irqreturn_t max8925_irq(int irq, void *data)
338 {
339 struct max8925_chip *chip = data;
340 struct max8925_irq_data *irq_data;
341 struct i2c_client *i2c;
342 int read_reg = -1, value = 0;
343 int i;
344
345 for (i = 0; i < ARRAY_SIZE(max8925_irqs); i++) {
346 irq_data = &max8925_irqs[i];
347 /* TSC IRQ should be serviced in max8925_tsc_irq() */
348 if (irq_data->tsc_irq)
349 continue;
350 if (irq_data->flags == FLAGS_RTC)
351 i2c = chip->rtc;
352 else if (irq_data->flags == FLAGS_ADC)
353 i2c = chip->adc;
354 else
355 i2c = chip->i2c;
356 if (read_reg != irq_data->reg) {
357 read_reg = irq_data->reg;
358 value = max8925_reg_read(i2c, irq_data->reg);
359 }
360 if (value & irq_data->enable)
361 handle_nested_irq(chip->irq_base + i);
362 }
363 return IRQ_HANDLED;
364 }
365
366 static irqreturn_t max8925_tsc_irq(int irq, void *data)
367 {
368 struct max8925_chip *chip = data;
369 struct max8925_irq_data *irq_data;
370 struct i2c_client *i2c;
371 int read_reg = -1, value = 0;
372 int i;
373
374 for (i = 0; i < ARRAY_SIZE(max8925_irqs); i++) {
375 irq_data = &max8925_irqs[i];
376 /* non TSC IRQ should be serviced in max8925_irq() */
377 if (!irq_data->tsc_irq)
378 continue;
379 if (irq_data->flags == FLAGS_RTC)
380 i2c = chip->rtc;
381 else if (irq_data->flags == FLAGS_ADC)
382 i2c = chip->adc;
383 else
384 i2c = chip->i2c;
385 if (read_reg != irq_data->reg) {
386 read_reg = irq_data->reg;
387 value = max8925_reg_read(i2c, irq_data->reg);
388 }
389 if (value & irq_data->enable)
390 handle_nested_irq(chip->irq_base + i);
391 }
392 return IRQ_HANDLED;
393 }
394
395 static void max8925_irq_lock(struct irq_data *data)
396 {
397 struct max8925_chip *chip = irq_data_get_irq_chip_data(data);
398
399 mutex_lock(&chip->irq_lock);
400 }
401
402 static void max8925_irq_sync_unlock(struct irq_data *data)
403 {
404 struct max8925_chip *chip = irq_data_get_irq_chip_data(data);
405 struct max8925_irq_data *irq_data;
406 static unsigned char cache_chg[2] = {0xff, 0xff};
407 static unsigned char cache_on[2] = {0xff, 0xff};
408 static unsigned char cache_rtc = 0xff, cache_tsc = 0xff;
409 unsigned char irq_chg[2], irq_on[2];
410 unsigned char irq_rtc, irq_tsc;
411 int i;
412
413 /* Load cached value. In initial, all IRQs are masked */
414 irq_chg[0] = cache_chg[0];
415 irq_chg[1] = cache_chg[1];
416 irq_on[0] = cache_on[0];
417 irq_on[1] = cache_on[1];
418 irq_rtc = cache_rtc;
419 irq_tsc = cache_tsc;
420 for (i = 0; i < ARRAY_SIZE(max8925_irqs); i++) {
421 irq_data = &max8925_irqs[i];
422 /* 1 -- disable, 0 -- enable */
423 switch (irq_data->mask_reg) {
424 case MAX8925_CHG_IRQ1_MASK:
425 irq_chg[0] &= ~irq_data->enable;
426 break;
427 case MAX8925_CHG_IRQ2_MASK:
428 irq_chg[1] &= ~irq_data->enable;
429 break;
430 case MAX8925_ON_OFF_IRQ1_MASK:
431 irq_on[0] &= ~irq_data->enable;
432 break;
433 case MAX8925_ON_OFF_IRQ2_MASK:
434 irq_on[1] &= ~irq_data->enable;
435 break;
436 case MAX8925_RTC_IRQ_MASK:
437 irq_rtc &= ~irq_data->enable;
438 break;
439 case MAX8925_TSC_IRQ_MASK:
440 irq_tsc &= ~irq_data->enable;
441 break;
442 default:
443 dev_err(chip->dev, "wrong IRQ\n");
444 break;
445 }
446 }
447 /* update mask into registers */
448 if (cache_chg[0] != irq_chg[0]) {
449 cache_chg[0] = irq_chg[0];
450 max8925_reg_write(chip->i2c, MAX8925_CHG_IRQ1_MASK,
451 irq_chg[0]);
452 }
453 if (cache_chg[1] != irq_chg[1]) {
454 cache_chg[1] = irq_chg[1];
455 max8925_reg_write(chip->i2c, MAX8925_CHG_IRQ2_MASK,
456 irq_chg[1]);
457 }
458 if (cache_on[0] != irq_on[0]) {
459 cache_on[0] = irq_on[0];
460 max8925_reg_write(chip->i2c, MAX8925_ON_OFF_IRQ1_MASK,
461 irq_on[0]);
462 }
463 if (cache_on[1] != irq_on[1]) {
464 cache_on[1] = irq_on[1];
465 max8925_reg_write(chip->i2c, MAX8925_ON_OFF_IRQ2_MASK,
466 irq_on[1]);
467 }
468 if (cache_rtc != irq_rtc) {
469 cache_rtc = irq_rtc;
470 max8925_reg_write(chip->rtc, MAX8925_RTC_IRQ_MASK, irq_rtc);
471 }
472 if (cache_tsc != irq_tsc) {
473 cache_tsc = irq_tsc;
474 max8925_reg_write(chip->adc, MAX8925_TSC_IRQ_MASK, irq_tsc);
475 }
476
477 mutex_unlock(&chip->irq_lock);
478 }
479
480 static void max8925_irq_enable(struct irq_data *data)
481 {
482 struct max8925_chip *chip = irq_data_get_irq_chip_data(data);
483 max8925_irqs[data->irq - chip->irq_base].enable
484 = max8925_irqs[data->irq - chip->irq_base].offs;
485 }
486
487 static void max8925_irq_disable(struct irq_data *data)
488 {
489 struct max8925_chip *chip = irq_data_get_irq_chip_data(data);
490 max8925_irqs[data->irq - chip->irq_base].enable = 0;
491 }
492
493 static struct irq_chip max8925_irq_chip = {
494 .name = "max8925",
495 .irq_bus_lock = max8925_irq_lock,
496 .irq_bus_sync_unlock = max8925_irq_sync_unlock,
497 .irq_enable = max8925_irq_enable,
498 .irq_disable = max8925_irq_disable,
499 };
500
501 static int max8925_irq_init(struct max8925_chip *chip, int irq,
502 struct max8925_platform_data *pdata)
503 {
504 unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
505 int i, ret;
506 int __irq;
507
508 if (!pdata || !pdata->irq_base) {
509 dev_warn(chip->dev, "No interrupt support on IRQ base\n");
510 return -EINVAL;
511 }
512 /* clear all interrupts */
513 max8925_reg_read(chip->i2c, MAX8925_CHG_IRQ1);
514 max8925_reg_read(chip->i2c, MAX8925_CHG_IRQ2);
515 max8925_reg_read(chip->i2c, MAX8925_ON_OFF_IRQ1);
516 max8925_reg_read(chip->i2c, MAX8925_ON_OFF_IRQ2);
517 max8925_reg_read(chip->rtc, MAX8925_RTC_IRQ);
518 max8925_reg_read(chip->adc, MAX8925_TSC_IRQ);
519 /* mask all interrupts except for TSC */
520 max8925_reg_write(chip->rtc, MAX8925_ALARM0_CNTL, 0);
521 max8925_reg_write(chip->rtc, MAX8925_ALARM1_CNTL, 0);
522 max8925_reg_write(chip->i2c, MAX8925_CHG_IRQ1_MASK, 0xff);
523 max8925_reg_write(chip->i2c, MAX8925_CHG_IRQ2_MASK, 0xff);
524 max8925_reg_write(chip->i2c, MAX8925_ON_OFF_IRQ1_MASK, 0xff);
525 max8925_reg_write(chip->i2c, MAX8925_ON_OFF_IRQ2_MASK, 0xff);
526 max8925_reg_write(chip->rtc, MAX8925_RTC_IRQ_MASK, 0xff);
527
528 mutex_init(&chip->irq_lock);
529 chip->core_irq = irq;
530 chip->irq_base = pdata->irq_base;
531
532 /* register with genirq */
533 for (i = 0; i < ARRAY_SIZE(max8925_irqs); i++) {
534 __irq = i + chip->irq_base;
535 irq_set_chip_data(__irq, chip);
536 irq_set_chip_and_handler(__irq, &max8925_irq_chip,
537 handle_edge_irq);
538 irq_set_nested_thread(__irq, 1);
539 #ifdef CONFIG_ARM
540 set_irq_flags(__irq, IRQF_VALID);
541 #else
542 irq_set_noprobe(__irq);
543 #endif
544 }
545 if (!irq) {
546 dev_warn(chip->dev, "No interrupt support on core IRQ\n");
547 goto tsc_irq;
548 }
549
550 ret = request_threaded_irq(irq, NULL, max8925_irq, flags,
551 "max8925", chip);
552 if (ret) {
553 dev_err(chip->dev, "Failed to request core IRQ: %d\n", ret);
554 chip->core_irq = 0;
555 }
556
557 tsc_irq:
558 /* mask TSC interrupt */
559 max8925_reg_write(chip->adc, MAX8925_TSC_IRQ_MASK, 0x0f);
560
561 if (!pdata->tsc_irq) {
562 dev_warn(chip->dev, "No interrupt support on TSC IRQ\n");
563 return 0;
564 }
565 chip->tsc_irq = pdata->tsc_irq;
566
567 ret = request_threaded_irq(chip->tsc_irq, NULL, max8925_tsc_irq,
568 flags, "max8925-tsc", chip);
569 if (ret) {
570 dev_err(chip->dev, "Failed to request TSC IRQ: %d\n", ret);
571 chip->tsc_irq = 0;
572 }
573 return 0;
574 }
575
576 int __devinit max8925_device_init(struct max8925_chip *chip,
577 struct max8925_platform_data *pdata)
578 {
579 int ret;
580
581 max8925_irq_init(chip, chip->i2c->irq, pdata);
582
583 if (pdata && (pdata->power || pdata->touch)) {
584 /* enable ADC to control internal reference */
585 max8925_set_bits(chip->i2c, MAX8925_RESET_CNFG, 1, 1);
586 /* enable internal reference for ADC */
587 max8925_set_bits(chip->adc, MAX8925_TSC_CNFG1, 3, 2);
588 /* check for internal reference IRQ */
589 do {
590 ret = max8925_reg_read(chip->adc, MAX8925_TSC_IRQ);
591 } while (ret & MAX8925_NREF_OK);
592 /* enaable ADC scheduler, interval is 1 second */
593 max8925_set_bits(chip->adc, MAX8925_ADC_SCHED, 3, 2);
594 }
595
596 /* enable Momentary Power Loss */
597 max8925_set_bits(chip->rtc, MAX8925_MPL_CNTL, 1 << 4, 1 << 4);
598
599 ret = mfd_add_devices(chip->dev, 0, &rtc_devs[0],
600 ARRAY_SIZE(rtc_devs),
601 &rtc_resources[0], 0);
602 if (ret < 0) {
603 dev_err(chip->dev, "Failed to add rtc subdev\n");
604 goto out;
605 }
606
607 ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0],
608 ARRAY_SIZE(onkey_devs),
609 &onkey_resources[0], 0);
610 if (ret < 0) {
611 dev_err(chip->dev, "Failed to add onkey subdev\n");
612 goto out_dev;
613 }
614
615 if (pdata) {
616 ret = mfd_add_devices(chip->dev, 0, &regulator_devs[0],
617 ARRAY_SIZE(regulator_devs),
618 &regulator_resources[0], 0);
619 if (ret < 0) {
620 dev_err(chip->dev, "Failed to add regulator subdev\n");
621 goto out_dev;
622 }
623 }
624
625 if (pdata && pdata->backlight) {
626 ret = mfd_add_devices(chip->dev, 0, &backlight_devs[0],
627 ARRAY_SIZE(backlight_devs),
628 &backlight_resources[0], 0);
629 if (ret < 0) {
630 dev_err(chip->dev, "Failed to add backlight subdev\n");
631 goto out_dev;
632 }
633 }
634
635 if (pdata && pdata->power) {
636 ret = mfd_add_devices(chip->dev, 0, &power_devs[0],
637 ARRAY_SIZE(power_devs),
638 &power_supply_resources[0], 0);
639 if (ret < 0) {
640 dev_err(chip->dev, "Failed to add power supply "
641 "subdev\n");
642 goto out_dev;
643 }
644 }
645
646 if (pdata && pdata->touch) {
647 ret = mfd_add_devices(chip->dev, 0, &touch_devs[0],
648 ARRAY_SIZE(touch_devs),
649 &touch_resources[0], 0);
650 if (ret < 0) {
651 dev_err(chip->dev, "Failed to add touch subdev\n");
652 goto out_dev;
653 }
654 }
655
656 return 0;
657 out_dev:
658 mfd_remove_devices(chip->dev);
659 out:
660 return ret;
661 }
662
663 void __devexit max8925_device_exit(struct max8925_chip *chip)
664 {
665 if (chip->core_irq)
666 free_irq(chip->core_irq, chip);
667 if (chip->tsc_irq)
668 free_irq(chip->tsc_irq, chip);
669 mfd_remove_devices(chip->dev);
670 }
671
672
673 MODULE_DESCRIPTION("PMIC Driver for Maxim MAX8925");
674 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com");
675 MODULE_LICENSE("GPL");