diff options
-rw-r--r-- | drivers/input/touchscreen/88pm860x-ts.c | 15 | ||||
-rw-r--r-- | drivers/mfd/88pm860x-core.c | 408 | ||||
-rw-r--r-- | include/linux/mfd/88pm860x.h | 30 |
3 files changed, 311 insertions, 142 deletions
diff --git a/drivers/input/touchscreen/88pm860x-ts.c b/drivers/input/touchscreen/88pm860x-ts.c index 56254d2a1f6e..286bb490a9f2 100644 --- a/drivers/input/touchscreen/88pm860x-ts.c +++ b/drivers/input/touchscreen/88pm860x-ts.c | |||
@@ -54,7 +54,6 @@ static irqreturn_t pm860x_touch_handler(int irq, void *data) | |||
54 | int z1, z2, rt = 0; | 54 | int z1, z2, rt = 0; |
55 | int ret; | 55 | int ret; |
56 | 56 | ||
57 | pm860x_mask_irq(chip, irq); | ||
58 | ret = pm860x_bulk_read(touch->i2c, MEAS_TSIX_1, MEAS_LEN, buf); | 57 | ret = pm860x_bulk_read(touch->i2c, MEAS_TSIX_1, MEAS_LEN, buf); |
59 | if (ret < 0) | 58 | if (ret < 0) |
60 | goto out; | 59 | goto out; |
@@ -83,7 +82,6 @@ static irqreturn_t pm860x_touch_handler(int irq, void *data) | |||
83 | dev_dbg(chip->dev, "pen release\n"); | 82 | dev_dbg(chip->dev, "pen release\n"); |
84 | } | 83 | } |
85 | input_sync(touch->idev); | 84 | input_sync(touch->idev); |
86 | pm860x_unmask_irq(chip, irq); | ||
87 | 85 | ||
88 | out: | 86 | out: |
89 | return IRQ_HANDLED; | 87 | return IRQ_HANDLED; |
@@ -92,7 +90,6 @@ out: | |||
92 | static int pm860x_touch_open(struct input_dev *dev) | 90 | static int pm860x_touch_open(struct input_dev *dev) |
93 | { | 91 | { |
94 | struct pm860x_touch *touch = input_get_drvdata(dev); | 92 | struct pm860x_touch *touch = input_get_drvdata(dev); |
95 | struct pm860x_chip *chip = touch->chip; | ||
96 | int data, ret; | 93 | int data, ret; |
97 | 94 | ||
98 | data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN | 95 | data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN |
@@ -100,7 +97,6 @@ static int pm860x_touch_open(struct input_dev *dev) | |||
100 | ret = pm860x_set_bits(touch->i2c, MEAS_EN3, data, data); | 97 | ret = pm860x_set_bits(touch->i2c, MEAS_EN3, data, data); |
101 | if (ret < 0) | 98 | if (ret < 0) |
102 | goto out; | 99 | goto out; |
103 | pm860x_unmask_irq(chip, touch->irq); | ||
104 | return 0; | 100 | return 0; |
105 | out: | 101 | out: |
106 | return ret; | 102 | return ret; |
@@ -109,13 +105,11 @@ out: | |||
109 | static void pm860x_touch_close(struct input_dev *dev) | 105 | static void pm860x_touch_close(struct input_dev *dev) |
110 | { | 106 | { |
111 | struct pm860x_touch *touch = input_get_drvdata(dev); | 107 | struct pm860x_touch *touch = input_get_drvdata(dev); |
112 | struct pm860x_chip *chip = touch->chip; | ||
113 | int data; | 108 | int data; |
114 | 109 | ||
115 | data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN | 110 | data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN |
116 | | MEAS_TSIZ1_EN | MEAS_TSIZ2_EN; | 111 | | MEAS_TSIZ1_EN | MEAS_TSIZ2_EN; |
117 | pm860x_set_bits(touch->i2c, MEAS_EN3, data, 0); | 112 | pm860x_set_bits(touch->i2c, MEAS_EN3, data, 0); |
118 | pm860x_mask_irq(chip, touch->irq); | ||
119 | } | 113 | } |
120 | 114 | ||
121 | static int __devinit pm860x_touch_probe(struct platform_device *pdev) | 115 | static int __devinit pm860x_touch_probe(struct platform_device *pdev) |
@@ -164,11 +158,12 @@ static int __devinit pm860x_touch_probe(struct platform_device *pdev) | |||
164 | touch->idev->close = pm860x_touch_close; | 158 | touch->idev->close = pm860x_touch_close; |
165 | touch->chip = chip; | 159 | touch->chip = chip; |
166 | touch->i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion; | 160 | touch->i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion; |
167 | touch->irq = irq; | 161 | touch->irq = irq + chip->irq_base; |
168 | touch->res_x = pdata->res_x; | 162 | touch->res_x = pdata->res_x; |
169 | input_set_drvdata(touch->idev, touch); | 163 | input_set_drvdata(touch->idev, touch); |
170 | 164 | ||
171 | ret = pm860x_request_irq(chip, irq, pm860x_touch_handler, touch); | 165 | ret = request_threaded_irq(touch->irq, NULL, pm860x_touch_handler, |
166 | IRQF_ONESHOT, "touch", touch); | ||
172 | if (ret < 0) | 167 | if (ret < 0) |
173 | goto out_irq; | 168 | goto out_irq; |
174 | 169 | ||
@@ -194,7 +189,7 @@ static int __devinit pm860x_touch_probe(struct platform_device *pdev) | |||
194 | platform_set_drvdata(pdev, touch); | 189 | platform_set_drvdata(pdev, touch); |
195 | return 0; | 190 | return 0; |
196 | out_rg: | 191 | out_rg: |
197 | pm860x_free_irq(chip, irq); | 192 | free_irq(touch->irq, touch); |
198 | out_irq: | 193 | out_irq: |
199 | input_free_device(touch->idev); | 194 | input_free_device(touch->idev); |
200 | out: | 195 | out: |
@@ -207,7 +202,7 @@ static int __devexit pm860x_touch_remove(struct platform_device *pdev) | |||
207 | struct pm860x_touch *touch = platform_get_drvdata(pdev); | 202 | struct pm860x_touch *touch = platform_get_drvdata(pdev); |
208 | 203 | ||
209 | input_unregister_device(touch->idev); | 204 | input_unregister_device(touch->idev); |
210 | pm860x_free_irq(touch->chip, touch->irq); | 205 | free_irq(touch->irq, touch); |
211 | platform_set_drvdata(pdev, NULL); | 206 | platform_set_drvdata(pdev, NULL); |
212 | kfree(touch); | 207 | kfree(touch); |
213 | return 0; | 208 | return 0; |
diff --git a/drivers/mfd/88pm860x-core.c b/drivers/mfd/88pm860x-core.c index 16f0dca707a7..6a14d2b1ccf0 100644 --- a/drivers/mfd/88pm860x-core.c +++ b/drivers/mfd/88pm860x-core.c | |||
@@ -12,11 +12,14 @@ | |||
12 | #include <linux/kernel.h> | 12 | #include <linux/kernel.h> |
13 | #include <linux/module.h> | 13 | #include <linux/module.h> |
14 | #include <linux/i2c.h> | 14 | #include <linux/i2c.h> |
15 | #include <linux/irq.h> | ||
15 | #include <linux/interrupt.h> | 16 | #include <linux/interrupt.h> |
16 | #include <linux/platform_device.h> | 17 | #include <linux/platform_device.h> |
17 | #include <linux/mfd/core.h> | 18 | #include <linux/mfd/core.h> |
18 | #include <linux/mfd/88pm860x.h> | 19 | #include <linux/mfd/88pm860x.h> |
19 | 20 | ||
21 | #define INT_STATUS_NUM 3 | ||
22 | |||
20 | char pm860x_backlight_name[][MFD_NAME_SIZE] = { | 23 | char pm860x_backlight_name[][MFD_NAME_SIZE] = { |
21 | "backlight-0", | 24 | "backlight-0", |
22 | "backlight-1", | 25 | "backlight-1", |
@@ -119,6 +122,42 @@ static struct mfd_cell touch_devs[] = { | |||
119 | .flags = IORESOURCE_IO, \ | 122 | .flags = IORESOURCE_IO, \ |
120 | } | 123 | } |
121 | 124 | ||
125 | static struct resource power_supply_resources[] = { | ||
126 | { | ||
127 | .name = "88pm860x-power", | ||
128 | .start = PM8607_IRQ_CHG, | ||
129 | .end = PM8607_IRQ_CHG, | ||
130 | .flags = IORESOURCE_IRQ, | ||
131 | }, | ||
132 | }; | ||
133 | |||
134 | static struct mfd_cell power_devs[] = { | ||
135 | { | ||
136 | .name = "88pm860x-power", | ||
137 | .num_resources = 1, | ||
138 | .resources = &power_supply_resources[0], | ||
139 | .id = -1, | ||
140 | }, | ||
141 | }; | ||
142 | |||
143 | static struct resource onkey_resources[] = { | ||
144 | { | ||
145 | .name = "88pm860x-onkey", | ||
146 | .start = PM8607_IRQ_ONKEY, | ||
147 | .end = PM8607_IRQ_ONKEY, | ||
148 | .flags = IORESOURCE_IRQ, | ||
149 | }, | ||
150 | }; | ||
151 | |||
152 | static struct mfd_cell onkey_devs[] = { | ||
153 | { | ||
154 | .name = "88pm860x-onkey", | ||
155 | .num_resources = 1, | ||
156 | .resources = &onkey_resources[0], | ||
157 | .id = -1, | ||
158 | }, | ||
159 | }; | ||
160 | |||
122 | static struct resource regulator_resources[] = { | 161 | static struct resource regulator_resources[] = { |
123 | PM8607_REG_RESOURCE(BUCK1, BUCK1), | 162 | PM8607_REG_RESOURCE(BUCK1, BUCK1), |
124 | PM8607_REG_RESOURCE(BUCK2, BUCK2), | 163 | PM8607_REG_RESOURCE(BUCK2, BUCK2), |
@@ -163,129 +202,224 @@ static struct mfd_cell regulator_devs[] = { | |||
163 | PM8607_REG_DEVS(ldo14, LDO14), | 202 | PM8607_REG_DEVS(ldo14, LDO14), |
164 | }; | 203 | }; |
165 | 204 | ||
166 | #define CHECK_IRQ(irq) \ | 205 | struct pm860x_irq_data { |
167 | do { \ | 206 | int reg; |
168 | if ((irq < 0) || (irq >= PM860X_NUM_IRQ)) \ | 207 | int mask_reg; |
169 | return -EINVAL; \ | 208 | int enable; /* enable or not */ |
170 | } while (0) | 209 | int offs; /* bit offset in mask register */ |
171 | 210 | }; | |
172 | /* IRQs only occur on 88PM8607 */ | ||
173 | int pm860x_mask_irq(struct pm860x_chip *chip, int irq) | ||
174 | { | ||
175 | struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \ | ||
176 | : chip->companion; | ||
177 | int offset, data, ret; | ||
178 | |||
179 | CHECK_IRQ(irq); | ||
180 | |||
181 | offset = (irq >> 3) + PM8607_INT_MASK_1; | ||
182 | data = 1 << (irq % 8); | ||
183 | ret = pm860x_set_bits(i2c, offset, data, 0); | ||
184 | 211 | ||
185 | return ret; | 212 | static struct pm860x_irq_data pm860x_irqs[] = { |
186 | } | 213 | [PM8607_IRQ_ONKEY] = { |
187 | EXPORT_SYMBOL(pm860x_mask_irq); | 214 | .reg = PM8607_INT_STATUS1, |
215 | .mask_reg = PM8607_INT_MASK_1, | ||
216 | .offs = 1 << 0, | ||
217 | }, | ||
218 | [PM8607_IRQ_EXTON] = { | ||
219 | .reg = PM8607_INT_STATUS1, | ||
220 | .mask_reg = PM8607_INT_MASK_1, | ||
221 | .offs = 1 << 1, | ||
222 | }, | ||
223 | [PM8607_IRQ_CHG] = { | ||
224 | .reg = PM8607_INT_STATUS1, | ||
225 | .mask_reg = PM8607_INT_MASK_1, | ||
226 | .offs = 1 << 2, | ||
227 | }, | ||
228 | [PM8607_IRQ_BAT] = { | ||
229 | .reg = PM8607_INT_STATUS1, | ||
230 | .mask_reg = PM8607_INT_MASK_1, | ||
231 | .offs = 1 << 3, | ||
232 | }, | ||
233 | [PM8607_IRQ_RTC] = { | ||
234 | .reg = PM8607_INT_STATUS1, | ||
235 | .mask_reg = PM8607_INT_MASK_1, | ||
236 | .offs = 1 << 4, | ||
237 | }, | ||
238 | [PM8607_IRQ_CC] = { | ||
239 | .reg = PM8607_INT_STATUS1, | ||
240 | .mask_reg = PM8607_INT_MASK_1, | ||
241 | .offs = 1 << 5, | ||
242 | }, | ||
243 | [PM8607_IRQ_VBAT] = { | ||
244 | .reg = PM8607_INT_STATUS2, | ||
245 | .mask_reg = PM8607_INT_MASK_2, | ||
246 | .offs = 1 << 0, | ||
247 | }, | ||
248 | [PM8607_IRQ_VCHG] = { | ||
249 | .reg = PM8607_INT_STATUS2, | ||
250 | .mask_reg = PM8607_INT_MASK_2, | ||
251 | .offs = 1 << 1, | ||
252 | }, | ||
253 | [PM8607_IRQ_VSYS] = { | ||
254 | .reg = PM8607_INT_STATUS2, | ||
255 | .mask_reg = PM8607_INT_MASK_2, | ||
256 | .offs = 1 << 2, | ||
257 | }, | ||
258 | [PM8607_IRQ_TINT] = { | ||
259 | .reg = PM8607_INT_STATUS2, | ||
260 | .mask_reg = PM8607_INT_MASK_2, | ||
261 | .offs = 1 << 3, | ||
262 | }, | ||
263 | [PM8607_IRQ_GPADC0] = { | ||
264 | .reg = PM8607_INT_STATUS2, | ||
265 | .mask_reg = PM8607_INT_MASK_2, | ||
266 | .offs = 1 << 4, | ||
267 | }, | ||
268 | [PM8607_IRQ_GPADC1] = { | ||
269 | .reg = PM8607_INT_STATUS2, | ||
270 | .mask_reg = PM8607_INT_MASK_2, | ||
271 | .offs = 1 << 5, | ||
272 | }, | ||
273 | [PM8607_IRQ_GPADC2] = { | ||
274 | .reg = PM8607_INT_STATUS2, | ||
275 | .mask_reg = PM8607_INT_MASK_2, | ||
276 | .offs = 1 << 6, | ||
277 | }, | ||
278 | [PM8607_IRQ_GPADC3] = { | ||
279 | .reg = PM8607_INT_STATUS2, | ||
280 | .mask_reg = PM8607_INT_MASK_2, | ||
281 | .offs = 1 << 7, | ||
282 | }, | ||
283 | [PM8607_IRQ_AUDIO_SHORT] = { | ||
284 | .reg = PM8607_INT_STATUS3, | ||
285 | .mask_reg = PM8607_INT_MASK_3, | ||
286 | .offs = 1 << 0, | ||
287 | }, | ||
288 | [PM8607_IRQ_PEN] = { | ||
289 | .reg = PM8607_INT_STATUS3, | ||
290 | .mask_reg = PM8607_INT_MASK_3, | ||
291 | .offs = 1 << 1, | ||
292 | }, | ||
293 | [PM8607_IRQ_HEADSET] = { | ||
294 | .reg = PM8607_INT_STATUS3, | ||
295 | .mask_reg = PM8607_INT_MASK_3, | ||
296 | .offs = 1 << 2, | ||
297 | }, | ||
298 | [PM8607_IRQ_HOOK] = { | ||
299 | .reg = PM8607_INT_STATUS3, | ||
300 | .mask_reg = PM8607_INT_MASK_3, | ||
301 | .offs = 1 << 3, | ||
302 | }, | ||
303 | [PM8607_IRQ_MICIN] = { | ||
304 | .reg = PM8607_INT_STATUS3, | ||
305 | .mask_reg = PM8607_INT_MASK_3, | ||
306 | .offs = 1 << 4, | ||
307 | }, | ||
308 | [PM8607_IRQ_CHG_FAIL] = { | ||
309 | .reg = PM8607_INT_STATUS3, | ||
310 | .mask_reg = PM8607_INT_MASK_3, | ||
311 | .offs = 1 << 5, | ||
312 | }, | ||
313 | [PM8607_IRQ_CHG_DONE] = { | ||
314 | .reg = PM8607_INT_STATUS3, | ||
315 | .mask_reg = PM8607_INT_MASK_3, | ||
316 | .offs = 1 << 6, | ||
317 | }, | ||
318 | [PM8607_IRQ_CHG_FAULT] = { | ||
319 | .reg = PM8607_INT_STATUS3, | ||
320 | .mask_reg = PM8607_INT_MASK_3, | ||
321 | .offs = 1 << 7, | ||
322 | }, | ||
323 | }; | ||
188 | 324 | ||
189 | int pm860x_unmask_irq(struct pm860x_chip *chip, int irq) | 325 | static inline struct pm860x_irq_data *irq_to_pm860x(struct pm860x_chip *chip, |
326 | int irq) | ||
190 | { | 327 | { |
191 | struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \ | 328 | return &pm860x_irqs[irq - chip->irq_base]; |
192 | : chip->companion; | ||
193 | int offset, data, ret; | ||
194 | |||
195 | CHECK_IRQ(irq); | ||
196 | |||
197 | offset = (irq >> 3) + PM8607_INT_MASK_1; | ||
198 | data = 1 << (irq % 8); | ||
199 | ret = pm860x_set_bits(i2c, offset, data, data); | ||
200 | |||
201 | return ret; | ||
202 | } | 329 | } |
203 | EXPORT_SYMBOL(pm860x_unmask_irq); | ||
204 | 330 | ||
205 | #define INT_STATUS_NUM (3) | 331 | static irqreturn_t pm860x_irq(int irq, void *data) |
206 | |||
207 | static irqreturn_t pm8607_irq_thread(int irq, void *data) | ||
208 | { | 332 | { |
209 | DECLARE_BITMAP(irq_status, PM860X_NUM_IRQ); | ||
210 | struct pm860x_chip *chip = data; | 333 | struct pm860x_chip *chip = data; |
211 | struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \ | 334 | struct pm860x_irq_data *irq_data; |
212 | : chip->companion; | 335 | struct i2c_client *i2c; |
213 | unsigned char status_buf[INT_STATUS_NUM << 1]; | 336 | int read_reg = -1, value = 0; |
214 | unsigned long value; | 337 | int i; |
215 | int i, ret; | 338 | |
216 | 339 | i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion; | |
217 | irq_status[0] = 0; | 340 | for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) { |
218 | 341 | irq_data = &pm860x_irqs[i]; | |
219 | /* read out status register */ | 342 | if (read_reg != irq_data->reg) { |
220 | ret = pm860x_bulk_read(i2c, PM8607_INT_STATUS1, | 343 | read_reg = irq_data->reg; |
221 | INT_STATUS_NUM << 1, status_buf); | 344 | value = pm860x_reg_read(i2c, irq_data->reg); |
222 | if (ret < 0) | ||
223 | goto out; | ||
224 | if (chip->irq_mode) { | ||
225 | /* 0, clear by read. 1, clear by write */ | ||
226 | ret = pm860x_bulk_write(i2c, PM8607_INT_STATUS1, | ||
227 | INT_STATUS_NUM, status_buf); | ||
228 | if (ret < 0) | ||
229 | goto out; | ||
230 | } | ||
231 | |||
232 | /* clear masked interrupt status */ | ||
233 | for (i = 0, value = 0; i < INT_STATUS_NUM; i++) { | ||
234 | status_buf[i] &= status_buf[i + INT_STATUS_NUM]; | ||
235 | irq_status[0] |= status_buf[i] << (i * 8); | ||
236 | } | ||
237 | |||
238 | while (!bitmap_empty(irq_status, PM860X_NUM_IRQ)) { | ||
239 | irq = find_first_bit(irq_status, PM860X_NUM_IRQ); | ||
240 | clear_bit(irq, irq_status); | ||
241 | dev_dbg(chip->dev, "Servicing IRQ #%d\n", irq); | ||
242 | |||
243 | mutex_lock(&chip->irq_lock); | ||
244 | if (chip->irq[irq].handler) | ||
245 | chip->irq[irq].handler(irq, chip->irq[irq].data); | ||
246 | else { | ||
247 | pm860x_mask_irq(chip, irq); | ||
248 | dev_err(chip->dev, "Nobody cares IRQ %d. " | ||
249 | "Now mask it.\n", irq); | ||
250 | for (i = 0; i < (INT_STATUS_NUM << 1); i++) { | ||
251 | dev_err(chip->dev, "status[%d]:%x\n", i, | ||
252 | status_buf[i]); | ||
253 | } | ||
254 | } | 345 | } |
255 | mutex_unlock(&chip->irq_lock); | 346 | if (value & irq_data->enable) |
347 | handle_nested_irq(chip->irq_base + i); | ||
256 | } | 348 | } |
257 | out: | ||
258 | return IRQ_HANDLED; | 349 | return IRQ_HANDLED; |
259 | } | 350 | } |
260 | 351 | ||
261 | int pm860x_request_irq(struct pm860x_chip *chip, int irq, | 352 | static void pm860x_irq_lock(unsigned int irq) |
262 | irq_handler_t handler, void *data) | ||
263 | { | 353 | { |
264 | CHECK_IRQ(irq); | 354 | struct pm860x_chip *chip = get_irq_chip_data(irq); |
265 | if (!handler) | ||
266 | return -EINVAL; | ||
267 | 355 | ||
268 | mutex_lock(&chip->irq_lock); | 356 | mutex_lock(&chip->irq_lock); |
269 | chip->irq[irq].handler = handler; | ||
270 | chip->irq[irq].data = data; | ||
271 | mutex_unlock(&chip->irq_lock); | ||
272 | |||
273 | return 0; | ||
274 | } | 357 | } |
275 | EXPORT_SYMBOL(pm860x_request_irq); | ||
276 | 358 | ||
277 | int pm860x_free_irq(struct pm860x_chip *chip, int irq) | 359 | static void pm860x_irq_sync_unlock(unsigned int irq) |
278 | { | 360 | { |
279 | CHECK_IRQ(irq); | 361 | struct pm860x_chip *chip = get_irq_chip_data(irq); |
362 | struct pm860x_irq_data *irq_data; | ||
363 | struct i2c_client *i2c; | ||
364 | static unsigned char cached[3] = {0x0, 0x0, 0x0}; | ||
365 | unsigned char mask[3]; | ||
366 | int i; | ||
367 | |||
368 | i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion; | ||
369 | /* Load cached value. In initial, all IRQs are masked */ | ||
370 | for (i = 0; i < 3; i++) | ||
371 | mask[i] = cached[i]; | ||
372 | for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) { | ||
373 | irq_data = &pm860x_irqs[i]; | ||
374 | switch (irq_data->mask_reg) { | ||
375 | case PM8607_INT_MASK_1: | ||
376 | mask[0] &= ~irq_data->offs; | ||
377 | mask[0] |= irq_data->enable; | ||
378 | break; | ||
379 | case PM8607_INT_MASK_2: | ||
380 | mask[1] &= ~irq_data->offs; | ||
381 | mask[1] |= irq_data->enable; | ||
382 | break; | ||
383 | case PM8607_INT_MASK_3: | ||
384 | mask[2] &= ~irq_data->offs; | ||
385 | mask[2] |= irq_data->enable; | ||
386 | break; | ||
387 | default: | ||
388 | dev_err(chip->dev, "wrong IRQ\n"); | ||
389 | break; | ||
390 | } | ||
391 | } | ||
392 | /* update mask into registers */ | ||
393 | for (i = 0; i < 3; i++) { | ||
394 | if (mask[i] != cached[i]) { | ||
395 | cached[i] = mask[i]; | ||
396 | pm860x_reg_write(i2c, PM8607_INT_MASK_1 + i, mask[i]); | ||
397 | } | ||
398 | } | ||
280 | 399 | ||
281 | mutex_lock(&chip->irq_lock); | ||
282 | chip->irq[irq].handler = NULL; | ||
283 | chip->irq[irq].data = NULL; | ||
284 | mutex_unlock(&chip->irq_lock); | 400 | mutex_unlock(&chip->irq_lock); |
401 | } | ||
285 | 402 | ||
286 | return 0; | 403 | static void pm860x_irq_enable(unsigned int irq) |
404 | { | ||
405 | struct pm860x_chip *chip = get_irq_chip_data(irq); | ||
406 | pm860x_irqs[irq - chip->irq_base].enable | ||
407 | = pm860x_irqs[irq - chip->irq_base].offs; | ||
287 | } | 408 | } |
288 | EXPORT_SYMBOL(pm860x_free_irq); | 409 | |
410 | static void pm860x_irq_disable(unsigned int irq) | ||
411 | { | ||
412 | struct pm860x_chip *chip = get_irq_chip_data(irq); | ||
413 | pm860x_irqs[irq - chip->irq_base].enable = 0; | ||
414 | } | ||
415 | |||
416 | static struct irq_chip pm860x_irq_chip = { | ||
417 | .name = "88pm860x", | ||
418 | .bus_lock = pm860x_irq_lock, | ||
419 | .bus_sync_unlock = pm860x_irq_sync_unlock, | ||
420 | .enable = pm860x_irq_enable, | ||
421 | .disable = pm860x_irq_disable, | ||
422 | }; | ||
289 | 423 | ||
290 | static int __devinit device_gpadc_init(struct pm860x_chip *chip, | 424 | static int __devinit device_gpadc_init(struct pm860x_chip *chip, |
291 | struct pm860x_platform_data *pdata) | 425 | struct pm860x_platform_data *pdata) |
@@ -348,9 +482,15 @@ static int __devinit device_irq_init(struct pm860x_chip *chip, | |||
348 | struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \ | 482 | struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \ |
349 | : chip->companion; | 483 | : chip->companion; |
350 | unsigned char status_buf[INT_STATUS_NUM]; | 484 | unsigned char status_buf[INT_STATUS_NUM]; |
351 | int data, mask, ret = -EINVAL; | 485 | unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT; |
486 | struct irq_desc *desc; | ||
487 | int i, data, mask, ret = -EINVAL; | ||
488 | int __irq; | ||
352 | 489 | ||
353 | mutex_init(&chip->irq_lock); | 490 | if (!pdata || !pdata->irq_base) { |
491 | dev_warn(chip->dev, "No interrupt support on IRQ base\n"); | ||
492 | return -EINVAL; | ||
493 | } | ||
354 | 494 | ||
355 | mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR | 495 | mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR |
356 | | PM8607_B0_MISC1_INT_MASK; | 496 | | PM8607_B0_MISC1_INT_MASK; |
@@ -389,25 +529,45 @@ static int __devinit device_irq_init(struct pm860x_chip *chip, | |||
389 | if (ret < 0) | 529 | if (ret < 0) |
390 | goto out; | 530 | goto out; |
391 | 531 | ||
392 | memset(chip->irq, 0, sizeof(struct pm860x_irq) * PM860X_NUM_IRQ); | 532 | mutex_init(&chip->irq_lock); |
393 | 533 | chip->irq_base = pdata->irq_base; | |
394 | ret = request_threaded_irq(i2c->irq, NULL, pm8607_irq_thread, | 534 | chip->core_irq = i2c->irq; |
395 | IRQF_ONESHOT | IRQF_TRIGGER_LOW, | 535 | if (!chip->core_irq) |
396 | "88PM8607", chip); | ||
397 | if (ret < 0) { | ||
398 | dev_err(chip->dev, "Failed to request IRQ #%d.\n", i2c->irq); | ||
399 | goto out; | 536 | goto out; |
537 | |||
538 | desc = irq_to_desc(chip->core_irq); | ||
539 | |||
540 | /* register IRQ by genirq */ | ||
541 | for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) { | ||
542 | __irq = i + chip->irq_base; | ||
543 | set_irq_chip_data(__irq, chip); | ||
544 | set_irq_chip_and_handler(__irq, &pm860x_irq_chip, | ||
545 | handle_edge_irq); | ||
546 | set_irq_nested_thread(__irq, 1); | ||
547 | #ifdef CONFIG_ARM | ||
548 | set_irq_flags(__irq, IRQF_VALID); | ||
549 | #else | ||
550 | set_irq_noprobe(__irq); | ||
551 | #endif | ||
400 | } | 552 | } |
401 | chip->chip_irq = i2c->irq; | 553 | |
554 | ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags, | ||
555 | "88pm860x", chip); | ||
556 | if (ret) { | ||
557 | dev_err(chip->dev, "Failed to request IRQ: %d\n", ret); | ||
558 | chip->core_irq = 0; | ||
559 | } | ||
560 | |||
402 | return 0; | 561 | return 0; |
403 | out: | 562 | out: |
563 | chip->core_irq = 0; | ||
404 | return ret; | 564 | return ret; |
405 | } | 565 | } |
406 | 566 | ||
407 | static void __devexit device_irq_exit(struct pm860x_chip *chip) | 567 | static void __devexit device_irq_exit(struct pm860x_chip *chip) |
408 | { | 568 | { |
409 | if (chip->chip_irq >= 0) | 569 | if (chip->core_irq) |
410 | free_irq(chip->chip_irq, chip); | 570 | free_irq(chip->core_irq, chip); |
411 | } | 571 | } |
412 | 572 | ||
413 | static void __devinit device_8606_init(struct pm860x_chip *chip, | 573 | static void __devinit device_8606_init(struct pm860x_chip *chip, |
@@ -513,6 +673,26 @@ static void __devinit device_8607_init(struct pm860x_chip *chip, | |||
513 | goto out_dev; | 673 | goto out_dev; |
514 | } | 674 | } |
515 | } | 675 | } |
676 | |||
677 | if (pdata && pdata->power) { | ||
678 | ret = mfd_add_devices(chip->dev, 0, &power_devs[0], | ||
679 | ARRAY_SIZE(power_devs), | ||
680 | &power_supply_resources[0], 0); | ||
681 | if (ret < 0) { | ||
682 | dev_err(chip->dev, "Failed to add power supply " | ||
683 | "subdev\n"); | ||
684 | goto out_dev; | ||
685 | } | ||
686 | } | ||
687 | |||
688 | ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0], | ||
689 | ARRAY_SIZE(onkey_devs), | ||
690 | &onkey_resources[0], 0); | ||
691 | if (ret < 0) { | ||
692 | dev_err(chip->dev, "Failed to add onkey subdev\n"); | ||
693 | goto out_dev; | ||
694 | } | ||
695 | |||
516 | return; | 696 | return; |
517 | out_dev: | 697 | out_dev: |
518 | mfd_remove_devices(chip->dev); | 698 | mfd_remove_devices(chip->dev); |
@@ -524,7 +704,7 @@ out: | |||
524 | int pm860x_device_init(struct pm860x_chip *chip, | 704 | int pm860x_device_init(struct pm860x_chip *chip, |
525 | struct pm860x_platform_data *pdata) | 705 | struct pm860x_platform_data *pdata) |
526 | { | 706 | { |
527 | chip->chip_irq = -EINVAL; | 707 | chip->core_irq = 0; |
528 | 708 | ||
529 | switch (chip->id) { | 709 | switch (chip->id) { |
530 | case CHIP_PM8606: | 710 | case CHIP_PM8606: |
diff --git a/include/linux/mfd/88pm860x.h b/include/linux/mfd/88pm860x.h index 80bc82a7ac96..73f92c5feea2 100644 --- a/include/linux/mfd/88pm860x.h +++ b/include/linux/mfd/88pm860x.h | |||
@@ -262,12 +262,13 @@ enum { | |||
262 | 262 | ||
263 | /* Interrupt Number in 88PM8607 */ | 263 | /* Interrupt Number in 88PM8607 */ |
264 | enum { | 264 | enum { |
265 | PM8607_IRQ_ONKEY = 0, | 265 | PM8607_IRQ_ONKEY, |
266 | PM8607_IRQ_EXTON, | 266 | PM8607_IRQ_EXTON, |
267 | PM8607_IRQ_CHG, | 267 | PM8607_IRQ_CHG, |
268 | PM8607_IRQ_BAT, | 268 | PM8607_IRQ_BAT, |
269 | PM8607_IRQ_RTC, | 269 | PM8607_IRQ_RTC, |
270 | PM8607_IRQ_VBAT = 8, | 270 | PM8607_IRQ_CC, |
271 | PM8607_IRQ_VBAT, | ||
271 | PM8607_IRQ_VCHG, | 272 | PM8607_IRQ_VCHG, |
272 | PM8607_IRQ_VSYS, | 273 | PM8607_IRQ_VSYS, |
273 | PM8607_IRQ_TINT, | 274 | PM8607_IRQ_TINT, |
@@ -275,7 +276,7 @@ enum { | |||
275 | PM8607_IRQ_GPADC1, | 276 | PM8607_IRQ_GPADC1, |
276 | PM8607_IRQ_GPADC2, | 277 | PM8607_IRQ_GPADC2, |
277 | PM8607_IRQ_GPADC3, | 278 | PM8607_IRQ_GPADC3, |
278 | PM8607_IRQ_AUDIO_SHORT = 16, | 279 | PM8607_IRQ_AUDIO_SHORT, |
279 | PM8607_IRQ_PEN, | 280 | PM8607_IRQ_PEN, |
280 | PM8607_IRQ_HEADSET, | 281 | PM8607_IRQ_HEADSET, |
281 | PM8607_IRQ_HOOK, | 282 | PM8607_IRQ_HOOK, |
@@ -291,26 +292,19 @@ enum { | |||
291 | PM8607_CHIP_B0 = 0x48, | 292 | PM8607_CHIP_B0 = 0x48, |
292 | }; | 293 | }; |
293 | 294 | ||
294 | #define PM860X_NUM_IRQ 24 | ||
295 | |||
296 | struct pm860x_irq { | ||
297 | irq_handler_t handler; | ||
298 | void *data; | ||
299 | }; | ||
300 | |||
301 | struct pm860x_chip { | 295 | struct pm860x_chip { |
302 | struct device *dev; | 296 | struct device *dev; |
303 | struct mutex io_lock; | 297 | struct mutex io_lock; |
304 | struct mutex irq_lock; | 298 | struct mutex irq_lock; |
305 | struct i2c_client *client; | 299 | struct i2c_client *client; |
306 | struct i2c_client *companion; /* companion chip client */ | 300 | struct i2c_client *companion; /* companion chip client */ |
307 | struct pm860x_irq irq[PM860X_NUM_IRQ]; | ||
308 | 301 | ||
309 | int buck3_double; /* DVC ramp slope double */ | 302 | int buck3_double; /* DVC ramp slope double */ |
310 | unsigned short companion_addr; | 303 | unsigned short companion_addr; |
311 | int id; | 304 | int id; |
312 | int irq_mode; | 305 | int irq_mode; |
313 | int chip_irq; | 306 | int irq_base; |
307 | int core_irq; | ||
314 | unsigned char chip_version; | 308 | unsigned char chip_version; |
315 | 309 | ||
316 | }; | 310 | }; |
@@ -347,14 +341,20 @@ struct pm860x_touch_pdata { | |||
347 | unsigned long flags; | 341 | unsigned long flags; |
348 | }; | 342 | }; |
349 | 343 | ||
344 | struct pm860x_power_pdata { | ||
345 | unsigned fast_charge; /* charge current */ | ||
346 | }; | ||
347 | |||
350 | struct pm860x_platform_data { | 348 | struct pm860x_platform_data { |
351 | struct pm860x_backlight_pdata *backlight; | 349 | struct pm860x_backlight_pdata *backlight; |
352 | struct pm860x_led_pdata *led; | 350 | struct pm860x_led_pdata *led; |
353 | struct pm860x_touch_pdata *touch; | 351 | struct pm860x_touch_pdata *touch; |
352 | struct pm860x_power_pdata *power; | ||
354 | 353 | ||
355 | unsigned short companion_addr; /* I2C address of companion chip */ | 354 | unsigned short companion_addr; /* I2C address of companion chip */ |
356 | int i2c_port; /* Controlled by GI2C or PI2C */ | 355 | int i2c_port; /* Controlled by GI2C or PI2C */ |
357 | int irq_mode; /* Clear interrupt by read/write(0/1) */ | 356 | int irq_mode; /* Clear interrupt by read/write(0/1) */ |
357 | int irq_base; /* IRQ base number of 88pm860x */ | ||
358 | struct regulator_init_data *regulator[PM8607_MAX_REGULATOR]; | 358 | struct regulator_init_data *regulator[PM8607_MAX_REGULATOR]; |
359 | }; | 359 | }; |
360 | 360 | ||
@@ -368,12 +368,6 @@ extern int pm860x_bulk_write(struct i2c_client *, int, int, unsigned char *); | |||
368 | extern int pm860x_set_bits(struct i2c_client *, int, unsigned char, | 368 | extern int pm860x_set_bits(struct i2c_client *, int, unsigned char, |
369 | unsigned char); | 369 | unsigned char); |
370 | 370 | ||
371 | extern int pm860x_mask_irq(struct pm860x_chip *, int); | ||
372 | extern int pm860x_unmask_irq(struct pm860x_chip *, int); | ||
373 | extern int pm860x_request_irq(struct pm860x_chip *, int, | ||
374 | irq_handler_t handler, void *); | ||
375 | extern int pm860x_free_irq(struct pm860x_chip *, int); | ||
376 | |||
377 | extern int pm860x_device_init(struct pm860x_chip *chip, | 371 | extern int pm860x_device_init(struct pm860x_chip *chip, |
378 | struct pm860x_platform_data *pdata); | 372 | struct pm860x_platform_data *pdata); |
379 | extern void pm860x_device_exit(struct pm860x_chip *chip); | 373 | extern void pm860x_device_exit(struct pm860x_chip *chip); |