Commit | Line | Data |
---|---|---|
ea31fd43 JL |
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> | |
bb072c3c | 19 | #include <linux/syscore_ops.h> |
ea31fd43 JL |
20 | #include <linux/io.h> |
21 | ||
22 | #include <plat/cpu.h> | |
23 | #include <plat/pm.h> | |
ea31fd43 JL |
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), | |
ea31fd43 JL |
79 | }; |
80 | ||
7e1291de | 81 | static int s5pv210_cpu_suspend(unsigned long arg) |
ea31fd43 JL |
82 | { |
83 | unsigned long tmp; | |
84 | ||
85 | /* issue the standby signal into the pm unit. Note, we | |
86 | * issue a write-buffer drain just in case */ | |
87 | ||
88 | tmp = 0; | |
89 | ||
90 | asm("b 1f\n\t" | |
91 | ".align 5\n\t" | |
92 | "1:\n\t" | |
93 | "mcr p15, 0, %0, c7, c10, 5\n\t" | |
94 | "mcr p15, 0, %0, c7, c10, 4\n\t" | |
95 | "wfi" : : "r" (tmp)); | |
96 | ||
d3fcacf5 AK |
97 | pr_info("Failed to suspend the system\n"); |
98 | return 1; /* Aborting suspend */ | |
ea31fd43 JL |
99 | } |
100 | ||
101 | static void s5pv210_pm_prepare(void) | |
102 | { | |
103 | unsigned int tmp; | |
104 | ||
105 | /* ensure at least INFORM0 has the resume address */ | |
106 | __raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0); | |
107 | ||
108 | tmp = __raw_readl(S5P_SLEEP_CFG); | |
109 | tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN); | |
110 | __raw_writel(tmp, S5P_SLEEP_CFG); | |
111 | ||
112 | /* WFI for SLEEP mode configuration by SYSCON */ | |
113 | tmp = __raw_readl(S5P_PWR_CFG); | |
114 | tmp &= S5P_CFG_WFI_CLEAN; | |
115 | tmp |= S5P_CFG_WFI_SLEEP; | |
116 | __raw_writel(tmp, S5P_PWR_CFG); | |
117 | ||
118 | /* SYSCON interrupt handling disable */ | |
119 | tmp = __raw_readl(S5P_OTHERS); | |
120 | tmp |= S5P_OTHER_SYSC_INTOFF; | |
121 | __raw_writel(tmp, S5P_OTHERS); | |
122 | ||
123 | s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save)); | |
124 | } | |
125 | ||
04511a6f | 126 | static int s5pv210_pm_add(struct device *dev, struct subsys_interface *sif) |
ea31fd43 JL |
127 | { |
128 | pm_cpu_prep = s5pv210_pm_prepare; | |
129 | pm_cpu_sleep = s5pv210_cpu_suspend; | |
130 | ||
131 | return 0; | |
132 | } | |
133 | ||
4a858cfc KS |
134 | static struct subsys_interface s5pv210_pm_interface = { |
135 | .name = "s5pv210_pm", | |
136 | .subsys = &s5pv210_subsys, | |
137 | .add_dev = s5pv210_pm_add, | |
bb072c3c RW |
138 | }; |
139 | ||
140 | static __init int s5pv210_pm_drvinit(void) | |
141 | { | |
4a858cfc | 142 | return subsys_interface_register(&s5pv210_pm_interface); |
bb072c3c RW |
143 | } |
144 | arch_initcall(s5pv210_pm_drvinit); | |
145 | ||
146 | static void s5pv210_pm_resume(void) | |
ea31fd43 JL |
147 | { |
148 | u32 tmp; | |
149 | ||
150 | tmp = __raw_readl(S5P_OTHERS); | |
151 | tmp |= (S5P_OTHERS_RET_IO | S5P_OTHERS_RET_CF |\ | |
152 | S5P_OTHERS_RET_MMC | S5P_OTHERS_RET_UART); | |
153 | __raw_writel(tmp , S5P_OTHERS); | |
154 | ||
155 | s3c_pm_do_restore_core(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save)); | |
ea31fd43 JL |
156 | } |
157 | ||
bb072c3c | 158 | static struct syscore_ops s5pv210_pm_syscore_ops = { |
ea31fd43 JL |
159 | .resume = s5pv210_pm_resume, |
160 | }; | |
161 | ||
bb072c3c | 162 | static __init int s5pv210_pm_syscore_init(void) |
ea31fd43 | 163 | { |
bb072c3c RW |
164 | register_syscore_ops(&s5pv210_pm_syscore_ops); |
165 | return 0; | |
ea31fd43 | 166 | } |
bb072c3c | 167 | arch_initcall(s5pv210_pm_syscore_init); |