|
@@ -63,6 +63,7 @@ struct gpio_bank {
|
|
|
struct gpio_chip chip;
|
|
|
struct clk *dbck;
|
|
|
u32 mod_usage;
|
|
|
+ u32 irq_usage;
|
|
|
u32 dbck_enable_mask;
|
|
|
bool dbck_enabled;
|
|
|
struct device *dev;
|
|
@@ -86,6 +87,9 @@ struct gpio_bank {
|
|
|
#define GPIO_BIT(bank, gpio) (1 << GPIO_INDEX(bank, gpio))
|
|
|
#define GPIO_MOD_CTRL_BIT BIT(0)
|
|
|
|
|
|
+#define BANK_USED(bank) (bank->mod_usage || bank->irq_usage)
|
|
|
+#define LINE_USED(line, offset) (line & (1 << offset))
|
|
|
+
|
|
|
static int irq_to_gpio(struct gpio_bank *bank, unsigned int gpio_irq)
|
|
|
{
|
|
|
return bank->chip.base + gpio_irq;
|
|
@@ -420,6 +424,13 @@ static int _set_gpio_triggering(struct gpio_bank *bank, int gpio,
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static int gpio_is_input(struct gpio_bank *bank, int mask)
|
|
|
+{
|
|
|
+ void __iomem *reg = bank->base + bank->regs->direction;
|
|
|
+
|
|
|
+ return __raw_readl(reg) & mask;
|
|
|
+}
|
|
|
+
|
|
|
static int gpio_irq_type(struct irq_data *d, unsigned type)
|
|
|
{
|
|
|
struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
|
|
@@ -427,7 +438,7 @@ static int gpio_irq_type(struct irq_data *d, unsigned type)
|
|
|
int retval;
|
|
|
unsigned long flags;
|
|
|
|
|
|
- if (WARN_ON(!bank->mod_usage))
|
|
|
+ if (WARN_ON(!BANK_USED(bank)))
|
|
|
return -EINVAL;
|
|
|
|
|
|
#ifdef CONFIG_ARCH_OMAP1
|
|
@@ -447,6 +458,7 @@ static int gpio_irq_type(struct irq_data *d, unsigned type)
|
|
|
|
|
|
spin_lock_irqsave(&bank->lock, flags);
|
|
|
retval = _set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), type);
|
|
|
+ bank->irq_usage |= 1 << GPIO_INDEX(bank, gpio);
|
|
|
spin_unlock_irqrestore(&bank->lock, flags);
|
|
|
|
|
|
if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH))
|
|
@@ -603,7 +615,7 @@ static int omap_gpio_request(struct gpio_chip *chip, unsigned offset)
|
|
|
* If this is the first gpio_request for the bank,
|
|
|
* enable the bank module.
|
|
|
*/
|
|
|
- if (!bank->mod_usage)
|
|
|
+ if (!BANK_USED(bank))
|
|
|
pm_runtime_get_sync(bank->dev);
|
|
|
|
|
|
spin_lock_irqsave(&bank->lock, flags);
|
|
@@ -619,7 +631,7 @@ static int omap_gpio_request(struct gpio_chip *chip, unsigned offset)
|
|
|
__raw_writel(__raw_readl(reg) | (1 << offset), reg);
|
|
|
}
|
|
|
|
|
|
- if (bank->regs->ctrl && !bank->mod_usage) {
|
|
|
+ if (bank->regs->ctrl && !BANK_USED(bank)) {
|
|
|
void __iomem *reg = bank->base + bank->regs->ctrl;
|
|
|
u32 ctrl;
|
|
|
|
|
@@ -654,7 +666,7 @@ static void omap_gpio_free(struct gpio_chip *chip, unsigned offset)
|
|
|
|
|
|
bank->mod_usage &= ~(1 << offset);
|
|
|
|
|
|
- if (bank->regs->ctrl && !bank->mod_usage) {
|
|
|
+ if (bank->regs->ctrl && !BANK_USED(bank)) {
|
|
|
void __iomem *reg = bank->base + bank->regs->ctrl;
|
|
|
u32 ctrl;
|
|
|
|
|
@@ -672,7 +684,7 @@ static void omap_gpio_free(struct gpio_chip *chip, unsigned offset)
|
|
|
* If this is the last gpio to be freed in the bank,
|
|
|
* disable the bank module.
|
|
|
*/
|
|
|
- if (!bank->mod_usage)
|
|
|
+ if (!BANK_USED(bank))
|
|
|
pm_runtime_put(bank->dev);
|
|
|
}
|
|
|
|
|
@@ -762,8 +774,10 @@ static void gpio_irq_shutdown(struct irq_data *d)
|
|
|
struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
|
|
|
unsigned int gpio = irq_to_gpio(bank, d->hwirq);
|
|
|
unsigned long flags;
|
|
|
+ unsigned offset = GPIO_INDEX(bank, gpio);
|
|
|
|
|
|
spin_lock_irqsave(&bank->lock, flags);
|
|
|
+ bank->irq_usage &= ~(1 << offset);
|
|
|
_reset_gpio(bank, gpio);
|
|
|
spin_unlock_irqrestore(&bank->lock, flags);
|
|
|
}
|
|
@@ -897,13 +911,6 @@ static int gpio_input(struct gpio_chip *chip, unsigned offset)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static int gpio_is_input(struct gpio_bank *bank, int mask)
|
|
|
-{
|
|
|
- void __iomem *reg = bank->base + bank->regs->direction;
|
|
|
-
|
|
|
- return __raw_readl(reg) & mask;
|
|
|
-}
|
|
|
-
|
|
|
static int gpio_get(struct gpio_chip *chip, unsigned offset)
|
|
|
{
|
|
|
struct gpio_bank *bank;
|
|
@@ -1400,7 +1407,7 @@ void omap2_gpio_prepare_for_idle(int pwr_mode)
|
|
|
struct gpio_bank *bank;
|
|
|
|
|
|
list_for_each_entry(bank, &omap_gpio_list, node) {
|
|
|
- if (!bank->mod_usage || !bank->loses_context)
|
|
|
+ if (!BANK_USED(bank) || !bank->loses_context)
|
|
|
continue;
|
|
|
|
|
|
bank->power_mode = pwr_mode;
|
|
@@ -1414,7 +1421,7 @@ void omap2_gpio_resume_after_idle(void)
|
|
|
struct gpio_bank *bank;
|
|
|
|
|
|
list_for_each_entry(bank, &omap_gpio_list, node) {
|
|
|
- if (!bank->mod_usage || !bank->loses_context)
|
|
|
+ if (!BANK_USED(bank) || !bank->loses_context)
|
|
|
continue;
|
|
|
|
|
|
pm_runtime_get_sync(bank->dev);
|