signal: fix __send_signal() false positive kmemcheck warning
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arm / plat-s3c24xx / pm.c
1 /* linux/arch/arm/plat-s3c24xx/pm.c
2 *
3 * Copyright (c) 2004,2006 Simtec Electronics
4 * Ben Dooks <ben@simtec.co.uk>
5 *
6 * S3C24XX Power Manager (Suspend-To-RAM) support
7 *
8 * See Documentation/arm/Samsung-S3C24XX/Suspend.txt for more information
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 *
24 * Parts based on arch/arm/mach-pxa/pm.c
25 *
26 * Thanks to Dimitry Andric for debugging
27 */
28
29 #include <linux/init.h>
30 #include <linux/suspend.h>
31 #include <linux/errno.h>
32 #include <linux/time.h>
33 #include <linux/interrupt.h>
34 #include <linux/serial_core.h>
35 #include <linux/io.h>
36
37 #include <plat/regs-serial.h>
38 #include <mach/regs-clock.h>
39 #include <mach/regs-gpio.h>
40 #include <mach/regs-mem.h>
41 #include <mach/regs-irq.h>
42
43 #include <asm/mach/time.h>
44
45 #include <plat/pm.h>
46
47 #define PFX "s3c24xx-pm: "
48
49 static struct sleep_save core_save[] = {
50 SAVE_ITEM(S3C2410_LOCKTIME),
51 SAVE_ITEM(S3C2410_CLKCON),
52
53 /* we restore the timings here, with the proviso that the board
54 * brings the system up in an slower, or equal frequency setting
55 * to the original system.
56 *
57 * if we cannot guarantee this, then things are going to go very
58 * wrong here, as we modify the refresh and both pll settings.
59 */
60
61 SAVE_ITEM(S3C2410_BWSCON),
62 SAVE_ITEM(S3C2410_BANKCON0),
63 SAVE_ITEM(S3C2410_BANKCON1),
64 SAVE_ITEM(S3C2410_BANKCON2),
65 SAVE_ITEM(S3C2410_BANKCON3),
66 SAVE_ITEM(S3C2410_BANKCON4),
67 SAVE_ITEM(S3C2410_BANKCON5),
68
69 #ifndef CONFIG_CPU_FREQ
70 SAVE_ITEM(S3C2410_CLKDIVN),
71 SAVE_ITEM(S3C2410_MPLLCON),
72 SAVE_ITEM(S3C2410_REFRESH),
73 #endif
74 SAVE_ITEM(S3C2410_UPLLCON),
75 SAVE_ITEM(S3C2410_CLKSLOW),
76 };
77
78 static struct gpio_sleep {
79 void __iomem *base;
80 unsigned int gpcon;
81 unsigned int gpdat;
82 unsigned int gpup;
83 } gpio_save[] = {
84 [0] = {
85 .base = S3C2410_GPACON,
86 },
87 [1] = {
88 .base = S3C2410_GPBCON,
89 },
90 [2] = {
91 .base = S3C2410_GPCCON,
92 },
93 [3] = {
94 .base = S3C2410_GPDCON,
95 },
96 [4] = {
97 .base = S3C2410_GPECON,
98 },
99 [5] = {
100 .base = S3C2410_GPFCON,
101 },
102 [6] = {
103 .base = S3C2410_GPGCON,
104 },
105 [7] = {
106 .base = S3C2410_GPHCON,
107 },
108 };
109
110 static struct sleep_save misc_save[] = {
111 SAVE_ITEM(S3C2410_DCLKCON),
112 };
113
114
115 /* s3c_pm_check_resume_pin
116 *
117 * check to see if the pin is configured correctly for sleep mode, and
118 * make any necessary adjustments if it is not
119 */
120
121 static void s3c_pm_check_resume_pin(unsigned int pin, unsigned int irqoffs)
122 {
123 unsigned long irqstate;
124 unsigned long pinstate;
125 int irq = s3c2410_gpio_getirq(pin);
126
127 if (irqoffs < 4)
128 irqstate = s3c_irqwake_intmask & (1L<<irqoffs);
129 else
130 irqstate = s3c_irqwake_eintmask & (1L<<irqoffs);
131
132 pinstate = s3c2410_gpio_getcfg(pin);
133
134 if (!irqstate) {
135 if (pinstate == S3C2410_GPIO_IRQ)
136 S3C_PMDBG("Leaving IRQ %d (pin %d) enabled\n", irq, pin);
137 } else {
138 if (pinstate == S3C2410_GPIO_IRQ) {
139 S3C_PMDBG("Disabling IRQ %d (pin %d)\n", irq, pin);
140 s3c2410_gpio_cfgpin(pin, S3C2410_GPIO_INPUT);
141 }
142 }
143 }
144
145 /* s3c_pm_configure_extint
146 *
147 * configure all external interrupt pins
148 */
149
150 void s3c_pm_configure_extint(void)
151 {
152 int pin;
153
154 /* for each of the external interrupts (EINT0..EINT15) we
155 * need to check wether it is an external interrupt source,
156 * and then configure it as an input if it is not
157 */
158
159 for (pin = S3C2410_GPF0; pin <= S3C2410_GPF7; pin++) {
160 s3c_pm_check_resume_pin(pin, pin - S3C2410_GPF0);
161 }
162
163 for (pin = S3C2410_GPG0; pin <= S3C2410_GPG7; pin++) {
164 s3c_pm_check_resume_pin(pin, (pin - S3C2410_GPG0)+8);
165 }
166 }
167
168 /* offsets for CON/DAT/UP registers */
169
170 #define OFFS_CON (S3C2410_GPACON - S3C2410_GPACON)
171 #define OFFS_DAT (S3C2410_GPADAT - S3C2410_GPACON)
172 #define OFFS_UP (S3C2410_GPBUP - S3C2410_GPBCON)
173
174 /* s3c_pm_save_gpios()
175 *
176 * Save the state of the GPIOs
177 */
178
179 void s3c_pm_save_gpios(void)
180 {
181 struct gpio_sleep *gps = gpio_save;
182 unsigned int gpio;
183
184 for (gpio = 0; gpio < ARRAY_SIZE(gpio_save); gpio++, gps++) {
185 void __iomem *base = gps->base;
186
187 gps->gpcon = __raw_readl(base + OFFS_CON);
188 gps->gpdat = __raw_readl(base + OFFS_DAT);
189
190 if (gpio > 0)
191 gps->gpup = __raw_readl(base + OFFS_UP);
192
193 }
194 }
195
196 /* Test whether the given masked+shifted bits of an GPIO configuration
197 * are one of the SFN (special function) modes. */
198
199 static inline int is_sfn(unsigned long con)
200 {
201 return (con == 2 || con == 3);
202 }
203
204 /* Test if the given masked+shifted GPIO configuration is an input */
205
206 static inline int is_in(unsigned long con)
207 {
208 return con == 0;
209 }
210
211 /* Test if the given masked+shifted GPIO configuration is an output */
212
213 static inline int is_out(unsigned long con)
214 {
215 return con == 1;
216 }
217
218 /**
219 * s3c2410_pm_restore_gpio() - restore the given GPIO bank
220 * @index: The number of the GPIO bank being resumed.
221 * @gps: The sleep confgiuration for the bank.
222 *
223 * Restore one of the GPIO banks that was saved during suspend. This is
224 * not as simple as once thought, due to the possibility of glitches
225 * from the order that the CON and DAT registers are set in.
226 *
227 * The three states the pin can be are {IN,OUT,SFN} which gives us 9
228 * combinations of changes to check. Three of these, if the pin stays
229 * in the same configuration can be discounted. This leaves us with
230 * the following:
231 *
232 * { IN => OUT } Change DAT first
233 * { IN => SFN } Change CON first
234 * { OUT => SFN } Change CON first, so new data will not glitch
235 * { OUT => IN } Change CON first, so new data will not glitch
236 * { SFN => IN } Change CON first
237 * { SFN => OUT } Change DAT first, so new data will not glitch [1]
238 *
239 * We do not currently deal with the UP registers as these control
240 * weak resistors, so a small delay in change should not need to bring
241 * these into the calculations.
242 *
243 * [1] this assumes that writing to a pin DAT whilst in SFN will set the
244 * state for when it is next output.
245 */
246
247 static void s3c2410_pm_restore_gpio(int index, struct gpio_sleep *gps)
248 {
249 void __iomem *base = gps->base;
250 unsigned long gps_gpcon = gps->gpcon;
251 unsigned long gps_gpdat = gps->gpdat;
252 unsigned long old_gpcon;
253 unsigned long old_gpdat;
254 unsigned long old_gpup = 0x0;
255 unsigned long gpcon;
256 int nr;
257
258 old_gpcon = __raw_readl(base + OFFS_CON);
259 old_gpdat = __raw_readl(base + OFFS_DAT);
260
261 if (base == S3C2410_GPACON) {
262 /* GPACON only has one bit per control / data and no PULLUPs.
263 * GPACON[x] = 0 => Output, 1 => SFN */
264
265 /* first set all SFN bits to SFN */
266
267 gpcon = old_gpcon | gps->gpcon;
268 __raw_writel(gpcon, base + OFFS_CON);
269
270 /* now set all the other bits */
271
272 __raw_writel(gps_gpdat, base + OFFS_DAT);
273 __raw_writel(gps_gpcon, base + OFFS_CON);
274 } else {
275 unsigned long old, new, mask;
276 unsigned long change_mask = 0x0;
277
278 old_gpup = __raw_readl(base + OFFS_UP);
279
280 /* Create a change_mask of all the items that need to have
281 * their CON value changed before their DAT value, so that
282 * we minimise the work between the two settings.
283 */
284
285 for (nr = 0, mask = 0x03; nr < 32; nr += 2, mask <<= 2) {
286 old = (old_gpcon & mask) >> nr;
287 new = (gps_gpcon & mask) >> nr;
288
289 /* If there is no change, then skip */
290
291 if (old == new)
292 continue;
293
294 /* If both are special function, then skip */
295
296 if (is_sfn(old) && is_sfn(new))
297 continue;
298
299 /* Change is IN => OUT, do not change now */
300
301 if (is_in(old) && is_out(new))
302 continue;
303
304 /* Change is SFN => OUT, do not change now */
305
306 if (is_sfn(old) && is_out(new))
307 continue;
308
309 /* We should now be at the case of IN=>SFN,
310 * OUT=>SFN, OUT=>IN, SFN=>IN. */
311
312 change_mask |= mask;
313 }
314
315 /* Write the new CON settings */
316
317 gpcon = old_gpcon & ~change_mask;
318 gpcon |= gps_gpcon & change_mask;
319
320 __raw_writel(gpcon, base + OFFS_CON);
321
322 /* Now change any items that require DAT,CON */
323
324 __raw_writel(gps_gpdat, base + OFFS_DAT);
325 __raw_writel(gps_gpcon, base + OFFS_CON);
326 __raw_writel(gps->gpup, base + OFFS_UP);
327 }
328
329 S3C_PMDBG("GPIO[%d] CON %08lx => %08lx, DAT %08lx => %08lx\n",
330 index, old_gpcon, gps_gpcon, old_gpdat, gps_gpdat);
331 }
332
333
334 /** s3c2410_pm_restore_gpios()
335 *
336 * Restore the state of the GPIOs
337 */
338
339 void s3c_pm_restore_gpios(void)
340 {
341 struct gpio_sleep *gps = gpio_save;
342 int gpio;
343
344 for (gpio = 0; gpio < ARRAY_SIZE(gpio_save); gpio++, gps++) {
345 s3c2410_pm_restore_gpio(gpio, gps);
346 }
347 }
348
349 void s3c_pm_restore_core(void)
350 {
351 s3c_pm_do_restore_core(core_save, ARRAY_SIZE(core_save));
352 s3c_pm_do_restore(misc_save, ARRAY_SIZE(misc_save));
353 }
354
355 void s3c_pm_save_core(void)
356 {
357 s3c_pm_do_save(misc_save, ARRAY_SIZE(misc_save));
358 s3c_pm_do_save(core_save, ARRAY_SIZE(core_save));
359 }
360