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