blob: d09918cf1b1556a74edb622e0174d3ceffdf7ca6 [file] [log] [blame]
Haojian Zhuangbbd51b12010-01-06 17:04:18 -05001/*
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>
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -050014#include <linux/i2c.h>
Haojian Zhuang2afa62e2010-02-08 05:02:00 -050015#include <linux/irq.h>
Haojian Zhuangbbd51b12010-01-06 17:04:18 -050016#include <linux/interrupt.h>
17#include <linux/platform_device.h>
18#include <linux/mfd/core.h>
Haojian Zhuang53dbab72010-01-08 06:01:24 -050019#include <linux/mfd/88pm860x.h>
Haojian Zhuang22aad002011-03-07 23:43:11 +080020#include <linux/regulator/machine.h>
Haojian Zhuangbbd51b12010-01-06 17:04:18 -050021
Haojian Zhuang2afa62e2010-02-08 05:02:00 -050022#define INT_STATUS_NUM 3
23
Haojian Zhuanga5156f12011-04-26 11:06:22 +020024static struct resource bk_resources[] __devinitdata = {
Haojian Zhuangadb70482011-03-07 23:43:09 +080025 {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,},
Haojian Zhuanga16122b2009-12-15 16:04:36 -050028};
Haojian Zhuangadb70482011-03-07 23:43:09 +080029
Haojian Zhuanga5156f12011-04-26 11:06:22 +020030static struct resource led_resources[] __devinitdata = {
Haojian Zhuang3154c342011-03-07 23:43:10 +080031 {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
Haojian Zhuanga5156f12011-04-26 11:06:22 +020039static struct resource regulator_resources[] __devinitdata = {
Haojian Zhuang22aad002011-03-07 23:43:11 +080040 {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
Haojian Zhuanga5156f12011-04-26 11:06:22 +020060static struct resource touch_resources[] __devinitdata = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +080061 {PM8607_IRQ_PEN, PM8607_IRQ_PEN, "touch", IORESOURCE_IRQ,},
62};
63
Haojian Zhuanga5156f12011-04-26 11:06:22 +020064static struct resource onkey_resources[] __devinitdata = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +080065 {PM8607_IRQ_ONKEY, PM8607_IRQ_ONKEY, "onkey", IORESOURCE_IRQ,},
66};
67
Haojian Zhuanga5156f12011-04-26 11:06:22 +020068static struct resource codec_resources[] __devinitdata = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +080069 /* 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
Haojian Zhuanga5156f12011-04-26 11:06:22 +020079static struct resource battery_resources[] __devinitdata = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +080080 {PM8607_IRQ_CC, PM8607_IRQ_CC, "columb counter", IORESOURCE_IRQ,},
81 {PM8607_IRQ_BAT, PM8607_IRQ_BAT, "battery", IORESOURCE_IRQ,},
82};
83
Haojian Zhuanga5156f12011-04-26 11:06:22 +020084static struct resource charger_resources[] __devinitdata = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +080085 {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
Jett.Zhou2573f6d2012-07-06 10:59:58 +080093static struct resource preg_resources[] __devinitdata = {
94 {PM8606_ID_PREG, PM8606_ID_PREG, "preg", IORESOURCE_IO,},
95};
96
Haojian Zhuang008b3042011-05-06 17:21:20 +080097static struct resource rtc_resources[] __devinitdata = {
98 {PM8607_IRQ_RTC, PM8607_IRQ_RTC, "rtc", IORESOURCE_IRQ,},
99};
100
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200101static struct mfd_cell bk_devs[] = {
Haojian Zhuangadb70482011-03-07 23:43:09 +0800102 {"88pm860x-backlight", 0,},
103 {"88pm860x-backlight", 1,},
104 {"88pm860x-backlight", 2,},
105};
106
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200107static struct mfd_cell led_devs[] = {
Haojian Zhuang3154c342011-03-07 23:43:10 +0800108 {"88pm860x-led", 0,},
109 {"88pm860x-led", 1,},
110 {"88pm860x-led", 2,},
111 {"88pm860x-led", 3,},
112 {"88pm860x-led", 4,},
113 {"88pm860x-led", 5,},
114};
115
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200116static struct mfd_cell regulator_devs[] = {
Haojian Zhuang22aad002011-03-07 23:43:11 +0800117 {"88pm860x-regulator", 0,},
118 {"88pm860x-regulator", 1,},
119 {"88pm860x-regulator", 2,},
120 {"88pm860x-regulator", 3,},
121 {"88pm860x-regulator", 4,},
122 {"88pm860x-regulator", 5,},
123 {"88pm860x-regulator", 6,},
124 {"88pm860x-regulator", 7,},
125 {"88pm860x-regulator", 8,},
126 {"88pm860x-regulator", 9,},
127 {"88pm860x-regulator", 10,},
128 {"88pm860x-regulator", 11,},
129 {"88pm860x-regulator", 12,},
130 {"88pm860x-regulator", 13,},
131 {"88pm860x-regulator", 14,},
132 {"88pm860x-regulator", 15,},
133 {"88pm860x-regulator", 16,},
134 {"88pm860x-regulator", 17,},
135};
136
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200137static struct mfd_cell touch_devs[] = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800138 {"88pm860x-touch", -1,},
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500139};
140
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200141static struct mfd_cell onkey_devs[] = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800142 {"88pm860x-onkey", -1,},
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500143};
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500144
Haojian Zhuanga5156f12011-04-26 11:06:22 +0200145static struct mfd_cell codec_devs[] = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800146 {"88pm860x-codec", -1,},
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500147};
148
Jett.Zhou2573f6d2012-07-06 10:59:58 +0800149static struct regulator_consumer_supply preg_supply[] = {
150 REGULATOR_SUPPLY("preg", "charger-manager"),
151};
152
153static struct regulator_init_data preg_init_data = {
154 .num_consumer_supplies = ARRAY_SIZE(preg_supply),
155 .consumer_supplies = &preg_supply[0],
156};
157
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500158static struct mfd_cell power_devs[] = {
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800159 {"88pm860x-battery", -1,},
160 {"88pm860x-charger", -1,},
Jett.Zhou2573f6d2012-07-06 10:59:58 +0800161 {"88pm860x-preg", -1,},
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500162};
163
Haojian Zhuang008b3042011-05-06 17:21:20 +0800164static struct mfd_cell rtc_devs[] = {
165 {"88pm860x-rtc", -1,},
166};
167
Haojian Zhuang2c36af72010-08-12 11:59:33 +0800168
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500169struct pm860x_irq_data {
170 int reg;
171 int mask_reg;
172 int enable; /* enable or not */
173 int offs; /* bit offset in mask register */
174};
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500175
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500176static struct pm860x_irq_data pm860x_irqs[] = {
177 [PM8607_IRQ_ONKEY] = {
178 .reg = PM8607_INT_STATUS1,
179 .mask_reg = PM8607_INT_MASK_1,
180 .offs = 1 << 0,
181 },
182 [PM8607_IRQ_EXTON] = {
183 .reg = PM8607_INT_STATUS1,
184 .mask_reg = PM8607_INT_MASK_1,
185 .offs = 1 << 1,
186 },
187 [PM8607_IRQ_CHG] = {
188 .reg = PM8607_INT_STATUS1,
189 .mask_reg = PM8607_INT_MASK_1,
190 .offs = 1 << 2,
191 },
192 [PM8607_IRQ_BAT] = {
193 .reg = PM8607_INT_STATUS1,
194 .mask_reg = PM8607_INT_MASK_1,
195 .offs = 1 << 3,
196 },
197 [PM8607_IRQ_RTC] = {
198 .reg = PM8607_INT_STATUS1,
199 .mask_reg = PM8607_INT_MASK_1,
200 .offs = 1 << 4,
201 },
202 [PM8607_IRQ_CC] = {
203 .reg = PM8607_INT_STATUS1,
204 .mask_reg = PM8607_INT_MASK_1,
205 .offs = 1 << 5,
206 },
207 [PM8607_IRQ_VBAT] = {
208 .reg = PM8607_INT_STATUS2,
209 .mask_reg = PM8607_INT_MASK_2,
210 .offs = 1 << 0,
211 },
212 [PM8607_IRQ_VCHG] = {
213 .reg = PM8607_INT_STATUS2,
214 .mask_reg = PM8607_INT_MASK_2,
215 .offs = 1 << 1,
216 },
217 [PM8607_IRQ_VSYS] = {
218 .reg = PM8607_INT_STATUS2,
219 .mask_reg = PM8607_INT_MASK_2,
220 .offs = 1 << 2,
221 },
222 [PM8607_IRQ_TINT] = {
223 .reg = PM8607_INT_STATUS2,
224 .mask_reg = PM8607_INT_MASK_2,
225 .offs = 1 << 3,
226 },
227 [PM8607_IRQ_GPADC0] = {
228 .reg = PM8607_INT_STATUS2,
229 .mask_reg = PM8607_INT_MASK_2,
230 .offs = 1 << 4,
231 },
232 [PM8607_IRQ_GPADC1] = {
233 .reg = PM8607_INT_STATUS2,
234 .mask_reg = PM8607_INT_MASK_2,
235 .offs = 1 << 5,
236 },
237 [PM8607_IRQ_GPADC2] = {
238 .reg = PM8607_INT_STATUS2,
239 .mask_reg = PM8607_INT_MASK_2,
240 .offs = 1 << 6,
241 },
242 [PM8607_IRQ_GPADC3] = {
243 .reg = PM8607_INT_STATUS2,
244 .mask_reg = PM8607_INT_MASK_2,
245 .offs = 1 << 7,
246 },
247 [PM8607_IRQ_AUDIO_SHORT] = {
248 .reg = PM8607_INT_STATUS3,
249 .mask_reg = PM8607_INT_MASK_3,
250 .offs = 1 << 0,
251 },
252 [PM8607_IRQ_PEN] = {
253 .reg = PM8607_INT_STATUS3,
254 .mask_reg = PM8607_INT_MASK_3,
255 .offs = 1 << 1,
256 },
257 [PM8607_IRQ_HEADSET] = {
258 .reg = PM8607_INT_STATUS3,
259 .mask_reg = PM8607_INT_MASK_3,
260 .offs = 1 << 2,
261 },
262 [PM8607_IRQ_HOOK] = {
263 .reg = PM8607_INT_STATUS3,
264 .mask_reg = PM8607_INT_MASK_3,
265 .offs = 1 << 3,
266 },
267 [PM8607_IRQ_MICIN] = {
268 .reg = PM8607_INT_STATUS3,
269 .mask_reg = PM8607_INT_MASK_3,
270 .offs = 1 << 4,
271 },
272 [PM8607_IRQ_CHG_FAIL] = {
273 .reg = PM8607_INT_STATUS3,
274 .mask_reg = PM8607_INT_MASK_3,
275 .offs = 1 << 5,
276 },
277 [PM8607_IRQ_CHG_DONE] = {
278 .reg = PM8607_INT_STATUS3,
279 .mask_reg = PM8607_INT_MASK_3,
280 .offs = 1 << 6,
281 },
282 [PM8607_IRQ_CHG_FAULT] = {
283 .reg = PM8607_INT_STATUS3,
284 .mask_reg = PM8607_INT_MASK_3,
285 .offs = 1 << 7,
286 },
287};
288
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500289static irqreturn_t pm860x_irq(int irq, void *data)
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500290{
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500291 struct pm860x_chip *chip = data;
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500292 struct pm860x_irq_data *irq_data;
293 struct i2c_client *i2c;
294 int read_reg = -1, value = 0;
295 int i;
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500296
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500297 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
298 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
299 irq_data = &pm860x_irqs[i];
300 if (read_reg != irq_data->reg) {
301 read_reg = irq_data->reg;
302 value = pm860x_reg_read(i2c, irq_data->reg);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500303 }
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500304 if (value & irq_data->enable)
305 handle_nested_irq(chip->irq_base + i);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500306 }
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500307 return IRQ_HANDLED;
308}
309
Mark Brown49f89d92010-12-11 12:31:31 +0000310static void pm860x_irq_lock(struct irq_data *data)
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500311{
Mark Brown49f89d92010-12-11 12:31:31 +0000312 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500313
314 mutex_lock(&chip->irq_lock);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500315}
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500316
Mark Brown49f89d92010-12-11 12:31:31 +0000317static void pm860x_irq_sync_unlock(struct irq_data *data)
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500318{
Mark Brown49f89d92010-12-11 12:31:31 +0000319 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500320 struct pm860x_irq_data *irq_data;
321 struct i2c_client *i2c;
322 static unsigned char cached[3] = {0x0, 0x0, 0x0};
323 unsigned char mask[3];
324 int i;
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500325
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500326 i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
327 /* Load cached value. In initial, all IRQs are masked */
328 for (i = 0; i < 3; i++)
329 mask[i] = cached[i];
330 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
331 irq_data = &pm860x_irqs[i];
332 switch (irq_data->mask_reg) {
333 case PM8607_INT_MASK_1:
334 mask[0] &= ~irq_data->offs;
335 mask[0] |= irq_data->enable;
336 break;
337 case PM8607_INT_MASK_2:
338 mask[1] &= ~irq_data->offs;
339 mask[1] |= irq_data->enable;
340 break;
341 case PM8607_INT_MASK_3:
342 mask[2] &= ~irq_data->offs;
343 mask[2] |= irq_data->enable;
344 break;
345 default:
346 dev_err(chip->dev, "wrong IRQ\n");
347 break;
348 }
349 }
350 /* update mask into registers */
351 for (i = 0; i < 3; i++) {
352 if (mask[i] != cached[i]) {
353 cached[i] = mask[i];
354 pm860x_reg_write(i2c, PM8607_INT_MASK_1 + i, mask[i]);
355 }
356 }
357
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500358 mutex_unlock(&chip->irq_lock);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500359}
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500360
Mark Brown49f89d92010-12-11 12:31:31 +0000361static void pm860x_irq_enable(struct irq_data *data)
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500362{
Mark Brown49f89d92010-12-11 12:31:31 +0000363 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
364 pm860x_irqs[data->irq - chip->irq_base].enable
365 = pm860x_irqs[data->irq - chip->irq_base].offs;
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500366}
367
Mark Brown49f89d92010-12-11 12:31:31 +0000368static void pm860x_irq_disable(struct irq_data *data)
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500369{
Mark Brown49f89d92010-12-11 12:31:31 +0000370 struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
371 pm860x_irqs[data->irq - chip->irq_base].enable = 0;
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500372}
373
374static struct irq_chip pm860x_irq_chip = {
375 .name = "88pm860x",
Mark Brown49f89d92010-12-11 12:31:31 +0000376 .irq_bus_lock = pm860x_irq_lock,
377 .irq_bus_sync_unlock = pm860x_irq_sync_unlock,
378 .irq_enable = pm860x_irq_enable,
379 .irq_disable = pm860x_irq_disable,
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500380};
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500381
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500382static int __devinit device_gpadc_init(struct pm860x_chip *chip,
383 struct pm860x_platform_data *pdata)
384{
385 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
386 : chip->companion;
Dan Carpentereb6e8dd2010-05-27 00:54:09 +0200387 int data;
388 int ret;
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500389
390 /* initialize GPADC without activating it */
391
Dan Carpentereb6e8dd2010-05-27 00:54:09 +0200392 if (!pdata || !pdata->touch)
393 return -EINVAL;
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500394
Dan Carpentereb6e8dd2010-05-27 00:54:09 +0200395 /* set GPADC MISC1 register */
396 data = 0;
397 data |= (pdata->touch->gpadc_prebias << 1) & PM8607_GPADC_PREBIAS_MASK;
398 data |= (pdata->touch->slot_cycle << 3) & PM8607_GPADC_SLOT_CYCLE_MASK;
399 data |= (pdata->touch->off_scale << 5) & PM8607_GPADC_OFF_SCALE_MASK;
400 data |= (pdata->touch->sw_cal << 7) & PM8607_GPADC_SW_CAL_MASK;
401 if (data) {
402 ret = pm860x_reg_write(i2c, PM8607_GPADC_MISC1, data);
403 if (ret < 0)
404 goto out;
405 }
406 /* set tsi prebias time */
407 if (pdata->touch->tsi_prebias) {
408 data = pdata->touch->tsi_prebias;
409 ret = pm860x_reg_write(i2c, PM8607_TSI_PREBIAS, data);
410 if (ret < 0)
411 goto out;
412 }
413 /* set prebias & prechg time of pen detect */
414 data = 0;
415 data |= pdata->touch->pen_prebias & PM8607_PD_PREBIAS_MASK;
416 data |= (pdata->touch->pen_prechg << 5) & PM8607_PD_PRECHG_MASK;
417 if (data) {
418 ret = pm860x_reg_write(i2c, PM8607_PD_PREBIAS, data);
419 if (ret < 0)
420 goto out;
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500421 }
422
Dan Carpentereb6e8dd2010-05-27 00:54:09 +0200423 ret = pm860x_set_bits(i2c, PM8607_GPADC_MISC1,
424 PM8607_GPADC_EN, PM8607_GPADC_EN);
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500425out:
426 return ret;
427}
428
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500429static int __devinit device_irq_init(struct pm860x_chip *chip,
430 struct pm860x_platform_data *pdata)
431{
432 struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
433 : chip->companion;
434 unsigned char status_buf[INT_STATUS_NUM];
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500435 unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500436 int i, data, mask, ret = -EINVAL;
437 int __irq;
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500438
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500439 if (!pdata || !pdata->irq_base) {
440 dev_warn(chip->dev, "No interrupt support on IRQ base\n");
441 return -EINVAL;
442 }
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500443
444 mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR
445 | PM8607_B0_MISC1_INT_MASK;
446 data = 0;
447 chip->irq_mode = 0;
448 if (pdata && pdata->irq_mode) {
449 /*
450 * irq_mode defines the way of clearing interrupt. If it's 1,
451 * clear IRQ by write. Otherwise, clear it by read.
452 * This control bit is valid from 88PM8607 B0 steping.
453 */
454 data |= PM8607_B0_MISC1_INT_CLEAR;
455 chip->irq_mode = 1;
456 }
457 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, mask, data);
458 if (ret < 0)
459 goto out;
460
461 /* mask all IRQs */
462 memset(status_buf, 0, INT_STATUS_NUM);
463 ret = pm860x_bulk_write(i2c, PM8607_INT_MASK_1,
464 INT_STATUS_NUM, status_buf);
465 if (ret < 0)
466 goto out;
467
468 if (chip->irq_mode) {
469 /* clear interrupt status by write */
470 memset(status_buf, 0xFF, INT_STATUS_NUM);
471 ret = pm860x_bulk_write(i2c, PM8607_INT_STATUS1,
472 INT_STATUS_NUM, status_buf);
473 } else {
474 /* clear interrupt status by read */
475 ret = pm860x_bulk_read(i2c, PM8607_INT_STATUS1,
476 INT_STATUS_NUM, status_buf);
477 }
478 if (ret < 0)
479 goto out;
480
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500481 mutex_init(&chip->irq_lock);
482 chip->irq_base = pdata->irq_base;
483 chip->core_irq = i2c->irq;
484 if (!chip->core_irq)
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500485 goto out;
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500486
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500487 /* register IRQ by genirq */
488 for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
489 __irq = i + chip->irq_base;
Thomas Gleixnerd5bb1222011-03-25 11:12:32 +0000490 irq_set_chip_data(__irq, chip);
491 irq_set_chip_and_handler(__irq, &pm860x_irq_chip,
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500492 handle_edge_irq);
Thomas Gleixnerd5bb1222011-03-25 11:12:32 +0000493 irq_set_nested_thread(__irq, 1);
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500494#ifdef CONFIG_ARM
495 set_irq_flags(__irq, IRQF_VALID);
496#else
Thomas Gleixnerd5bb1222011-03-25 11:12:32 +0000497 irq_set_noprobe(__irq);
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500498#endif
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500499 }
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500500
501 ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags,
502 "88pm860x", chip);
503 if (ret) {
504 dev_err(chip->dev, "Failed to request IRQ: %d\n", ret);
505 chip->core_irq = 0;
506 }
507
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500508 return 0;
509out:
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500510 chip->core_irq = 0;
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500511 return ret;
512}
513
Henrik Kretzschmar872c1b12010-03-26 02:40:13 +0100514static void device_irq_exit(struct pm860x_chip *chip)
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500515{
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500516 if (chip->core_irq)
517 free_irq(chip->core_irq, chip);
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500518}
519
Jett.Zhou23de4352012-03-01 11:59:19 +0100520int pm8606_osc_enable(struct pm860x_chip *chip, unsigned short client)
521{
522 int ret = -EIO;
523 struct i2c_client *i2c = (chip->id == CHIP_PM8606) ?
524 chip->client : chip->companion;
525
526 dev_dbg(chip->dev, "%s(B): client=0x%x\n", __func__, client);
527 dev_dbg(chip->dev, "%s(B): vote=0x%x status=%d\n",
528 __func__, chip->osc_vote,
529 chip->osc_status);
530
531 mutex_lock(&chip->osc_lock);
532 /* Update voting status */
533 chip->osc_vote |= client;
534 /* If reference group is off - turn on*/
535 if (chip->osc_status != PM8606_REF_GP_OSC_ON) {
536 chip->osc_status = PM8606_REF_GP_OSC_UNKNOWN;
537 /* Enable Reference group Vsys */
538 if (pm860x_set_bits(i2c, PM8606_VSYS,
539 PM8606_VSYS_EN, PM8606_VSYS_EN))
540 goto out;
541
542 /*Enable Internal Oscillator */
543 if (pm860x_set_bits(i2c, PM8606_MISC,
544 PM8606_MISC_OSC_EN, PM8606_MISC_OSC_EN))
545 goto out;
546 /* Update status (only if writes succeed) */
547 chip->osc_status = PM8606_REF_GP_OSC_ON;
548 }
549 mutex_unlock(&chip->osc_lock);
550
551 dev_dbg(chip->dev, "%s(A): vote=0x%x status=%d ret=%d\n",
552 __func__, chip->osc_vote,
553 chip->osc_status, ret);
554 return 0;
555out:
556 mutex_unlock(&chip->osc_lock);
557 return ret;
558}
Samuel Ortiz2f5f89b2012-03-06 08:06:14 +0100559EXPORT_SYMBOL(pm8606_osc_enable);
Jett.Zhou23de4352012-03-01 11:59:19 +0100560
561int pm8606_osc_disable(struct pm860x_chip *chip, unsigned short client)
562{
563 int ret = -EIO;
564 struct i2c_client *i2c = (chip->id == CHIP_PM8606) ?
565 chip->client : chip->companion;
566
567 dev_dbg(chip->dev, "%s(B): client=0x%x\n", __func__, client);
568 dev_dbg(chip->dev, "%s(B): vote=0x%x status=%d\n",
569 __func__, chip->osc_vote,
570 chip->osc_status);
571
572 mutex_lock(&chip->osc_lock);
573 /*Update voting status */
574 chip->osc_vote &= ~(client);
575 /* If reference group is off and this is the last client to release
576 * - turn off */
577 if ((chip->osc_status != PM8606_REF_GP_OSC_OFF) &&
578 (chip->osc_vote == REF_GP_NO_CLIENTS)) {
579 chip->osc_status = PM8606_REF_GP_OSC_UNKNOWN;
580 /* Disable Reference group Vsys */
581 if (pm860x_set_bits(i2c, PM8606_VSYS, PM8606_VSYS_EN, 0))
582 goto out;
583 /* Disable Internal Oscillator */
584 if (pm860x_set_bits(i2c, PM8606_MISC, PM8606_MISC_OSC_EN, 0))
585 goto out;
586 chip->osc_status = PM8606_REF_GP_OSC_OFF;
587 }
588 mutex_unlock(&chip->osc_lock);
589
590 dev_dbg(chip->dev, "%s(A): vote=0x%x status=%d ret=%d\n",
591 __func__, chip->osc_vote,
592 chip->osc_status, ret);
593 return 0;
594out:
595 mutex_unlock(&chip->osc_lock);
596 return ret;
597}
Samuel Ortiz2f5f89b2012-03-06 08:06:14 +0100598EXPORT_SYMBOL(pm8606_osc_disable);
Jett.Zhou23de4352012-03-01 11:59:19 +0100599
600static void __devinit device_osc_init(struct i2c_client *i2c)
601{
602 struct pm860x_chip *chip = i2c_get_clientdata(i2c);
603
604 mutex_init(&chip->osc_lock);
605 /* init portofino reference group voting and status */
606 /* Disable Reference group Vsys */
607 pm860x_set_bits(i2c, PM8606_VSYS, PM8606_VSYS_EN, 0);
608 /* Disable Internal Oscillator */
609 pm860x_set_bits(i2c, PM8606_MISC, PM8606_MISC_OSC_EN, 0);
610
611 chip->osc_vote = REF_GP_NO_CLIENTS;
612 chip->osc_status = PM8606_REF_GP_OSC_OFF;
613}
614
Haojian Zhuangadb70482011-03-07 23:43:09 +0800615static void __devinit device_bk_init(struct pm860x_chip *chip,
Haojian Zhuangadb70482011-03-07 23:43:09 +0800616 struct pm860x_platform_data *pdata)
617{
618 int ret;
619 int i, j, id;
620
621 if ((pdata == NULL) || (pdata->backlight == NULL))
622 return;
623
624 if (pdata->num_backlights > ARRAY_SIZE(bk_devs))
625 pdata->num_backlights = ARRAY_SIZE(bk_devs);
626
627 for (i = 0; i < pdata->num_backlights; i++) {
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800628 bk_devs[i].platform_data = &pdata->backlight[i];
629 bk_devs[i].pdata_size = sizeof(struct pm860x_backlight_pdata);
Haojian Zhuangadb70482011-03-07 23:43:09 +0800630
631 for (j = 0; j < ARRAY_SIZE(bk_devs); j++) {
632 id = bk_resources[j].start;
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800633 if (pdata->backlight[i].flags != id)
Haojian Zhuangadb70482011-03-07 23:43:09 +0800634 continue;
635
636 bk_devs[i].num_resources = 1;
637 bk_devs[i].resources = &bk_resources[j];
638 ret = mfd_add_devices(chip->dev, 0,
639 &bk_devs[i], 1,
640 &bk_resources[j], 0);
641 if (ret < 0) {
642 dev_err(chip->dev, "Failed to add "
643 "backlight subdev\n");
644 return;
645 }
646 }
647 }
648}
649
Haojian Zhuang3154c342011-03-07 23:43:10 +0800650static void __devinit device_led_init(struct pm860x_chip *chip,
Haojian Zhuang3154c342011-03-07 23:43:10 +0800651 struct pm860x_platform_data *pdata)
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500652{
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500653 int ret;
Haojian Zhuang3154c342011-03-07 23:43:10 +0800654 int i, j, id;
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500655
Haojian Zhuang3154c342011-03-07 23:43:10 +0800656 if ((pdata == NULL) || (pdata->led == NULL))
657 return;
658
659 if (pdata->num_leds > ARRAY_SIZE(led_devs))
660 pdata->num_leds = ARRAY_SIZE(led_devs);
661
662 for (i = 0; i < pdata->num_leds; i++) {
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800663 led_devs[i].platform_data = &pdata->led[i];
664 led_devs[i].pdata_size = sizeof(struct pm860x_led_pdata);
Haojian Zhuang3154c342011-03-07 23:43:10 +0800665
666 for (j = 0; j < ARRAY_SIZE(led_devs); j++) {
667 id = led_resources[j].start;
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800668 if (pdata->led[i].flags != id)
Haojian Zhuang3154c342011-03-07 23:43:10 +0800669 continue;
670
671 led_devs[i].num_resources = 1;
672 led_devs[i].resources = &led_resources[j],
673 ret = mfd_add_devices(chip->dev, 0,
674 &led_devs[i], 1,
675 &led_resources[j], 0);
676 if (ret < 0) {
677 dev_err(chip->dev, "Failed to add "
678 "led subdev\n");
679 return;
680 }
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500681 }
682 }
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500683}
684
Haojian Zhuang22aad002011-03-07 23:43:11 +0800685static void __devinit device_regulator_init(struct pm860x_chip *chip,
Haojian Zhuang22aad002011-03-07 23:43:11 +0800686 struct pm860x_platform_data *pdata)
687{
688 struct regulator_init_data *initdata;
689 int ret;
Haojian Zhuang586e1a12011-05-06 17:21:23 +0800690 int i, seq;
Haojian Zhuang22aad002011-03-07 23:43:11 +0800691
692 if ((pdata == NULL) || (pdata->regulator == NULL))
693 return;
694
695 if (pdata->num_regulators > ARRAY_SIZE(regulator_devs))
696 pdata->num_regulators = ARRAY_SIZE(regulator_devs);
697
Haojian Zhuang586e1a12011-05-06 17:21:23 +0800698 for (i = 0, seq = -1; i < pdata->num_regulators; i++) {
Haojian Zhuang22aad002011-03-07 23:43:11 +0800699 initdata = &pdata->regulator[i];
Haojian Zhuang586e1a12011-05-06 17:21:23 +0800700 seq = *(unsigned int *)initdata->driver_data;
701 if ((seq < 0) || (seq > PM8607_ID_RG_MAX)) {
702 dev_err(chip->dev, "Wrong ID(%d) on regulator(%s)\n",
703 seq, initdata->constraints.name);
Haojian Zhuang22aad002011-03-07 23:43:11 +0800704 goto out;
705 }
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800706 regulator_devs[i].platform_data = &pdata->regulator[i];
707 regulator_devs[i].pdata_size = sizeof(struct regulator_init_data);
Haojian Zhuang22aad002011-03-07 23:43:11 +0800708 regulator_devs[i].num_resources = 1;
Haojian Zhuang586e1a12011-05-06 17:21:23 +0800709 regulator_devs[i].resources = &regulator_resources[seq];
Haojian Zhuang22aad002011-03-07 23:43:11 +0800710
711 ret = mfd_add_devices(chip->dev, 0, &regulator_devs[i], 1,
Haojian Zhuang586e1a12011-05-06 17:21:23 +0800712 &regulator_resources[seq], 0);
Haojian Zhuang22aad002011-03-07 23:43:11 +0800713 if (ret < 0) {
714 dev_err(chip->dev, "Failed to add regulator subdev\n");
715 goto out;
716 }
717 }
718out:
719 return;
720}
721
Haojian Zhuang008b3042011-05-06 17:21:20 +0800722static void __devinit device_rtc_init(struct pm860x_chip *chip,
Haojian Zhuang008b3042011-05-06 17:21:20 +0800723 struct pm860x_platform_data *pdata)
724{
725 int ret;
726
727 if ((pdata == NULL))
728 return;
729
730 rtc_devs[0].platform_data = pdata->rtc;
731 rtc_devs[0].pdata_size = sizeof(struct pm860x_rtc_pdata);
732 rtc_devs[0].num_resources = ARRAY_SIZE(rtc_resources);
733 rtc_devs[0].resources = &rtc_resources[0];
734 ret = mfd_add_devices(chip->dev, 0, &rtc_devs[0],
735 ARRAY_SIZE(rtc_devs), &rtc_resources[0],
736 chip->irq_base);
737 if (ret < 0)
738 dev_err(chip->dev, "Failed to add rtc subdev\n");
739}
740
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800741static void __devinit device_touch_init(struct pm860x_chip *chip,
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800742 struct pm860x_platform_data *pdata)
743{
744 int ret;
745
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800746 if (pdata == NULL)
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800747 return;
748
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800749 touch_devs[0].platform_data = pdata->touch;
750 touch_devs[0].pdata_size = sizeof(struct pm860x_touch_pdata);
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800751 touch_devs[0].num_resources = ARRAY_SIZE(touch_resources);
752 touch_devs[0].resources = &touch_resources[0];
753 ret = mfd_add_devices(chip->dev, 0, &touch_devs[0],
754 ARRAY_SIZE(touch_devs), &touch_resources[0],
755 chip->irq_base);
756 if (ret < 0)
757 dev_err(chip->dev, "Failed to add touch subdev\n");
758}
759
760static void __devinit device_power_init(struct pm860x_chip *chip,
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800761 struct pm860x_platform_data *pdata)
762{
763 int ret;
764
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800765 if (pdata == NULL)
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800766 return;
767
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800768 power_devs[0].platform_data = pdata->power;
769 power_devs[0].pdata_size = sizeof(struct pm860x_power_pdata);
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800770 power_devs[0].num_resources = ARRAY_SIZE(battery_resources);
771 power_devs[0].resources = &battery_resources[0],
772 ret = mfd_add_devices(chip->dev, 0, &power_devs[0], 1,
773 &battery_resources[0], chip->irq_base);
774 if (ret < 0)
775 dev_err(chip->dev, "Failed to add battery subdev\n");
776
Haojian Zhuangf5fb7582011-05-06 17:21:21 +0800777 power_devs[1].platform_data = pdata->power;
778 power_devs[1].pdata_size = sizeof(struct pm860x_power_pdata);
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800779 power_devs[1].num_resources = ARRAY_SIZE(charger_resources);
780 power_devs[1].resources = &charger_resources[0],
781 ret = mfd_add_devices(chip->dev, 0, &power_devs[1], 1,
782 &charger_resources[0], chip->irq_base);
783 if (ret < 0)
784 dev_err(chip->dev, "Failed to add charger subdev\n");
Jett.Zhou2573f6d2012-07-06 10:59:58 +0800785
786 power_devs[2].platform_data = &preg_init_data;
787 power_devs[2].pdata_size = sizeof(struct regulator_init_data);
788 power_devs[2].num_resources = ARRAY_SIZE(preg_resources);
789 power_devs[2].resources = &preg_resources[0],
790 ret = mfd_add_devices(chip->dev, 0, &power_devs[2], 1,
791 &preg_resources[0], chip->irq_base);
792 if (ret < 0)
793 dev_err(chip->dev, "Failed to add preg subdev\n");
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800794}
795
796static void __devinit device_onkey_init(struct pm860x_chip *chip,
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800797 struct pm860x_platform_data *pdata)
798{
799 int ret;
800
801 onkey_devs[0].num_resources = ARRAY_SIZE(onkey_resources);
802 onkey_devs[0].resources = &onkey_resources[0],
803 ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0],
804 ARRAY_SIZE(onkey_devs), &onkey_resources[0],
805 chip->irq_base);
806 if (ret < 0)
807 dev_err(chip->dev, "Failed to add onkey subdev\n");
808}
809
810static void __devinit device_codec_init(struct pm860x_chip *chip,
Haojian Zhuangc9f560b2011-03-07 23:43:12 +0800811 struct pm860x_platform_data *pdata)
812{
813 int ret;
814
815 codec_devs[0].num_resources = ARRAY_SIZE(codec_resources);
816 codec_devs[0].resources = &codec_resources[0],
817 ret = mfd_add_devices(chip->dev, 0, &codec_devs[0],
818 ARRAY_SIZE(codec_devs), &codec_resources[0], 0);
819 if (ret < 0)
820 dev_err(chip->dev, "Failed to add codec subdev\n");
821}
822
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500823static void __devinit device_8607_init(struct pm860x_chip *chip,
824 struct i2c_client *i2c,
825 struct pm860x_platform_data *pdata)
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500826{
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500827 int data, ret;
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500828
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500829 ret = pm860x_reg_read(i2c, PM8607_CHIP_ID);
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500830 if (ret < 0) {
831 dev_err(chip->dev, "Failed to read CHIP ID: %d\n", ret);
832 goto out;
833 }
Haojian Zhuang38b340522010-09-08 09:44:34 -0400834 switch (ret & PM8607_VERSION_MASK) {
835 case 0x40:
836 case 0x50:
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500837 dev_info(chip->dev, "Marvell 88PM8607 (ID: %02x) detected\n",
838 ret);
Haojian Zhuang38b340522010-09-08 09:44:34 -0400839 break;
840 default:
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500841 dev_err(chip->dev, "Failed to detect Marvell 88PM8607. "
842 "Chip ID: %02x\n", ret);
843 goto out;
844 }
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500845
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500846 ret = pm860x_reg_read(i2c, PM8607_BUCK3);
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500847 if (ret < 0) {
848 dev_err(chip->dev, "Failed to read BUCK3 register: %d\n", ret);
849 goto out;
850 }
851 if (ret & PM8607_BUCK3_DOUBLE)
852 chip->buck3_double = 1;
853
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500854 ret = pm860x_reg_read(i2c, PM8607_B0_MISC1);
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500855 if (ret < 0) {
856 dev_err(chip->dev, "Failed to read MISC1 register: %d\n", ret);
857 goto out;
858 }
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500859
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500860 if (pdata && (pdata->i2c_port == PI2C_PORT))
861 data = PM8607_B0_MISC1_PI2C;
862 else
863 data = 0;
864 ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, PM8607_B0_MISC1_PI2C, data);
865 if (ret < 0) {
866 dev_err(chip->dev, "Failed to access MISC1:%d\n", ret);
867 goto out;
868 }
869
Haojian Zhuanga16122b2009-12-15 16:04:36 -0500870 ret = device_gpadc_init(chip, pdata);
871 if (ret < 0)
872 goto out;
873
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500874 ret = device_irq_init(chip, pdata);
875 if (ret < 0)
876 goto out;
877
Haojian Zhuangcea438d2011-05-06 17:21:24 +0800878 device_regulator_init(chip, pdata);
879 device_rtc_init(chip, pdata);
880 device_onkey_init(chip, pdata);
881 device_touch_init(chip, pdata);
882 device_power_init(chip, pdata);
883 device_codec_init(chip, pdata);
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500884out:
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500885 return;
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500886}
887
Jett.Zhou78258062012-02-28 10:58:42 +0800888static void __devinit device_8606_init(struct pm860x_chip *chip,
889 struct i2c_client *i2c,
890 struct pm860x_platform_data *pdata)
891{
892 device_osc_init(i2c);
893 device_bk_init(chip, pdata);
894 device_led_init(chip, pdata);
895}
896
Henrik Kretzschmar872c1b12010-03-26 02:40:13 +0100897int __devinit pm860x_device_init(struct pm860x_chip *chip,
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500898 struct pm860x_platform_data *pdata)
899{
Haojian Zhuang2afa62e2010-02-08 05:02:00 -0500900 chip->core_irq = 0;
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500901
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500902 switch (chip->id) {
903 case CHIP_PM8606:
Jett.Zhou78258062012-02-28 10:58:42 +0800904 device_8606_init(chip, chip->client, pdata);
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500905 break;
906 case CHIP_PM8607:
907 device_8607_init(chip, chip->client, pdata);
908 break;
909 }
910
911 if (chip->companion) {
912 switch (chip->id) {
913 case CHIP_PM8607:
Jett.Zhou78258062012-02-28 10:58:42 +0800914 device_8606_init(chip, chip->companion, pdata);
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500915 break;
916 case CHIP_PM8606:
917 device_8607_init(chip, chip->companion, pdata);
918 break;
919 }
920 }
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500921
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500922 return 0;
923}
924
Henrik Kretzschmar872c1b12010-03-26 02:40:13 +0100925void __devexit pm860x_device_exit(struct pm860x_chip *chip)
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500926{
Haojian Zhuang5c42e8c2009-12-15 16:01:47 -0500927 device_irq_exit(chip);
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500928 mfd_remove_devices(chip->dev);
929}
930
Haojian Zhuang53dbab72010-01-08 06:01:24 -0500931MODULE_DESCRIPTION("PMIC Driver for Marvell 88PM860x");
Haojian Zhuangbbd51b12010-01-06 17:04:18 -0500932MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
933MODULE_LICENSE("GPL");