Pileus Git - ~andy/linux/blob - arch/blackfin/mach-bf609/pm.c

   1 /*
   2  * Blackfin bf609 power management
   3  *
   4  * Copyright 2011 Analog Devices Inc.
   5  *
   6  * Licensed under the GPL-2
   7  */
   8
   9 #include <linux/suspend.h>
  10 #include <linux/io.h>
  11 #include <linux/interrupt.h>
  12 #include <linux/gpio.h>
  13 #include <linux/irq.h>
  14 #include <linux/delay.h>
  15 #include <linux/syscore_ops.h>
  16
  17 #include <asm/dpmc.h>
  18 #include <asm/pm.h>
  19 #include <mach/pm.h>
  20 #include <asm/blackfin.h>
  21 #include <asm/mem_init.h>
  22
  23 /***********************************************************/
  24 /*                                                         */
  25 /* Wakeup Actions for DPM_RESTORE                          */
  26 /*                                                         */
  27 /***********************************************************/
  28 #define BITP_ROM_WUA_CHKHDR             24
  29 #define BITP_ROM_WUA_DDRLOCK            7
  30 #define BITP_ROM_WUA_DDRDLLEN           6
  31 #define BITP_ROM_WUA_DDR                5
  32 #define BITP_ROM_WUA_CGU                4
  33 #define BITP_ROM_WUA_MEMBOOT            2
  34 #define BITP_ROM_WUA_EN                 1
  35
  36 #define BITM_ROM_WUA_CHKHDR             (0xFF000000)
  37 #define ENUM_ROM_WUA_CHKHDR_AD                  0xAD000000
  38
  39 #define BITM_ROM_WUA_DDRLOCK            (0x00000080)
  40 #define BITM_ROM_WUA_DDRDLLEN           (0x00000040)
  41 #define BITM_ROM_WUA_DDR                (0x00000020)
  42 #define BITM_ROM_WUA_CGU                (0x00000010)
  43 #define BITM_ROM_WUA_MEMBOOT            (0x00000002)
  44 #define BITM_ROM_WUA_EN                 (0x00000001)
  45
  46 /***********************************************************/
  47 /*                                                         */
  48 /* Syscontrol                                              */
  49 /*                                                         */
  50 /***********************************************************/
  51 #define BITP_ROM_SYSCTRL_CGU_LOCKINGEN  28    /* unlocks CGU_CTL register */
  52 #define BITP_ROM_SYSCTRL_WUA_OVERRIDE   24
  53 #define BITP_ROM_SYSCTRL_WUA_DDRDLLEN   20    /* Saves the DDR DLL and PADS registers to the DPM registers */
  54 #define BITP_ROM_SYSCTRL_WUA_DDR        19    /* Saves the DDR registers to the DPM registers */
  55 #define BITP_ROM_SYSCTRL_WUA_CGU        18    /* Saves the CGU registers into DPM registers */
  56 #define BITP_ROM_SYSCTRL_WUA_DPMWRITE   17    /* Saves the Syscontrol structure structure contents into DPM registers */
  57 #define BITP_ROM_SYSCTRL_WUA_EN         16    /* reads current PLL and DDR configuration into structure */
  58 #define BITP_ROM_SYSCTRL_DDR_WRITE      13    /* writes the DDR registers from Syscontrol structure for wakeup initialization of DDR */
  59 #define BITP_ROM_SYSCTRL_DDR_READ       12    /* Read the DDR registers into the Syscontrol structure for storing prior to hibernate */
  60 #define BITP_ROM_SYSCTRL_CGU_AUTODIS    11    /* Disables auto handling of UPDT and ALGN fields */
  61 #define BITP_ROM_SYSCTRL_CGU_CLKOUTSEL  7    /* access CGU_CLKOUTSEL register */
  62 #define BITP_ROM_SYSCTRL_CGU_DIV        6    /* access CGU_DIV register */
  63 #define BITP_ROM_SYSCTRL_CGU_STAT       5    /* access CGU_STAT register */
  64 #define BITP_ROM_SYSCTRL_CGU_CTL        4    /* access CGU_CTL register */
  65 #define BITP_ROM_SYSCTRL_CGU_RTNSTAT    2    /* Update structure STAT field upon error */
  66 #define BITP_ROM_SYSCTRL_WRITE          1    /* write registers */
  67 #define BITP_ROM_SYSCTRL_READ           0    /* read registers */
  68
  69 #define BITM_ROM_SYSCTRL_CGU_READ       (0x00000001)    /* Read CGU registers */
  70 #define BITM_ROM_SYSCTRL_CGU_WRITE      (0x00000002)    /* Write registers */
  71 #define BITM_ROM_SYSCTRL_CGU_RTNSTAT    (0x00000004)    /* Update structure STAT field upon error or after a write operation */
  72 #define BITM_ROM_SYSCTRL_CGU_CTL        (0x00000010)    /* Access CGU_CTL register */
  73 #define BITM_ROM_SYSCTRL_CGU_STAT       (0x00000020)    /* Access CGU_STAT register */
  74 #define BITM_ROM_SYSCTRL_CGU_DIV        (0x00000040)    /* Access CGU_DIV register */
  75 #define BITM_ROM_SYSCTRL_CGU_CLKOUTSEL  (0x00000080)    /* Access CGU_CLKOUTSEL register */
  76 #define BITM_ROM_SYSCTRL_CGU_AUTODIS    (0x00000800)    /* Disables auto handling of UPDT and ALGN fields */
  77 #define BITM_ROM_SYSCTRL_DDR_READ       (0x00001000)    /* Reads the contents of the DDR registers and stores them into the structure */
  78 #define BITM_ROM_SYSCTRL_DDR_WRITE      (0x00002000)    /* Writes the DDR registers from the structure, only really intented for wakeup functionality and not for full DDR configuration */
  79 #define BITM_ROM_SYSCTRL_WUA_EN         (0x00010000)    /* Wakeup entry or exit opertation enable */
  80 #define BITM_ROM_SYSCTRL_WUA_DPMWRITE   (0x00020000)    /* When set indicates a restore of the PLL and DDR is to be performed otherwise a save is required */
  81 #define BITM_ROM_SYSCTRL_WUA_CGU        (0x00040000)    /* Only applicable for a PLL and DDR save operation to the DPM, saves the current settings if cleared or the contents of the structure if set */
  82 #define BITM_ROM_SYSCTRL_WUA_DDR        (0x00080000)    /* Only applicable for a PLL and DDR save operation to the DPM, saves the current settings if cleared or the contents of the structure if set */
  83 #define BITM_ROM_SYSCTRL_WUA_DDRDLLEN   (0x00100000)    /* Enables saving/restoring of the DDR DLLCTL register */
  84 #define BITM_ROM_SYSCTRL_WUA_OVERRIDE   (0x01000000)
  85 #define BITM_ROM_SYSCTRL_CGU_LOCKINGEN  (0x10000000)    /* Unlocks the CGU_CTL register */
  86
  87
  88 /* Structures for the syscontrol() function */
  89 struct STRUCT_ROM_SYSCTRL {
  90         uint32_t ulCGU_CTL;
  91         uint32_t ulCGU_STAT;
  92         uint32_t ulCGU_DIV;
  93         uint32_t ulCGU_CLKOUTSEL;
  94         uint32_t ulWUA_Flags;
  95         uint32_t ulWUA_BootAddr;
  96         uint32_t ulWUA_User;
  97         uint32_t ulDDR_CTL;
  98         uint32_t ulDDR_CFG;
  99         uint32_t ulDDR_TR0;
 100         uint32_t ulDDR_TR1;
 101         uint32_t ulDDR_TR2;
 102         uint32_t ulDDR_MR;
 103         uint32_t ulDDR_EMR1;
 104         uint32_t ulDDR_EMR2;
 105         uint32_t ulDDR_PADCTL;
 106         uint32_t ulDDR_DLLCTL;
 107         uint32_t ulReserved;
 108 };
 109
 110 struct bfin_pm_data {
 111         uint32_t magic;
 112         uint32_t resume_addr;
 113         uint32_t sp;
 114 };
 115
 116 struct bfin_pm_data bf609_pm_data;
 117
 118 struct STRUCT_ROM_SYSCTRL configvalues;
 119 uint32_t dactionflags;
 120
 121 #define FUNC_ROM_SYSCONTROL 0xC8000080
 122 __attribute__((l1_data))
 123 static uint32_t (* const bfrom_SysControl)(uint32_t action_flags, struct STRUCT_ROM_SYSCTRL *settings, void *reserved) = (void *)FUNC_ROM_SYSCONTROL;
 124
 125 __attribute__((l1_text))
 126 void bfin_cpu_suspend(void)
 127 {
 128         __asm__ __volatile__( \
 129                         ".align 8;" \
 130                         "idle;" \
 131                         : : \
 132                         );
 133 }
 134
 135 __attribute__((l1_text))
 136 void bf609_ddr_sr(void)
 137 {
 138         dmc_enter_self_refresh();
 139 }
 140
 141 __attribute__((l1_text))
 142 void bf609_ddr_sr_exit(void)
 143 {
 144         dmc_exit_self_refresh();
 145
 146         /* After wake up from deep sleep and exit DDR from self refress mode,
 147          * should wait till CGU PLL is locked.
 148          */
 149         while (bfin_read32(CGU0_STAT) & CLKSALGN)
 150                 continue;
 151 }
 152
 153 __attribute__((l1_text))
 154 void bf609_resume_ccbuf(void)
 155 {
 156         bfin_write32(DPM0_CCBF_EN, 3);
 157         bfin_write32(DPM0_CTL, 2);
 158
 159         while ((bfin_read32(DPM0_STAT) & 0xf) != 1);
 160 }
 161
 162 __attribute__((l1_text))
 163 void bfin_hibernate_syscontrol(void)
 164 {
 165         configvalues.ulWUA_Flags = (0xAD000000 | BITM_ROM_WUA_EN
 166                 | BITM_ROM_WUA_CGU | BITM_ROM_WUA_DDR | BITM_ROM_WUA_DDRDLLEN);
 167
 168         dactionflags = (BITM_ROM_SYSCTRL_WUA_EN
 169                 | BITM_ROM_SYSCTRL_WUA_DPMWRITE | BITM_ROM_SYSCTRL_WUA_CGU
 170                 | BITM_ROM_SYSCTRL_WUA_DDR | BITM_ROM_SYSCTRL_WUA_DDRDLLEN);
 171
 172         bfrom_SysControl(dactionflags, &configvalues, NULL);
 173
 174         bfin_write32(DPM0_RESTORE5, bfin_read32(DPM0_RESTORE5) | 4);
 175 }
 176
 177 #ifndef CONFIG_BF60x
 178 # define SIC_SYSIRQ(irq)        (irq - (IRQ_CORETMR + 1))
 179 #else
 180 # define SIC_SYSIRQ(irq)        ((irq) - IVG15)
 181 #endif
 182 asmlinkage void enter_deepsleep(void);
 183
 184 __attribute__((l1_text))
 185 void bfin_deepsleep(unsigned long mask, unsigned long pol_mask)
 186 {
 187         bfin_write32(DPM0_WAKE_EN, mask);
 188         bfin_write32(DPM0_WAKE_POL, pol_mask);
 189         SSYNC();
 190         enter_deepsleep();
 191 }
 192
 193 void bfin_hibernate(unsigned long mask, unsigned long pol_mask)
 194 {
 195         bfin_write32(DPM0_WAKE_EN, mask);
 196         bfin_write32(DPM0_WAKE_POL, pol_mask);
 197         bfin_write32(DPM0_PGCNTR, 0x0000FFFF);
 198         bfin_write32(DPM0_HIB_DIS, 0xFFFF);
 199
 200         bf609_hibernate();
 201 }
 202
 203 void bf609_cpu_pm_enter(suspend_state_t state)
 204 {
 205         int error;
 206         unsigned long wakeup = 0;
 207         unsigned long wakeup_pol = 0;
 208
 209 #ifdef CONFIG_PM_BFIN_WAKE_PA15
 210         wakeup |= PA15WE;
 211 # if CONFIG_PM_BFIN_WAKE_PA15_POL
 212         wakeup_pol |= PA15WE;
 213 # endif
 214 #endif
 215
 216 #ifdef CONFIG_PM_BFIN_WAKE_PB15
 217         wakeup |= PB15WE;
 218 # if CONFIG_PM_BFIN_WAKE_PA15_POL
 219         wakeup_pol |= PB15WE;
 220 # endif
 221 #endif
 222
 223 #ifdef CONFIG_PM_BFIN_WAKE_PC15
 224         wakeup |= PC15WE;
 225 # if CONFIG_PM_BFIN_WAKE_PC15_POL
 226         wakeup_pol |= PC15WE;
 227 # endif
 228 #endif
 229
 230 #ifdef CONFIG_PM_BFIN_WAKE_PD06
 231         wakeup |= PD06WE;
 232 # if CONFIG_PM_BFIN_WAKE_PD06_POL
 233         wakeup_pol |= PD06WE;
 234 # endif
 235 #endif
 236
 237 #ifdef CONFIG_PM_BFIN_WAKE_PE12
 238         wakeup |= PE12WE;
 239 # if CONFIG_PM_BFIN_WAKE_PE12_POL
 240         wakeup_pol |= PE12WE;
 241 # endif
 242 #endif
 243
 244 #ifdef CONFIG_PM_BFIN_WAKE_PG04
 245         wakeup |= PG04WE;
 246 # if CONFIG_PM_BFIN_WAKE_PG04_POL
 247         wakeup_pol |= PG04WE;
 248 # endif
 249 #endif
 250
 251 #ifdef CONFIG_PM_BFIN_WAKE_PG13
 252         wakeup |= PG13WE;
 253 # if CONFIG_PM_BFIN_WAKE_PG13_POL
 254         wakeup_pol |= PG13WE;
 255 # endif
 256 #endif
 257
 258 #ifdef CONFIG_PM_BFIN_WAKE_USB
 259         wakeup |= USBWE;
 260 # if CONFIG_PM_BFIN_WAKE_USB_POL
 261         wakeup_pol |= USBWE;
 262 # endif
 263 #endif
 264
 265         error = irq_set_irq_wake(255, 1);
 266         if(error < 0)
 267                 printk(KERN_DEBUG "Unable to get irq wake\n");
 268         error = irq_set_irq_wake(231, 1);
 269         if (error < 0)
 270                 printk(KERN_DEBUG "Unable to get irq wake\n");
 271
 272         if (state == PM_SUSPEND_STANDBY)
 273                 bfin_deepsleep(wakeup, wakeup_pol);
 274         else {
 275                 bfin_hibernate(wakeup, wakeup_pol);
 276         }
 277
 278 }
 279
 280 int bf609_cpu_pm_prepare(void)
 281 {
 282         return 0;
 283 }
 284
 285 void bf609_cpu_pm_finish(void)
 286 {
 287
 288 }
 289
 290 static struct bfin_cpu_pm_fns bf609_cpu_pm = {
 291         .enter          = bf609_cpu_pm_enter,
 292         .prepare        = bf609_cpu_pm_prepare,
 293         .finish         = bf609_cpu_pm_finish,
 294 };
 295
 296 #if defined(CONFIG_MTD_PHYSMAP) || defined(CONFIG_MTD_PHYSMAP_MODULE)
 297 static int smc_pm_syscore_suspend(void)
 298 {
 299         bf609_nor_flash_exit();
 300         return 0;
 301 }
 302
 303 static void smc_pm_syscore_resume(void)
 304 {
 305         bf609_nor_flash_init();
 306 }
 307
 308 static struct syscore_ops smc_pm_syscore_ops = {
 309         .suspend        = smc_pm_syscore_suspend,
 310         .resume         = smc_pm_syscore_resume,
 311 };
 312 #endif
 313
 314 static irqreturn_t test_isr(int irq, void *dev_id)
 315 {
 316         printk(KERN_DEBUG "gpio irq %d\n", irq);
 317         return IRQ_HANDLED;
 318 }
 319
 320 static irqreturn_t dpm0_isr(int irq, void *dev_id)
 321 {
 322         bfin_write32(DPM0_WAKE_STAT, bfin_read32(DPM0_WAKE_STAT));
 323         bfin_write32(CGU0_STAT, bfin_read32(CGU0_STAT));
 324         return IRQ_HANDLED;
 325 }
 326 #endif
 327
 328 static int __init bf609_init_pm(void)
 329 {
 330         int irq;
 331         int error;
 332
 333 #if defined(CONFIG_MTD_PHYSMAP) || defined(CONFIG_MTD_PHYSMAP_MODULE)
 334         register_syscore_ops(&smc_pm_syscore_ops);
 335 #endif
 336
 337 #ifdef CONFIG_PM_BFIN_WAKE_PE12
 338         irq = gpio_to_irq(GPIO_PE12);
 339         if (irq < 0) {
 340                 error = irq;
 341                 printk(KERN_DEBUG "Unable to get irq number for GPIO %d, error %d\n",
 342                                 GPIO_PE12, error);
 343         }
 344
 345         error = request_irq(irq, test_isr, IRQF_TRIGGER_RISING | IRQF_NO_SUSPEND
 346                                 | IRQF_FORCE_RESUME, "gpiope12", NULL);
 347         if(error < 0)
 348                 printk(KERN_DEBUG "Unable to get irq\n");
 349 #endif
 350
 351         error = request_irq(IRQ_CGU_EVT, dpm0_isr, IRQF_NO_SUSPEND |
 352                                 IRQF_FORCE_RESUME, "cgu0 event", NULL);
 353         if(error < 0)
 354                 printk(KERN_DEBUG "Unable to get irq\n");
 355
 356         error = request_irq(IRQ_DPM, dpm0_isr, IRQF_NO_SUSPEND |
 357                                 IRQF_FORCE_RESUME, "dpm0 event", NULL);
 358         if (error < 0)
 359                 printk(KERN_DEBUG "Unable to get irq\n");
 360
 361         bfin_cpu_pm = &bf609_cpu_pm;
 362         return 0;
 363 }
 364
 365 late_initcall(bf609_init_pm);