ARM: S5PV210: Add Power Management Support
This patch adds suspend-to-ram support for S5PV210. Note. This patch is confirmed on SMDKV210 and SMDKC110 board. Signed-off-by: Jongpill Lee <boyko.lee@samsung.com> Signed-off-by: Sangbeom Kim <sbkim73@samsung.com> Signed-off-by: Kukjin Kim <kgene.kim@samsung.com>
This commit is contained in:
Jongpill Lee
Kukjin Kim
parent
dc425471b6
commit
ea31fd4330
12 changed files with 546 additions and 4 deletions
|
|
@ -13,6 +13,7 @@ config CPU_S5PV210
|
|||
bool
|
||||
select S3C_PL330_DMA
|
||||
select S5P_EXT_INT
|
||||
select S5PV210_PM if PM
|
||||
help
|
||||
Enable S5PV210 CPU support
|
||||
|
||||
|
|
@ -152,4 +153,9 @@ config MACH_TORBRECK
|
|||
|
||||
endmenu
|
||||
|
||||
config S5PV210_PM
|
||||
bool
|
||||
help
|
||||
Power Management code common to S5PV210
|
||||
|
||||
endif
|
||||
|
|
|
|||
|
|
@ -14,6 +14,7 @@ obj- :=
|
|||
|
||||
obj-$(CONFIG_CPU_S5PV210) += cpu.o init.o clock.o dma.o gpiolib.o
|
||||
obj-$(CONFIG_CPU_S5PV210) += setup-i2c0.o
|
||||
obj-$(CONFIG_S5PV210_PM) += pm.o sleep.o
|
||||
|
||||
# machine support
|
||||
|
||||
|
|
|
|||
43
arch/arm/mach-s5pv210/include/mach/pm-core.h
Normal file
43
arch/arm/mach-s5pv210/include/mach/pm-core.h
Normal file
|
|
@ -0,0 +1,43 @@
|
|||
/* linux/arch/arm/mach-s5pv210/include/mach/pm-core.h
|
||||
*
|
||||
* Copyright (c) 2010 Samsung Electronics Co., Ltd.
|
||||
* http://www.samsung.com
|
||||
*
|
||||
* Based on arch/arm/mach-s3c2410/include/mach/pm-core.h,
|
||||
* Copyright 2008 Simtec Electronics
|
||||
* Ben Dooks <ben@simtec.co.uk>
|
||||
* http://armlinux.simtec.co.uk/
|
||||
*
|
||||
* S5PV210 - PM core support for arch/arm/plat-s5p/pm.c
|
||||
*
|
||||
* 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
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
static inline void s3c_pm_debug_init_uart(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
static inline void s3c_pm_arch_prepare_irqs(void)
|
||||
{
|
||||
__raw_writel(s3c_irqwake_intmask, S5P_WAKEUP_MASK);
|
||||
__raw_writel(s3c_irqwake_eintmask, S5P_EINT_WAKEUP_MASK);
|
||||
}
|
||||
|
||||
static inline void s3c_pm_arch_stop_clocks(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
static inline void s3c_pm_arch_show_resume_irqs(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
static inline void s3c_pm_arch_update_uart(void __iomem *regs,
|
||||
struct pm_uart_save *save)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
|
@ -95,7 +95,7 @@
|
|||
/* Registers related to power management */
|
||||
#define S5P_PWR_CFG S5P_CLKREG(0xC000)
|
||||
#define S5P_EINT_WAKEUP_MASK S5P_CLKREG(0xC004)
|
||||
#define S5P_WAKEUP_MASK S5P_CLKREG(0xC008)
|
||||
#define S5P_WAKEUP_MASK S5P_CLKREG(0xC008)
|
||||
#define S5P_PWR_MODE S5P_CLKREG(0xC00C)
|
||||
#define S5P_NORMAL_CFG S5P_CLKREG(0xC010)
|
||||
#define S5P_IDLE_CFG S5P_CLKREG(0xC020)
|
||||
|
|
@ -159,8 +159,11 @@
|
|||
#define S5P_SLEEP_CFG_USBOSC_EN (1 << 1)
|
||||
|
||||
/* OTHERS Resgister */
|
||||
#define S5P_OTHERS_RET_IO (1 << 31)
|
||||
#define S5P_OTHERS_RET_CF (1 << 30)
|
||||
#define S5P_OTHERS_RET_MMC (1 << 29)
|
||||
#define S5P_OTHERS_RET_UART (1 << 28)
|
||||
#define S5P_OTHERS_USB_SIG_MASK (1 << 16)
|
||||
#define S5P_OTHERS_MIPI_DPHY_EN (1 << 28)
|
||||
|
||||
/* MIPI */
|
||||
#define S5P_MIPI_DPHY_EN (3)
|
||||
|
|
|
|||
|
|
@ -28,6 +28,7 @@
|
|||
#include <plat/cpu.h>
|
||||
#include <plat/ata.h>
|
||||
#include <plat/iic.h>
|
||||
#include <plat/pm.h>
|
||||
|
||||
/* Following are default values for UCON, ULCON and UFCON UART registers */
|
||||
#define SMDKC110_UCON_DEFAULT (S3C2410_UCON_TXILEVEL | \
|
||||
|
|
@ -110,6 +111,8 @@ static void __init smdkc110_map_io(void)
|
|||
|
||||
static void __init smdkc110_machine_init(void)
|
||||
{
|
||||
s3c_pm_init();
|
||||
|
||||
s3c_i2c0_set_platdata(NULL);
|
||||
s3c_i2c1_set_platdata(NULL);
|
||||
s3c_i2c2_set_platdata(NULL);
|
||||
|
|
|
|||
|
|
@ -31,6 +31,7 @@
|
|||
#include <plat/ata.h>
|
||||
#include <plat/iic.h>
|
||||
#include <plat/keypad.h>
|
||||
#include <plat/pm.h>
|
||||
|
||||
/* Following are default values for UCON, ULCON and UFCON UART registers */
|
||||
#define SMDKV210_UCON_DEFAULT (S3C2410_UCON_TXILEVEL | \
|
||||
|
|
@ -145,6 +146,8 @@ static void __init smdkv210_map_io(void)
|
|||
|
||||
static void __init smdkv210_machine_init(void)
|
||||
{
|
||||
s3c_pm_init();
|
||||
|
||||
samsung_keypad_set_platdata(&smdkv210_keypad_data);
|
||||
s3c24xx_ts_set_platdata(&s3c_ts_platform);
|
||||
|
||||
|
|
|
|||
166
arch/arm/mach-s5pv210/pm.c
Normal file
166
arch/arm/mach-s5pv210/pm.c
Normal file
|
|
@ -0,0 +1,166 @@
|
|||
/* linux/arch/arm/mach-s5pv210/pm.c
|
||||
*
|
||||
* Copyright (c) 2010 Samsung Electronics Co., Ltd.
|
||||
* http://www.samsung.com
|
||||
*
|
||||
* S5PV210 - Power Management support
|
||||
*
|
||||
* Based on arch/arm/mach-s3c2410/pm.c
|
||||
* Copyright (c) 2006 Simtec Electronics
|
||||
* Ben Dooks <ben@simtec.co.uk>
|
||||
*
|
||||
* 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
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/suspend.h>
|
||||
#include <linux/io.h>
|
||||
|
||||
#include <plat/cpu.h>
|
||||
#include <plat/pm.h>
|
||||
#include <plat/regs-timer.h>
|
||||
|
||||
#include <mach/regs-irq.h>
|
||||
#include <mach/regs-clock.h>
|
||||
|
||||
static struct sleep_save s5pv210_core_save[] = {
|
||||
/* Clock source */
|
||||
SAVE_ITEM(S5P_CLK_SRC0),
|
||||
SAVE_ITEM(S5P_CLK_SRC1),
|
||||
SAVE_ITEM(S5P_CLK_SRC2),
|
||||
SAVE_ITEM(S5P_CLK_SRC3),
|
||||
SAVE_ITEM(S5P_CLK_SRC4),
|
||||
SAVE_ITEM(S5P_CLK_SRC5),
|
||||
SAVE_ITEM(S5P_CLK_SRC6),
|
||||
|
||||
/* Clock source Mask */
|
||||
SAVE_ITEM(S5P_CLK_SRC_MASK0),
|
||||
SAVE_ITEM(S5P_CLK_SRC_MASK1),
|
||||
|
||||
/* Clock Divider */
|
||||
SAVE_ITEM(S5P_CLK_DIV0),
|
||||
SAVE_ITEM(S5P_CLK_DIV1),
|
||||
SAVE_ITEM(S5P_CLK_DIV2),
|
||||
SAVE_ITEM(S5P_CLK_DIV3),
|
||||
SAVE_ITEM(S5P_CLK_DIV4),
|
||||
SAVE_ITEM(S5P_CLK_DIV5),
|
||||
SAVE_ITEM(S5P_CLK_DIV6),
|
||||
SAVE_ITEM(S5P_CLK_DIV7),
|
||||
|
||||
/* Clock Main Gate */
|
||||
SAVE_ITEM(S5P_CLKGATE_MAIN0),
|
||||
SAVE_ITEM(S5P_CLKGATE_MAIN1),
|
||||
SAVE_ITEM(S5P_CLKGATE_MAIN2),
|
||||
|
||||
/* Clock source Peri Gate */
|
||||
SAVE_ITEM(S5P_CLKGATE_PERI0),
|
||||
SAVE_ITEM(S5P_CLKGATE_PERI1),
|
||||
|
||||
/* Clock source SCLK Gate */
|
||||
SAVE_ITEM(S5P_CLKGATE_SCLK0),
|
||||
SAVE_ITEM(S5P_CLKGATE_SCLK1),
|
||||
|
||||
/* Clock IP Clock gate */
|
||||
SAVE_ITEM(S5P_CLKGATE_IP0),
|
||||
SAVE_ITEM(S5P_CLKGATE_IP1),
|
||||
SAVE_ITEM(S5P_CLKGATE_IP2),
|
||||
SAVE_ITEM(S5P_CLKGATE_IP3),
|
||||
SAVE_ITEM(S5P_CLKGATE_IP4),
|
||||
|
||||
/* Clock Blcok and Bus gate */
|
||||
SAVE_ITEM(S5P_CLKGATE_BLOCK),
|
||||
SAVE_ITEM(S5P_CLKGATE_BUS0),
|
||||
|
||||
/* Clock ETC */
|
||||
SAVE_ITEM(S5P_CLK_OUT),
|
||||
SAVE_ITEM(S5P_MDNIE_SEL),
|
||||
|
||||
/* PWM Register */
|
||||
SAVE_ITEM(S3C2410_TCFG0),
|
||||
SAVE_ITEM(S3C2410_TCFG1),
|
||||
SAVE_ITEM(S3C64XX_TINT_CSTAT),
|
||||
SAVE_ITEM(S3C2410_TCON),
|
||||
SAVE_ITEM(S3C2410_TCNTB(0)),
|
||||
SAVE_ITEM(S3C2410_TCMPB(0)),
|
||||
SAVE_ITEM(S3C2410_TCNTO(0)),
|
||||
};
|
||||
|
||||
void s5pv210_cpu_suspend(void)
|
||||
{
|
||||
unsigned long tmp;
|
||||
|
||||
/* issue the standby signal into the pm unit. Note, we
|
||||
* issue a write-buffer drain just in case */
|
||||
|
||||
tmp = 0;
|
||||
|
||||
asm("b 1f\n\t"
|
||||
".align 5\n\t"
|
||||
"1:\n\t"
|
||||
"mcr p15, 0, %0, c7, c10, 5\n\t"
|
||||
"mcr p15, 0, %0, c7, c10, 4\n\t"
|
||||
"wfi" : : "r" (tmp));
|
||||
|
||||
/* we should never get past here */
|
||||
panic("sleep resumed to originator?");
|
||||
}
|
||||
|
||||
static void s5pv210_pm_prepare(void)
|
||||
{
|
||||
unsigned int tmp;
|
||||
|
||||
/* ensure at least INFORM0 has the resume address */
|
||||
__raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0);
|
||||
|
||||
tmp = __raw_readl(S5P_SLEEP_CFG);
|
||||
tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN);
|
||||
__raw_writel(tmp, S5P_SLEEP_CFG);
|
||||
|
||||
/* WFI for SLEEP mode configuration by SYSCON */
|
||||
tmp = __raw_readl(S5P_PWR_CFG);
|
||||
tmp &= S5P_CFG_WFI_CLEAN;
|
||||
tmp |= S5P_CFG_WFI_SLEEP;
|
||||
__raw_writel(tmp, S5P_PWR_CFG);
|
||||
|
||||
/* SYSCON interrupt handling disable */
|
||||
tmp = __raw_readl(S5P_OTHERS);
|
||||
tmp |= S5P_OTHER_SYSC_INTOFF;
|
||||
__raw_writel(tmp, S5P_OTHERS);
|
||||
|
||||
s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
|
||||
}
|
||||
|
||||
static int s5pv210_pm_add(struct sys_device *sysdev)
|
||||
{
|
||||
pm_cpu_prep = s5pv210_pm_prepare;
|
||||
pm_cpu_sleep = s5pv210_cpu_suspend;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int s5pv210_pm_resume(struct sys_device *dev)
|
||||
{
|
||||
u32 tmp;
|
||||
|
||||
tmp = __raw_readl(S5P_OTHERS);
|
||||
tmp |= (S5P_OTHERS_RET_IO | S5P_OTHERS_RET_CF |\
|
||||
S5P_OTHERS_RET_MMC | S5P_OTHERS_RET_UART);
|
||||
__raw_writel(tmp , S5P_OTHERS);
|
||||
|
||||
s3c_pm_do_restore_core(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct sysdev_driver s5pv210_pm_driver = {
|
||||
.add = s5pv210_pm_add,
|
||||
.resume = s5pv210_pm_resume,
|
||||
};
|
||||
|
||||
static __init int s5pv210_pm_drvinit(void)
|
||||
{
|
||||
return sysdev_driver_register(&s5pv210_sysclass, &s5pv210_pm_driver);
|
||||
}
|
||||
arch_initcall(s5pv210_pm_drvinit);
|
||||
170
arch/arm/mach-s5pv210/sleep.S
Normal file
170
arch/arm/mach-s5pv210/sleep.S
Normal file
|
|
@ -0,0 +1,170 @@
|
|||
/* linux/arch/arm/plat-s5p/sleep.S
|
||||
*
|
||||
* Copyright (c) 2010 Samsung Electronics Co., Ltd.
|
||||
* http://www.samsung.com
|
||||
*
|
||||
* S5PV210 power Manager (Suspend-To-RAM) support
|
||||
* Based on S3C2410 sleep code by:
|
||||
* Ben Dooks, (c) 2004 Simtec Electronics
|
||||
*
|
||||
* Based on PXA/SA1100 sleep code by:
|
||||
* Nicolas Pitre, (c) 2002 Monta Vista Software Inc
|
||||
* Cliff Brake, (c) 2001
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*/
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include <asm/assembler.h>
|
||||
#include <asm/memory.h>
|
||||
|
||||
.text
|
||||
|
||||
/* s3c_cpu_save
|
||||
*
|
||||
* entry:
|
||||
* r0 = save address (virtual addr of s3c_sleep_save_phys)
|
||||
*/
|
||||
|
||||
ENTRY(s3c_cpu_save)
|
||||
|
||||
stmfd sp!, { r3 - r12, lr }
|
||||
|
||||
mrc p15, 0, r4, c13, c0, 0 @ FCSE/PID
|
||||
mrc p15, 0, r5, c3, c0, 0 @ Domain ID
|
||||
mrc p15, 0, r6, c2, c0, 0 @ Translation Table BASE0
|
||||
mrc p15, 0, r7, c2, c0, 1 @ Translation Table BASE1
|
||||
mrc p15, 0, r8, c2, c0, 2 @ Translation Table Control
|
||||
mrc p15, 0, r9, c1, c0, 0 @ Control register
|
||||
mrc p15, 0, r10, c1, c0, 1 @ Auxiliary control register
|
||||
mrc p15, 0, r11, c1, c0, 2 @ Co-processor access controls
|
||||
mrc p15, 0, r12, c10, c2, 0 @ Read PRRR
|
||||
mrc p15, 0, r3, c10, c2, 1 @ READ NMRR
|
||||
|
||||
stmia r0, { r3 - r13 }
|
||||
|
||||
bl s3c_pm_cb_flushcache
|
||||
|
||||
ldr r0, =pm_cpu_sleep
|
||||
ldr r0, [ r0 ]
|
||||
mov pc, r0
|
||||
|
||||
resume_with_mmu:
|
||||
/*
|
||||
* After MMU is turned on, restore the previous MMU table.
|
||||
*/
|
||||
ldr r9 , =(PAGE_OFFSET - PHYS_OFFSET)
|
||||
add r4, r4, r9
|
||||
str r12, [r4]
|
||||
|
||||
ldmfd sp!, { r3 - r12, pc }
|
||||
|
||||
.ltorg
|
||||
|
||||
.data
|
||||
|
||||
.global s3c_sleep_save_phys
|
||||
s3c_sleep_save_phys:
|
||||
.word 0
|
||||
|
||||
/* sleep magic, to allow the bootloader to check for an valid
|
||||
* image to resume to. Must be the first word before the
|
||||
* s3c_cpu_resume entry.
|
||||
*/
|
||||
|
||||
.word 0x2bedf00d
|
||||
|
||||
/* s3c_cpu_resume
|
||||
*
|
||||
* resume code entry for bootloader to call
|
||||
*
|
||||
* we must put this code here in the data segment as we have no
|
||||
* other way of restoring the stack pointer after sleep, and we
|
||||
* must not write to the code segment (code is read-only)
|
||||
*/
|
||||
|
||||
ENTRY(s3c_cpu_resume)
|
||||
mov r0, #PSR_I_BIT | PSR_F_BIT | SVC_MODE
|
||||
msr cpsr_c, r0
|
||||
|
||||
mov r1, #0
|
||||
mcr p15, 0, r1, c8, c7, 0 @ invalidate TLBs
|
||||
mcr p15, 0, r1, c7, c5, 0 @ invalidate I Cache
|
||||
|
||||
ldr r0, s3c_sleep_save_phys @ address of restore block
|
||||
ldmia r0, { r3 - r13 }
|
||||
|
||||
mcr p15, 0, r4, c13, c0, 0 @ FCSE/PID
|
||||
mcr p15, 0, r5, c3, c0, 0 @ Domain ID
|
||||
|
||||
mcr p15, 0, r8, c2, c0, 2 @ Translation Table Control
|
||||
mcr p15, 0, r7, c2, c0, 1 @ Translation Table BASE1
|
||||
mcr p15, 0, r6, c2, c0, 0 @ Translation Table BASE0
|
||||
|
||||
mcr p15, 0, r10, c1, c0, 1 @ Auxiliary control register
|
||||
|
||||
mov r0, #0
|
||||
mcr p15, 0, r0, c8, c7, 0 @ Invalidate I & D TLB
|
||||
|
||||
mov r0, #0 @ restore copro access
|
||||
mcr p15, 0, r11, c1, c0, 2 @ Co-processor access
|
||||
mcr p15, 0, r0, c7, c5, 4
|
||||
|
||||
mcr p15, 0, r12, c10, c2, 0 @ write PRRR
|
||||
mcr p15, 0, r3, c10, c2, 1 @ write NMRR
|
||||
|
||||
/*
|
||||
* In Cortex-A8, when MMU is turned on, the pipeline is flushed.
|
||||
* And there are no valid entries in the MMU table at this point.
|
||||
* So before turning on the MMU, the MMU entry for the DRAM address
|
||||
* range is added. After the MMU is turned on, the other entries
|
||||
* in the MMU table will be restored.
|
||||
*/
|
||||
|
||||
/* r6 = Translation Table BASE0 */
|
||||
mov r4, r6
|
||||
mov r4, r4, LSR #14
|
||||
mov r4, r4, LSL #14
|
||||
|
||||
/* Load address for adding to MMU table list */
|
||||
ldr r11, =0xE010F000 @ INFORM0 reg.
|
||||
ldr r10, [r11, #0]
|
||||
mov r10, r10, LSR #18
|
||||
bic r10, r10, #0x3
|
||||
orr r4, r4, r10
|
||||
|
||||
/* Calculate MMU table entry */
|
||||
mov r10, r10, LSL #18
|
||||
ldr r5, =0x40E
|
||||
orr r10, r10, r5
|
||||
|
||||
/* Back up originally data */
|
||||
ldr r12, [r4]
|
||||
|
||||
/* Add calculated MMU table entry into MMU table list */
|
||||
str r10, [r4]
|
||||
|
||||
ldr r2, =resume_with_mmu
|
||||
mcr p15, 0, r9, c1, c0, 0 @ turn on MMU, etc
|
||||
|
||||
nop
|
||||
nop
|
||||
nop
|
||||
nop
|
||||
nop @ second-to-last before mmu
|
||||
|
||||
mov pc, r2 @ go back to virtual address
|
||||
|
||||
.ltorg
|
||||
|
|
@ -19,6 +19,8 @@ obj-y += clock.o
|
|||
obj-y += irq.o
|
||||
obj-$(CONFIG_S5P_EXT_INT) += irq-eint.o
|
||||
obj-$(CONFIG_S5P_GPIO_INT) += irq-gpioint.o
|
||||
obj-$(CONFIG_PM) += pm.o
|
||||
obj-$(CONFIG_PM) += irq-pm.o
|
||||
|
||||
# devices
|
||||
|
||||
|
|
|
|||
93
arch/arm/plat-s5p/irq-pm.c
Normal file
93
arch/arm/plat-s5p/irq-pm.c
Normal file
|
|
@ -0,0 +1,93 @@
|
|||
/* linux/arch/arm/plat-s5p/irq-pm.c
|
||||
*
|
||||
* Copyright (c) 2010 Samsung Electronics Co., Ltd.
|
||||
* http://www.samsung.com
|
||||
*
|
||||
* Based on arch/arm/plat-s3c24xx/irq-pm.c,
|
||||
* Copyright (c) 2003,2004 Simtec Electronics
|
||||
* Ben Dooks <ben@simtec.co.uk>
|
||||
* http://armlinux.simtec.co.uk/
|
||||
*
|
||||
* 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
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/sysdev.h>
|
||||
|
||||
#include <plat/cpu.h>
|
||||
#include <plat/irqs.h>
|
||||
#include <plat/pm.h>
|
||||
#include <mach/map.h>
|
||||
|
||||
#include <mach/regs-gpio.h>
|
||||
#include <mach/regs-irq.h>
|
||||
|
||||
/* state for IRQs over sleep */
|
||||
|
||||
/* default is to allow for EINT0..EINT31, and IRQ_RTC_TIC, IRQ_RTC_ALARM,
|
||||
* as wakeup sources
|
||||
*
|
||||
* set bit to 1 in allow bitfield to enable the wakeup settings on it
|
||||
*/
|
||||
|
||||
unsigned long s3c_irqwake_intallow = 0x00000006L;
|
||||
unsigned long s3c_irqwake_eintallow = 0xffffffffL;
|
||||
|
||||
int s3c_irq_wake(unsigned int irqno, unsigned int state)
|
||||
{
|
||||
unsigned long irqbit;
|
||||
|
||||
switch (irqno) {
|
||||
case IRQ_RTC_TIC:
|
||||
case IRQ_RTC_ALARM:
|
||||
irqbit = 1 << (irqno + 1 - IRQ_RTC_ALARM);
|
||||
if (!state)
|
||||
s3c_irqwake_intmask |= irqbit;
|
||||
else
|
||||
s3c_irqwake_intmask &= ~irqbit;
|
||||
break;
|
||||
default:
|
||||
return -ENOENT;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct sleep_save eint_save[] = {
|
||||
SAVE_ITEM(S5P_EINT_CON(0)),
|
||||
SAVE_ITEM(S5P_EINT_CON(1)),
|
||||
SAVE_ITEM(S5P_EINT_CON(2)),
|
||||
SAVE_ITEM(S5P_EINT_CON(3)),
|
||||
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(0)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(1)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(2)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(3)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(4)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(5)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(6)),
|
||||
SAVE_ITEM(S5P_EINT_FLTCON(7)),
|
||||
|
||||
SAVE_ITEM(S5P_EINT_MASK(0)),
|
||||
SAVE_ITEM(S5P_EINT_MASK(1)),
|
||||
SAVE_ITEM(S5P_EINT_MASK(2)),
|
||||
SAVE_ITEM(S5P_EINT_MASK(3)),
|
||||
};
|
||||
|
||||
int s3c24xx_irq_suspend(struct sys_device *dev, pm_message_t state)
|
||||
{
|
||||
s3c_pm_do_save(eint_save, ARRAY_SIZE(eint_save));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int s3c24xx_irq_resume(struct sys_device *dev)
|
||||
{
|
||||
s3c_pm_do_restore(eint_save, ARRAY_SIZE(eint_save));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
52
arch/arm/plat-s5p/pm.c
Normal file
52
arch/arm/plat-s5p/pm.c
Normal file
|
|
@ -0,0 +1,52 @@
|
|||
/* linux/arch/arm/plat-s5p/pm.c
|
||||
*
|
||||
* Copyright (c) 2010 Samsung Electronics Co., Ltd.
|
||||
* http://www.samsung.com
|
||||
*
|
||||
* S5P Power Manager (Suspend-To-RAM) support
|
||||
*
|
||||
* Based on arch/arm/plat-s3c24xx/pm.c
|
||||
* Copyright (c) 2004,2006 Simtec Electronics
|
||||
* Ben Dooks <ben@simtec.co.uk>
|
||||
*
|
||||
* 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
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
#include <linux/suspend.h>
|
||||
#include <plat/pm.h>
|
||||
|
||||
#define PFX "s5p pm: "
|
||||
|
||||
/* s3c_pm_check_resume_pin
|
||||
*
|
||||
* check to see if the pin is configured correctly for sleep mode, and
|
||||
* make any necessary adjustments if it is not
|
||||
*/
|
||||
|
||||
static void s3c_pm_check_resume_pin(unsigned int pin, unsigned int irqoffs)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
/* s3c_pm_configure_extint
|
||||
*
|
||||
* configure all external interrupt pins
|
||||
*/
|
||||
|
||||
void s3c_pm_configure_extint(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
void s3c_pm_restore_core(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
void s3c_pm_save_core(void)
|
||||
{
|
||||
/* nothing here yet */
|
||||
}
|
||||
|
||||
|
|
@ -192,7 +192,7 @@ struct s3c_gpio_pm s3c_gpio_pm_2bit = {
|
|||
.resume = s3c_gpio_pm_2bit_resume,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_ARCH_S3C64XX
|
||||
#if defined(CONFIG_ARCH_S3C64XX) || defined(CONFIG_PLAT_S5P)
|
||||
static void s3c_gpio_pm_4bit_save(struct s3c_gpio_chip *chip)
|
||||
{
|
||||
chip->pm_save[1] = __raw_readl(chip->base + OFFS_CON);
|
||||
|
|
@ -302,7 +302,7 @@ struct s3c_gpio_pm s3c_gpio_pm_4bit = {
|
|||
.save = s3c_gpio_pm_4bit_save,
|
||||
.resume = s3c_gpio_pm_4bit_resume,
|
||||
};
|
||||
#endif /* CONFIG_ARCH_S3C64XX */
|
||||
#endif /* CONFIG_ARCH_S3C64XX || CONFIG_PLAT_S5P */
|
||||
|
||||
/**
|
||||
* s3c_pm_save_gpio() - save gpio chip data for suspend
|
||||
|
|
|
|||
Loading…
Reference in a new issue