mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-12-25 15:04:16 +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:
parent
848fab305c
commit
9486190f3f
@ -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);
|
||||
}
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user