1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // Copyright (c) 2006 Simtec Electronics
4*4882a593Smuzhiyun // Ben Dooks <ben@simtec.co.uk>
5*4882a593Smuzhiyun //
6*4882a593Smuzhiyun // http://armlinux.simtec.co.uk/.
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/kernel.h>
9*4882a593Smuzhiyun #include <linux/types.h>
10*4882a593Smuzhiyun #include <linux/interrupt.h>
11*4882a593Smuzhiyun #include <linux/list.h>
12*4882a593Smuzhiyun #include <linux/timer.h>
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/device.h>
15*4882a593Smuzhiyun #include <linux/syscore_ops.h>
16*4882a593Smuzhiyun #include <linux/platform_device.h>
17*4882a593Smuzhiyun #include <linux/io.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include <asm/cacheflush.h>
20*4882a593Smuzhiyun #include <asm/irq.h>
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun #include <mach/irqs.h>
23*4882a593Smuzhiyun #include "regs-gpio.h"
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun #include "cpu.h"
26*4882a593Smuzhiyun #include "pm.h"
27*4882a593Smuzhiyun #include "wakeup-mask.h"
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun #include "regs-dsc-s3c24xx.h"
30*4882a593Smuzhiyun #include "s3c2412-power.h"
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun extern void s3c2412_sleep_enter(void);
33*4882a593Smuzhiyun
s3c2412_cpu_suspend(unsigned long arg)34*4882a593Smuzhiyun static int s3c2412_cpu_suspend(unsigned long arg)
35*4882a593Smuzhiyun {
36*4882a593Smuzhiyun unsigned long tmp;
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun /* set our standby method to sleep */
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun tmp = __raw_readl(S3C2412_PWRCFG);
41*4882a593Smuzhiyun tmp |= S3C2412_PWRCFG_STANDBYWFI_SLEEP;
42*4882a593Smuzhiyun __raw_writel(tmp, S3C2412_PWRCFG);
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun s3c2412_sleep_enter();
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun pr_info("Failed to suspend the system\n");
47*4882a593Smuzhiyun return 1; /* Aborting suspend */
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun /* mapping of interrupts to parts of the wakeup mask */
51*4882a593Smuzhiyun static const struct samsung_wakeup_mask wake_irqs[] = {
52*4882a593Smuzhiyun { .irq = IRQ_RTC, .bit = S3C2412_PWRCFG_RTC_MASKIRQ, },
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun
s3c2412_pm_prepare(void)55*4882a593Smuzhiyun static void s3c2412_pm_prepare(void)
56*4882a593Smuzhiyun {
57*4882a593Smuzhiyun samsung_sync_wakemask(S3C2412_PWRCFG,
58*4882a593Smuzhiyun wake_irqs, ARRAY_SIZE(wake_irqs));
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun
s3c2412_pm_add(struct device * dev,struct subsys_interface * sif)61*4882a593Smuzhiyun static int s3c2412_pm_add(struct device *dev, struct subsys_interface *sif)
62*4882a593Smuzhiyun {
63*4882a593Smuzhiyun pm_cpu_prep = s3c2412_pm_prepare;
64*4882a593Smuzhiyun pm_cpu_sleep = s3c2412_cpu_suspend;
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun return 0;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun
69*4882a593Smuzhiyun static struct sleep_save s3c2412_sleep[] = {
70*4882a593Smuzhiyun SAVE_ITEM(S3C2412_DSC0),
71*4882a593Smuzhiyun SAVE_ITEM(S3C2412_DSC1),
72*4882a593Smuzhiyun SAVE_ITEM(S3C2413_GPJDAT),
73*4882a593Smuzhiyun SAVE_ITEM(S3C2413_GPJCON),
74*4882a593Smuzhiyun SAVE_ITEM(S3C2413_GPJUP),
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun /* save the PWRCFG to get back to original sleep method */
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun SAVE_ITEM(S3C2412_PWRCFG),
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun /* save the sleep configuration anyway, just in case these
81*4882a593Smuzhiyun * get damaged during wakeup */
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPBSLPCON),
84*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPCSLPCON),
85*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPDSLPCON),
86*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPFSLPCON),
87*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPGSLPCON),
88*4882a593Smuzhiyun SAVE_ITEM(S3C2412_GPHSLPCON),
89*4882a593Smuzhiyun SAVE_ITEM(S3C2413_GPJSLPCON),
90*4882a593Smuzhiyun };
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun static struct subsys_interface s3c2412_pm_interface = {
93*4882a593Smuzhiyun .name = "s3c2412_pm",
94*4882a593Smuzhiyun .subsys = &s3c2412_subsys,
95*4882a593Smuzhiyun .add_dev = s3c2412_pm_add,
96*4882a593Smuzhiyun };
97*4882a593Smuzhiyun
s3c2412_pm_init(void)98*4882a593Smuzhiyun static __init int s3c2412_pm_init(void)
99*4882a593Smuzhiyun {
100*4882a593Smuzhiyun return subsys_interface_register(&s3c2412_pm_interface);
101*4882a593Smuzhiyun }
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun arch_initcall(s3c2412_pm_init);
104*4882a593Smuzhiyun
s3c2412_pm_suspend(void)105*4882a593Smuzhiyun static int s3c2412_pm_suspend(void)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun s3c_pm_do_save(s3c2412_sleep, ARRAY_SIZE(s3c2412_sleep));
108*4882a593Smuzhiyun return 0;
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun
s3c2412_pm_resume(void)111*4882a593Smuzhiyun static void s3c2412_pm_resume(void)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun unsigned long tmp;
114*4882a593Smuzhiyun
115*4882a593Smuzhiyun tmp = __raw_readl(S3C2412_PWRCFG);
116*4882a593Smuzhiyun tmp &= ~S3C2412_PWRCFG_STANDBYWFI_MASK;
117*4882a593Smuzhiyun tmp |= S3C2412_PWRCFG_STANDBYWFI_IDLE;
118*4882a593Smuzhiyun __raw_writel(tmp, S3C2412_PWRCFG);
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun s3c_pm_do_restore(s3c2412_sleep, ARRAY_SIZE(s3c2412_sleep));
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun struct syscore_ops s3c2412_pm_syscore_ops = {
124*4882a593Smuzhiyun .suspend = s3c2412_pm_suspend,
125*4882a593Smuzhiyun .resume = s3c2412_pm_resume,
126*4882a593Smuzhiyun };
127