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/io.h>
  20
  21 #include <plat/cpu.h>
  22 #include <plat/pm.h>
  23 #include <plat/regs-timer.h>
  24
  25 #include <mach/regs-irq.h>
  26 #include <mach/regs-clock.h>
  27
  28 static struct sleep_save s5pv210_core_save[] = {
  29         /* Clock source */
  30         SAVE_ITEM(S5P_CLK_SRC0),
  31         SAVE_ITEM(S5P_CLK_SRC1),
  32         SAVE_ITEM(S5P_CLK_SRC2),
  33         SAVE_ITEM(S5P_CLK_SRC3),
  34         SAVE_ITEM(S5P_CLK_SRC4),
  35         SAVE_ITEM(S5P_CLK_SRC5),
  36         SAVE_ITEM(S5P_CLK_SRC6),
  37
  38         /* Clock source Mask */
  39         SAVE_ITEM(S5P_CLK_SRC_MASK0),
  40         SAVE_ITEM(S5P_CLK_SRC_MASK1),
  41
  42         /* Clock Divider */
  43         SAVE_ITEM(S5P_CLK_DIV0),
  44         SAVE_ITEM(S5P_CLK_DIV1),
  45         SAVE_ITEM(S5P_CLK_DIV2),
  46         SAVE_ITEM(S5P_CLK_DIV3),
  47         SAVE_ITEM(S5P_CLK_DIV4),
  48         SAVE_ITEM(S5P_CLK_DIV5),
  49         SAVE_ITEM(S5P_CLK_DIV6),
  50         SAVE_ITEM(S5P_CLK_DIV7),
  51
  52         /* Clock Main Gate */
  53         SAVE_ITEM(S5P_CLKGATE_MAIN0),
  54         SAVE_ITEM(S5P_CLKGATE_MAIN1),
  55         SAVE_ITEM(S5P_CLKGATE_MAIN2),
  56
  57         /* Clock source Peri Gate */
  58         SAVE_ITEM(S5P_CLKGATE_PERI0),
  59         SAVE_ITEM(S5P_CLKGATE_PERI1),
  60
  61         /* Clock source SCLK Gate */
  62         SAVE_ITEM(S5P_CLKGATE_SCLK0),
  63         SAVE_ITEM(S5P_CLKGATE_SCLK1),
  64
  65         /* Clock IP Clock gate */
  66         SAVE_ITEM(S5P_CLKGATE_IP0),
  67         SAVE_ITEM(S5P_CLKGATE_IP1),
  68         SAVE_ITEM(S5P_CLKGATE_IP2),
  69         SAVE_ITEM(S5P_CLKGATE_IP3),
  70         SAVE_ITEM(S5P_CLKGATE_IP4),
  71
  72         /* Clock Blcok and Bus gate */
  73         SAVE_ITEM(S5P_CLKGATE_BLOCK),
  74         SAVE_ITEM(S5P_CLKGATE_BUS0),
  75
  76         /* Clock ETC */
  77         SAVE_ITEM(S5P_CLK_OUT),
  78         SAVE_ITEM(S5P_MDNIE_SEL),
  79
  80         /* PWM Register */
  81         SAVE_ITEM(S3C2410_TCFG0),
  82         SAVE_ITEM(S3C2410_TCFG1),
  83         SAVE_ITEM(S3C64XX_TINT_CSTAT),
  84         SAVE_ITEM(S3C2410_TCON),
  85         SAVE_ITEM(S3C2410_TCNTB(0)),
  86         SAVE_ITEM(S3C2410_TCMPB(0)),
  87         SAVE_ITEM(S3C2410_TCNTO(0)),
  88 };
  89
  90 void s5pv210_cpu_suspend(void)
  91 {
  92         unsigned long tmp;
  93
  94         /* issue the standby signal into the pm unit. Note, we
  95          * issue a write-buffer drain just in case */
  96
  97         tmp = 0;
  98
  99         asm("b 1f\n\t"
 100             ".align 5\n\t"
 101             "1:\n\t"
 102             "mcr p15, 0, %0, c7, c10, 5\n\t"
 103             "mcr p15, 0, %0, c7, c10, 4\n\t"
 104             "wfi" : : "r" (tmp));
 105
 106         /* we should never get past here */
 107         panic("sleep resumed to originator?");
 108 }
 109
 110 static void s5pv210_pm_prepare(void)
 111 {
 112         unsigned int tmp;
 113
 114         /* ensure at least INFORM0 has the resume address */
 115         __raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0);
 116
 117         tmp = __raw_readl(S5P_SLEEP_CFG);
 118         tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN);
 119         __raw_writel(tmp, S5P_SLEEP_CFG);
 120
 121         /* WFI for SLEEP mode configuration by SYSCON */
 122         tmp = __raw_readl(S5P_PWR_CFG);
 123         tmp &= S5P_CFG_WFI_CLEAN;
 124         tmp |= S5P_CFG_WFI_SLEEP;
 125         __raw_writel(tmp, S5P_PWR_CFG);
 126
 127         /* SYSCON interrupt handling disable */
 128         tmp = __raw_readl(S5P_OTHERS);
 129         tmp |= S5P_OTHER_SYSC_INTOFF;
 130         __raw_writel(tmp, S5P_OTHERS);
 131
 132         s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
 133 }
 134
 135 static int s5pv210_pm_add(struct sys_device *sysdev)
 136 {
 137         pm_cpu_prep = s5pv210_pm_prepare;
 138         pm_cpu_sleep = s5pv210_cpu_suspend;
 139
 140         return 0;
 141 }
 142
 143 static int s5pv210_pm_resume(struct sys_device *dev)
 144 {
 145         u32 tmp;
 146
 147         tmp = __raw_readl(S5P_OTHERS);
 148         tmp |= (S5P_OTHERS_RET_IO | S5P_OTHERS_RET_CF |\
 149                 S5P_OTHERS_RET_MMC | S5P_OTHERS_RET_UART);
 150         __raw_writel(tmp , S5P_OTHERS);
 151
 152         s3c_pm_do_restore_core(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
 153
 154         return 0;
 155 }
 156
 157 static struct sysdev_driver s5pv210_pm_driver = {
 158         .add            = s5pv210_pm_add,
 159         .resume         = s5pv210_pm_resume,
 160 };
 161
 162 static __init int s5pv210_pm_drvinit(void)
 163 {
 164         return sysdev_driver_register(&s5pv210_sysclass, &s5pv210_pm_driver);
 165 }
 166 arch_initcall(s5pv210_pm_drvinit);