xref: /openbmc/linux/arch/arm/mach-s5pv210/pm.c (revision 4800cd83)
1 /* linux/arch/arm/mach-s5pv210/pm.c
2  *
3  * Copyright (c) 2010 Samsung Electronics Co., Ltd.
4  *		http://www.samsung.com
5  *
6  * S5PV210 - Power Management support
7  *
8  * Based on arch/arm/mach-s3c2410/pm.c
9  * Copyright (c) 2006 Simtec Electronics
10  *	Ben Dooks <ben@simtec.co.uk>
11  *
12  * This program is free software; you can redistribute it and/or modify
13  * it under the terms of the GNU General Public License version 2 as
14  * published by the Free Software Foundation.
15 */
16 
17 #include <linux/init.h>
18 #include <linux/suspend.h>
19 #include <linux/io.h>
20 
21 #include <plat/cpu.h>
22 #include <plat/pm.h>
23 #include <plat/regs-timer.h>
24 
25 #include <mach/regs-irq.h>
26 #include <mach/regs-clock.h>
27 
28 static struct sleep_save s5pv210_core_save[] = {
29 	/* Clock source */
30 	SAVE_ITEM(S5P_CLK_SRC0),
31 	SAVE_ITEM(S5P_CLK_SRC1),
32 	SAVE_ITEM(S5P_CLK_SRC2),
33 	SAVE_ITEM(S5P_CLK_SRC3),
34 	SAVE_ITEM(S5P_CLK_SRC4),
35 	SAVE_ITEM(S5P_CLK_SRC5),
36 	SAVE_ITEM(S5P_CLK_SRC6),
37 
38 	/* Clock source Mask */
39 	SAVE_ITEM(S5P_CLK_SRC_MASK0),
40 	SAVE_ITEM(S5P_CLK_SRC_MASK1),
41 
42 	/* Clock Divider */
43 	SAVE_ITEM(S5P_CLK_DIV0),
44 	SAVE_ITEM(S5P_CLK_DIV1),
45 	SAVE_ITEM(S5P_CLK_DIV2),
46 	SAVE_ITEM(S5P_CLK_DIV3),
47 	SAVE_ITEM(S5P_CLK_DIV4),
48 	SAVE_ITEM(S5P_CLK_DIV5),
49 	SAVE_ITEM(S5P_CLK_DIV6),
50 	SAVE_ITEM(S5P_CLK_DIV7),
51 
52 	/* Clock Main Gate */
53 	SAVE_ITEM(S5P_CLKGATE_MAIN0),
54 	SAVE_ITEM(S5P_CLKGATE_MAIN1),
55 	SAVE_ITEM(S5P_CLKGATE_MAIN2),
56 
57 	/* Clock source Peri Gate */
58 	SAVE_ITEM(S5P_CLKGATE_PERI0),
59 	SAVE_ITEM(S5P_CLKGATE_PERI1),
60 
61 	/* Clock source SCLK Gate */
62 	SAVE_ITEM(S5P_CLKGATE_SCLK0),
63 	SAVE_ITEM(S5P_CLKGATE_SCLK1),
64 
65 	/* Clock IP Clock gate */
66 	SAVE_ITEM(S5P_CLKGATE_IP0),
67 	SAVE_ITEM(S5P_CLKGATE_IP1),
68 	SAVE_ITEM(S5P_CLKGATE_IP2),
69 	SAVE_ITEM(S5P_CLKGATE_IP3),
70 	SAVE_ITEM(S5P_CLKGATE_IP4),
71 
72 	/* Clock Blcok and Bus gate */
73 	SAVE_ITEM(S5P_CLKGATE_BLOCK),
74 	SAVE_ITEM(S5P_CLKGATE_BUS0),
75 
76 	/* Clock ETC */
77 	SAVE_ITEM(S5P_CLK_OUT),
78 	SAVE_ITEM(S5P_MDNIE_SEL),
79 
80 	/* PWM Register */
81 	SAVE_ITEM(S3C2410_TCFG0),
82 	SAVE_ITEM(S3C2410_TCFG1),
83 	SAVE_ITEM(S3C64XX_TINT_CSTAT),
84 	SAVE_ITEM(S3C2410_TCON),
85 	SAVE_ITEM(S3C2410_TCNTB(0)),
86 	SAVE_ITEM(S3C2410_TCMPB(0)),
87 	SAVE_ITEM(S3C2410_TCNTO(0)),
88 };
89 
90 void s5pv210_cpu_suspend(void)
91 {
92 	unsigned long tmp;
93 
94 	/* issue the standby signal into the pm unit. Note, we
95 	 * issue a write-buffer drain just in case */
96 
97 	tmp = 0;
98 
99 	asm("b 1f\n\t"
100 	    ".align 5\n\t"
101 	    "1:\n\t"
102 	    "mcr p15, 0, %0, c7, c10, 5\n\t"
103 	    "mcr p15, 0, %0, c7, c10, 4\n\t"
104 	    "wfi" : : "r" (tmp));
105 
106 	/* we should never get past here */
107 	panic("sleep resumed to originator?");
108 }
109 
110 static void s5pv210_pm_prepare(void)
111 {
112 	unsigned int tmp;
113 
114 	/* ensure at least INFORM0 has the resume address */
115 	__raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0);
116 
117 	tmp = __raw_readl(S5P_SLEEP_CFG);
118 	tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN);
119 	__raw_writel(tmp, S5P_SLEEP_CFG);
120 
121 	/* WFI for SLEEP mode configuration by SYSCON */
122 	tmp = __raw_readl(S5P_PWR_CFG);
123 	tmp &= S5P_CFG_WFI_CLEAN;
124 	tmp |= S5P_CFG_WFI_SLEEP;
125 	__raw_writel(tmp, S5P_PWR_CFG);
126 
127 	/* SYSCON interrupt handling disable */
128 	tmp = __raw_readl(S5P_OTHERS);
129 	tmp |= S5P_OTHER_SYSC_INTOFF;
130 	__raw_writel(tmp, S5P_OTHERS);
131 
132 	s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
133 }
134 
135 static int s5pv210_pm_add(struct sys_device *sysdev)
136 {
137 	pm_cpu_prep = s5pv210_pm_prepare;
138 	pm_cpu_sleep = s5pv210_cpu_suspend;
139 
140 	return 0;
141 }
142 
143 static int s5pv210_pm_resume(struct sys_device *dev)
144 {
145 	u32 tmp;
146 
147 	tmp = __raw_readl(S5P_OTHERS);
148 	tmp |= (S5P_OTHERS_RET_IO | S5P_OTHERS_RET_CF |\
149 		S5P_OTHERS_RET_MMC | S5P_OTHERS_RET_UART);
150 	__raw_writel(tmp , S5P_OTHERS);
151 
152 	s3c_pm_do_restore_core(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
153 
154 	return 0;
155 }
156 
157 static struct sysdev_driver s5pv210_pm_driver = {
158 	.add		= s5pv210_pm_add,
159 	.resume		= s5pv210_pm_resume,
160 };
161 
162 static __init int s5pv210_pm_drvinit(void)
163 {
164 	return sysdev_driver_register(&s5pv210_sysclass, &s5pv210_pm_driver);
165 }
166 arch_initcall(s5pv210_pm_drvinit);
167