OMAP3: PM: Wakeup from T2 keypad with OFF mode
Subsystems (3)
PATCH 3/4 OMAP3: PM: Wakeup from T2 keypad with OFF mode
This patch allows wakeup from T2 keypad when
OFF mode is hit during suspend.
Tested on OMAP3EVM.
Signed-off-by Sanjeev Premi <[email protected]>
--- arch/arm/mach-omap2/board-omap3evm.c | 89 ++++++++++++++++++++++++++++++++++ 1 files changed, 89 insertions(+), 0 deletions(-)
arch/arm/mach-omap2/board-omap3evm.c +89 -0
@@ -39,6 +39,7 @@#include <plat/mux.h> #include <plat/usb.h> #include <plat/common.h> +#include <plat/control.h> #include <plat/mcspi.h> #include <plat/clock.h> #include <plat/omap-pm.h>
@@ -46,6 +47,7 @@#include "sdram-micron-mt46h32m32lf-6.h" #include "mmc-twl4030.h" #include "pm.h" +#include "prm-regbits-34xx.h" #include "omap3-opp.h" #define OMAP3_EVM_TS_GPIO 175
@@ -169,6 +171,84 @@ static struct platform_device leds_gpio = { }, }; +#ifdef CONFIG_PM +/* +* Save the state of keypad +* +* TODO: This definition should ideally be in a header file, but +* matrix_keypad.h is not the right one. Also, plat/keypad.h +* is no longer used. +*/ +struct omap_keypad_pm_state { +void __iomem *wk_st; +void __iomem *wk_en; +u32 wk_mask; +u32 padconf; +}; + +/* +* Board specific hook for keypad suspend +*/ +void omap3_evm_kp_suspend (void *ptr) +{ +struct omap_keypad_pm_state *pstate = + (struct omap_keypad_pm_state *)ptr; + +if (pstate) { +/* +* Set wake-enable bit +*/ +if (pstate->wk_en && pstate->wk_mask) { +u32 v =__raw_readl (pstate->wk_en); + v |= pstate->wk_mask; +__raw_writel (v, pstate->wk_en); + } +/* +* Set corresponding IOPAD wakeup-enable +*/ +if (cpu_is_omap34xx () && pstate->padconf) { +u16 v =omap_ctrl_readw (pstate->padconf); + v |=OMAP3_PADCONF_WAKEUPENABLE0 ; +omap_ctrl_writew (v, pstate->padconf); + } + } +} + +/* +* Board specific hook for keypad resume +*/ +void omap3_evm_kp_resume (void *ptr) +{ +struct omap_keypad_pm_state *pstate = + (struct omap_keypad_pm_state *)ptr; + +if (pstate) { +/* +* Clear wake-enable bit +*/ +if (pstate->wk_en && pstate->wk_mask) { +u32 v =__raw_readl (pstate->wk_en); + v &= ~pstate->wk_mask; +__raw_writel (v, pstate->wk_en); + } +/* +* Clear corresponding IOPAD wakeup-enable +*/ +if (cpu_is_omap34xx () && pstate->padconf) { +u16 v =omap_ctrl_readw (pstate->padconf); + v &= ~OMAP3_PADCONF_WAKEUPENABLE0 ; +omap_ctrl_writew (v, pstate->padconf); + } + } +} + +static struct omap_keypad_pm_state omap3evm_kp_pm_state = { + .wk_st =OMAP34XX_PRM_REGADDR (WKUP_MOD ,PM_WKEN1 ), + .wk_en =OMAP34XX_PRM_REGADDR (WKUP_MOD ,PM_WKST1 ), + .wk_mask =OMAP3430_EN_GPIO1 , + .padconf =0x1e0 , +}; +#endif /* CONFIG_PM */ static int omap3evm_twl_gpio_setup (struct device *dev,unsigned gpio,unsigned ngpio)
@@ -236,6 +316,15 @@ static struct twl4030_keypad_data omap3evm_kp_data = { .rows = 4, .cols = 4, .rep =1 , +#ifdef CONFIG_PM + .pm_state = (void *)&omap3evm_kp_pm_state, + .on_suspend = omap3_evm_kp_suspend, + .on_resume = omap3_evm_kp_resume, +#else + .pm_state =NULL , + .on_suspend = NULL, + .on_resume = NULL, +#endif /* CONFIG_PM */ }; static struct twl4030_madc_platform_data omap3evm_madc_data = {
Signature · 1 line
1.6.2.2