1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // Copyright (c) 2010 Samsung Electronics Co., Ltd.
4*4882a593Smuzhiyun // http://www.samsung.com
5*4882a593Smuzhiyun //
6*4882a593Smuzhiyun // S3C2416 - PM support (Based on Ben Dooks' S3C2412 PM support)
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/device.h>
9*4882a593Smuzhiyun #include <linux/syscore_ops.h>
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <asm/cacheflush.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #include "regs-s3c2443-clock.h"
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun #include "cpu.h"
17*4882a593Smuzhiyun #include "pm.h"
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include "s3c2412-power.h"
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
22*4882a593Smuzhiyun extern void s3c2412_sleep_enter(void);
23*4882a593Smuzhiyun
s3c2416_cpu_suspend(unsigned long arg)24*4882a593Smuzhiyun static int s3c2416_cpu_suspend(unsigned long arg)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun /* enable wakeup sources regardless of battery state */
27*4882a593Smuzhiyun __raw_writel(S3C2443_PWRCFG_SLEEP, S3C2443_PWRCFG);
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun /* set the mode as sleep, 2BED represents "Go to BED" */
30*4882a593Smuzhiyun __raw_writel(0x2BED, S3C2443_PWRMODE);
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun s3c2412_sleep_enter();
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun pr_info("Failed to suspend the system\n");
35*4882a593Smuzhiyun return 1; /* Aborting suspend */
36*4882a593Smuzhiyun }
37*4882a593Smuzhiyun
s3c2416_pm_prepare(void)38*4882a593Smuzhiyun static void s3c2416_pm_prepare(void)
39*4882a593Smuzhiyun {
40*4882a593Smuzhiyun /*
41*4882a593Smuzhiyun * write the magic value u-boot uses to check for resume into
42*4882a593Smuzhiyun * the INFORM0 register, and ensure INFORM1 is set to the
43*4882a593Smuzhiyun * correct address to resume from.
44*4882a593Smuzhiyun */
45*4882a593Smuzhiyun __raw_writel(0x2BED, S3C2412_INFORM0);
46*4882a593Smuzhiyun __raw_writel(__pa_symbol(s3c_cpu_resume), S3C2412_INFORM1);
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun
s3c2416_pm_add(struct device * dev,struct subsys_interface * sif)49*4882a593Smuzhiyun static int s3c2416_pm_add(struct device *dev, struct subsys_interface *sif)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun pm_cpu_prep = s3c2416_pm_prepare;
52*4882a593Smuzhiyun pm_cpu_sleep = s3c2416_cpu_suspend;
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun return 0;
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun static struct subsys_interface s3c2416_pm_interface = {
58*4882a593Smuzhiyun .name = "s3c2416_pm",
59*4882a593Smuzhiyun .subsys = &s3c2416_subsys,
60*4882a593Smuzhiyun .add_dev = s3c2416_pm_add,
61*4882a593Smuzhiyun };
62*4882a593Smuzhiyun
s3c2416_pm_init(void)63*4882a593Smuzhiyun static __init int s3c2416_pm_init(void)
64*4882a593Smuzhiyun {
65*4882a593Smuzhiyun return subsys_interface_register(&s3c2416_pm_interface);
66*4882a593Smuzhiyun }
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun arch_initcall(s3c2416_pm_init);
69*4882a593Smuzhiyun #endif
70*4882a593Smuzhiyun
s3c2416_pm_resume(void)71*4882a593Smuzhiyun static void s3c2416_pm_resume(void)
72*4882a593Smuzhiyun {
73*4882a593Smuzhiyun /* unset the return-from-sleep amd inform flags */
74*4882a593Smuzhiyun __raw_writel(0x0, S3C2443_PWRMODE);
75*4882a593Smuzhiyun __raw_writel(0x0, S3C2412_INFORM0);
76*4882a593Smuzhiyun __raw_writel(0x0, S3C2412_INFORM1);
77*4882a593Smuzhiyun }
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun struct syscore_ops s3c2416_pm_syscore_ops = {
80*4882a593Smuzhiyun .resume = s3c2416_pm_resume,
81*4882a593Smuzhiyun };
82