diff options
Diffstat (limited to 'drivers/mfd/ezx-pcap.c')
-rw-r--r-- | drivers/mfd/ezx-pcap.c | 72 |
1 files changed, 36 insertions, 36 deletions
diff --git a/drivers/mfd/ezx-pcap.c b/drivers/mfd/ezx-pcap.c index 134c69aa4790..43a76c41cfcc 100644 --- a/drivers/mfd/ezx-pcap.c +++ b/drivers/mfd/ezx-pcap.c | |||
@@ -144,26 +144,27 @@ int pcap_to_irq(struct pcap_chip *pcap, int irq) | |||
144 | } | 144 | } |
145 | EXPORT_SYMBOL_GPL(pcap_to_irq); | 145 | EXPORT_SYMBOL_GPL(pcap_to_irq); |
146 | 146 | ||
147 | static void pcap_mask_irq(unsigned int irq) | 147 | static void pcap_mask_irq(struct irq_data *d) |
148 | { | 148 | { |
149 | struct pcap_chip *pcap = get_irq_chip_data(irq); | 149 | struct pcap_chip *pcap = irq_data_get_irq_chip_data(d); |
150 | 150 | ||
151 | pcap->msr |= 1 << irq_to_pcap(pcap, irq); | 151 | pcap->msr |= 1 << irq_to_pcap(pcap, d->irq); |
152 | queue_work(pcap->workqueue, &pcap->msr_work); | 152 | queue_work(pcap->workqueue, &pcap->msr_work); |
153 | } | 153 | } |
154 | 154 | ||
155 | static void pcap_unmask_irq(unsigned int irq) | 155 | static void pcap_unmask_irq(struct irq_data *d) |
156 | { | 156 | { |
157 | struct pcap_chip *pcap = get_irq_chip_data(irq); | 157 | struct pcap_chip *pcap = irq_data_get_irq_chip_data(d); |
158 | 158 | ||
159 | pcap->msr &= ~(1 << irq_to_pcap(pcap, irq)); | 159 | pcap->msr &= ~(1 << irq_to_pcap(pcap, d->irq)); |
160 | queue_work(pcap->workqueue, &pcap->msr_work); | 160 | queue_work(pcap->workqueue, &pcap->msr_work); |
161 | } | 161 | } |
162 | 162 | ||
163 | static struct irq_chip pcap_irq_chip = { | 163 | static struct irq_chip pcap_irq_chip = { |
164 | .name = "pcap", | 164 | .name = "pcap", |
165 | .mask = pcap_mask_irq, | 165 | .irq_disable = pcap_mask_irq, |
166 | .unmask = pcap_unmask_irq, | 166 | .irq_mask = pcap_mask_irq, |
167 | .irq_unmask = pcap_unmask_irq, | ||
167 | }; | 168 | }; |
168 | 169 | ||
169 | static void pcap_msr_work(struct work_struct *work) | 170 | static void pcap_msr_work(struct work_struct *work) |
@@ -184,7 +185,7 @@ static void pcap_isr_work(struct work_struct *work) | |||
184 | ezx_pcap_read(pcap, PCAP_REG_MSR, &msr); | 185 | ezx_pcap_read(pcap, PCAP_REG_MSR, &msr); |
185 | ezx_pcap_read(pcap, PCAP_REG_ISR, &isr); | 186 | ezx_pcap_read(pcap, PCAP_REG_ISR, &isr); |
186 | 187 | ||
187 | /* We cant service/ack irqs that are assigned to port 2 */ | 188 | /* We can't service/ack irqs that are assigned to port 2 */ |
188 | if (!(pdata->config & PCAP_SECOND_PORT)) { | 189 | if (!(pdata->config & PCAP_SECOND_PORT)) { |
189 | ezx_pcap_read(pcap, PCAP_REG_INT_SEL, &int_sel); | 190 | ezx_pcap_read(pcap, PCAP_REG_INT_SEL, &int_sel); |
190 | isr &= ~int_sel; | 191 | isr &= ~int_sel; |
@@ -196,18 +197,8 @@ static void pcap_isr_work(struct work_struct *work) | |||
196 | local_irq_disable(); | 197 | local_irq_disable(); |
197 | service = isr & ~msr; | 198 | service = isr & ~msr; |
198 | for (irq = pcap->irq_base; service; service >>= 1, irq++) { | 199 | for (irq = pcap->irq_base; service; service >>= 1, irq++) { |
199 | if (service & 1) { | 200 | if (service & 1) |
200 | struct irq_desc *desc = irq_to_desc(irq); | 201 | generic_handle_irq(irq); |
201 | |||
202 | if (WARN(!desc, KERN_WARNING | ||
203 | "Invalid PCAP IRQ %d\n", irq)) | ||
204 | break; | ||
205 | |||
206 | if (desc->status & IRQ_DISABLED) | ||
207 | note_interrupt(irq, desc, IRQ_NONE); | ||
208 | else | ||
209 | desc->handle_irq(irq, desc); | ||
210 | } | ||
211 | } | 202 | } |
212 | local_irq_enable(); | 203 | local_irq_enable(); |
213 | ezx_pcap_write(pcap, PCAP_REG_MSR, pcap->msr); | 204 | ezx_pcap_write(pcap, PCAP_REG_MSR, pcap->msr); |
@@ -216,9 +207,9 @@ static void pcap_isr_work(struct work_struct *work) | |||
216 | 207 | ||
217 | static void pcap_irq_handler(unsigned int irq, struct irq_desc *desc) | 208 | static void pcap_irq_handler(unsigned int irq, struct irq_desc *desc) |
218 | { | 209 | { |
219 | struct pcap_chip *pcap = get_irq_data(irq); | 210 | struct pcap_chip *pcap = irq_get_handler_data(irq); |
220 | 211 | ||
221 | desc->chip->ack(irq); | 212 | desc->irq_data.chip->irq_ack(&desc->irq_data); |
222 | queue_work(pcap->workqueue, &pcap->isr_work); | 213 | queue_work(pcap->workqueue, &pcap->isr_work); |
223 | return; | 214 | return; |
224 | } | 215 | } |
@@ -282,7 +273,7 @@ static irqreturn_t pcap_adc_irq(int irq, void *_pcap) | |||
282 | mutex_lock(&pcap->adc_mutex); | 273 | mutex_lock(&pcap->adc_mutex); |
283 | req = pcap->adc_queue[pcap->adc_head]; | 274 | req = pcap->adc_queue[pcap->adc_head]; |
284 | 275 | ||
285 | if (WARN(!req, KERN_WARNING "adc irq without pending request\n")) { | 276 | if (WARN(!req, "adc irq without pending request\n")) { |
286 | mutex_unlock(&pcap->adc_mutex); | 277 | mutex_unlock(&pcap->adc_mutex); |
287 | return IRQ_HANDLED; | 278 | return IRQ_HANDLED; |
288 | } | 279 | } |
@@ -384,12 +375,20 @@ static int __devinit pcap_add_subdev(struct pcap_chip *pcap, | |||
384 | struct pcap_subdev *subdev) | 375 | struct pcap_subdev *subdev) |
385 | { | 376 | { |
386 | struct platform_device *pdev; | 377 | struct platform_device *pdev; |
378 | int ret; | ||
387 | 379 | ||
388 | pdev = platform_device_alloc(subdev->name, subdev->id); | 380 | pdev = platform_device_alloc(subdev->name, subdev->id); |
381 | if (!pdev) | ||
382 | return -ENOMEM; | ||
383 | |||
389 | pdev->dev.parent = &pcap->spi->dev; | 384 | pdev->dev.parent = &pcap->spi->dev; |
390 | pdev->dev.platform_data = subdev->platform_data; | 385 | pdev->dev.platform_data = subdev->platform_data; |
391 | 386 | ||
392 | return platform_device_add(pdev); | 387 | ret = platform_device_add(pdev); |
388 | if (ret) | ||
389 | platform_device_put(pdev); | ||
390 | |||
391 | return ret; | ||
393 | } | 392 | } |
394 | 393 | ||
395 | static int __devexit ezx_pcap_remove(struct spi_device *spi) | 394 | static int __devexit ezx_pcap_remove(struct spi_device *spi) |
@@ -412,7 +411,7 @@ static int __devexit ezx_pcap_remove(struct spi_device *spi) | |||
412 | 411 | ||
413 | /* cleanup irqchip */ | 412 | /* cleanup irqchip */ |
414 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) | 413 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) |
415 | set_irq_chip_and_handler(i, NULL, NULL); | 414 | irq_set_chip_and_handler(i, NULL, NULL); |
416 | 415 | ||
417 | destroy_workqueue(pcap->workqueue); | 416 | destroy_workqueue(pcap->workqueue); |
418 | 417 | ||
@@ -457,7 +456,8 @@ static int __devinit ezx_pcap_probe(struct spi_device *spi) | |||
457 | pcap->irq_base = pdata->irq_base; | 456 | pcap->irq_base = pdata->irq_base; |
458 | pcap->workqueue = create_singlethread_workqueue("pcapd"); | 457 | pcap->workqueue = create_singlethread_workqueue("pcapd"); |
459 | if (!pcap->workqueue) { | 458 | if (!pcap->workqueue) { |
460 | dev_err(&spi->dev, "cant create pcap thread\n"); | 459 | ret = -ENOMEM; |
460 | dev_err(&spi->dev, "can't create pcap thread\n"); | ||
461 | goto free_pcap; | 461 | goto free_pcap; |
462 | } | 462 | } |
463 | 463 | ||
@@ -468,12 +468,12 @@ static int __devinit ezx_pcap_probe(struct spi_device *spi) | |||
468 | 468 | ||
469 | /* setup irq chip */ | 469 | /* setup irq chip */ |
470 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) { | 470 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) { |
471 | set_irq_chip_and_handler(i, &pcap_irq_chip, handle_simple_irq); | 471 | irq_set_chip_and_handler(i, &pcap_irq_chip, handle_simple_irq); |
472 | set_irq_chip_data(i, pcap); | 472 | irq_set_chip_data(i, pcap); |
473 | #ifdef CONFIG_ARM | 473 | #ifdef CONFIG_ARM |
474 | set_irq_flags(i, IRQF_VALID); | 474 | set_irq_flags(i, IRQF_VALID); |
475 | #else | 475 | #else |
476 | set_irq_noprobe(i); | 476 | irq_set_noprobe(i); |
477 | #endif | 477 | #endif |
478 | } | 478 | } |
479 | 479 | ||
@@ -482,10 +482,10 @@ static int __devinit ezx_pcap_probe(struct spi_device *spi) | |||
482 | ezx_pcap_write(pcap, PCAP_REG_ISR, PCAP_CLEAR_INTERRUPT_REGISTER); | 482 | ezx_pcap_write(pcap, PCAP_REG_ISR, PCAP_CLEAR_INTERRUPT_REGISTER); |
483 | pcap->msr = PCAP_MASK_ALL_INTERRUPT; | 483 | pcap->msr = PCAP_MASK_ALL_INTERRUPT; |
484 | 484 | ||
485 | set_irq_type(spi->irq, IRQ_TYPE_EDGE_RISING); | 485 | irq_set_irq_type(spi->irq, IRQ_TYPE_EDGE_RISING); |
486 | set_irq_data(spi->irq, pcap); | 486 | irq_set_handler_data(spi->irq, pcap); |
487 | set_irq_chained_handler(spi->irq, pcap_irq_handler); | 487 | irq_set_chained_handler(spi->irq, pcap_irq_handler); |
488 | set_irq_wake(spi->irq, 1); | 488 | irq_set_irq_wake(spi->irq, 1); |
489 | 489 | ||
490 | /* ADC */ | 490 | /* ADC */ |
491 | adc_irq = pcap_to_irq(pcap, (pdata->config & PCAP_SECOND_PORT) ? | 491 | adc_irq = pcap_to_irq(pcap, (pdata->config & PCAP_SECOND_PORT) ? |
@@ -514,7 +514,7 @@ remove_subdevs: | |||
514 | free_irq(adc_irq, pcap); | 514 | free_irq(adc_irq, pcap); |
515 | free_irqchip: | 515 | free_irqchip: |
516 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) | 516 | for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) |
517 | set_irq_chip_and_handler(i, NULL, NULL); | 517 | irq_set_chip_and_handler(i, NULL, NULL); |
518 | /* destroy_workqueue: */ | 518 | /* destroy_workqueue: */ |
519 | destroy_workqueue(pcap->workqueue); | 519 | destroy_workqueue(pcap->workqueue); |
520 | free_pcap: | 520 | free_pcap: |