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