2 * Base driver for Marvell 88PM8607
4 * Copyright (C) 2009 Marvell International Ltd.
5 * Haojian Zhuang <haojian.zhuang@marvell.com>
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.
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 #include <linux/power/charger-manager.h>
23 #define INT_STATUS_NUM 3
25 static struct resource bk_resources[] __devinitdata = {
26 {PM8606_BACKLIGHT1, PM8606_BACKLIGHT1, "backlight-0", IORESOURCE_IO,},
27 {PM8606_BACKLIGHT2, PM8606_BACKLIGHT2, "backlight-1", IORESOURCE_IO,},
28 {PM8606_BACKLIGHT3, PM8606_BACKLIGHT3, "backlight-2", IORESOURCE_IO,},
31 static struct resource led_resources[] __devinitdata = {
32 {PM8606_LED1_RED, PM8606_LED1_RED, "led0-red", IORESOURCE_IO,},
33 {PM8606_LED1_GREEN, PM8606_LED1_GREEN, "led0-green", IORESOURCE_IO,},
34 {PM8606_LED1_BLUE, PM8606_LED1_BLUE, "led0-blue", IORESOURCE_IO,},
35 {PM8606_LED2_RED, PM8606_LED2_RED, "led1-red", IORESOURCE_IO,},
36 {PM8606_LED2_GREEN, PM8606_LED2_GREEN, "led1-green", IORESOURCE_IO,},
37 {PM8606_LED2_BLUE, PM8606_LED2_BLUE, "led1-blue", IORESOURCE_IO,},
40 static struct resource regulator_resources[] __devinitdata = {
41 {PM8607_ID_BUCK1, PM8607_ID_BUCK1, "buck-1", IORESOURCE_IO,},
42 {PM8607_ID_BUCK2, PM8607_ID_BUCK2, "buck-2", IORESOURCE_IO,},
43 {PM8607_ID_BUCK3, PM8607_ID_BUCK3, "buck-3", IORESOURCE_IO,},
44 {PM8607_ID_LDO1, PM8607_ID_LDO1, "ldo-01", IORESOURCE_IO,},
45 {PM8607_ID_LDO2, PM8607_ID_LDO2, "ldo-02", IORESOURCE_IO,},
46 {PM8607_ID_LDO3, PM8607_ID_LDO3, "ldo-03", IORESOURCE_IO,},
47 {PM8607_ID_LDO4, PM8607_ID_LDO4, "ldo-04", IORESOURCE_IO,},
48 {PM8607_ID_LDO5, PM8607_ID_LDO5, "ldo-05", IORESOURCE_IO,},
49 {PM8607_ID_LDO6, PM8607_ID_LDO6, "ldo-06", IORESOURCE_IO,},
50 {PM8607_ID_LDO7, PM8607_ID_LDO7, "ldo-07", IORESOURCE_IO,},
51 {PM8607_ID_LDO8, PM8607_ID_LDO8, "ldo-08", IORESOURCE_IO,},
52 {PM8607_ID_LDO9, PM8607_ID_LDO9, "ldo-09", IORESOURCE_IO,},
53 {PM8607_ID_LDO10, PM8607_ID_LDO10, "ldo-10", IORESOURCE_IO,},
54 {PM8607_ID_LDO11, PM8607_ID_LDO11, "ldo-11", IORESOURCE_IO,},
55 {PM8607_ID_LDO12, PM8607_ID_LDO12, "ldo-12", IORESOURCE_IO,},
56 {PM8607_ID_LDO13, PM8607_ID_LDO13, "ldo-13", IORESOURCE_IO,},
57 {PM8607_ID_LDO14, PM8607_ID_LDO14, "ldo-14", IORESOURCE_IO,},
58 {PM8607_ID_LDO15, PM8607_ID_LDO15, "ldo-15", IORESOURCE_IO,},
61 static struct resource touch_resources[] __devinitdata = {
62 {PM8607_IRQ_PEN, PM8607_IRQ_PEN, "touch", IORESOURCE_IRQ,},
65 static struct resource onkey_resources[] __devinitdata = {
66 {PM8607_IRQ_ONKEY, PM8607_IRQ_ONKEY, "onkey", IORESOURCE_IRQ,},
69 static struct resource codec_resources[] __devinitdata = {
70 /* Headset microphone insertion or removal */
71 {PM8607_IRQ_MICIN, PM8607_IRQ_MICIN, "micin", IORESOURCE_IRQ,},
72 /* Hook-switch press or release */
73 {PM8607_IRQ_HOOK, PM8607_IRQ_HOOK, "hook", IORESOURCE_IRQ,},
74 /* Headset insertion or removal */
75 {PM8607_IRQ_HEADSET, PM8607_IRQ_HEADSET, "headset", IORESOURCE_IRQ,},
77 {PM8607_IRQ_AUDIO_SHORT, PM8607_IRQ_AUDIO_SHORT, "audio-short", IORESOURCE_IRQ,},
80 static struct resource battery_resources[] __devinitdata = {
81 {PM8607_IRQ_CC, PM8607_IRQ_CC, "columb counter", IORESOURCE_IRQ,},
82 {PM8607_IRQ_BAT, PM8607_IRQ_BAT, "battery", IORESOURCE_IRQ,},
85 static struct resource charger_resources[] __devinitdata = {
86 {PM8607_IRQ_CHG, PM8607_IRQ_CHG, "charger detect", IORESOURCE_IRQ,},
87 {PM8607_IRQ_CHG_DONE, PM8607_IRQ_CHG_DONE, "charging done", IORESOURCE_IRQ,},
88 {PM8607_IRQ_CHG_FAIL, PM8607_IRQ_CHG_FAIL, "charging timeout", IORESOURCE_IRQ,},
89 {PM8607_IRQ_CHG_FAULT, PM8607_IRQ_CHG_FAULT, "charging fault", IORESOURCE_IRQ,},
90 {PM8607_IRQ_GPADC1, PM8607_IRQ_GPADC1, "battery temperature", IORESOURCE_IRQ,},
91 {PM8607_IRQ_VBAT, PM8607_IRQ_VBAT, "battery voltage", IORESOURCE_IRQ,},
92 {PM8607_IRQ_VCHG, PM8607_IRQ_VCHG, "vchg voltage", IORESOURCE_IRQ,},
95 static struct resource preg_resources[] __devinitdata = {
96 {PM8606_ID_PREG, PM8606_ID_PREG, "preg", IORESOURCE_IO,},
99 static struct resource rtc_resources[] __devinitdata = {
100 {PM8607_IRQ_RTC, PM8607_IRQ_RTC, "rtc", IORESOURCE_IRQ,},
103 static struct mfd_cell bk_devs[] = {
104 {"88pm860x-backlight", 0,},
105 {"88pm860x-backlight", 1,},
106 {"88pm860x-backlight", 2,},
109 static struct mfd_cell led_devs[] = {
110 {"88pm860x-led", 0,},
111 {"88pm860x-led", 1,},
112 {"88pm860x-led", 2,},
113 {"88pm860x-led", 3,},
114 {"88pm860x-led", 4,},
115 {"88pm860x-led", 5,},
118 static struct mfd_cell regulator_devs[] = {
119 {"88pm860x-regulator", 0,},
120 {"88pm860x-regulator", 1,},
121 {"88pm860x-regulator", 2,},
122 {"88pm860x-regulator", 3,},
123 {"88pm860x-regulator", 4,},
124 {"88pm860x-regulator", 5,},
125 {"88pm860x-regulator", 6,},
126 {"88pm860x-regulator", 7,},
127 {"88pm860x-regulator", 8,},
128 {"88pm860x-regulator", 9,},
129 {"88pm860x-regulator", 10,},
130 {"88pm860x-regulator", 11,},
131 {"88pm860x-regulator", 12,},
132 {"88pm860x-regulator", 13,},
133 {"88pm860x-regulator", 14,},
134 {"88pm860x-regulator", 15,},
135 {"88pm860x-regulator", 16,},
136 {"88pm860x-regulator", 17,},
139 static struct mfd_cell touch_devs[] = {
140 {"88pm860x-touch", -1,},
143 static struct mfd_cell onkey_devs[] = {
144 {"88pm860x-onkey", -1,},
147 static struct mfd_cell codec_devs[] = {
148 {"88pm860x-codec", -1,},
151 static struct regulator_consumer_supply preg_supply[] = {
152 REGULATOR_SUPPLY("preg", "charger-manager"),
155 static struct regulator_init_data preg_init_data = {
156 .num_consumer_supplies = ARRAY_SIZE(preg_supply),
157 .consumer_supplies = &preg_supply[0],
160 static struct regulator_bulk_data chg_desc_regulator_data[] = {
161 { .supply = "preg", },
164 static struct mfd_cell power_devs[] = {
165 {"88pm860x-battery", -1,},
166 {"88pm860x-charger", -1,},
167 {"88pm860x-preg", -1,},
168 {"charger-manager", -1,},
171 static struct mfd_cell rtc_devs[] = {
172 {"88pm860x-rtc", -1,},
176 struct pm860x_irq_data {
179 int enable; /* enable or not */
180 int offs; /* bit offset in mask register */
183 static struct pm860x_irq_data pm860x_irqs[] = {
184 [PM8607_IRQ_ONKEY] = {
185 .reg = PM8607_INT_STATUS1,
186 .mask_reg = PM8607_INT_MASK_1,
189 [PM8607_IRQ_EXTON] = {
190 .reg = PM8607_INT_STATUS1,
191 .mask_reg = PM8607_INT_MASK_1,
195 .reg = PM8607_INT_STATUS1,
196 .mask_reg = PM8607_INT_MASK_1,
200 .reg = PM8607_INT_STATUS1,
201 .mask_reg = PM8607_INT_MASK_1,
205 .reg = PM8607_INT_STATUS1,
206 .mask_reg = PM8607_INT_MASK_1,
210 .reg = PM8607_INT_STATUS1,
211 .mask_reg = PM8607_INT_MASK_1,
214 [PM8607_IRQ_VBAT] = {
215 .reg = PM8607_INT_STATUS2,
216 .mask_reg = PM8607_INT_MASK_2,
219 [PM8607_IRQ_VCHG] = {
220 .reg = PM8607_INT_STATUS2,
221 .mask_reg = PM8607_INT_MASK_2,
224 [PM8607_IRQ_VSYS] = {
225 .reg = PM8607_INT_STATUS2,
226 .mask_reg = PM8607_INT_MASK_2,
229 [PM8607_IRQ_TINT] = {
230 .reg = PM8607_INT_STATUS2,
231 .mask_reg = PM8607_INT_MASK_2,
234 [PM8607_IRQ_GPADC0] = {
235 .reg = PM8607_INT_STATUS2,
236 .mask_reg = PM8607_INT_MASK_2,
239 [PM8607_IRQ_GPADC1] = {
240 .reg = PM8607_INT_STATUS2,
241 .mask_reg = PM8607_INT_MASK_2,
244 [PM8607_IRQ_GPADC2] = {
245 .reg = PM8607_INT_STATUS2,
246 .mask_reg = PM8607_INT_MASK_2,
249 [PM8607_IRQ_GPADC3] = {
250 .reg = PM8607_INT_STATUS2,
251 .mask_reg = PM8607_INT_MASK_2,
254 [PM8607_IRQ_AUDIO_SHORT] = {
255 .reg = PM8607_INT_STATUS3,
256 .mask_reg = PM8607_INT_MASK_3,
260 .reg = PM8607_INT_STATUS3,
261 .mask_reg = PM8607_INT_MASK_3,
264 [PM8607_IRQ_HEADSET] = {
265 .reg = PM8607_INT_STATUS3,
266 .mask_reg = PM8607_INT_MASK_3,
269 [PM8607_IRQ_HOOK] = {
270 .reg = PM8607_INT_STATUS3,
271 .mask_reg = PM8607_INT_MASK_3,
274 [PM8607_IRQ_MICIN] = {
275 .reg = PM8607_INT_STATUS3,
276 .mask_reg = PM8607_INT_MASK_3,
279 [PM8607_IRQ_CHG_FAIL] = {
280 .reg = PM8607_INT_STATUS3,
281 .mask_reg = PM8607_INT_MASK_3,
284 [PM8607_IRQ_CHG_DONE] = {
285 .reg = PM8607_INT_STATUS3,
286 .mask_reg = PM8607_INT_MASK_3,
289 [PM8607_IRQ_CHG_FAULT] = {
290 .reg = PM8607_INT_STATUS3,
291 .mask_reg = PM8607_INT_MASK_3,
296 static irqreturn_t pm860x_irq(int irq, void *data)
298 struct pm860x_chip *chip = data;
299 struct pm860x_irq_data *irq_data;
300 struct i2c_client *i2c;
301 int read_reg = -1, value = 0;
304 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
305 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
306 irq_data = &pm860x_irqs[i];
307 if (read_reg != irq_data->reg) {
308 read_reg = irq_data->reg;
309 value = pm860x_reg_read(i2c, irq_data->reg);
311 if (value & irq_data->enable)
312 handle_nested_irq(chip->irq_base + i);
317 static void pm860x_irq_lock(struct irq_data *data)
319 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
321 mutex_lock(&chip->irq_lock);
324 static void pm860x_irq_sync_unlock(struct irq_data *data)
326 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
327 struct pm860x_irq_data *irq_data;
328 struct i2c_client *i2c;
329 static unsigned char cached[3] = {0x0, 0x0, 0x0};
330 unsigned char mask[3];
333 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
334 /* Load cached value. In initial, all IRQs are masked */
335 for (i = 0; i < 3; i++)
337 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
338 irq_data = &pm860x_irqs[i];
339 switch (irq_data->mask_reg) {
340 case PM8607_INT_MASK_1:
341 mask[0] &= ~irq_data->offs;
342 mask[0] |= irq_data->enable;
344 case PM8607_INT_MASK_2:
345 mask[1] &= ~irq_data->offs;
346 mask[1] |= irq_data->enable;
348 case PM8607_INT_MASK_3:
349 mask[2] &= ~irq_data->offs;
350 mask[2] |= irq_data->enable;
353 dev_err(chip->dev, "wrong IRQ\n");
357 /* update mask into registers */
358 for (i = 0; i < 3; i++) {
359 if (mask[i] != cached[i]) {
361 pm860x_reg_write(i2c, PM8607_INT_MASK_1 + i, mask[i]);
365 mutex_unlock(&chip->irq_lock);
368 static void pm860x_irq_enable(struct irq_data *data)
370 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
371 pm860x_irqs[data->irq - chip->irq_base].enable
372 = pm860x_irqs[data->irq - chip->irq_base].offs;
375 static void pm860x_irq_disable(struct irq_data *data)
377 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
378 pm860x_irqs[data->irq - chip->irq_base].enable = 0;
381 static struct irq_chip pm860x_irq_chip = {
383 .irq_bus_lock = pm860x_irq_lock,
384 .irq_bus_sync_unlock = pm860x_irq_sync_unlock,
385 .irq_enable = pm860x_irq_enable,
386 .irq_disable = pm860x_irq_disable,
389 static int __devinit device_gpadc_init(struct pm860x_chip *chip,
390 struct pm860x_platform_data *pdata)
392 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
397 /* initialize GPADC without activating it */
399 if (!pdata || !pdata->touch)
402 /* set GPADC MISC1 register */
404 data |= (pdata->touch->gpadc_prebias << 1) & PM8607_GPADC_PREBIAS_MASK;
405 data |= (pdata->touch->slot_cycle << 3) & PM8607_GPADC_SLOT_CYCLE_MASK;
406 data |= (pdata->touch->off_scale << 5) & PM8607_GPADC_OFF_SCALE_MASK;
407 data |= (pdata->touch->sw_cal << 7) & PM8607_GPADC_SW_CAL_MASK;
409 ret = pm860x_reg_write(i2c, PM8607_GPADC_MISC1, data);
413 /* set tsi prebias time */
414 if (pdata->touch->tsi_prebias) {
415 data = pdata->touch->tsi_prebias;
416 ret = pm860x_reg_write(i2c, PM8607_TSI_PREBIAS, data);
420 /* set prebias & prechg time of pen detect */
422 data |= pdata->touch->pen_prebias & PM8607_PD_PREBIAS_MASK;
423 data |= (pdata->touch->pen_prechg << 5) & PM8607_PD_PRECHG_MASK;
425 ret = pm860x_reg_write(i2c, PM8607_PD_PREBIAS, data);
430 ret = pm860x_set_bits(i2c, PM8607_GPADC_MISC1,
431 PM8607_GPADC_EN, PM8607_GPADC_EN);
436 static int __devinit device_irq_init(struct pm860x_chip *chip,
437 struct pm860x_platform_data *pdata)
439 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
441 unsigned char status_buf[INT_STATUS_NUM];
442 unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
443 int i, data, mask, ret = -EINVAL;
446 if (!pdata || !pdata->irq_base) {
447 dev_warn(chip->dev, "No interrupt support on IRQ base\n");
451 mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR
452 | PM8607_B0_MISC1_INT_MASK;
455 if (pdata && pdata->irq_mode) {
457 * irq_mode defines the way of clearing interrupt. If it's 1,
458 * clear IRQ by write. Otherwise, clear it by read.
459 * This control bit is valid from 88PM8607 B0 steping.
461 data |= PM8607_B0_MISC1_INT_CLEAR;
464 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, mask, data);
469 memset(status_buf, 0, INT_STATUS_NUM);
470 ret = pm860x_bulk_write(i2c, PM8607_INT_MASK_1,
471 INT_STATUS_NUM, status_buf);
475 if (chip->irq_mode) {
476 /* clear interrupt status by write */
477 memset(status_buf, 0xFF, INT_STATUS_NUM);
478 ret = pm860x_bulk_write(i2c, PM8607_INT_STATUS1,
479 INT_STATUS_NUM, status_buf);
481 /* clear interrupt status by read */
482 ret = pm860x_bulk_read(i2c, PM8607_INT_STATUS1,
483 INT_STATUS_NUM, status_buf);
488 mutex_init(&chip->irq_lock);
489 chip->irq_base = pdata->irq_base;
490 chip->core_irq = i2c->irq;
494 /* register IRQ by genirq */
495 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
496 __irq = i + chip->irq_base;
497 irq_set_chip_data(__irq, chip);
498 irq_set_chip_and_handler(__irq, &pm860x_irq_chip,
500 irq_set_nested_thread(__irq, 1);
502 set_irq_flags(__irq, IRQF_VALID);
504 irq_set_noprobe(__irq);
508 ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags,
511 dev_err(chip->dev, "Failed to request IRQ: %d\n", ret);
521 static void device_irq_exit(struct pm860x_chip *chip)
524 free_irq(chip->core_irq, chip);
527 int pm8606_osc_enable(struct pm860x_chip *chip, unsigned short client)
530 struct i2c_client *i2c = (chip->id == CHIP_PM8606) ?
531 chip->client : chip->companion;
533 dev_dbg(chip->dev, "%s(B): client=0x%x\n", __func__, client);
534 dev_dbg(chip->dev, "%s(B): vote=0x%x status=%d\n",
535 __func__, chip->osc_vote,
538 mutex_lock(&chip->osc_lock);
539 /* Update voting status */
540 chip->osc_vote |= client;
541 /* If reference group is off - turn on*/
542 if (chip->osc_status != PM8606_REF_GP_OSC_ON) {
543 chip->osc_status = PM8606_REF_GP_OSC_UNKNOWN;
544 /* Enable Reference group Vsys */
545 if (pm860x_set_bits(i2c, PM8606_VSYS,
546 PM8606_VSYS_EN, PM8606_VSYS_EN))
549 /*Enable Internal Oscillator */
550 if (pm860x_set_bits(i2c, PM8606_MISC,
551 PM8606_MISC_OSC_EN, PM8606_MISC_OSC_EN))
553 /* Update status (only if writes succeed) */
554 chip->osc_status = PM8606_REF_GP_OSC_ON;
556 mutex_unlock(&chip->osc_lock);
558 dev_dbg(chip->dev, "%s(A): vote=0x%x status=%d ret=%d\n",
559 __func__, chip->osc_vote,
560 chip->osc_status, ret);
563 mutex_unlock(&chip->osc_lock);
566 EXPORT_SYMBOL(pm8606_osc_enable);
568 int pm8606_osc_disable(struct pm860x_chip *chip, unsigned short client)
571 struct i2c_client *i2c = (chip->id == CHIP_PM8606) ?
572 chip->client : chip->companion;
574 dev_dbg(chip->dev, "%s(B): client=0x%x\n", __func__, client);
575 dev_dbg(chip->dev, "%s(B): vote=0x%x status=%d\n",
576 __func__, chip->osc_vote,
579 mutex_lock(&chip->osc_lock);
580 /*Update voting status */
581 chip->osc_vote &= ~(client);
582 /* If reference group is off and this is the last client to release
584 if ((chip->osc_status != PM8606_REF_GP_OSC_OFF) &&
585 (chip->osc_vote == REF_GP_NO_CLIENTS)) {
586 chip->osc_status = PM8606_REF_GP_OSC_UNKNOWN;
587 /* Disable Reference group Vsys */
588 if (pm860x_set_bits(i2c, PM8606_VSYS, PM8606_VSYS_EN, 0))
590 /* Disable Internal Oscillator */
591 if (pm860x_set_bits(i2c, PM8606_MISC, PM8606_MISC_OSC_EN, 0))
593 chip->osc_status = PM8606_REF_GP_OSC_OFF;
595 mutex_unlock(&chip->osc_lock);
597 dev_dbg(chip->dev, "%s(A): vote=0x%x status=%d ret=%d\n",
598 __func__, chip->osc_vote,
599 chip->osc_status, ret);
602 mutex_unlock(&chip->osc_lock);
605 EXPORT_SYMBOL(pm8606_osc_disable);
607 static void __devinit device_osc_init(struct i2c_client *i2c)
609 struct pm860x_chip *chip = i2c_get_clientdata(i2c);
611 mutex_init(&chip->osc_lock);
612 /* init portofino reference group voting and status */
613 /* Disable Reference group Vsys */
614 pm860x_set_bits(i2c, PM8606_VSYS, PM8606_VSYS_EN, 0);
615 /* Disable Internal Oscillator */
616 pm860x_set_bits(i2c, PM8606_MISC, PM8606_MISC_OSC_EN, 0);
618 chip->osc_vote = REF_GP_NO_CLIENTS;
619 chip->osc_status = PM8606_REF_GP_OSC_OFF;
622 static void __devinit device_bk_init(struct pm860x_chip *chip,
623 struct pm860x_platform_data *pdata)
628 if ((pdata == NULL) || (pdata->backlight == NULL))
631 if (pdata->num_backlights > ARRAY_SIZE(bk_devs))
632 pdata->num_backlights = ARRAY_SIZE(bk_devs);
634 for (i = 0; i < pdata->num_backlights; i++) {
635 bk_devs[i].platform_data = &pdata->backlight[i];
636 bk_devs[i].pdata_size = sizeof(struct pm860x_backlight_pdata);
638 for (j = 0; j < ARRAY_SIZE(bk_devs); j++) {
639 id = bk_resources[j].start;
640 if (pdata->backlight[i].flags != id)
643 bk_devs[i].num_resources = 1;
644 bk_devs[i].resources = &bk_resources[j];
645 ret = mfd_add_devices(chip->dev, 0,
647 &bk_resources[j], 0);
649 dev_err(chip->dev, "Failed to add "
650 "backlight subdev\n");
657 static void __devinit device_led_init(struct pm860x_chip *chip,
658 struct pm860x_platform_data *pdata)
663 if ((pdata == NULL) || (pdata->led == NULL))
666 if (pdata->num_leds > ARRAY_SIZE(led_devs))
667 pdata->num_leds = ARRAY_SIZE(led_devs);
669 for (i = 0; i < pdata->num_leds; i++) {
670 led_devs[i].platform_data = &pdata->led[i];
671 led_devs[i].pdata_size = sizeof(struct pm860x_led_pdata);
673 for (j = 0; j < ARRAY_SIZE(led_devs); j++) {
674 id = led_resources[j].start;
675 if (pdata->led[i].flags != id)
678 led_devs[i].num_resources = 1;
679 led_devs[i].resources = &led_resources[j],
680 ret = mfd_add_devices(chip->dev, 0,
682 &led_resources[j], 0);
684 dev_err(chip->dev, "Failed to add "
692 static void __devinit device_regulator_init(struct pm860x_chip *chip,
693 struct pm860x_platform_data *pdata)
695 struct regulator_init_data *initdata;
699 if ((pdata == NULL) || (pdata->regulator == NULL))
702 if (pdata->num_regulators > ARRAY_SIZE(regulator_devs))
703 pdata->num_regulators = ARRAY_SIZE(regulator_devs);
705 for (i = 0, seq = -1; i < pdata->num_regulators; i++) {
706 initdata = &pdata->regulator[i];
707 seq = *(unsigned int *)initdata->driver_data;
708 if ((seq < 0) || (seq > PM8607_ID_RG_MAX)) {
709 dev_err(chip->dev, "Wrong ID(%d) on regulator(%s)\n",
710 seq, initdata->constraints.name);
713 regulator_devs[i].platform_data = &pdata->regulator[i];
714 regulator_devs[i].pdata_size = sizeof(struct regulator_init_data);
715 regulator_devs[i].num_resources = 1;
716 regulator_devs[i].resources = ®ulator_resources[seq];
718 ret = mfd_add_devices(chip->dev, 0, ®ulator_devs[i], 1,
719 ®ulator_resources[seq], 0);
721 dev_err(chip->dev, "Failed to add regulator subdev\n");
729 static void __devinit device_rtc_init(struct pm860x_chip *chip,
730 struct pm860x_platform_data *pdata)
737 rtc_devs[0].platform_data = pdata->rtc;
738 rtc_devs[0].pdata_size = sizeof(struct pm860x_rtc_pdata);
739 rtc_devs[0].num_resources = ARRAY_SIZE(rtc_resources);
740 rtc_devs[0].resources = &rtc_resources[0];
741 ret = mfd_add_devices(chip->dev, 0, &rtc_devs[0],
742 ARRAY_SIZE(rtc_devs), &rtc_resources[0],
745 dev_err(chip->dev, "Failed to add rtc subdev\n");
748 static void __devinit device_touch_init(struct pm860x_chip *chip,
749 struct pm860x_platform_data *pdata)
756 touch_devs[0].platform_data = pdata->touch;
757 touch_devs[0].pdata_size = sizeof(struct pm860x_touch_pdata);
758 touch_devs[0].num_resources = ARRAY_SIZE(touch_resources);
759 touch_devs[0].resources = &touch_resources[0];
760 ret = mfd_add_devices(chip->dev, 0, &touch_devs[0],
761 ARRAY_SIZE(touch_devs), &touch_resources[0],
764 dev_err(chip->dev, "Failed to add touch subdev\n");
767 static void __devinit device_power_init(struct pm860x_chip *chip,
768 struct pm860x_platform_data *pdata)
775 power_devs[0].platform_data = pdata->power;
776 power_devs[0].pdata_size = sizeof(struct pm860x_power_pdata);
777 power_devs[0].num_resources = ARRAY_SIZE(battery_resources);
778 power_devs[0].resources = &battery_resources[0],
779 ret = mfd_add_devices(chip->dev, 0, &power_devs[0], 1,
780 &battery_resources[0], chip->irq_base);
782 dev_err(chip->dev, "Failed to add battery subdev\n");
784 power_devs[1].platform_data = pdata->power;
785 power_devs[1].pdata_size = sizeof(struct pm860x_power_pdata);
786 power_devs[1].num_resources = ARRAY_SIZE(charger_resources);
787 power_devs[1].resources = &charger_resources[0],
788 ret = mfd_add_devices(chip->dev, 0, &power_devs[1], 1,
789 &charger_resources[0], chip->irq_base);
791 dev_err(chip->dev, "Failed to add charger subdev\n");
793 power_devs[2].platform_data = &preg_init_data;
794 power_devs[2].pdata_size = sizeof(struct regulator_init_data);
795 power_devs[2].num_resources = ARRAY_SIZE(preg_resources);
796 power_devs[2].resources = &preg_resources[0],
797 ret = mfd_add_devices(chip->dev, 0, &power_devs[2], 1,
798 &preg_resources[0], chip->irq_base);
800 dev_err(chip->dev, "Failed to add preg subdev\n");
802 if (pdata->chg_desc) {
803 pdata->chg_desc->charger_regulators =
804 &chg_desc_regulator_data[0];
805 pdata->chg_desc->num_charger_regulators =
806 ARRAY_SIZE(chg_desc_regulator_data),
807 power_devs[3].platform_data = pdata->chg_desc;
808 power_devs[3].pdata_size = sizeof(*pdata->chg_desc);
809 ret = mfd_add_devices(chip->dev, 0, &power_devs[3], 1,
810 NULL, chip->irq_base);
812 dev_err(chip->dev, "Failed to add chg-manager subdev\n");
816 static void __devinit device_onkey_init(struct pm860x_chip *chip,
817 struct pm860x_platform_data *pdata)
821 onkey_devs[0].num_resources = ARRAY_SIZE(onkey_resources);
822 onkey_devs[0].resources = &onkey_resources[0],
823 ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0],
824 ARRAY_SIZE(onkey_devs), &onkey_resources[0],
827 dev_err(chip->dev, "Failed to add onkey subdev\n");
830 static void __devinit device_codec_init(struct pm860x_chip *chip,
831 struct pm860x_platform_data *pdata)
835 codec_devs[0].num_resources = ARRAY_SIZE(codec_resources);
836 codec_devs[0].resources = &codec_resources[0],
837 ret = mfd_add_devices(chip->dev, 0, &codec_devs[0],
838 ARRAY_SIZE(codec_devs), &codec_resources[0], 0);
840 dev_err(chip->dev, "Failed to add codec subdev\n");
843 static void __devinit device_8607_init(struct pm860x_chip *chip,
844 struct i2c_client *i2c,
845 struct pm860x_platform_data *pdata)
849 ret = pm860x_reg_read(i2c, PM8607_CHIP_ID);
851 dev_err(chip->dev, "Failed to read CHIP ID: %d\n", ret);
854 switch (ret & PM8607_VERSION_MASK) {
857 dev_info(chip->dev, "Marvell 88PM8607 (ID: %02x) detected\n",
861 dev_err(chip->dev, "Failed to detect Marvell 88PM8607. "
862 "Chip ID: %02x\n", ret);
866 ret = pm860x_reg_read(i2c, PM8607_BUCK3);
868 dev_err(chip->dev, "Failed to read BUCK3 register: %d\n", ret);
871 if (ret & PM8607_BUCK3_DOUBLE)
872 chip->buck3_double = 1;
874 ret = pm860x_reg_read(i2c, PM8607_B0_MISC1);
876 dev_err(chip->dev, "Failed to read MISC1 register: %d\n", ret);
880 if (pdata && (pdata->i2c_port == PI2C_PORT))
881 data = PM8607_B0_MISC1_PI2C;
884 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, PM8607_B0_MISC1_PI2C, data);
886 dev_err(chip->dev, "Failed to access MISC1:%d\n", ret);
890 ret = device_gpadc_init(chip, pdata);
894 ret = device_irq_init(chip, pdata);
898 device_regulator_init(chip, pdata);
899 device_rtc_init(chip, pdata);
900 device_onkey_init(chip, pdata);
901 device_touch_init(chip, pdata);
902 device_power_init(chip, pdata);
903 device_codec_init(chip, pdata);
908 static void __devinit device_8606_init(struct pm860x_chip *chip,
909 struct i2c_client *i2c,
910 struct pm860x_platform_data *pdata)
912 device_osc_init(i2c);
913 device_bk_init(chip, pdata);
914 device_led_init(chip, pdata);
917 int __devinit pm860x_device_init(struct pm860x_chip *chip,
918 struct pm860x_platform_data *pdata)
924 device_8606_init(chip, chip->client, pdata);
927 device_8607_init(chip, chip->client, pdata);
931 if (chip->companion) {
934 device_8606_init(chip, chip->companion, pdata);
937 device_8607_init(chip, chip->companion, pdata);
945 void __devexit pm860x_device_exit(struct pm860x_chip *chip)
947 device_irq_exit(chip);
948 mfd_remove_devices(chip->dev);
951 MODULE_DESCRIPTION("PMIC Driver for Marvell 88PM860x");
952 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
953 MODULE_LICENSE("GPL");