Merge branch 'x86-cpu-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6.git] / arch / arm / mach-s3c2410 / pm.c
1 /* linux/arch/arm/mach-s3c2410/pm.c
2  *
3  * Copyright (c) 2006 Simtec Electronics
4  *      Ben Dooks <ben@simtec.co.uk>
5  *
6  * S3C2410 (and compatible) Power Manager (Suspend-To-RAM) support
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21 */
22
23 #include <linux/init.h>
24 #include <linux/suspend.h>
25 #include <linux/errno.h>
26 #include <linux/time.h>
27 #include <linux/sysdev.h>
28 #include <linux/gpio.h>
29 #include <linux/io.h>
30
31 #include <mach/hardware.h>
32
33 #include <asm/mach-types.h>
34
35 #include <mach/regs-gpio.h>
36 #include <mach/h1940.h>
37
38 #include <plat/cpu.h>
39 #include <plat/pm.h>
40
41 static void s3c2410_pm_prepare(void)
42 {
43         /* ensure at least GSTATUS3 has the resume address */
44
45         __raw_writel(virt_to_phys(s3c_cpu_resume), S3C2410_GSTATUS3);
46
47         S3C_PMDBG("GSTATUS3 0x%08x\n", __raw_readl(S3C2410_GSTATUS3));
48         S3C_PMDBG("GSTATUS4 0x%08x\n", __raw_readl(S3C2410_GSTATUS4));
49
50         if (machine_is_h1940()) {
51                 void *base = phys_to_virt(H1940_SUSPEND_CHECK);
52                 unsigned long ptr;
53                 unsigned long calc = 0;
54
55                 /* generate check for the bootloader to check on resume */
56
57                 for (ptr = 0; ptr < 0x40000; ptr += 0x400)
58                         calc += __raw_readl(base+ptr);
59
60                 __raw_writel(calc, phys_to_virt(H1940_SUSPEND_CHECKSUM));
61         }
62
63         /* the RX3715 uses similar code and the same H1940 and the
64          * same offsets for resume and checksum pointers */
65
66         if (machine_is_rx3715()) {
67                 void *base = phys_to_virt(H1940_SUSPEND_CHECK);
68                 unsigned long ptr;
69                 unsigned long calc = 0;
70
71                 /* generate check for the bootloader to check on resume */
72
73                 for (ptr = 0; ptr < 0x40000; ptr += 0x4)
74                         calc += __raw_readl(base+ptr);
75
76                 __raw_writel(calc, phys_to_virt(H1940_SUSPEND_CHECKSUM));
77         }
78
79         if ( machine_is_aml_m5900() )
80                 s3c2410_gpio_setpin(S3C2410_GPF(2), 1);
81
82 }
83
84 static int s3c2410_pm_resume(struct sys_device *dev)
85 {
86         unsigned long tmp;
87
88         /* unset the return-from-sleep flag, to ensure reset */
89
90         tmp = __raw_readl(S3C2410_GSTATUS2);
91         tmp &= S3C2410_GSTATUS2_OFFRESET;
92         __raw_writel(tmp, S3C2410_GSTATUS2);
93
94         if ( machine_is_aml_m5900() )
95                 s3c2410_gpio_setpin(S3C2410_GPF(2), 0);
96
97         return 0;
98 }
99
100 static int s3c2410_pm_add(struct sys_device *dev)
101 {
102         pm_cpu_prep = s3c2410_pm_prepare;
103         pm_cpu_sleep = s3c2410_cpu_suspend;
104
105         return 0;
106 }
107
108 #if defined(CONFIG_CPU_S3C2410)
109 static struct sysdev_driver s3c2410_pm_driver = {
110         .add            = s3c2410_pm_add,
111         .resume         = s3c2410_pm_resume,
112 };
113
114 /* register ourselves */
115
116 static int __init s3c2410_pm_drvinit(void)
117 {
118         return sysdev_driver_register(&s3c2410_sysclass, &s3c2410_pm_driver);
119 }
120
121 arch_initcall(s3c2410_pm_drvinit);
122
123 static struct sysdev_driver s3c2410a_pm_driver = {
124         .add            = s3c2410_pm_add,
125         .resume         = s3c2410_pm_resume,
126 };
127
128 static int __init s3c2410a_pm_drvinit(void)
129 {
130         return sysdev_driver_register(&s3c2410a_sysclass, &s3c2410a_pm_driver);
131 }
132
133 arch_initcall(s3c2410a_pm_drvinit);
134 #endif
135
136 #if defined(CONFIG_CPU_S3C2440)
137 static struct sysdev_driver s3c2440_pm_driver = {
138         .add            = s3c2410_pm_add,
139         .resume         = s3c2410_pm_resume,
140 };
141
142 static int __init s3c2440_pm_drvinit(void)
143 {
144         return sysdev_driver_register(&s3c2440_sysclass, &s3c2440_pm_driver);
145 }
146
147 arch_initcall(s3c2440_pm_drvinit);
148 #endif
149
150 #if defined(CONFIG_CPU_S3C2442)
151 static struct sysdev_driver s3c2442_pm_driver = {
152         .add            = s3c2410_pm_add,
153         .resume         = s3c2410_pm_resume,
154 };
155
156 static int __init s3c2442_pm_drvinit(void)
157 {
158         return sysdev_driver_register(&s3c2442_sysclass, &s3c2442_pm_driver);
159 }
160
161 arch_initcall(s3c2442_pm_drvinit);
162 #endif