pm-s3c2412.c (2828B)
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};