Piteball/android_kernel_samsung_msm8226
1
0
Fork 0
mirror of https://github.com/S3NEO/android_kernel_samsung_msm8226.git synced 2024-11-07 03:47:13 +00:00
Code Issues Projects Releases Packages Wiki Activity

gpio: pl061: fix IRQ handling for GPIOs >= PL061_GPIO_NR

Browse source 
IRQ handling is wrong for any GPIO >= PL061_GPIO_NR.

Fix this by implementing and using a proper .to_irq method.

Signed-off-by: Baruch Siach <baruch@tkos.co.il>
Cc: David Brownell <david-b@pacbell.net>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
This commit is contained in:
Baruch Siach 2009-06-30 11:41:39 -07:00 committed by Linus Torvalds
parent 79d7f4ee23
commit 50efacf671
1 changed files with 14 additions and 3 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

17
drivers/gpio/pl061.c
View file

@ -109,6 +109,16 @@ static void pl061_set_value(struct gpio_chip *gc, unsigned offset, int value)
writeb(!!value << offset, chip->base + (1 << (offset + 2))); writeb(!!value << offset, chip->base + (1 << (offset + 2)));
} }
static int pl061_to_irq(struct gpio_chip *gc, unsigned offset)
{
struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
if (chip->irq_base == (unsigned) -1)
return -EINVAL;
return chip->irq_base + offset;
}
/* /*
* PL061 GPIO IRQ * PL061 GPIO IRQ
*/ */
@ -200,7 +210,7 @@ static void pl061_irq_handler(unsigned irq, struct irq_desc *desc)
desc->chip->ack(irq); desc->chip->ack(irq);
list_for_each(ptr, chip_list) { list_for_each(ptr, chip_list) {
unsigned long pending; unsigned long pending;
int gpio; int offset;
chip = list_entry(ptr, struct pl061_gpio, list); chip = list_entry(ptr, struct pl061_gpio, list);
pending = readb(chip->base + GPIOMIS); pending = readb(chip->base + GPIOMIS);
@ -209,8 +219,8 @@ static void pl061_irq_handler(unsigned irq, struct irq_desc *desc)
if (pending == 0) if (pending == 0)
continue; continue;
for_each_bit(gpio, &pending, PL061_GPIO_NR) for_each_bit(offset, &pending, PL061_GPIO_NR)
generic_handle_irq(gpio_to_irq(gpio)); generic_handle_irq(pl061_to_irq(&chip->gc, offset));
} }
desc->chip->unmask(irq); desc->chip->unmask(irq);
} }
@ -251,6 +261,7 @@ static int __init pl061_probe(struct amba_device *dev, struct amba_id *id)
chip->gc.direction_output = pl061_direction_output; chip->gc.direction_output = pl061_direction_output;
chip->gc.get = pl061_get_value; chip->gc.get = pl061_get_value;
chip->gc.set = pl061_set_value; chip->gc.set = pl061_set_value;
chip->gc.to_irq = pl061_to_irq;
chip->gc.base = pdata->gpio_base; chip->gc.base = pdata->gpio_base;
chip->gc.ngpio = PL061_GPIO_NR; chip->gc.ngpio = PL061_GPIO_NR;
chip->gc.label = dev_name(&dev->dev); chip->gc.label = dev_name(&dev->dev);