|
@@ -185,16 +185,15 @@ int mantis_core_exit(struct mantis_pci *mantis)
|
|
// Turn the given bit on or off.
|
|
// Turn the given bit on or off.
|
|
void gpio_set_bits(struct mantis_pci *mantis, u32 bitpos, u8 value)
|
|
void gpio_set_bits(struct mantis_pci *mantis, u32 bitpos, u8 value)
|
|
{
|
|
{
|
|
- u32 currVal, newVal;
|
|
|
|
-
|
|
|
|
- currVal = mmread(MANTIS_GPIF_ADDR);
|
|
|
|
|
|
+ u32 cur;
|
|
|
|
|
|
|
|
+ cur = mmread(MANTIS_GPIF_ADDR);
|
|
if (value)
|
|
if (value)
|
|
- newVal = currVal | (1 << bitpos);
|
|
|
|
|
|
+ mantis->gpio_status = cur | (1 << bitpos);
|
|
else
|
|
else
|
|
- newVal = currVal & (~(1 << bitpos));
|
|
|
|
|
|
+ mantis->gpio_status = cur & (~(1 << bitpos));
|
|
|
|
|
|
- mmwrite(newVal, MANTIS_GPIF_ADDR);
|
|
|
|
|
|
+ mmwrite(mantis->gpio_status, MANTIS_GPIF_ADDR);
|
|
mmwrite(0x00, MANTIS_GPIF_DOUT);
|
|
mmwrite(0x00, MANTIS_GPIF_DOUT);
|
|
udelay(100);
|
|
udelay(100);
|
|
}
|
|
}
|