arch/arm/mach-s5pv210/pm.c

   1 /* linux/arch/arm/mach-s5pv210/pm.c
   2  *
   3  * Copyright (c) 2010 Samsung Electronics Co., Ltd.
   4  *              http://www.samsung.com
   5  *
   6  * S5PV210 - Power Management support
   7  *
   8  * Based on arch/arm/mach-s3c2410/pm.c
   9  * Copyright (c) 2006 Simtec Electronics
  10  *      Ben Dooks <ben@simtec.co.uk>
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License version 2 as
  14  * published by the Free Software Foundation.
  15 */
  16
  17 #include <linux/init.h>
  18 #include <linux/suspend.h>
  19 #include <linux/syscore_ops.h>
  20 #include <linux/io.h>
  21
  22 #include <plat/cpu.h>
  23 #include <plat/pm.h>
  24 #include <plat/regs-timer.h>
  25
  26 #include <mach/regs-irq.h>
  27 #include <mach/regs-clock.h>
  28
  29 static struct sleep_save s5pv210_core_save[] = {
  30         /* Clock source */
  31         SAVE_ITEM(S5P_CLK_SRC0),
  32         SAVE_ITEM(S5P_CLK_SRC1),
  33         SAVE_ITEM(S5P_CLK_SRC2),
  34         SAVE_ITEM(S5P_CLK_SRC3),
  35         SAVE_ITEM(S5P_CLK_SRC4),
  36         SAVE_ITEM(S5P_CLK_SRC5),
  37         SAVE_ITEM(S5P_CLK_SRC6),
  38
  39         /* Clock source Mask */
  40         SAVE_ITEM(S5P_CLK_SRC_MASK0),
  41         SAVE_ITEM(S5P_CLK_SRC_MASK1),
  42
  43         /* Clock Divider */
  44         SAVE_ITEM(S5P_CLK_DIV0),
  45         SAVE_ITEM(S5P_CLK_DIV1),
  46         SAVE_ITEM(S5P_CLK_DIV2),
  47         SAVE_ITEM(S5P_CLK_DIV3),
  48         SAVE_ITEM(S5P_CLK_DIV4),
  49         SAVE_ITEM(S5P_CLK_DIV5),
  50         SAVE_ITEM(S5P_CLK_DIV6),
  51         SAVE_ITEM(S5P_CLK_DIV7),
  52
  53         /* Clock Main Gate */
  54         SAVE_ITEM(S5P_CLKGATE_MAIN0),
  55         SAVE_ITEM(S5P_CLKGATE_MAIN1),
  56         SAVE_ITEM(S5P_CLKGATE_MAIN2),
  57
  58         /* Clock source Peri Gate */
  59         SAVE_ITEM(S5P_CLKGATE_PERI0),
  60         SAVE_ITEM(S5P_CLKGATE_PERI1),
  61
  62         /* Clock source SCLK Gate */
  63         SAVE_ITEM(S5P_CLKGATE_SCLK0),
  64         SAVE_ITEM(S5P_CLKGATE_SCLK1),
  65
  66         /* Clock IP Clock gate */
  67         SAVE_ITEM(S5P_CLKGATE_IP0),
  68         SAVE_ITEM(S5P_CLKGATE_IP1),
  69         SAVE_ITEM(S5P_CLKGATE_IP2),
  70         SAVE_ITEM(S5P_CLKGATE_IP3),
  71         SAVE_ITEM(S5P_CLKGATE_IP4),
  72
  73         /* Clock Blcok and Bus gate */
  74         SAVE_ITEM(S5P_CLKGATE_BLOCK),
  75         SAVE_ITEM(S5P_CLKGATE_BUS0),
  76
  77         /* Clock ETC */
  78         SAVE_ITEM(S5P_CLK_OUT),
  79         SAVE_ITEM(S5P_MDNIE_SEL),
  80
  81         /* PWM Register */
  82         SAVE_ITEM(S3C2410_TCFG0),
  83         SAVE_ITEM(S3C2410_TCFG1),
  84         SAVE_ITEM(S3C64XX_TINT_CSTAT),
  85         SAVE_ITEM(S3C2410_TCON),
  86         SAVE_ITEM(S3C2410_TCNTB(0)),
  87         SAVE_ITEM(S3C2410_TCMPB(0)),
  88         SAVE_ITEM(S3C2410_TCNTO(0)),
  89 };
  90
  91 static int s5pv210_cpu_suspend(unsigned long arg)
  92 {
  93         unsigned long tmp;
  94
  95         /* issue the standby signal into the pm unit. Note, we
  96          * issue a write-buffer drain just in case */
  97
  98         tmp = 0;
  99
 100         asm("b 1f\n\t"
 101             ".align 5\n\t"
 102             "1:\n\t"
 103             "mcr p15, 0, %0, c7, c10, 5\n\t"
 104             "mcr p15, 0, %0, c7, c10, 4\n\t"
 105             "wfi" : : "r" (tmp));
 106
 107         pr_info("Failed to suspend the system\n");
 108         return 1; /* Aborting suspend */
 109 }
 110
 111 static void s5pv210_pm_prepare(void)
 112 {
 113         unsigned int tmp;
 114
 115         /* ensure at least INFORM0 has the resume address */
 116         __raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0);
 117
 118         tmp = __raw_readl(S5P_SLEEP_CFG);
 119         tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN);
 120         __raw_writel(tmp, S5P_SLEEP_CFG);
 121
 122         /* WFI for SLEEP mode configuration by SYSCON */
 123         tmp = __raw_readl(S5P_PWR_CFG);
 124         tmp &= S5P_CFG_WFI_CLEAN;
 125         tmp |= S5P_CFG_WFI_SLEEP;
 126         __raw_writel(tmp, S5P_PWR_CFG);
 127
 128         /* SYSCON interrupt handling disable */
 129         tmp = __raw_readl(S5P_OTHERS);
 130         tmp |= S5P_OTHER_SYSC_INTOFF;
 131         __raw_writel(tmp, S5P_OTHERS);
 132
 133         s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
 134 }
 135
 136 static int s5pv210_pm_add(struct device *dev, struct subsys_interface *sif)
 137 {
 138         pm_cpu_prep = s5pv210_pm_prepare;
 139         pm_cpu_sleep = s5pv210_cpu_suspend;
 140
 141         return 0;
 142 }
 143
 144 static struct subsys_interface s5pv210_pm_interface = {
 145         .name           = "s5pv210_pm",
 146         .subsys         = &s5pv210_subsys,
 147         .add_dev        = s5pv210_pm_add,
 148 };
 149
 150 static __init int s5pv210_pm_drvinit(void)
 151 {
 152         return subsys_interface_register(&s5pv210_pm_interface);
 153 }
 154 arch_initcall(s5pv210_pm_drvinit);
 155
 156 static void s5pv210_pm_resume(void)
 157 {
 158         u32 tmp;
 159
 160         tmp = __raw_readl(S5P_OTHERS);
 161         tmp |= (S5P_OTHERS_RET_IO | S5P_OTHERS_RET_CF |\
 162                 S5P_OTHERS_RET_MMC | S5P_OTHERS_RET_UART);
 163         __raw_writel(tmp , S5P_OTHERS);
 164
 165         s3c_pm_do_restore_core(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
 166 }
 167
 168 static struct syscore_ops s5pv210_pm_syscore_ops = {
 169         .resume         = s5pv210_pm_resume,
 170 };
 171
 172 static __init int s5pv210_pm_syscore_init(void)
 173 {
 174         register_syscore_ops(&s5pv210_pm_syscore_ops);
 175         return 0;
 176 }
 177 arch_initcall(s5pv210_pm_syscore_init);