?  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 / 88pm860x-core.c
blob17dfe9bb6d2745c2bb5f6123b1afbc6c6d997ca6
1 /*
2 * Base driver for Marvell 88PM8607
3 *
4 * Copyright (C) 2009 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/88pm860x.h>
20 #include <linux/regulator/machine.h>
21
22 #define INT_STATUS_NUM 3
23
24 static struct resource bk_resources[] __devinitdata = {
25 {PM8606_BACKLIGHT1, PM8606_BACKLIGHT1, "backlight-0", IORESOURCE_IO,},
26 {PM8606_BACKLIGHT2, PM8606_BACKLIGHT2, "backlight-1", IORESOURCE_IO,},
27 {PM8606_BACKLIGHT3, PM8606_BACKLIGHT3, "backlight-2", IORESOURCE_IO,},
28 };
29
30 static struct resource led_resources[] __devinitdata = {
31 {PM8606_LED1_RED, PM8606_LED1_RED, "led0-red", IORESOURCE_IO,},
32 {PM8606_LED1_GREEN, PM8606_LED1_GREEN, "led0-green", IORESOURCE_IO,},
33 {PM8606_LED1_BLUE, PM8606_LED1_BLUE, "led0-blue", IORESOURCE_IO,},
34 {PM8606_LED2_RED, PM8606_LED2_RED, "led1-red", IORESOURCE_IO,},
35 {PM8606_LED2_GREEN, PM8606_LED2_GREEN, "led1-green", IORESOURCE_IO,},
36 {PM8606_LED2_BLUE, PM8606_LED2_BLUE, "led1-blue", IORESOURCE_IO,},
37 };
38
39 static struct resource regulator_resources[] __devinitdata = {
40 {PM8607_ID_BUCK1, PM8607_ID_BUCK1, "buck-1", IORESOURCE_IO,},
41 {PM8607_ID_BUCK2, PM8607_ID_BUCK2, "buck-2", IORESOURCE_IO,},
42 {PM8607_ID_BUCK3, PM8607_ID_BUCK3, "buck-3", IORESOURCE_IO,},
43 {PM8607_ID_LDO1, PM8607_ID_LDO1, "ldo-01", IORESOURCE_IO,},
44 {PM8607_ID_LDO2, PM8607_ID_LDO2, "ldo-02", IORESOURCE_IO,},
45 {PM8607_ID_LDO3, PM8607_ID_LDO3, "ldo-03", IORESOURCE_IO,},
46 {PM8607_ID_LDO4, PM8607_ID_LDO4, "ldo-04", IORESOURCE_IO,},
47 {PM8607_ID_LDO5, PM8607_ID_LDO5, "ldo-05", IORESOURCE_IO,},
48 {PM8607_ID_LDO6, PM8607_ID_LDO6, "ldo-06", IORESOURCE_IO,},
49 {PM8607_ID_LDO7, PM8607_ID_LDO7, "ldo-07", IORESOURCE_IO,},
50 {PM8607_ID_LDO8, PM8607_ID_LDO8, "ldo-08", IORESOURCE_IO,},
51 {PM8607_ID_LDO9, PM8607_ID_LDO9, "ldo-09", IORESOURCE_IO,},
52 {PM8607_ID_LDO10, PM8607_ID_LDO10, "ldo-10", IORESOURCE_IO,},
53 {PM8607_ID_LDO11, PM8607_ID_LDO11, "ldo-11", IORESOURCE_IO,},
54 {PM8607_ID_LDO12, PM8607_ID_LDO12, "ldo-12", IORESOURCE_IO,},
55 {PM8607_ID_LDO13, PM8607_ID_LDO13, "ldo-13", IORESOURCE_IO,},
56 {PM8607_ID_LDO14, PM8607_ID_LDO14, "ldo-14", IORESOURCE_IO,},
57 {PM8607_ID_LDO15, PM8607_ID_LDO15, "ldo-15", IORESOURCE_IO,},
58 };
59
60 static struct resource touch_resources[] __devinitdata = {
61 {PM8607_IRQ_PEN, PM8607_IRQ_PEN, "touch", IORESOURCE_IRQ,},
62 };
63
64 static struct resource onkey_resources[] __devinitdata = {
65 {PM8607_IRQ_ONKEY, PM8607_IRQ_ONKEY, "onkey", IORESOURCE_IRQ,},
66 };
67
68 static struct resource codec_resources[] __devinitdata = {
69 /* Headset microphone insertion or removal */
70 {PM8607_IRQ_MICIN, PM8607_IRQ_MICIN, "micin", IORESOURCE_IRQ,},
71 /* Hook-switch press or release */
72 {PM8607_IRQ_HOOK, PM8607_IRQ_HOOK, "hook", IORESOURCE_IRQ,},
73 /* Headset insertion or removal */
74 {PM8607_IRQ_HEADSET, PM8607_IRQ_HEADSET, "headset", IORESOURCE_IRQ,},
75 /* Audio short */
76 {PM8607_IRQ_AUDIO_SHORT, PM8607_IRQ_AUDIO_SHORT, "audio-short", IORESOURCE_IRQ,},
77 };
78
79 static struct resource battery_resources[] __devinitdata = {
80 {PM8607_IRQ_CC, PM8607_IRQ_CC, "columb counter", IORESOURCE_IRQ,},
81 {PM8607_IRQ_BAT, PM8607_IRQ_BAT, "battery", IORESOURCE_IRQ,},
82 };
83
84 static struct resource charger_resources[] __devinitdata = {
85 {PM8607_IRQ_CHG, PM8607_IRQ_CHG, "charger detect", IORESOURCE_IRQ,},
86 {PM8607_IRQ_CHG_DONE, PM8607_IRQ_CHG_DONE, "charging done", IORESOURCE_IRQ,},
87 {PM8607_IRQ_CHG_FAULT, PM8607_IRQ_CHG_FAULT, "charging timeout", IORESOURCE_IRQ,},
88 {PM8607_IRQ_GPADC1, PM8607_IRQ_GPADC1, "battery temperature", IORESOURCE_IRQ,},
89 {PM8607_IRQ_VBAT, PM8607_IRQ_VBAT, "battery voltage", IORESOURCE_IRQ,},
90 {PM8607_IRQ_VCHG, PM8607_IRQ_VCHG, "vchg voltage", IORESOURCE_IRQ,},
91 };
92
93 static struct resource rtc_resources[] __devinitdata = {
94 {PM8607_IRQ_RTC, PM8607_IRQ_RTC, "rtc", IORESOURCE_IRQ,},
95 };
96
97 static struct mfd_cell bk_devs[] = {
98 {"88pm860x-backlight", 0,},
99 {"88pm860x-backlight", 1,},
100 {"88pm860x-backlight", 2,},
101 };
102
103 static struct mfd_cell led_devs[] = {
104 {"88pm860x-led", 0,},
105 {"88pm860x-led", 1,},
106 {"88pm860x-led", 2,},
107 {"88pm860x-led", 3,},
108 {"88pm860x-led", 4,},
109 {"88pm860x-led", 5,},
110 };
111
112 static struct mfd_cell regulator_devs[] = {
113 {"88pm860x-regulator", 0,},
114 {"88pm860x-regulator", 1,},
115 {"88pm860x-regulator", 2,},
116 {"88pm860x-regulator", 3,},
117 {"88pm860x-regulator", 4,},
118 {"88pm860x-regulator", 5,},
119 {"88pm860x-regulator", 6,},
120 {"88pm860x-regulator", 7,},
121 {"88pm860x-regulator", 8,},
122 {"88pm860x-regulator", 9,},
123 {"88pm860x-regulator", 10,},
124 {"88pm860x-regulator", 11,},
125 {"88pm860x-regulator", 12,},
126 {"88pm860x-regulator", 13,},
127 {"88pm860x-regulator", 14,},
128 {"88pm860x-regulator", 15,},
129 {"88pm860x-regulator", 16,},
130 {"88pm860x-regulator", 17,},
131 };
132
133 static struct mfd_cell touch_devs[] = {
134 {"88pm860x-touch", -1,},
135 };
136
137 static struct mfd_cell onkey_devs[] = {
138 {"88pm860x-onkey", -1,},
139 };
140
141 static struct mfd_cell codec_devs[] = {
142 {"88pm860x-codec", -1,},
143 };
144
145 static struct mfd_cell power_devs[] = {
146 {"88pm860x-battery", -1,},
147 {"88pm860x-charger", -1,},
148 };
149
150 static struct mfd_cell rtc_devs[] = {
151 {"88pm860x-rtc", -1,},
152 };
153
154
155 struct pm860x_irq_data {
156 int reg;
157 int mask_reg;
158 int enable; /* enable or not */
159 int offs; /* bit offset in mask register */
160 };
161
162 static struct pm860x_irq_data pm860x_irqs[] = {
163 [PM8607_IRQ_ONKEY] = {
164 .reg = PM8607_INT_STATUS1,
165 .mask_reg = PM8607_INT_MASK_1,
166 .offs = 1 << 0,
167 },
168 [PM8607_IRQ_EXTON] = {
169 .reg = PM8607_INT_STATUS1,
170 .mask_reg = PM8607_INT_MASK_1,
171 .offs = 1 << 1,
172 },
173 [PM8607_IRQ_CHG] = {
174 .reg = PM8607_INT_STATUS1,
175 .mask_reg = PM8607_INT_MASK_1,
176 .offs = 1 << 2,
177 },
178 [PM8607_IRQ_BAT] = {
179 .reg = PM8607_INT_STATUS1,
180 .mask_reg = PM8607_INT_MASK_1,
181 .offs = 1 << 3,
182 },
183 [PM8607_IRQ_RTC] = {
184 .reg = PM8607_INT_STATUS1,
185 .mask_reg = PM8607_INT_MASK_1,
186 .offs = 1 << 4,
187 },
188 [PM8607_IRQ_CC] = {
189 .reg = PM8607_INT_STATUS1,
190 .mask_reg = PM8607_INT_MASK_1,
191 .offs = 1 << 5,
192 },
193 [PM8607_IRQ_VBAT] = {
194 .reg = PM8607_INT_STATUS2,
195 .mask_reg = PM8607_INT_MASK_2,
196 .offs = 1 << 0,
197 },
198 [PM8607_IRQ_VCHG] = {
199 .reg = PM8607_INT_STATUS2,
200 .mask_reg = PM8607_INT_MASK_2,
201 .offs = 1 << 1,
202 },
203 [PM8607_IRQ_VSYS] = {
204 .reg = PM8607_INT_STATUS2,
205 .mask_reg = PM8607_INT_MASK_2,
206 .offs = 1 << 2,
207 },
208 [PM8607_IRQ_TINT] = {
209 .reg = PM8607_INT_STATUS2,
210 .mask_reg = PM8607_INT_MASK_2,
211 .offs = 1 << 3,
212 },
213 [PM8607_IRQ_GPADC0] = {
214 .reg = PM8607_INT_STATUS2,
215 .mask_reg = PM8607_INT_MASK_2,
216 .offs = 1 << 4,
217 },
218 [PM8607_IRQ_GPADC1] = {
219 .reg = PM8607_INT_STATUS2,
220 .mask_reg = PM8607_INT_MASK_2,
221 .offs = 1 << 5,
222 },
223 [PM8607_IRQ_GPADC2] = {
224 .reg = PM8607_INT_STATUS2,
225 .mask_reg = PM8607_INT_MASK_2,
226 .offs = 1 << 6,
227 },
228 [PM8607_IRQ_GPADC3] = {
229 .reg = PM8607_INT_STATUS2,
230 .mask_reg = PM8607_INT_MASK_2,
231 .offs = 1 << 7,
232 },
233 [PM8607_IRQ_AUDIO_SHORT] = {
234 .reg = PM8607_INT_STATUS3,
235 .mask_reg = PM8607_INT_MASK_3,
236 .offs = 1 << 0,
237 },
238 [PM8607_IRQ_PEN] = {
239 .reg = PM8607_INT_STATUS3,
240 .mask_reg = PM8607_INT_MASK_3,
241 .offs = 1 << 1,
242 },
243 [PM8607_IRQ_HEADSET] = {
244 .reg = PM8607_INT_STATUS3,
245 .mask_reg = PM8607_INT_MASK_3,
246 .offs = 1 << 2,
247 },
248 [PM8607_IRQ_HOOK] = {
249 .reg = PM8607_INT_STATUS3,
250 .mask_reg = PM8607_INT_MASK_3,
251 .offs = 1 << 3,
252 },
253 [PM8607_IRQ_MICIN] = {
254 .reg = PM8607_INT_STATUS3,
255 .mask_reg = PM8607_INT_MASK_3,
256 .offs = 1 << 4,
257 },
258 [PM8607_IRQ_CHG_FAIL] = {
259 .reg = PM8607_INT_STATUS3,
260 .mask_reg = PM8607_INT_MASK_3,
261 .offs = 1 << 5,
262 },
263 [PM8607_IRQ_CHG_DONE] = {
264 .reg = PM8607_INT_STATUS3,
265 .mask_reg = PM8607_INT_MASK_3,
266 .offs = 1 << 6,
267 },
268 [PM8607_IRQ_CHG_FAULT] = {
269 .reg = PM8607_INT_STATUS3,
270 .mask_reg = PM8607_INT_MASK_3,
271 .offs = 1 << 7,
272 },
273 };
274
275 static irqreturn_t pm860x_irq(int irq, void *data)
276 {
277 struct pm860x_chip *chip = data;
278 struct pm860x_irq_data *irq_data;
279 struct i2c_client *i2c;
280 int read_reg = -1, value = 0;
281 int i;
282
283 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
284 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
285 irq_data = &pm860x_irqs[i];
286 if (read_reg != irq_data->reg) {
287 read_reg = irq_data->reg;
288 value = pm860x_reg_read(i2c, irq_data->reg);
289 }
290 if (value & irq_data->enable)
291 handle_nested_irq(chip->irq_base + i);
292 }
293 return IRQ_HANDLED;
294 }
295
296 static void pm860x_irq_lock(struct irq_data *data)
297 {
298 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
299
300 mutex_lock(&chip->irq_lock);
301 }
302
303 static void pm860x_irq_sync_unlock(struct irq_data *data)
304 {
305 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
306 struct pm860x_irq_data *irq_data;
307 struct i2c_client *i2c;
308 static unsigned char cached[3] = {0x0, 0x0, 0x0};
309 unsigned char mask[3];
310 int i;
311
312 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
313 /* Load cached value. In initial, all IRQs are masked */
314 for (i = 0; i < 3; i++)
315 mask[i] = cached[i];
316 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
317 irq_data = &pm860x_irqs[i];
318 switch (irq_data->mask_reg) {
319 case PM8607_INT_MASK_1:
320 mask[0] &= ~irq_data->offs;
321 mask[0] |= irq_data->enable;
322 break;
323 case PM8607_INT_MASK_2:
324 mask[1] &= ~irq_data->offs;
325 mask[1] |= irq_data->enable;
326 break;
327 case PM8607_INT_MASK_3:
328 mask[2] &= ~irq_data->offs;
329 mask[2] |= irq_data->enable;
330 break;
331 default:
332 dev_err(chip->dev, "wrong IRQ\n");
333 break;
334 }
335 }
336 /* update mask into registers */
337 for (i = 0; i < 3; i++) {
338 if (mask[i] != cached[i]) {
339 cached[i] = mask[i];
340 pm860x_reg_write(i2c, PM8607_INT_MASK_1 + i, mask[i]);
341 }
342 }
343
344 mutex_unlock(&chip->irq_lock);
345 }
346
347 static void pm860x_irq_enable(struct irq_data *data)
348 {
349 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
350 pm860x_irqs[data->irq - chip->irq_base].enable
351 = pm860x_irqs[data->irq - chip->irq_base].offs;
352 }
353
354 static void pm860x_irq_disable(struct irq_data *data)
355 {
356 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
357 pm860x_irqs[data->irq - chip->irq_base].enable = 0;
358 }
359
360 static struct irq_chip pm860x_irq_chip = {
361 .name = "88pm860x",
362 .irq_bus_lock = pm860x_irq_lock,
363 .irq_bus_sync_unlock = pm860x_irq_sync_unlock,
364 .irq_enable = pm860x_irq_enable,
365 .irq_disable = pm860x_irq_disable,
366 };
367
368 static int __devinit device_gpadc_init(struct pm860x_chip *chip,
369 struct pm860x_platform_data *pdata)
370 {
371 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
372 : chip->companion;
373 int data;
374 int ret;
375
376 /* initialize GPADC without activating it */
377
378 if (!pdata || !pdata->touch)
379 return -EINVAL;
380
381 /* set GPADC MISC1 register */
382 data = 0;
383 data |= (pdata->touch->gpadc_prebias << 1) & PM8607_GPADC_PREBIAS_MASK;
384 data |= (pdata->touch->slot_cycle << 3) & PM8607_GPADC_SLOT_CYCLE_MASK;
385 data |= (pdata->touch->off_scale << 5) & PM8607_GPADC_OFF_SCALE_MASK;
386 data |= (pdata->touch->sw_cal << 7) & PM8607_GPADC_SW_CAL_MASK;
387 if (data) {
388 ret = pm860x_reg_write(i2c, PM8607_GPADC_MISC1, data);
389 if (ret < 0)
390 goto out;
391 }
392 /* set tsi prebias time */
393 if (pdata->touch->tsi_prebias) {
394 data = pdata->touch->tsi_prebias;
395 ret = pm860x_reg_write(i2c, PM8607_TSI_PREBIAS, data);
396 if (ret < 0)
397 goto out;
398 }
399 /* set prebias & prechg time of pen detect */
400 data = 0;
401 data |= pdata->touch->pen_prebias & PM8607_PD_PREBIAS_MASK;
402 data |= (pdata->touch->pen_prechg << 5) & PM8607_PD_PRECHG_MASK;
403 if (data) {
404 ret = pm860x_reg_write(i2c, PM8607_PD_PREBIAS, data);
405 if (ret < 0)
406 goto out;
407 }
408
409 ret = pm860x_set_bits(i2c, PM8607_GPADC_MISC1,
410 PM8607_GPADC_EN, PM8607_GPADC_EN);
411 out:
412 return ret;
413 }
414
415 static int __devinit device_irq_init(struct pm860x_chip *chip,
416 struct pm860x_platform_data *pdata)
417 {
418 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
419 : chip->companion;
420 unsigned char status_buf[INT_STATUS_NUM];
421 unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
422 int i, data, mask, ret = -EINVAL;
423 int __irq;
424
425 if (!pdata || !pdata->irq_base) {
426 dev_warn(chip->dev, "No interrupt support on IRQ base\n");
427 return -EINVAL;
428 }
429
430 mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR
431 | PM8607_B0_MISC1_INT_MASK;
432 data = 0;
433 chip->irq_mode = 0;
434 if (pdata && pdata->irq_mode) {
435 /*
436 * irq_mode defines the way of clearing interrupt. If it's 1,
437 * clear IRQ by write. Otherwise, clear it by read.
438 * This control bit is valid from 88PM8607 B0 steping.
439 */
440 data |= PM8607_B0_MISC1_INT_CLEAR;
441 chip->irq_mode = 1;
442 }
443 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, mask, data);
444 if (ret < 0)
445 goto out;
446
447 /* mask all IRQs */
448 memset(status_buf, 0, INT_STATUS_NUM);
449 ret = pm860x_bulk_write(i2c, PM8607_INT_MASK_1,
450 INT_STATUS_NUM, status_buf);
451 if (ret < 0)
452 goto out;
453
454 if (chip->irq_mode) {
455 /* clear interrupt status by write */
456 memset(status_buf, 0xFF, INT_STATUS_NUM);
457 ret = pm860x_bulk_write(i2c, PM8607_INT_STATUS1,
458 INT_STATUS_NUM, status_buf);
459 } else {
460 /* clear interrupt status by read */
461 ret = pm860x_bulk_read(i2c, PM8607_INT_STATUS1,
462 INT_STATUS_NUM, status_buf);
463 }
464 if (ret < 0)
465 goto out;
466
467 mutex_init(&chip->irq_lock);
468 chip->irq_base = pdata->irq_base;
469 chip->core_irq = i2c->irq;
470 if (!chip->core_irq)
471 goto out;
472
473 /* register IRQ by genirq */
474 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
475 __irq = i + chip->irq_base;
476 irq_set_chip_data(__irq, chip);
477 irq_set_chip_and_handler(__irq, &pm860x_irq_chip,
478 handle_edge_irq);
479 irq_set_nested_thread(__irq, 1);
480 #ifdef CONFIG_ARM
481 set_irq_flags(__irq, IRQF_VALID);
482 #else
483 irq_set_noprobe(__irq);
484 #endif
485 }
486
487 ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags,
488 "88pm860x", chip);
489 if (ret) {
490 dev_err(chip->dev, "Failed to request IRQ: %d\n", ret);
491 chip->core_irq = 0;
492 }
493
494 return 0;
495 out:
496 chip->core_irq = 0;
497 return ret;
498 }
499
500 static void device_irq_exit(struct pm860x_chip *chip)
501 {
502 if (chip->core_irq)
503 free_irq(chip->core_irq, chip);
504 }
505
506 static void __devinit device_bk_init(struct pm860x_chip *chip,
507 struct pm860x_platform_data *pdata)
508 {
509 int ret;
510 int i, j, id;
511
512 if ((pdata == NULL) || (pdata->backlight == NULL))
513 return;
514
515 if (pdata->num_backlights > ARRAY_SIZE(bk_devs))
516 pdata->num_backlights = ARRAY_SIZE(bk_devs);
517
518 for (i = 0; i < pdata->num_backlights; i++) {
519 bk_devs[i].platform_data = &pdata->backlight[i];
520 bk_devs[i].pdata_size = sizeof(struct pm860x_backlight_pdata);
521
522 for (j = 0; j < ARRAY_SIZE(bk_devs); j++) {
523 id = bk_resources[j].start;
524 if (pdata->backlight[i].flags != id)
525 continue;
526
527 bk_devs[i].num_resources = 1;
528 bk_devs[i].resources = &bk_resources[j];
529 ret = mfd_add_devices(chip->dev, 0,
530 &bk_devs[i], 1,
531 &bk_resources[j], 0);
532 if (ret < 0) {
533 dev_err(chip->dev, "Failed to add "
534 "backlight subdev\n");
535 return;
536 }
537 }
538 }
539 }
540
541 static void __devinit device_led_init(struct pm860x_chip *chip,
542 struct pm860x_platform_data *pdata)
543 {
544 int ret;
545 int i, j, id;
546
547 if ((pdata == NULL) || (pdata->led == NULL))
548 return;
549
550 if (pdata->num_leds > ARRAY_SIZE(led_devs))
551 pdata->num_leds = ARRAY_SIZE(led_devs);
552
553 for (i = 0; i < pdata->num_leds; i++) {
554 led_devs[i].platform_data = &pdata->led[i];
555 led_devs[i].pdata_size = sizeof(struct pm860x_led_pdata);
556
557 for (j = 0; j < ARRAY_SIZE(led_devs); j++) {
558 id = led_resources[j].start;
559 if (pdata->led[i].flags != id)
560 continue;
561
562 led_devs[i].num_resources = 1;
563 led_devs[i].resources = &led_resources[j],
564 ret = mfd_add_devices(chip->dev, 0,
565 &led_devs[i], 1,
566 &led_resources[j], 0);
567 if (ret < 0) {
568 dev_err(chip->dev, "Failed to add "
569 "led subdev\n");
570 return;
571 }
572 }
573 }
574 }
575
576 static void __devinit device_regulator_init(struct pm860x_chip *chip,
577 struct pm860x_platform_data *pdata)
578 {
579 struct regulator_init_data *initdata;
580 int ret;
581 int i, seq;
582
583 if ((pdata == NULL) || (pdata->regulator == NULL))
584 return;
585
586 if (pdata->num_regulators > ARRAY_SIZE(regulator_devs))
587 pdata->num_regulators = ARRAY_SIZE(regulator_devs);
588
589 for (i = 0, seq = -1; i < pdata->num_regulators; i++) {
590 initdata = &pdata->regulator[i];
591 seq = *(unsigned int *)initdata->driver_data;
592 if ((seq < 0) || (seq > PM8607_ID_RG_MAX)) {
593 dev_err(chip->dev, "Wrong ID(%d) on regulator(%s)\n",
594 seq, initdata->constraints.name);
595 goto out;
596 }
597 regulator_devs[i].platform_data = &pdata->regulator[i];
598 regulator_devs[i].pdata_size = sizeof(struct regulator_init_data);
599 regulator_devs[i].num_resources = 1;
600 regulator_devs[i].resources = &regulator_resources[seq];
601
602 ret = mfd_add_devices(chip->dev, 0, &regulator_devs[i], 1,
603 &regulator_resources[seq], 0);
604 if (ret < 0) {
605 dev_err(chip->dev, "Failed to add regulator subdev\n");
606 goto out;
607 }
608 }
609 out:
610 return;
611 }
612
613 static void __devinit device_rtc_init(struct pm860x_chip *chip,
614 struct pm860x_platform_data *pdata)
615 {
616 int ret;
617
618 if ((pdata == NULL))
619 return;
620
621 rtc_devs[0].platform_data = pdata->rtc;
622 rtc_devs[0].pdata_size = sizeof(struct pm860x_rtc_pdata);
623 rtc_devs[0].num_resources = ARRAY_SIZE(rtc_resources);
624 rtc_devs[0].resources = &rtc_resources[0];
625 ret = mfd_add_devices(chip->dev, 0, &rtc_devs[0],
626 ARRAY_SIZE(rtc_devs), &rtc_resources[0],
627 chip->irq_base);
628 if (ret < 0)
629 dev_err(chip->dev, "Failed to add rtc subdev\n");
630 }
631
632 static void __devinit device_touch_init(struct pm860x_chip *chip,
633 struct pm860x_platform_data *pdata)
634 {
635 int ret;
636
637 if (pdata == NULL)
638 return;
639
640 touch_devs[0].platform_data = pdata->touch;
641 touch_devs[0].pdata_size = sizeof(struct pm860x_touch_pdata);
642 touch_devs[0].num_resources = ARRAY_SIZE(touch_resources);
643 touch_devs[0].resources = &touch_resources[0];
644 ret = mfd_add_devices(chip->dev, 0, &touch_devs[0],
645 ARRAY_SIZE(touch_devs), &touch_resources[0],
646 chip->irq_base);
647 if (ret < 0)
648 dev_err(chip->dev, "Failed to add touch subdev\n");
649 }
650
651 static void __devinit device_power_init(struct pm860x_chip *chip,
652 struct pm860x_platform_data *pdata)
653 {
654 int ret;
655
656 if (pdata == NULL)
657 return;
658
659 power_devs[0].platform_data = pdata->power;
660 power_devs[0].pdata_size = sizeof(struct pm860x_power_pdata);
661 power_devs[0].num_resources = ARRAY_SIZE(battery_resources);
662 power_devs[0].resources = &battery_resources[0],
663 ret = mfd_add_devices(chip->dev, 0, &power_devs[0], 1,
664 &battery_resources[0], chip->irq_base);
665 if (ret < 0)
666 dev_err(chip->dev, "Failed to add battery subdev\n");
667
668 power_devs[1].platform_data = pdata->power;
669 power_devs[1].pdata_size = sizeof(struct pm860x_power_pdata);
670 power_devs[1].num_resources = ARRAY_SIZE(charger_resources);
671 power_devs[1].resources = &charger_resources[0],
672 ret = mfd_add_devices(chip->dev, 0, &power_devs[1], 1,
673 &charger_resources[0], chip->irq_base);
674 if (ret < 0)
675 dev_err(chip->dev, "Failed to add charger subdev\n");
676 }
677
678 static void __devinit device_onkey_init(struct pm860x_chip *chip,
679 struct pm860x_platform_data *pdata)
680 {
681 int ret;
682
683 onkey_devs[0].num_resources = ARRAY_SIZE(onkey_resources);
684 onkey_devs[0].resources = &onkey_resources[0],
685 ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0],
686 ARRAY_SIZE(onkey_devs), &onkey_resources[0],
687 chip->irq_base);
688 if (ret < 0)
689 dev_err(chip->dev, "Failed to add onkey subdev\n");
690 }
691
692 static void __devinit device_codec_init(struct pm860x_chip *chip,
693 struct pm860x_platform_data *pdata)
694 {
695 int ret;
696
697 codec_devs[0].num_resources = ARRAY_SIZE(codec_resources);
698 codec_devs[0].resources = &codec_resources[0],
699 ret = mfd_add_devices(chip->dev, 0, &codec_devs[0],
700 ARRAY_SIZE(codec_devs), &codec_resources[0], 0);
701 if (ret < 0)
702 dev_err(chip->dev, "Failed to add codec subdev\n");
703 }
704
705 static void __devinit device_8607_init(struct pm860x_chip *chip,
706 struct i2c_client *i2c,
707 struct pm860x_platform_data *pdata)
708 {
709 int data, ret;
710
711 ret = pm860x_reg_read(i2c, PM8607_CHIP_ID);
712 if (ret < 0) {
713 dev_err(chip->dev, "Failed to read CHIP ID: %d\n", ret);
714 goto out;
715 }
716 switch (ret & PM8607_VERSION_MASK) {
717 case 0x40:
718 case 0x50:
719 dev_info(chip->dev, "Marvell 88PM8607 (ID: %02x) detected\n",
720 ret);
721 break;
722 default:
723 dev_err(chip->dev, "Failed to detect Marvell 88PM8607. "
724 "Chip ID: %02x\n", ret);
725 goto out;
726 }
727
728 ret = pm860x_reg_read(i2c, PM8607_BUCK3);
729 if (ret < 0) {
730 dev_err(chip->dev, "Failed to read BUCK3 register: %d\n", ret);
731 goto out;
732 }
733 if (ret & PM8607_BUCK3_DOUBLE)
734 chip->buck3_double = 1;
735
736 ret = pm860x_reg_read(i2c, PM8607_B0_MISC1);
737 if (ret < 0) {
738 dev_err(chip->dev, "Failed to read MISC1 register: %d\n", ret);
739 goto out;
740 }
741
742 if (pdata && (pdata->i2c_port == PI2C_PORT))
743 data = PM8607_B0_MISC1_PI2C;
744 else
745 data = 0;
746 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, PM8607_B0_MISC1_PI2C, data);
747 if (ret < 0) {
748 dev_err(chip->dev, "Failed to access MISC1:%d\n", ret);
749 goto out;
750 }
751
752 ret = device_gpadc_init(chip, pdata);
753 if (ret < 0)
754 goto out;
755
756 ret = device_irq_init(chip, pdata);
757 if (ret < 0)
758 goto out;
759
760 device_regulator_init(chip, pdata);
761 device_rtc_init(chip, pdata);
762 device_onkey_init(chip, pdata);
763 device_touch_init(chip, pdata);
764 device_power_init(chip, pdata);
765 device_codec_init(chip, pdata);
766 out:
767 return;
768 }
769
770 int __devinit pm860x_device_init(struct pm860x_chip *chip,
771 struct pm860x_platform_data *pdata)
772 {
773 chip->core_irq = 0;
774
775 switch (chip->id) {
776 case CHIP_PM8606:
777 device_bk_init(chip, pdata);
778 device_led_init(chip, pdata);
779 break;
780 case CHIP_PM8607:
781 device_8607_init(chip, chip->client, pdata);
782 break;
783 }
784
785 if (chip->companion) {
786 switch (chip->id) {
787 case CHIP_PM8607:
788 device_bk_init(chip, pdata);
789 device_led_init(chip, pdata);
790 break;
791 case CHIP_PM8606:
792 device_8607_init(chip, chip->companion, pdata);
793 break;
794 }
795 }
796
797 return 0;
798 }
799
800 void __devexit pm860x_device_exit(struct pm860x_chip *chip)
801 {
802 device_irq_exit(chip);
803 mfd_remove_devices(chip->dev);
804 }
805
806 MODULE_DESCRIPTION("PMIC Driver for Marvell 88PM860x");
807 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
808 MODULE_LICENSE("GPL");