1
0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-12-25 03:01:09 +02:00

[brcm63xx] cache gpio values in gpio_set

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@16330 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
florian 2009-06-04 10:01:55 +00:00
parent 848fab305c
commit 9486190f3f

View File

@ -18,12 +18,14 @@
#include <bcm63xx_io.h>
#include <bcm63xx_regs.h>
static u32 gpio_out_low, gpio_out_high;
static void bcm63xx_gpio_set(struct gpio_chip *chip,
unsigned gpio, int val)
{
u32 reg;
u32 mask;
u32 tmp;
u32 *v;
unsigned long flags;
if (gpio >= chip->ngpio)
@ -32,18 +34,19 @@ static void bcm63xx_gpio_set(struct gpio_chip *chip,
if (gpio < 32) {
reg = GPIO_DATA_LO_REG;
mask = 1 << gpio;
v = &gpio_out_low;
} else {
reg = GPIO_DATA_HI_REG;
mask = 1 << (gpio - 32);
v = &gpio_out_high;
}
local_irq_save(flags);
tmp = bcm_gpio_readl(reg);
if (val)
tmp |= mask;
*v |= mask;
else
tmp &= ~mask;
bcm_gpio_writel(tmp, reg);
*v &= ~mask;
bcm_gpio_writel(*v, reg);
local_irq_restore(flags);
}