Commit 33d78647 authored by Linus Walleij's avatar Linus Walleij Committed by Grant Likely

gpio/nomadik: fix sleepmode for elder Nomadik

The mach-nomadik machine did not compile properly due to bad
ux500-specific functions being called. Introduce new state
variables to fix this up.
Reported-by: default avatarAxel Lin <axel.lin@gmail.com>
Cc: Alessandro Rubini <rubini@unipv.it>
Cc: Prafulla Wadaskar <prafulla.wadaskar@st.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarGrant Likely <grant.likely@secretlab.ca>
parent c226feb0
...@@ -159,6 +159,9 @@ static void __init db8500_add_gpios(void) ...@@ -159,6 +159,9 @@ static void __init db8500_add_gpios(void)
/* No custom data yet */ /* No custom data yet */
}; };
if (cpu_is_u8500v2())
pdata.supports_sleepmode = true;
dbx500_add_gpios(ARRAY_AND_SIZE(db8500_gpio_base), dbx500_add_gpios(ARRAY_AND_SIZE(db8500_gpio_base),
IRQ_DB8500_GPIO0, &pdata); IRQ_DB8500_GPIO0, &pdata);
} }
......
...@@ -90,6 +90,7 @@ struct nmk_gpio_platform_data { ...@@ -90,6 +90,7 @@ struct nmk_gpio_platform_data {
int num_gpio; int num_gpio;
u32 (*get_secondary_status)(unsigned int bank); u32 (*get_secondary_status)(unsigned int bank);
void (*set_ioforce)(bool enable); void (*set_ioforce)(bool enable);
bool supports_sleepmode;
}; };
#endif /* __ASM_PLAT_GPIO_H */ #endif /* __ASM_PLAT_GPIO_H */
...@@ -4,6 +4,7 @@ ...@@ -4,6 +4,7 @@
* Copyright (C) 2008,2009 STMicroelectronics * Copyright (C) 2008,2009 STMicroelectronics
* Copyright (C) 2009 Alessandro Rubini <rubini@unipv.it> * Copyright (C) 2009 Alessandro Rubini <rubini@unipv.it>
* Rewritten based on work by Prafulla WADASKAR <prafulla.wadaskar@st.com> * Rewritten based on work by Prafulla WADASKAR <prafulla.wadaskar@st.com>
* Copyright (C) 2011 Linus Walleij <linus.walleij@linaro.org>
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as * it under the terms of the GNU General Public License version 2 as
...@@ -49,6 +50,7 @@ struct nmk_gpio_chip { ...@@ -49,6 +50,7 @@ struct nmk_gpio_chip {
u32 (*get_secondary_status)(unsigned int bank); u32 (*get_secondary_status)(unsigned int bank);
void (*set_ioforce)(bool enable); void (*set_ioforce)(bool enable);
spinlock_t lock; spinlock_t lock;
bool sleepmode;
/* Keep track of configured edges */ /* Keep track of configured edges */
u32 edge_rising; u32 edge_rising;
u32 edge_falling; u32 edge_falling;
...@@ -393,14 +395,25 @@ EXPORT_SYMBOL(nmk_config_pins_sleep); ...@@ -393,14 +395,25 @@ EXPORT_SYMBOL(nmk_config_pins_sleep);
* @gpio: pin number * @gpio: pin number
* @mode: NMK_GPIO_SLPM_INPUT or NMK_GPIO_SLPM_NOCHANGE, * @mode: NMK_GPIO_SLPM_INPUT or NMK_GPIO_SLPM_NOCHANGE,
* *
* Sets the sleep mode of a pin. If @mode is NMK_GPIO_SLPM_INPUT, the pin is * This register is actually in the pinmux layer, not the GPIO block itself.
* changed to an input (with pullup/down enabled) in sleep and deep sleep. If * The GPIO1B_SLPM register defines the GPIO mode when SLEEP/DEEP-SLEEP
* @mode is NMK_GPIO_SLPM_NOCHANGE, the pin remains in the state it was * mode is entered (i.e. when signal IOFORCE is HIGH by the platform code).
* configured even when in sleep and deep sleep. * Each GPIO can be configured to be forced into GPIO mode when IOFORCE is
* HIGH, overriding the normal setting defined by GPIO_AFSELx registers.
* When IOFORCE returns LOW (by software, after SLEEP/DEEP-SLEEP exit),
* the GPIOs return to the normal setting defined by GPIO_AFSELx registers.
* *
* On DB8500v2 onwards, this setting loses the previous meaning and instead * If @mode is NMK_GPIO_SLPM_INPUT, the corresponding GPIO is switched to GPIO
* indicates if wakeup detection is enabled on the pin. Note that * mode when signal IOFORCE is HIGH (i.e. when SLEEP/DEEP-SLEEP mode is
* enable_irq_wake() will automatically enable wakeup detection. * entered) regardless of the altfunction selected. Also wake-up detection is
* ENABLED.
*
* If @mode is NMK_GPIO_SLPM_NOCHANGE, the corresponding GPIO remains
* controlled by NMK_GPIO_DATC, NMK_GPIO_DATS, NMK_GPIO_DIR, NMK_GPIO_PDIS
* (for altfunction GPIO) or respective on-chip peripherals (for other
* altfuncs) when IOFORCE is HIGH. Also wake-up detection DISABLED.
*
* Note that enable_irq_wake() will automatically enable wakeup detection.
*/ */
int nmk_gpio_set_slpm(int gpio, enum nmk_gpio_slpm mode) int nmk_gpio_set_slpm(int gpio, enum nmk_gpio_slpm mode)
{ {
...@@ -551,6 +564,12 @@ static void __nmk_gpio_irq_modify(struct nmk_gpio_chip *nmk_chip, ...@@ -551,6 +564,12 @@ static void __nmk_gpio_irq_modify(struct nmk_gpio_chip *nmk_chip,
static void __nmk_gpio_set_wake(struct nmk_gpio_chip *nmk_chip, static void __nmk_gpio_set_wake(struct nmk_gpio_chip *nmk_chip,
int gpio, bool on) int gpio, bool on)
{ {
if (nmk_chip->sleepmode) {
__nmk_gpio_set_slpm(nmk_chip, gpio - nmk_chip->chip.base,
on ? NMK_GPIO_SLPM_WAKEUP_ENABLE
: NMK_GPIO_SLPM_WAKEUP_DISABLE);
}
__nmk_gpio_irq_modify(nmk_chip, gpio, WAKE, on); __nmk_gpio_irq_modify(nmk_chip, gpio, WAKE, on);
} }
...@@ -901,7 +920,7 @@ void nmk_gpio_wakeups_suspend(void) ...@@ -901,7 +920,7 @@ void nmk_gpio_wakeups_suspend(void)
writel(chip->fwimsc & chip->real_wake, writel(chip->fwimsc & chip->real_wake,
chip->addr + NMK_GPIO_FWIMSC); chip->addr + NMK_GPIO_FWIMSC);
if (cpu_is_u8500v2()) { if (chip->sleepmode) {
chip->slpm = readl(chip->addr + NMK_GPIO_SLPC); chip->slpm = readl(chip->addr + NMK_GPIO_SLPC);
/* 0 -> wakeup enable */ /* 0 -> wakeup enable */
...@@ -923,7 +942,7 @@ void nmk_gpio_wakeups_resume(void) ...@@ -923,7 +942,7 @@ void nmk_gpio_wakeups_resume(void)
writel(chip->rwimsc, chip->addr + NMK_GPIO_RWIMSC); writel(chip->rwimsc, chip->addr + NMK_GPIO_RWIMSC);
writel(chip->fwimsc, chip->addr + NMK_GPIO_FWIMSC); writel(chip->fwimsc, chip->addr + NMK_GPIO_FWIMSC);
if (cpu_is_u8500v2()) if (chip->sleepmode)
writel(chip->slpm, chip->addr + NMK_GPIO_SLPC); writel(chip->slpm, chip->addr + NMK_GPIO_SLPC);
} }
} }
...@@ -1010,6 +1029,7 @@ static int __devinit nmk_gpio_probe(struct platform_device *dev) ...@@ -1010,6 +1029,7 @@ static int __devinit nmk_gpio_probe(struct platform_device *dev)
nmk_chip->secondary_parent_irq = secondary_irq; nmk_chip->secondary_parent_irq = secondary_irq;
nmk_chip->get_secondary_status = pdata->get_secondary_status; nmk_chip->get_secondary_status = pdata->get_secondary_status;
nmk_chip->set_ioforce = pdata->set_ioforce; nmk_chip->set_ioforce = pdata->set_ioforce;
nmk_chip->sleepmode = pdata->supports_sleepmode;
spin_lock_init(&nmk_chip->lock); spin_lock_init(&nmk_chip->lock);
chip = &nmk_chip->chip; chip = &nmk_chip->chip;
...@@ -1065,5 +1085,3 @@ core_initcall(nmk_gpio_init); ...@@ -1065,5 +1085,3 @@ core_initcall(nmk_gpio_init);
MODULE_AUTHOR("Prafulla WADASKAR and Alessandro Rubini"); MODULE_AUTHOR("Prafulla WADASKAR and Alessandro Rubini");
MODULE_DESCRIPTION("Nomadik GPIO Driver"); MODULE_DESCRIPTION("Nomadik GPIO Driver");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment