|
@@ -42,12 +42,6 @@
|
|
|
#include <plat/gpio-fns.h>
|
|
|
#include <plat/pm.h>
|
|
|
|
|
|
-#ifndef DEBUG_GPIO
|
|
|
-#define gpio_dbg(x...) do { } while (0)
|
|
|
-#else
|
|
|
-#define gpio_dbg(x...) printk(KERN_DEBUG x)
|
|
|
-#endif
|
|
|
-
|
|
|
int samsung_gpio_setpull_updown(struct samsung_gpio_chip *chip,
|
|
|
unsigned int off, samsung_gpio_pull_t pull)
|
|
|
{
|
|
@@ -596,10 +590,13 @@ static int samsung_gpiolib_4bit_input(struct gpio_chip *chip,
|
|
|
unsigned long con;
|
|
|
|
|
|
con = __raw_readl(base + GPIOCON_OFF);
|
|
|
- con &= ~(0xf << con_4bit_shift(offset));
|
|
|
+ if (ourchip->bitmap_gpio_int & BIT(offset))
|
|
|
+ con |= 0xf << con_4bit_shift(offset);
|
|
|
+ else
|
|
|
+ con &= ~(0xf << con_4bit_shift(offset));
|
|
|
__raw_writel(con, base + GPIOCON_OFF);
|
|
|
|
|
|
- gpio_dbg("%s: %p: CON now %08lx\n", __func__, base, con);
|
|
|
+ pr_debug("%s: %p: CON now %08lx\n", __func__, base, con);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -627,7 +624,7 @@ static int samsung_gpiolib_4bit_output(struct gpio_chip *chip,
|
|
|
__raw_writel(con, base + GPIOCON_OFF);
|
|
|
__raw_writel(dat, base + GPIODAT_OFF);
|
|
|
|
|
|
- gpio_dbg("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
|
|
|
+ pr_debug("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -671,7 +668,7 @@ static int samsung_gpiolib_4bit2_input(struct gpio_chip *chip,
|
|
|
con &= ~(0xf << con_4bit_shift(offset));
|
|
|
__raw_writel(con, regcon);
|
|
|
|
|
|
- gpio_dbg("%s: %p: CON %08lx\n", __func__, base, con);
|
|
|
+ pr_debug("%s: %p: CON %08lx\n", __func__, base, con);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -706,7 +703,7 @@ static int samsung_gpiolib_4bit2_output(struct gpio_chip *chip,
|
|
|
__raw_writel(con, regcon);
|
|
|
__raw_writel(dat, base + GPIODAT_OFF);
|
|
|
|
|
|
- gpio_dbg("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
|
|
|
+ pr_debug("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -926,10 +923,10 @@ static void __init samsung_gpiolib_add(struct samsung_gpio_chip *chip)
|
|
|
#ifdef CONFIG_PM
|
|
|
if (chip->pm != NULL) {
|
|
|
if (!chip->pm->save || !chip->pm->resume)
|
|
|
- printk(KERN_ERR "gpio: %s has missing PM functions\n",
|
|
|
+ pr_err("gpio: %s has missing PM functions\n",
|
|
|
gc->label);
|
|
|
} else
|
|
|
- printk(KERN_ERR "gpio: %s has no PM function\n", gc->label);
|
|
|
+ pr_err("gpio: %s has no PM function\n", gc->label);
|
|
|
#endif
|
|
|
|
|
|
/* gpiochip_add() prints own failure message on error. */
|
|
@@ -1081,6 +1078,8 @@ static void __init samsung_gpiolib_add_4bit_chips(struct samsung_gpio_chip *chip
|
|
|
if ((base != NULL) && (chip->base == NULL))
|
|
|
chip->base = base + ((i) * 0x20);
|
|
|
|
|
|
+ chip->bitmap_gpio_int = 0;
|
|
|
+
|
|
|
samsung_gpiolib_add(chip);
|
|
|
}
|
|
|
}
|