Commit | Line | Data |
---|---|---|
907d6deb AV |
1 | /* |
2 | * arch/arm/mach-at91rm9200/pm.c | |
3 | * AT91 Power Management | |
4 | * | |
5 | * Copyright (C) 2005 David Brownell | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | */ | |
12 | ||
13 | #include <linux/pm.h> | |
14 | #include <linux/sched.h> | |
15 | #include <linux/proc_fs.h> | |
16 | #include <linux/pm.h> | |
17 | #include <linux/interrupt.h> | |
18 | #include <linux/sysfs.h> | |
19 | #include <linux/module.h> | |
20 | #include <linux/platform_device.h> | |
21 | ||
22 | #include <asm/io.h> | |
23 | #include <asm/irq.h> | |
24 | #include <asm/atomic.h> | |
25 | #include <asm/mach/time.h> | |
26 | #include <asm/mach/irq.h> | |
27 | #include <asm/mach-types.h> | |
28 | ||
29 | #include <asm/arch/gpio.h> | |
30 | ||
31 | #include "generic.h" | |
32 | ||
33 | ||
34 | static int at91_pm_valid_state(suspend_state_t state) | |
35 | { | |
36 | switch (state) { | |
37 | case PM_SUSPEND_ON: | |
38 | case PM_SUSPEND_STANDBY: | |
39 | case PM_SUSPEND_MEM: | |
40 | return 1; | |
41 | ||
42 | default: | |
43 | return 0; | |
44 | } | |
45 | } | |
46 | ||
47 | ||
48 | static suspend_state_t target_state; | |
49 | ||
50 | /* | |
51 | * Called after processes are frozen, but before we shutdown devices. | |
52 | */ | |
53 | static int at91_pm_prepare(suspend_state_t state) | |
54 | { | |
55 | target_state = state; | |
56 | return 0; | |
57 | } | |
58 | ||
59 | /* | |
60 | * Verify that all the clocks are correct before entering | |
61 | * slow-clock mode. | |
62 | */ | |
63 | static int at91_pm_verify_clocks(void) | |
64 | { | |
65 | unsigned long scsr; | |
66 | int i; | |
67 | ||
68 | scsr = at91_sys_read(AT91_PMC_SCSR); | |
69 | ||
70 | /* USB must not be using PLLB */ | |
71 | if ((scsr & (AT91_PMC_UHP | AT91_PMC_UDP)) != 0) { | |
72 | pr_debug("AT91: PM - Suspend-to-RAM with USB still active\n"); | |
73 | return 0; | |
74 | } | |
75 | ||
76 | #ifdef CONFIG_AT91_PROGRAMMABLE_CLOCKS | |
77 | /* PCK0..PCK3 must be disabled, or configured to use clk32k */ | |
78 | for (i = 0; i < 4; i++) { | |
79 | u32 css; | |
80 | ||
81 | if ((scsr & (AT91_PMC_PCK0 << i)) == 0) | |
82 | continue; | |
83 | ||
84 | css = at91_sys_read(AT91_PMC_PCKR(i)) & AT91_PMC_CSS; | |
85 | if (css != AT91_PMC_CSS_SLOW) { | |
86 | pr_debug("AT91: PM - Suspend-to-RAM with PCK%d src %d\n", i, css); | |
87 | return 0; | |
88 | } | |
89 | } | |
90 | #endif | |
91 | ||
92 | return 1; | |
93 | } | |
94 | ||
95 | /* | |
96 | * Call this from platform driver suspend() to see how deeply to suspend. | |
97 | * For example, some controllers (like OHCI) need one of the PLL clocks | |
98 | * in order to act as a wakeup source, and those are not available when | |
99 | * going into slow clock mode. | |
100 | * | |
101 | * REVISIT: generalize as clk_will_be_available(clk)? Other platforms have | |
102 | * the very same problem (but not using at91 main_clk), and it'd be better | |
103 | * to add one generic API rather than lots of platform-specific ones. | |
104 | */ | |
105 | int at91_suspend_entering_slow_clock(void) | |
106 | { | |
107 | return (target_state == PM_SUSPEND_MEM); | |
108 | } | |
109 | EXPORT_SYMBOL(at91_suspend_entering_slow_clock); | |
110 | ||
111 | ||
112 | static void (*slow_clock)(void); | |
113 | ||
114 | ||
115 | ||
116 | static int at91_pm_enter(suspend_state_t state) | |
117 | { | |
118 | at91_gpio_suspend(); | |
119 | at91_irq_suspend(); | |
120 | ||
121 | pr_debug("AT91: PM - wake mask %08x, pm state %d\n", | |
122 | /* remember all the always-wake irqs */ | |
123 | (at91_sys_read(AT91_PMC_PCSR) | |
124 | | (1 << AT91_ID_FIQ) | |
125 | | (1 << AT91_ID_SYS) | |
72729910 AV |
126 | | (1 << AT91RM9200_ID_IRQ0) |
127 | | (1 << AT91RM9200_ID_IRQ1) | |
128 | | (1 << AT91RM9200_ID_IRQ2) | |
129 | | (1 << AT91RM9200_ID_IRQ3) | |
130 | | (1 << AT91RM9200_ID_IRQ4) | |
131 | | (1 << AT91RM9200_ID_IRQ5) | |
132 | | (1 << AT91RM9200_ID_IRQ6)) | |
907d6deb AV |
133 | & at91_sys_read(AT91_AIC_IMR), |
134 | state); | |
135 | ||
136 | switch (state) { | |
137 | /* | |
138 | * Suspend-to-RAM is like STANDBY plus slow clock mode, so | |
139 | * drivers must suspend more deeply: only the master clock | |
140 | * controller may be using the main oscillator. | |
141 | */ | |
142 | case PM_SUSPEND_MEM: | |
143 | /* | |
144 | * Ensure that clocks are in a valid state. | |
145 | */ | |
146 | if (!at91_pm_verify_clocks()) | |
147 | goto error; | |
148 | ||
149 | /* | |
150 | * Enter slow clock mode by switching over to clk32k and | |
151 | * turning off the main oscillator; reverse on wakeup. | |
152 | */ | |
153 | if (slow_clock) { | |
154 | slow_clock(); | |
155 | break; | |
156 | } else { | |
157 | /* DEVELOPMENT ONLY */ | |
158 | pr_info("AT91: PM - no slow clock mode yet ...\n"); | |
159 | /* FALLTHROUGH leaving master clock alone */ | |
160 | } | |
161 | ||
162 | /* | |
163 | * STANDBY mode has *all* drivers suspended; ignores irqs not | |
164 | * marked as 'wakeup' event sources; and reduces DRAM power. | |
165 | * But otherwise it's identical to PM_SUSPEND_ON: cpu idle, and | |
166 | * nothing fancy done with main or cpu clocks. | |
167 | */ | |
168 | case PM_SUSPEND_STANDBY: | |
169 | /* | |
170 | * NOTE: the Wait-for-Interrupt instruction needs to be | |
171 | * in icache so the SDRAM stays in self-refresh mode until | |
172 | * the wakeup IRQ occurs. | |
173 | */ | |
174 | asm("b 1f; .align 5; 1:"); | |
175 | asm("mcr p15, 0, r0, c7, c10, 4"); /* drain write buffer */ | |
176 | at91_sys_write(AT91_SDRAMC_SRR, 1); /* self-refresh mode */ | |
177 | /* fall though to next state */ | |
178 | ||
179 | case PM_SUSPEND_ON: | |
180 | asm("mcr p15, 0, r0, c7, c0, 4"); /* wait for interrupt */ | |
181 | break; | |
182 | ||
183 | default: | |
184 | pr_debug("AT91: PM - bogus suspend state %d\n", state); | |
185 | goto error; | |
186 | } | |
187 | ||
188 | pr_debug("AT91: PM - wakeup %08x\n", | |
189 | at91_sys_read(AT91_AIC_IPR) & at91_sys_read(AT91_AIC_IMR)); | |
190 | ||
191 | error: | |
192 | target_state = PM_SUSPEND_ON; | |
193 | at91_irq_resume(); | |
194 | at91_gpio_resume(); | |
195 | return 0; | |
196 | } | |
197 | ||
198 | ||
199 | static struct pm_ops at91_pm_ops ={ | |
200 | .pm_disk_mode = 0, | |
201 | .valid = at91_pm_valid_state, | |
202 | .prepare = at91_pm_prepare, | |
203 | .enter = at91_pm_enter, | |
204 | }; | |
205 | ||
206 | static int __init at91_pm_init(void) | |
207 | { | |
208 | printk("AT91: Power Management\n"); | |
209 | ||
210 | #ifdef CONFIG_AT91_PM_SLOW_CLOCK | |
211 | /* REVISIT allocations of SRAM should be dynamically managed. | |
212 | * FIQ handlers and other components will want SRAM/TCM too... | |
213 | */ | |
214 | slow_clock = (void *) (AT91_VA_BASE_SRAM + (3 * SZ_4K)); | |
215 | memcpy(slow_clock, at91rm9200_slow_clock, at91rm9200_slow_clock_sz); | |
216 | #endif | |
217 | ||
218 | /* Disable SDRAM low-power mode. Cannot be used with self-refresh. */ | |
219 | at91_sys_write(AT91_SDRAMC_LPR, 0); | |
220 | ||
221 | pm_set_ops(&at91_pm_ops); | |
222 | ||
223 | return 0; | |
224 | } | |
225 | arch_initcall(at91_pm_init); |