Merge branch 'for-2.6.30' into for-2.6.31
[linux-2.6] / 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/io.h>
29
30 #include <mach/hardware.h>
31
32 #include <asm/mach-types.h>
33
34 #include <mach/regs-gpio.h>
35 #include <mach/h1940.h>
36
37 #include <plat/cpu.h>
38 #include <plat/pm.h>
39
40 static void s3c2410_pm_prepare(void)
41 {
42         /* ensure at least GSTATUS3 has the resume address */
43
44         __raw_writel(virt_to_phys(s3c_cpu_resume), S3C2410_GSTATUS3);
45
46         S3C_PMDBG("GSTATUS3 0x%08x\n", __raw_readl(S3C2410_GSTATUS3));
47         S3C_PMDBG("GSTATUS4 0x%08x\n", __raw_readl(S3C2410_GSTATUS4));
48
49         if (machine_is_h1940()) {
50                 void *base = phys_to_virt(H1940_SUSPEND_CHECK);
51                 unsigned long ptr;
52                 unsigned long calc = 0;
53
54                 /* generate check for the bootloader to check on resume */
55
56                 for (ptr = 0; ptr < 0x40000; ptr += 0x400)
57                         calc += __raw_readl(base+ptr);
58
59                 __raw_writel(calc, phys_to_virt(H1940_SUSPEND_CHECKSUM));
60         }
61
62         /* the RX3715 uses similar code and the same H1940 and the
63          * same offsets for resume and checksum pointers */
64
65         if (machine_is_rx3715()) {
66                 void *base = phys_to_virt(H1940_SUSPEND_CHECK);
67                 unsigned long ptr;
68                 unsigned long calc = 0;
69
70                 /* generate check for the bootloader to check on resume */
71
72                 for (ptr = 0; ptr < 0x40000; ptr += 0x4)
73                         calc += __raw_readl(base+ptr);
74
75                 __raw_writel(calc, phys_to_virt(H1940_SUSPEND_CHECKSUM));
76         }
77
78         if ( machine_is_aml_m5900() )
79                 s3c2410_gpio_setpin(S3C2410_GPF2, 1);
80
81 }
82
83 static int s3c2410_pm_resume(struct sys_device *dev)
84 {
85         unsigned long tmp;
86
87         /* unset the return-from-sleep flag, to ensure reset */
88
89         tmp = __raw_readl(S3C2410_GSTATUS2);
90         tmp &= S3C2410_GSTATUS2_OFFRESET;
91         __raw_writel(tmp, S3C2410_GSTATUS2);
92
93         if ( machine_is_aml_m5900() )
94                 s3c2410_gpio_setpin(S3C2410_GPF2, 0);
95
96         return 0;
97 }
98
99 static int s3c2410_pm_add(struct sys_device *dev)
100 {
101         pm_cpu_prep = s3c2410_pm_prepare;
102         pm_cpu_sleep = s3c2410_cpu_suspend;
103
104         return 0;
105 }
106
107 #if defined(CONFIG_CPU_S3C2410)
108 static struct sysdev_driver s3c2410_pm_driver = {
109         .add            = s3c2410_pm_add,
110         .resume         = s3c2410_pm_resume,
111 };
112
113 /* register ourselves */
114
115 static int __init s3c2410_pm_drvinit(void)
116 {
117         return sysdev_driver_register(&s3c2410_sysclass, &s3c2410_pm_driver);
118 }
119
120 arch_initcall(s3c2410_pm_drvinit);
121 #endif
122
123 #if defined(CONFIG_CPU_S3C2440)
124 static struct sysdev_driver s3c2440_pm_driver = {
125         .add            = s3c2410_pm_add,
126         .resume         = s3c2410_pm_resume,
127 };
128
129 static int __init s3c2440_pm_drvinit(void)
130 {
131         return sysdev_driver_register(&s3c2440_sysclass, &s3c2440_pm_driver);
132 }
133
134 arch_initcall(s3c2440_pm_drvinit);
135 #endif
136
137 #if defined(CONFIG_CPU_S3C2442)
138 static struct sysdev_driver s3c2442_pm_driver = {
139         .add            = s3c2410_pm_add,
140         .resume         = s3c2410_pm_resume,
141 };
142
143 static int __init s3c2442_pm_drvinit(void)
144 {
145         return sysdev_driver_register(&s3c2442_sysclass, &s3c2442_pm_driver);
146 }
147
148 arch_initcall(s3c2442_pm_drvinit);
149 #endif