Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 1 | /* |
| 2 | * OMAP3 Power Management Routines |
| 3 | * |
| 4 | * Copyright (C) 2006-2008 Nokia Corporation |
| 5 | * Tony Lindgren <tony@atomide.com> |
| 6 | * Jouni Hogander |
| 7 | * |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 8 | * Copyright (C) 2007 Texas Instruments, Inc. |
| 9 | * Rajendra Nayak <rnayak@ti.com> |
| 10 | * |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 11 | * Copyright (C) 2005 Texas Instruments, Inc. |
| 12 | * Richard Woodruff <r-woodruff2@ti.com> |
| 13 | * |
| 14 | * Based on pm.c for omap1 |
| 15 | * |
| 16 | * This program is free software; you can redistribute it and/or modify |
| 17 | * it under the terms of the GNU General Public License version 2 as |
| 18 | * published by the Free Software Foundation. |
| 19 | */ |
| 20 | |
| 21 | #include <linux/pm.h> |
| 22 | #include <linux/suspend.h> |
| 23 | #include <linux/interrupt.h> |
| 24 | #include <linux/module.h> |
| 25 | #include <linux/list.h> |
| 26 | #include <linux/err.h> |
| 27 | #include <linux/gpio.h> |
Kevin Hilman | c40552b | 2009-10-06 14:25:09 -0700 | [diff] [blame] | 28 | #include <linux/clk.h> |
Tero Kristo | dccaad8 | 2009-11-17 18:34:53 +0200 | [diff] [blame] | 29 | #include <linux/delay.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 30 | #include <linux/slab.h> |
Paul Walmsley | 0d8e2d0 | 2010-11-24 16:49:05 -0700 | [diff] [blame] | 31 | #include <linux/console.h> |
Jean Pihet | 5e7c58d | 2011-03-03 11:25:43 +0100 | [diff] [blame] | 32 | #include <trace/events/power.h> |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 33 | |
Russell King | 2c74a0c | 2011-06-22 17:41:48 +0100 | [diff] [blame] | 34 | #include <asm/suspend.h> |
| 35 | |
Tony Lindgren | ce491cf | 2009-10-20 09:40:47 -0700 | [diff] [blame] | 36 | #include <plat/sram.h> |
Paul Walmsley | 1540f214 | 2010-12-21 21:05:15 -0700 | [diff] [blame] | 37 | #include "clockdomain.h" |
Paul Walmsley | 72e06d0 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 38 | #include "powerdomain.h" |
Tony Lindgren | ce491cf | 2009-10-20 09:40:47 -0700 | [diff] [blame] | 39 | #include <plat/serial.h> |
Rajendra Nayak | 61255ab | 2008-09-26 17:49:56 +0530 | [diff] [blame] | 40 | #include <plat/sdrc.h> |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 41 | #include <plat/prcm.h> |
| 42 | #include <plat/gpmc.h> |
Tero Kristo | f2d1185 | 2008-08-28 13:13:31 +0000 | [diff] [blame] | 43 | #include <plat/dma.h> |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 44 | |
Paul Walmsley | 59fb659 | 2010-12-21 15:30:55 -0700 | [diff] [blame] | 45 | #include "cm2xxx_3xxx.h" |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 46 | #include "cm-regbits-34xx.h" |
| 47 | #include "prm-regbits-34xx.h" |
| 48 | |
Paul Walmsley | 59fb659 | 2010-12-21 15:30:55 -0700 | [diff] [blame] | 49 | #include "prm2xxx_3xxx.h" |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 50 | #include "pm.h" |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 51 | #include "sdrc.h" |
Paul Walmsley | 4814ced | 2010-10-08 11:40:20 -0600 | [diff] [blame] | 52 | #include "control.h" |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 53 | |
Kevin Hilman | e83df17 | 2010-12-08 22:40:40 +0000 | [diff] [blame] | 54 | #ifdef CONFIG_SUSPEND |
| 55 | static suspend_state_t suspend_state = PM_SUSPEND_ON; |
| 56 | static inline bool is_suspending(void) |
| 57 | { |
Kevin Hilman | dca2d0e | 2011-09-13 11:18:44 -0700 | [diff] [blame] | 58 | return (suspend_state != PM_SUSPEND_ON) && console_suspend_enabled; |
Kevin Hilman | e83df17 | 2010-12-08 22:40:40 +0000 | [diff] [blame] | 59 | } |
| 60 | #else |
| 61 | static inline bool is_suspending(void) |
| 62 | { |
| 63 | return false; |
| 64 | } |
| 65 | #endif |
| 66 | |
Nishanth Menon | 8cdfd83 | 2010-12-20 14:05:05 -0600 | [diff] [blame] | 67 | /* pm34xx errata defined in pm.h */ |
| 68 | u16 pm34xx_errata; |
| 69 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 70 | struct power_state { |
| 71 | struct powerdomain *pwrdm; |
| 72 | u32 next_state; |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 73 | #ifdef CONFIG_SUSPEND |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 74 | u32 saved_state; |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 75 | #endif |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 76 | struct list_head node; |
| 77 | }; |
| 78 | |
| 79 | static LIST_HEAD(pwrst_list); |
| 80 | |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 81 | static int (*_omap_save_secure_sram)(u32 *addr); |
Jean Pihet | 46e130d | 2011-06-29 18:40:23 +0200 | [diff] [blame] | 82 | void (*omap3_do_wfi_sram)(void); |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 83 | |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 84 | static struct powerdomain *mpu_pwrdm, *neon_pwrdm; |
| 85 | static struct powerdomain *core_pwrdm, *per_pwrdm; |
Tero Kristo | c16c3f6 | 2008-12-11 16:46:57 +0200 | [diff] [blame] | 86 | static struct powerdomain *cam_pwrdm; |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 87 | |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 88 | static inline void omap3_per_save_context(void) |
| 89 | { |
| 90 | omap_gpio_save_context(); |
| 91 | } |
| 92 | |
| 93 | static inline void omap3_per_restore_context(void) |
| 94 | { |
| 95 | omap_gpio_restore_context(); |
| 96 | } |
| 97 | |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 98 | static void omap3_enable_io_chain(void) |
| 99 | { |
| 100 | int timeout = 0; |
| 101 | |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 102 | omap2_prm_set_mod_reg_bits(OMAP3430_EN_IO_CHAIN_MASK, WKUP_MOD, |
| 103 | PM_WKEN); |
| 104 | /* Do a readback to assure write has been done */ |
| 105 | omap2_prm_read_mod_reg(WKUP_MOD, PM_WKEN); |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 106 | |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 107 | while (!(omap2_prm_read_mod_reg(WKUP_MOD, PM_WKEN) & |
| 108 | OMAP3430_ST_IO_CHAIN_MASK)) { |
| 109 | timeout++; |
| 110 | if (timeout > 1000) { |
| 111 | pr_err("Wake up daisy chain activation failed.\n"); |
| 112 | return; |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 113 | } |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 114 | omap2_prm_set_mod_reg_bits(OMAP3430_ST_IO_CHAIN_MASK, |
| 115 | WKUP_MOD, PM_WKEN); |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 116 | } |
| 117 | } |
| 118 | |
| 119 | static void omap3_disable_io_chain(void) |
| 120 | { |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 121 | omap2_prm_clear_mod_reg_bits(OMAP3430_EN_IO_CHAIN_MASK, WKUP_MOD, |
| 122 | PM_WKEN); |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 123 | } |
| 124 | |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 125 | static void omap3_core_save_context(void) |
| 126 | { |
Paul Walmsley | 596efe4 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 127 | omap3_ctrl_save_padconf(); |
Tero Kristo | dccaad8 | 2009-11-17 18:34:53 +0200 | [diff] [blame] | 128 | |
| 129 | /* |
| 130 | * Force write last pad into memory, as this can fail in some |
Jean Pihet | 8352129 | 2010-12-18 16:44:46 +0100 | [diff] [blame] | 131 | * cases according to errata 1.157, 1.185 |
Tero Kristo | dccaad8 | 2009-11-17 18:34:53 +0200 | [diff] [blame] | 132 | */ |
| 133 | omap_ctrl_writel(omap_ctrl_readl(OMAP343X_PADCONF_ETK_D14), |
| 134 | OMAP343X_CONTROL_MEM_WKUP + 0x2a0); |
| 135 | |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 136 | /* Save the Interrupt controller context */ |
| 137 | omap_intc_save_context(); |
| 138 | /* Save the GPMC context */ |
| 139 | omap3_gpmc_save_context(); |
| 140 | /* Save the system control module context, padconf already save above*/ |
| 141 | omap3_control_save_context(); |
Tero Kristo | f2d1185 | 2008-08-28 13:13:31 +0000 | [diff] [blame] | 142 | omap_dma_global_context_save(); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 143 | } |
| 144 | |
| 145 | static void omap3_core_restore_context(void) |
| 146 | { |
| 147 | /* Restore the control module context, padconf restored by h/w */ |
| 148 | omap3_control_restore_context(); |
| 149 | /* Restore the GPMC context */ |
| 150 | omap3_gpmc_restore_context(); |
| 151 | /* Restore the interrupt controller context */ |
| 152 | omap_intc_restore_context(); |
Tero Kristo | f2d1185 | 2008-08-28 13:13:31 +0000 | [diff] [blame] | 153 | omap_dma_global_context_restore(); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 154 | } |
| 155 | |
Tero Kristo | 9d97140 | 2008-12-12 11:20:05 +0200 | [diff] [blame] | 156 | /* |
| 157 | * FIXME: This function should be called before entering off-mode after |
| 158 | * OMAP3 secure services have been accessed. Currently it is only called |
| 159 | * once during boot sequence, but this works as we are not using secure |
| 160 | * services. |
| 161 | */ |
Kevin Hilman | 617fcc9 | 2011-01-25 16:40:01 -0800 | [diff] [blame] | 162 | static void omap3_save_secure_ram_context(void) |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 163 | { |
| 164 | u32 ret; |
Kevin Hilman | 617fcc9 | 2011-01-25 16:40:01 -0800 | [diff] [blame] | 165 | int mpu_next_state = pwrdm_read_next_pwrst(mpu_pwrdm); |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 166 | |
| 167 | if (omap_type() != OMAP2_DEVICE_TYPE_GP) { |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 168 | /* |
| 169 | * MPU next state must be set to POWER_ON temporarily, |
| 170 | * otherwise the WFI executed inside the ROM code |
| 171 | * will hang the system. |
| 172 | */ |
| 173 | pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_ON); |
| 174 | ret = _omap_save_secure_sram((u32 *) |
| 175 | __pa(omap3_secure_ram_storage)); |
Kevin Hilman | 617fcc9 | 2011-01-25 16:40:01 -0800 | [diff] [blame] | 176 | pwrdm_set_next_pwrst(mpu_pwrdm, mpu_next_state); |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 177 | /* Following is for error tracking, it should not happen */ |
| 178 | if (ret) { |
| 179 | printk(KERN_ERR "save_secure_sram() returns %08x\n", |
| 180 | ret); |
| 181 | while (1) |
| 182 | ; |
| 183 | } |
| 184 | } |
| 185 | } |
| 186 | |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 187 | /* |
| 188 | * PRCM Interrupt Handler Helper Function |
| 189 | * |
| 190 | * The purpose of this function is to clear any wake-up events latched |
| 191 | * in the PRCM PM_WKST_x registers. It is possible that a wake-up event |
| 192 | * may occur whilst attempting to clear a PM_WKST_x register and thus |
| 193 | * set another bit in this register. A while loop is used to ensure |
| 194 | * that any peripheral wake-up events occurring while attempting to |
| 195 | * clear the PM_WKST_x are detected and cleared. |
| 196 | */ |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 197 | static int prcm_clear_mod_irqs(s16 module, u8 regs) |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 198 | { |
Vikram Pandita | 71a8077 | 2009-07-17 19:33:09 -0500 | [diff] [blame] | 199 | u32 wkst, fclk, iclk, clken; |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 200 | u16 wkst_off = (regs == 3) ? OMAP3430ES2_PM_WKST3 : PM_WKST1; |
| 201 | u16 fclk_off = (regs == 3) ? OMAP3430ES2_CM_FCLKEN3 : CM_FCLKEN1; |
| 202 | u16 iclk_off = (regs == 3) ? CM_ICLKEN3 : CM_ICLKEN1; |
Paul Walmsley | 5d80597 | 2009-07-22 10:18:07 -0700 | [diff] [blame] | 203 | u16 grpsel_off = (regs == 3) ? |
| 204 | OMAP3430ES2_PM_MPUGRPSEL3 : OMAP3430_PM_MPUGRPSEL; |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 205 | int c = 0; |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 206 | |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 207 | wkst = omap2_prm_read_mod_reg(module, wkst_off); |
| 208 | wkst &= omap2_prm_read_mod_reg(module, grpsel_off); |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 209 | if (wkst) { |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 210 | iclk = omap2_cm_read_mod_reg(module, iclk_off); |
| 211 | fclk = omap2_cm_read_mod_reg(module, fclk_off); |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 212 | while (wkst) { |
Vikram Pandita | 71a8077 | 2009-07-17 19:33:09 -0500 | [diff] [blame] | 213 | clken = wkst; |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 214 | omap2_cm_set_mod_reg_bits(clken, module, iclk_off); |
Vikram Pandita | 71a8077 | 2009-07-17 19:33:09 -0500 | [diff] [blame] | 215 | /* |
| 216 | * For USBHOST, we don't know whether HOST1 or |
| 217 | * HOST2 woke us up, so enable both f-clocks |
| 218 | */ |
| 219 | if (module == OMAP3430ES2_USBHOST_MOD) |
| 220 | clken |= 1 << OMAP3430ES2_EN_USBHOST2_SHIFT; |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 221 | omap2_cm_set_mod_reg_bits(clken, module, fclk_off); |
| 222 | omap2_prm_write_mod_reg(wkst, module, wkst_off); |
| 223 | wkst = omap2_prm_read_mod_reg(module, wkst_off); |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 224 | c++; |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 225 | } |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 226 | omap2_cm_write_mod_reg(iclk, module, iclk_off); |
| 227 | omap2_cm_write_mod_reg(fclk, module, fclk_off); |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 228 | } |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 229 | |
| 230 | return c; |
| 231 | } |
| 232 | |
| 233 | static int _prcm_int_handle_wakeup(void) |
| 234 | { |
| 235 | int c; |
| 236 | |
| 237 | c = prcm_clear_mod_irqs(WKUP_MOD, 1); |
| 238 | c += prcm_clear_mod_irqs(CORE_MOD, 1); |
| 239 | c += prcm_clear_mod_irqs(OMAP3430_PER_MOD, 1); |
| 240 | if (omap_rev() > OMAP3430_REV_ES1_0) { |
| 241 | c += prcm_clear_mod_irqs(CORE_MOD, 3); |
| 242 | c += prcm_clear_mod_irqs(OMAP3430ES2_USBHOST_MOD, 1); |
| 243 | } |
| 244 | |
| 245 | return c; |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 246 | } |
| 247 | |
| 248 | /* |
| 249 | * PRCM Interrupt Handler |
| 250 | * |
| 251 | * The PRM_IRQSTATUS_MPU register indicates if there are any pending |
| 252 | * interrupts from the PRCM for the MPU. These bits must be cleared in |
| 253 | * order to clear the PRCM interrupt. The PRCM interrupt handler is |
| 254 | * implemented to simply clear the PRM_IRQSTATUS_MPU in order to clear |
| 255 | * the PRCM interrupt. Please note that bit 0 of the PRM_IRQSTATUS_MPU |
| 256 | * register indicates that a wake-up event is pending for the MPU and |
| 257 | * this bit can only be cleared if the all the wake-up events latched |
| 258 | * in the various PM_WKST_x registers have been cleared. The interrupt |
| 259 | * handler is implemented using a do-while loop so that if a wake-up |
| 260 | * event occurred during the processing of the prcm interrupt handler |
| 261 | * (setting a bit in the corresponding PM_WKST_x register and thus |
| 262 | * preventing us from clearing bit 0 of the PRM_IRQSTATUS_MPU register) |
| 263 | * this would be handled. |
| 264 | */ |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 265 | static irqreturn_t prcm_interrupt_handler (int irq, void *dev_id) |
| 266 | { |
Kevin Hilman | d6290a3 | 2010-04-26 14:59:09 -0700 | [diff] [blame] | 267 | u32 irqenable_mpu, irqstatus_mpu; |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 268 | int c = 0; |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 269 | |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 270 | irqenable_mpu = omap2_prm_read_mod_reg(OCP_MOD, |
Kevin Hilman | d6290a3 | 2010-04-26 14:59:09 -0700 | [diff] [blame] | 271 | OMAP3_PRM_IRQENABLE_MPU_OFFSET); |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 272 | irqstatus_mpu = omap2_prm_read_mod_reg(OCP_MOD, |
Kevin Hilman | d6290a3 | 2010-04-26 14:59:09 -0700 | [diff] [blame] | 273 | OMAP3_PRM_IRQSTATUS_MPU_OFFSET); |
| 274 | irqstatus_mpu &= irqenable_mpu; |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 275 | |
Kevin Hilman | d6290a3 | 2010-04-26 14:59:09 -0700 | [diff] [blame] | 276 | do { |
Paul Walmsley | 2bc4ef7 | 2010-05-18 18:47:24 -0600 | [diff] [blame] | 277 | if (irqstatus_mpu & (OMAP3430_WKUP_ST_MASK | |
| 278 | OMAP3430_IO_ST_MASK)) { |
Paul Walmsley | 8cb0ac9 | 2009-07-22 10:29:02 -0700 | [diff] [blame] | 279 | c = _prcm_int_handle_wakeup(); |
| 280 | |
| 281 | /* |
| 282 | * Is the MPU PRCM interrupt handler racing with the |
| 283 | * IVA2 PRCM interrupt handler ? |
| 284 | */ |
| 285 | WARN(c == 0, "prcm: WARNING: PRCM indicated MPU wakeup " |
| 286 | "but no wakeup sources are marked\n"); |
| 287 | } else { |
| 288 | /* XXX we need to expand our PRCM interrupt handler */ |
| 289 | WARN(1, "prcm: WARNING: PRCM interrupt received, but " |
| 290 | "no code to handle it (%08x)\n", irqstatus_mpu); |
| 291 | } |
| 292 | |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 293 | omap2_prm_write_mod_reg(irqstatus_mpu, OCP_MOD, |
Jon Hunter | 77da2d9 | 2009-06-27 00:07:25 -0500 | [diff] [blame] | 294 | OMAP3_PRM_IRQSTATUS_MPU_OFFSET); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 295 | |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 296 | irqstatus_mpu = omap2_prm_read_mod_reg(OCP_MOD, |
Kevin Hilman | d6290a3 | 2010-04-26 14:59:09 -0700 | [diff] [blame] | 297 | OMAP3_PRM_IRQSTATUS_MPU_OFFSET); |
| 298 | irqstatus_mpu &= irqenable_mpu; |
| 299 | |
| 300 | } while (irqstatus_mpu); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 301 | |
| 302 | return IRQ_HANDLED; |
| 303 | } |
| 304 | |
Russell King | cbe2634 | 2011-06-30 08:45:49 +0100 | [diff] [blame] | 305 | static void omap34xx_save_context(u32 *save) |
| 306 | { |
| 307 | u32 val; |
| 308 | |
| 309 | /* Read Auxiliary Control Register */ |
| 310 | asm("mrc p15, 0, %0, c1, c0, 1" : "=r" (val)); |
| 311 | *save++ = 1; |
| 312 | *save++ = val; |
| 313 | |
| 314 | /* Read L2 AUX ctrl register */ |
| 315 | asm("mrc p15, 1, %0, c9, c0, 2" : "=r" (val)); |
| 316 | *save++ = 1; |
| 317 | *save++ = val; |
| 318 | } |
| 319 | |
Russell King | 29cb3cd | 2011-07-02 09:54:01 +0100 | [diff] [blame] | 320 | static int omap34xx_do_sram_idle(unsigned long save_state) |
Rajendra Nayak | 57f277b | 2008-09-26 17:49:34 +0530 | [diff] [blame] | 321 | { |
Russell King | cbe2634 | 2011-06-30 08:45:49 +0100 | [diff] [blame] | 322 | omap34xx_cpu_suspend(save_state); |
Russell King | 29cb3cd | 2011-07-02 09:54:01 +0100 | [diff] [blame] | 323 | return 0; |
Rajendra Nayak | 57f277b | 2008-09-26 17:49:34 +0530 | [diff] [blame] | 324 | } |
| 325 | |
Rajendra Nayak | 99e6a4d | 2008-10-08 17:30:58 +0530 | [diff] [blame] | 326 | void omap_sram_idle(void) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 327 | { |
| 328 | /* Variable to tell what needs to be saved and restored |
| 329 | * in omap_sram_idle*/ |
| 330 | /* save_state = 0 => Nothing to save and restored */ |
| 331 | /* save_state = 1 => Only L1 and logic lost */ |
| 332 | /* save_state = 2 => Only L2 lost */ |
| 333 | /* save_state = 3 => L1, L2 and logic lost */ |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 334 | int save_state = 0; |
| 335 | int mpu_next_state = PWRDM_POWER_ON; |
| 336 | int per_next_state = PWRDM_POWER_ON; |
| 337 | int core_next_state = PWRDM_POWER_ON; |
Paul Walmsley | 72e06d0 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 338 | int per_going_off; |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 339 | int core_prev_state, per_prev_state; |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 340 | u32 sdrc_pwr = 0; |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 341 | |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 342 | pwrdm_clear_all_prev_pwrst(mpu_pwrdm); |
| 343 | pwrdm_clear_all_prev_pwrst(neon_pwrdm); |
| 344 | pwrdm_clear_all_prev_pwrst(core_pwrdm); |
| 345 | pwrdm_clear_all_prev_pwrst(per_pwrdm); |
| 346 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 347 | mpu_next_state = pwrdm_read_next_pwrst(mpu_pwrdm); |
| 348 | switch (mpu_next_state) { |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 349 | case PWRDM_POWER_ON: |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 350 | case PWRDM_POWER_RET: |
| 351 | /* No need to save context */ |
| 352 | save_state = 0; |
| 353 | break; |
Rajendra Nayak | 61255ab | 2008-09-26 17:49:56 +0530 | [diff] [blame] | 354 | case PWRDM_POWER_OFF: |
| 355 | save_state = 3; |
| 356 | break; |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 357 | default: |
| 358 | /* Invalid state */ |
| 359 | printk(KERN_ERR "Invalid mpu state in sram_idle\n"); |
| 360 | return; |
| 361 | } |
Peter 'p2' De Schrijver | fe617af | 2008-10-15 17:48:44 +0300 | [diff] [blame] | 362 | |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 363 | /* NEON control */ |
| 364 | if (pwrdm_read_pwrst(neon_pwrdm) == PWRDM_POWER_ON) |
Jouni Hogander | 7139178 | 2008-10-28 10:59:05 +0200 | [diff] [blame] | 365 | pwrdm_set_next_pwrst(neon_pwrdm, mpu_next_state); |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 366 | |
Mike Chan | 40742fa | 2010-05-03 16:04:06 -0700 | [diff] [blame] | 367 | /* Enable IO-PAD and IO-CHAIN wakeups */ |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 368 | per_next_state = pwrdm_read_next_pwrst(per_pwrdm); |
Tero Kristo | ecf157d | 2008-12-01 13:17:29 +0200 | [diff] [blame] | 369 | core_next_state = pwrdm_read_next_pwrst(core_pwrdm); |
Kevin Hilman | d5c47d7 | 2010-08-10 16:04:35 -0700 | [diff] [blame] | 370 | if (omap3_has_io_wakeup() && |
| 371 | (per_next_state < PWRDM_POWER_ON || |
| 372 | core_next_state < PWRDM_POWER_ON)) { |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 373 | omap2_prm_set_mod_reg_bits(OMAP3430_EN_IO_MASK, WKUP_MOD, PM_WKEN); |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 374 | if (omap3_has_io_chain_ctrl()) |
| 375 | omap3_enable_io_chain(); |
Mike Chan | 40742fa | 2010-05-03 16:04:06 -0700 | [diff] [blame] | 376 | } |
| 377 | |
Paul Walmsley | 0d8e2d0 | 2010-11-24 16:49:05 -0700 | [diff] [blame] | 378 | /* Block console output in case it is on one of the OMAP UARTs */ |
Kevin Hilman | e83df17 | 2010-12-08 22:40:40 +0000 | [diff] [blame] | 379 | if (!is_suspending()) |
| 380 | if (per_next_state < PWRDM_POWER_ON || |
| 381 | core_next_state < PWRDM_POWER_ON) |
Torben Hohn | ac751ef | 2011-01-25 15:07:35 -0800 | [diff] [blame] | 382 | if (!console_trylock()) |
Kevin Hilman | e83df17 | 2010-12-08 22:40:40 +0000 | [diff] [blame] | 383 | goto console_still_active; |
Paul Walmsley | 0d8e2d0 | 2010-11-24 16:49:05 -0700 | [diff] [blame] | 384 | |
Charulatha V | ff2f8e5 | 2011-09-13 18:32:37 +0530 | [diff] [blame] | 385 | pwrdm_pre_transition(); |
| 386 | |
Mike Chan | 40742fa | 2010-05-03 16:04:06 -0700 | [diff] [blame] | 387 | /* PER */ |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 388 | if (per_next_state < PWRDM_POWER_ON) { |
Paul Walmsley | 72e06d0 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 389 | per_going_off = (per_next_state == PWRDM_POWER_OFF) ? 1 : 0; |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 390 | omap_uart_prepare_idle(2); |
Govindraj.R | cd4f1fa | 2010-09-27 20:20:32 +0530 | [diff] [blame] | 391 | omap_uart_prepare_idle(3); |
Paul Walmsley | 72e06d0 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 392 | omap2_gpio_prepare_for_idle(per_going_off); |
Kevin Hilman | e7410cf | 2010-09-08 16:37:42 -0700 | [diff] [blame] | 393 | if (per_next_state == PWRDM_POWER_OFF) |
Tero Kristo | ecf157d | 2008-12-01 13:17:29 +0200 | [diff] [blame] | 394 | omap3_per_save_context(); |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 395 | } |
| 396 | |
| 397 | /* CORE */ |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 398 | if (core_next_state < PWRDM_POWER_ON) { |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 399 | omap_uart_prepare_idle(0); |
| 400 | omap_uart_prepare_idle(1); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 401 | if (core_next_state == PWRDM_POWER_OFF) { |
| 402 | omap3_core_save_context(); |
Paul Walmsley | f0611a5 | 2010-12-21 15:30:56 -0700 | [diff] [blame] | 403 | omap3_cm_save_context(); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 404 | } |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 405 | } |
Mike Chan | 40742fa | 2010-05-03 16:04:06 -0700 | [diff] [blame] | 406 | |
Tero Kristo | f18cc2f | 2009-10-23 19:03:50 +0300 | [diff] [blame] | 407 | omap3_intc_prepare_idle(); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 408 | |
Rajendra Nayak | 61255ab | 2008-09-26 17:49:56 +0530 | [diff] [blame] | 409 | /* |
Paul Walmsley | 3047454 | 2011-10-06 13:43:23 -0600 | [diff] [blame] | 410 | * On EMU/HS devices ROM code restores a SRDC value |
| 411 | * from scratchpad which has automatic self refresh on timeout |
| 412 | * of AUTO_CNT = 1 enabled. This takes care of erratum ID i443. |
| 413 | * Hence store/restore the SDRC_POWER register here. |
| 414 | */ |
| 415 | if (cpu_is_omap3430() && omap_rev() >= OMAP3430_REV_ES3_0 && |
| 416 | (omap_type() == OMAP2_DEVICE_TYPE_EMU || |
| 417 | omap_type() == OMAP2_DEVICE_TYPE_SEC) && |
Rajendra Nayak | f265dc4 | 2009-06-09 22:30:41 +0530 | [diff] [blame] | 418 | core_next_state == PWRDM_POWER_OFF) |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 419 | sdrc_pwr = sdrc_read_reg(SDRC_POWER); |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 420 | |
| 421 | /* |
Russell King | 076f2cc | 2011-06-22 15:42:54 +0100 | [diff] [blame] | 422 | * omap3_arm_context is the location where some ARM context |
| 423 | * get saved. The rest is placed on the stack, and restored |
| 424 | * from there before resuming. |
Rajendra Nayak | 61255ab | 2008-09-26 17:49:56 +0530 | [diff] [blame] | 425 | */ |
Russell King | cbe2634 | 2011-06-30 08:45:49 +0100 | [diff] [blame] | 426 | if (save_state) |
| 427 | omap34xx_save_context(omap3_arm_context); |
Russell King | 076f2cc | 2011-06-22 15:42:54 +0100 | [diff] [blame] | 428 | if (save_state == 1 || save_state == 3) |
Russell King | 2c74a0c | 2011-06-22 17:41:48 +0100 | [diff] [blame] | 429 | cpu_suspend(save_state, omap34xx_do_sram_idle); |
Russell King | 076f2cc | 2011-06-22 15:42:54 +0100 | [diff] [blame] | 430 | else |
| 431 | omap34xx_do_sram_idle(save_state); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 432 | |
Rajendra Nayak | f265dc4 | 2009-06-09 22:30:41 +0530 | [diff] [blame] | 433 | /* Restore normal SDRC POWER settings */ |
Paul Walmsley | 3047454 | 2011-10-06 13:43:23 -0600 | [diff] [blame] | 434 | if (cpu_is_omap3430() && omap_rev() >= OMAP3430_REV_ES3_0 && |
| 435 | (omap_type() == OMAP2_DEVICE_TYPE_EMU || |
| 436 | omap_type() == OMAP2_DEVICE_TYPE_SEC) && |
Tero Kristo | 13a6fe0 | 2008-10-13 13:17:06 +0300 | [diff] [blame] | 437 | core_next_state == PWRDM_POWER_OFF) |
| 438 | sdrc_write_reg(sdrc_pwr, SDRC_POWER); |
| 439 | |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 440 | /* CORE */ |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 441 | if (core_next_state < PWRDM_POWER_ON) { |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 442 | core_prev_state = pwrdm_read_prev_pwrst(core_pwrdm); |
| 443 | if (core_prev_state == PWRDM_POWER_OFF) { |
| 444 | omap3_core_restore_context(); |
Paul Walmsley | f0611a5 | 2010-12-21 15:30:56 -0700 | [diff] [blame] | 445 | omap3_cm_restore_context(); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 446 | omap3_sram_restore_context(); |
Kalle Jokiniemi | 8a917d2 | 2009-05-13 13:32:11 +0300 | [diff] [blame] | 447 | omap2_sms_restore_context(); |
Rajendra Nayak | 2f5939c | 2008-09-26 17:50:07 +0530 | [diff] [blame] | 448 | } |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 449 | omap_uart_resume_idle(0); |
| 450 | omap_uart_resume_idle(1); |
| 451 | if (core_next_state == PWRDM_POWER_OFF) |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 452 | omap2_prm_clear_mod_reg_bits(OMAP3430_AUTO_OFF_MASK, |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 453 | OMAP3430_GR_MOD, |
| 454 | OMAP3_PRM_VOLTCTRL_OFFSET); |
| 455 | } |
Tero Kristo | f18cc2f | 2009-10-23 19:03:50 +0300 | [diff] [blame] | 456 | omap3_intc_resume_idle(); |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 457 | |
Charulatha V | ff2f8e5 | 2011-09-13 18:32:37 +0530 | [diff] [blame] | 458 | pwrdm_post_transition(); |
| 459 | |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 460 | /* PER */ |
| 461 | if (per_next_state < PWRDM_POWER_ON) { |
| 462 | per_prev_state = pwrdm_read_prev_pwrst(per_pwrdm); |
Kevin Hilman | 43ffcd9 | 2009-01-27 11:09:24 -0800 | [diff] [blame] | 463 | omap2_gpio_resume_after_idle(); |
| 464 | if (per_prev_state == PWRDM_POWER_OFF) |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 465 | omap3_per_restore_context(); |
Tero Kristo | ecf157d | 2008-12-01 13:17:29 +0200 | [diff] [blame] | 466 | omap_uart_resume_idle(2); |
Govindraj.R | cd4f1fa | 2010-09-27 20:20:32 +0530 | [diff] [blame] | 467 | omap_uart_resume_idle(3); |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 468 | } |
Peter 'p2' De Schrijver | fe617af | 2008-10-15 17:48:44 +0300 | [diff] [blame] | 469 | |
Kevin Hilman | e83df17 | 2010-12-08 22:40:40 +0000 | [diff] [blame] | 470 | if (!is_suspending()) |
Torben Hohn | ac751ef | 2011-01-25 15:07:35 -0800 | [diff] [blame] | 471 | console_unlock(); |
Paul Walmsley | 0d8e2d0 | 2010-11-24 16:49:05 -0700 | [diff] [blame] | 472 | |
| 473 | console_still_active: |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 474 | /* Disable IO-PAD and IO-CHAIN wakeup */ |
Kevin Hilman | 58a5559 | 2010-08-16 09:21:19 +0300 | [diff] [blame] | 475 | if (omap3_has_io_wakeup() && |
| 476 | (per_next_state < PWRDM_POWER_ON || |
| 477 | core_next_state < PWRDM_POWER_ON)) { |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 478 | omap2_prm_clear_mod_reg_bits(OMAP3430_EN_IO_MASK, WKUP_MOD, |
| 479 | PM_WKEN); |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 480 | if (omap3_has_io_chain_ctrl()) |
| 481 | omap3_disable_io_chain(); |
Kalle Jokiniemi | 3a7ec26 | 2009-03-26 15:59:01 +0200 | [diff] [blame] | 482 | } |
Kevin Hilman | 658ce97 | 2008-11-04 20:50:52 -0800 | [diff] [blame] | 483 | |
Rajendra Nayak | 5cd1937 | 2011-02-25 16:06:48 -0700 | [diff] [blame] | 484 | clkdm_allow_idle(mpu_pwrdm->pwrdm_clkdms[0]); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 485 | } |
| 486 | |
Rajendra Nayak | 20b0166 | 2008-10-08 17:31:22 +0530 | [diff] [blame] | 487 | int omap3_can_sleep(void) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 488 | { |
Kevin Hilman | 4af4016 | 2009-02-04 10:51:40 -0800 | [diff] [blame] | 489 | if (!omap_uart_can_sleep()) |
| 490 | return 0; |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 491 | return 1; |
| 492 | } |
| 493 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 494 | static void omap3_pm_idle(void) |
| 495 | { |
| 496 | local_irq_disable(); |
| 497 | local_fiq_disable(); |
| 498 | |
| 499 | if (!omap3_can_sleep()) |
| 500 | goto out; |
| 501 | |
Tero Kristo | cf22854 | 2009-03-20 15:21:02 +0200 | [diff] [blame] | 502 | if (omap_irq_pending() || need_resched()) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 503 | goto out; |
| 504 | |
Jean Pihet | 5e7c58d | 2011-03-03 11:25:43 +0100 | [diff] [blame] | 505 | trace_power_start(POWER_CSTATE, 1, smp_processor_id()); |
| 506 | trace_cpu_idle(1, smp_processor_id()); |
| 507 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 508 | omap_sram_idle(); |
| 509 | |
Jean Pihet | 5e7c58d | 2011-03-03 11:25:43 +0100 | [diff] [blame] | 510 | trace_power_end(smp_processor_id()); |
| 511 | trace_cpu_idle(PWR_EVENT_EXIT, smp_processor_id()); |
| 512 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 513 | out: |
| 514 | local_fiq_enable(); |
| 515 | local_irq_enable(); |
| 516 | } |
| 517 | |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 518 | #ifdef CONFIG_SUSPEND |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 519 | static int omap3_pm_suspend(void) |
| 520 | { |
| 521 | struct power_state *pwrst; |
| 522 | int state, ret = 0; |
| 523 | |
| 524 | /* Read current next_pwrsts */ |
| 525 | list_for_each_entry(pwrst, &pwrst_list, node) |
| 526 | pwrst->saved_state = pwrdm_read_next_pwrst(pwrst->pwrdm); |
| 527 | /* Set ones wanted by suspend */ |
| 528 | list_for_each_entry(pwrst, &pwrst_list, node) { |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 529 | if (omap_set_pwrdm_state(pwrst->pwrdm, pwrst->next_state)) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 530 | goto restore; |
| 531 | if (pwrdm_clear_all_prev_pwrst(pwrst->pwrdm)) |
| 532 | goto restore; |
| 533 | } |
| 534 | |
Kevin Hilman | 4af4016 | 2009-02-04 10:51:40 -0800 | [diff] [blame] | 535 | omap_uart_prepare_suspend(); |
Tero Kristo | 2bbe3af | 2009-10-23 19:03:48 +0300 | [diff] [blame] | 536 | omap3_intc_suspend(); |
| 537 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 538 | omap_sram_idle(); |
| 539 | |
| 540 | restore: |
| 541 | /* Restore next_pwrsts */ |
| 542 | list_for_each_entry(pwrst, &pwrst_list, node) { |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 543 | state = pwrdm_read_prev_pwrst(pwrst->pwrdm); |
| 544 | if (state > pwrst->next_state) { |
| 545 | printk(KERN_INFO "Powerdomain (%s) didn't enter " |
| 546 | "target state %d\n", |
| 547 | pwrst->pwrdm->name, pwrst->next_state); |
| 548 | ret = -1; |
| 549 | } |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 550 | omap_set_pwrdm_state(pwrst->pwrdm, pwrst->saved_state); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 551 | } |
| 552 | if (ret) |
| 553 | printk(KERN_ERR "Could not enter target state in pm_suspend\n"); |
| 554 | else |
| 555 | printk(KERN_INFO "Successfully put all powerdomains " |
| 556 | "to target state\n"); |
| 557 | |
| 558 | return ret; |
| 559 | } |
| 560 | |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 561 | static int omap3_pm_enter(suspend_state_t unused) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 562 | { |
| 563 | int ret = 0; |
| 564 | |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 565 | switch (suspend_state) { |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 566 | case PM_SUSPEND_STANDBY: |
| 567 | case PM_SUSPEND_MEM: |
| 568 | ret = omap3_pm_suspend(); |
| 569 | break; |
| 570 | default: |
| 571 | ret = -EINVAL; |
| 572 | } |
| 573 | |
| 574 | return ret; |
| 575 | } |
| 576 | |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 577 | /* Hooks to enable / disable UART interrupts during suspend */ |
| 578 | static int omap3_pm_begin(suspend_state_t state) |
| 579 | { |
Jean Pihet | c166381 | 2010-12-09 18:39:58 +0100 | [diff] [blame] | 580 | disable_hlt(); |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 581 | suspend_state = state; |
| 582 | omap_uart_enable_irqs(0); |
| 583 | return 0; |
| 584 | } |
| 585 | |
| 586 | static void omap3_pm_end(void) |
| 587 | { |
| 588 | suspend_state = PM_SUSPEND_ON; |
| 589 | omap_uart_enable_irqs(1); |
Jean Pihet | c166381 | 2010-12-09 18:39:58 +0100 | [diff] [blame] | 590 | enable_hlt(); |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 591 | return; |
| 592 | } |
| 593 | |
Lionel Debroux | 2f55ac0 | 2010-11-16 14:14:02 +0100 | [diff] [blame] | 594 | static const struct platform_suspend_ops omap_pm_ops = { |
Tero Kristo | 2466211 | 2009-03-05 16:32:23 +0200 | [diff] [blame] | 595 | .begin = omap3_pm_begin, |
| 596 | .end = omap3_pm_end, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 597 | .enter = omap3_pm_enter, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 598 | .valid = suspend_valid_only_mem, |
| 599 | }; |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 600 | #endif /* CONFIG_SUSPEND */ |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 601 | |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 602 | |
| 603 | /** |
| 604 | * omap3_iva_idle(): ensure IVA is in idle so it can be put into |
| 605 | * retention |
| 606 | * |
| 607 | * In cases where IVA2 is activated by bootcode, it may prevent |
| 608 | * full-chip retention or off-mode because it is not idle. This |
| 609 | * function forces the IVA2 into idle state so it can go |
| 610 | * into retention/off and thus allow full-chip retention/off. |
| 611 | * |
| 612 | **/ |
| 613 | static void __init omap3_iva_idle(void) |
| 614 | { |
| 615 | /* ensure IVA2 clock is disabled */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 616 | omap2_cm_write_mod_reg(0, OMAP3430_IVA2_MOD, CM_FCLKEN); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 617 | |
| 618 | /* if no clock activity, nothing else to do */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 619 | if (!(omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP3430_CM_CLKSTST) & |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 620 | OMAP3430_CLKACTIVITY_IVA2_MASK)) |
| 621 | return; |
| 622 | |
| 623 | /* Reset IVA2 */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 624 | omap2_prm_write_mod_reg(OMAP3430_RST1_IVA2_MASK | |
Paul Walmsley | 2bc4ef7 | 2010-05-18 18:47:24 -0600 | [diff] [blame] | 625 | OMAP3430_RST2_IVA2_MASK | |
| 626 | OMAP3430_RST3_IVA2_MASK, |
Abhijit Pagare | 3790300 | 2010-01-26 20:12:51 -0700 | [diff] [blame] | 627 | OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 628 | |
| 629 | /* Enable IVA2 clock */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 630 | omap2_cm_write_mod_reg(OMAP3430_CM_FCLKEN_IVA2_EN_IVA2_MASK, |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 631 | OMAP3430_IVA2_MOD, CM_FCLKEN); |
| 632 | |
| 633 | /* Set IVA2 boot mode to 'idle' */ |
| 634 | omap_ctrl_writel(OMAP3_IVA2_BOOTMOD_IDLE, |
| 635 | OMAP343X_CONTROL_IVA2_BOOTMOD); |
| 636 | |
| 637 | /* Un-reset IVA2 */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 638 | omap2_prm_write_mod_reg(0, OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 639 | |
| 640 | /* Disable IVA2 clock */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 641 | omap2_cm_write_mod_reg(0, OMAP3430_IVA2_MOD, CM_FCLKEN); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 642 | |
| 643 | /* Reset IVA2 */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 644 | omap2_prm_write_mod_reg(OMAP3430_RST1_IVA2_MASK | |
Paul Walmsley | 2bc4ef7 | 2010-05-18 18:47:24 -0600 | [diff] [blame] | 645 | OMAP3430_RST2_IVA2_MASK | |
| 646 | OMAP3430_RST3_IVA2_MASK, |
Abhijit Pagare | 3790300 | 2010-01-26 20:12:51 -0700 | [diff] [blame] | 647 | OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 648 | } |
| 649 | |
Kevin Hilman | 8111b22 | 2009-04-28 15:27:44 -0700 | [diff] [blame] | 650 | static void __init omap3_d2d_idle(void) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 651 | { |
Kevin Hilman | 8111b22 | 2009-04-28 15:27:44 -0700 | [diff] [blame] | 652 | u16 mask, padconf; |
| 653 | |
| 654 | /* In a stand alone OMAP3430 where there is not a stacked |
| 655 | * modem for the D2D Idle Ack and D2D MStandby must be pulled |
| 656 | * high. S CONTROL_PADCONF_SAD2D_IDLEACK and |
| 657 | * CONTROL_PADCONF_SAD2D_MSTDBY to have a pull up. */ |
| 658 | mask = (1 << 4) | (1 << 3); /* pull-up, enabled */ |
| 659 | padconf = omap_ctrl_readw(OMAP3_PADCONF_SAD2D_MSTANDBY); |
| 660 | padconf |= mask; |
| 661 | omap_ctrl_writew(padconf, OMAP3_PADCONF_SAD2D_MSTANDBY); |
| 662 | |
| 663 | padconf = omap_ctrl_readw(OMAP3_PADCONF_SAD2D_IDLEACK); |
| 664 | padconf |= mask; |
| 665 | omap_ctrl_writew(padconf, OMAP3_PADCONF_SAD2D_IDLEACK); |
| 666 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 667 | /* reset modem */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 668 | omap2_prm_write_mod_reg(OMAP3430_RM_RSTCTRL_CORE_MODEM_SW_RSTPWRON_MASK | |
Paul Walmsley | 2bc4ef7 | 2010-05-18 18:47:24 -0600 | [diff] [blame] | 669 | OMAP3430_RM_RSTCTRL_CORE_MODEM_SW_RST_MASK, |
Abhijit Pagare | 3790300 | 2010-01-26 20:12:51 -0700 | [diff] [blame] | 670 | CORE_MOD, OMAP2_RM_RSTCTRL); |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 671 | omap2_prm_write_mod_reg(0, CORE_MOD, OMAP2_RM_RSTCTRL); |
Kevin Hilman | 8111b22 | 2009-04-28 15:27:44 -0700 | [diff] [blame] | 672 | } |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 673 | |
Kevin Hilman | 8111b22 | 2009-04-28 15:27:44 -0700 | [diff] [blame] | 674 | static void __init prcm_setup_regs(void) |
| 675 | { |
Govindraj.R | e586368 | 2010-09-27 20:20:25 +0530 | [diff] [blame] | 676 | u32 omap3630_en_uart4_mask = cpu_is_omap3630() ? |
| 677 | OMAP3630_EN_UART4_MASK : 0; |
| 678 | u32 omap3630_grpsel_uart4_mask = cpu_is_omap3630() ? |
| 679 | OMAP3630_GRPSEL_UART4_MASK : 0; |
| 680 | |
Paul Walmsley | 4ef70c0 | 2011-02-25 15:39:30 -0700 | [diff] [blame] | 681 | /* XXX This should be handled by hwmod code or SCM init code */ |
Paul Walmsley | 2fd0f75 | 2010-05-18 18:40:23 -0600 | [diff] [blame] | 682 | omap_ctrl_writel(OMAP3430_AUTOIDLE_MASK, OMAP2_CONTROL_SYSCONFIG); |
Tero Kristo | b296c81 | 2009-10-23 19:03:49 +0300 | [diff] [blame] | 683 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 684 | /* |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 685 | * Enable control of expternal oscillator through |
| 686 | * sys_clkreq. In the long run clock framework should |
| 687 | * take care of this. |
| 688 | */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 689 | omap2_prm_rmw_mod_reg_bits(OMAP_AUTOEXTCLKMODE_MASK, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 690 | 1 << OMAP_AUTOEXTCLKMODE_SHIFT, |
| 691 | OMAP3430_GR_MOD, |
| 692 | OMAP3_PRM_CLKSRC_CTRL_OFFSET); |
| 693 | |
| 694 | /* setup wakup source */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 695 | omap2_prm_write_mod_reg(OMAP3430_EN_IO_MASK | OMAP3430_EN_GPIO1_MASK | |
Paul Walmsley | 2fd0f75 | 2010-05-18 18:40:23 -0600 | [diff] [blame] | 696 | OMAP3430_EN_GPT1_MASK | OMAP3430_EN_GPT12_MASK, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 697 | WKUP_MOD, PM_WKEN); |
| 698 | /* No need to write EN_IO, that is always enabled */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 699 | omap2_prm_write_mod_reg(OMAP3430_GRPSEL_GPIO1_MASK | |
Paul Walmsley | 275f675 | 2010-05-18 18:40:23 -0600 | [diff] [blame] | 700 | OMAP3430_GRPSEL_GPT1_MASK | |
| 701 | OMAP3430_GRPSEL_GPT12_MASK, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 702 | WKUP_MOD, OMAP3430_PM_MPUGRPSEL); |
| 703 | /* For some reason IO doesn't generate wakeup event even if |
| 704 | * it is selected to mpu wakeup goup */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 705 | omap2_prm_write_mod_reg(OMAP3430_IO_EN_MASK | OMAP3430_WKUP_EN_MASK, |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 706 | OCP_MOD, OMAP3_PRM_IRQENABLE_MPU_OFFSET); |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 707 | |
Subramani Venkatesh | b92c572 | 2009-12-22 15:07:50 +0530 | [diff] [blame] | 708 | /* Enable PM_WKEN to support DSS LPR */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 709 | omap2_prm_write_mod_reg(OMAP3430_PM_WKEN_DSS_EN_DSS_MASK, |
Subramani Venkatesh | b92c572 | 2009-12-22 15:07:50 +0530 | [diff] [blame] | 710 | OMAP3430_DSS_MOD, PM_WKEN); |
| 711 | |
Kevin Hilman | b427f92 | 2009-10-22 14:48:13 -0700 | [diff] [blame] | 712 | /* Enable wakeups in PER */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 713 | omap2_prm_write_mod_reg(omap3630_en_uart4_mask | |
Govindraj.R | e586368 | 2010-09-27 20:20:25 +0530 | [diff] [blame] | 714 | OMAP3430_EN_GPIO2_MASK | OMAP3430_EN_GPIO3_MASK | |
Paul Walmsley | 2fd0f75 | 2010-05-18 18:40:23 -0600 | [diff] [blame] | 715 | OMAP3430_EN_GPIO4_MASK | OMAP3430_EN_GPIO5_MASK | |
| 716 | OMAP3430_EN_GPIO6_MASK | OMAP3430_EN_UART3_MASK | |
| 717 | OMAP3430_EN_MCBSP2_MASK | OMAP3430_EN_MCBSP3_MASK | |
| 718 | OMAP3430_EN_MCBSP4_MASK, |
Kevin Hilman | b427f92 | 2009-10-22 14:48:13 -0700 | [diff] [blame] | 719 | OMAP3430_PER_MOD, PM_WKEN); |
Kevin Hilman | eb350f7 | 2009-09-10 15:53:08 +0000 | [diff] [blame] | 720 | /* and allow them to wake up MPU */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 721 | omap2_prm_write_mod_reg(omap3630_grpsel_uart4_mask | |
Govindraj.R | e586368 | 2010-09-27 20:20:25 +0530 | [diff] [blame] | 722 | OMAP3430_GRPSEL_GPIO2_MASK | |
Paul Walmsley | 275f675 | 2010-05-18 18:40:23 -0600 | [diff] [blame] | 723 | OMAP3430_GRPSEL_GPIO3_MASK | |
| 724 | OMAP3430_GRPSEL_GPIO4_MASK | |
| 725 | OMAP3430_GRPSEL_GPIO5_MASK | |
| 726 | OMAP3430_GRPSEL_GPIO6_MASK | |
| 727 | OMAP3430_GRPSEL_UART3_MASK | |
| 728 | OMAP3430_GRPSEL_MCBSP2_MASK | |
| 729 | OMAP3430_GRPSEL_MCBSP3_MASK | |
| 730 | OMAP3430_GRPSEL_MCBSP4_MASK, |
Kevin Hilman | eb350f7 | 2009-09-10 15:53:08 +0000 | [diff] [blame] | 731 | OMAP3430_PER_MOD, OMAP3430_PM_MPUGRPSEL); |
| 732 | |
Kevin Hilman | d3fd329 | 2009-05-05 16:34:25 -0700 | [diff] [blame] | 733 | /* Don't attach IVA interrupts */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 734 | omap2_prm_write_mod_reg(0, WKUP_MOD, OMAP3430_PM_IVAGRPSEL); |
| 735 | omap2_prm_write_mod_reg(0, CORE_MOD, OMAP3430_PM_IVAGRPSEL1); |
| 736 | omap2_prm_write_mod_reg(0, CORE_MOD, OMAP3430ES2_PM_IVAGRPSEL3); |
| 737 | omap2_prm_write_mod_reg(0, OMAP3430_PER_MOD, OMAP3430_PM_IVAGRPSEL); |
Kevin Hilman | d3fd329 | 2009-05-05 16:34:25 -0700 | [diff] [blame] | 738 | |
Kevin Hilman | b1340d1 | 2009-04-27 16:14:54 -0700 | [diff] [blame] | 739 | /* Clear any pending 'reset' flags */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 740 | omap2_prm_write_mod_reg(0xffffffff, MPU_MOD, OMAP2_RM_RSTST); |
| 741 | omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP2_RM_RSTST); |
| 742 | omap2_prm_write_mod_reg(0xffffffff, OMAP3430_PER_MOD, OMAP2_RM_RSTST); |
| 743 | omap2_prm_write_mod_reg(0xffffffff, OMAP3430_EMU_MOD, OMAP2_RM_RSTST); |
| 744 | omap2_prm_write_mod_reg(0xffffffff, OMAP3430_NEON_MOD, OMAP2_RM_RSTST); |
| 745 | omap2_prm_write_mod_reg(0xffffffff, OMAP3430_DSS_MOD, OMAP2_RM_RSTST); |
| 746 | omap2_prm_write_mod_reg(0xffffffff, OMAP3430ES2_USBHOST_MOD, OMAP2_RM_RSTST); |
Kevin Hilman | b1340d1 | 2009-04-27 16:14:54 -0700 | [diff] [blame] | 747 | |
Kevin Hilman | 014c46d | 2009-04-27 07:50:23 -0700 | [diff] [blame] | 748 | /* Clear any pending PRCM interrupts */ |
Paul Walmsley | c4d7e58 | 2010-12-21 21:05:14 -0700 | [diff] [blame] | 749 | omap2_prm_write_mod_reg(0, OCP_MOD, OMAP3_PRM_IRQSTATUS_MPU_OFFSET); |
Kevin Hilman | 014c46d | 2009-04-27 07:50:23 -0700 | [diff] [blame] | 750 | |
Kevin Hilman | 1155e42 | 2008-11-25 11:48:24 -0800 | [diff] [blame] | 751 | omap3_iva_idle(); |
Kevin Hilman | 8111b22 | 2009-04-28 15:27:44 -0700 | [diff] [blame] | 752 | omap3_d2d_idle(); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 753 | } |
| 754 | |
Kevin Hilman | c40552b | 2009-10-06 14:25:09 -0700 | [diff] [blame] | 755 | void omap3_pm_off_mode_enable(int enable) |
| 756 | { |
| 757 | struct power_state *pwrst; |
| 758 | u32 state; |
| 759 | |
| 760 | if (enable) |
| 761 | state = PWRDM_POWER_OFF; |
| 762 | else |
| 763 | state = PWRDM_POWER_RET; |
| 764 | |
| 765 | list_for_each_entry(pwrst, &pwrst_list, node) { |
Eduardo Valentin | cc1b602 | 2010-12-20 14:05:09 -0600 | [diff] [blame] | 766 | if (IS_PM34XX_ERRATUM(PM_SDRC_WAKEUP_ERRATUM_i583) && |
| 767 | pwrst->pwrdm == core_pwrdm && |
| 768 | state == PWRDM_POWER_OFF) { |
| 769 | pwrst->next_state = PWRDM_POWER_RET; |
Ricardo Salveti de Araujo | e16b41b | 2011-01-31 11:35:25 -0200 | [diff] [blame] | 770 | pr_warn("%s: Core OFF disabled due to errata i583\n", |
Eduardo Valentin | cc1b602 | 2010-12-20 14:05:09 -0600 | [diff] [blame] | 771 | __func__); |
| 772 | } else { |
| 773 | pwrst->next_state = state; |
| 774 | } |
| 775 | omap_set_pwrdm_state(pwrst->pwrdm, pwrst->next_state); |
Kevin Hilman | c40552b | 2009-10-06 14:25:09 -0700 | [diff] [blame] | 776 | } |
| 777 | } |
| 778 | |
Tero Kristo | 68d4778 | 2008-11-26 12:26:24 +0200 | [diff] [blame] | 779 | int omap3_pm_get_suspend_state(struct powerdomain *pwrdm) |
| 780 | { |
| 781 | struct power_state *pwrst; |
| 782 | |
| 783 | list_for_each_entry(pwrst, &pwrst_list, node) { |
| 784 | if (pwrst->pwrdm == pwrdm) |
| 785 | return pwrst->next_state; |
| 786 | } |
| 787 | return -EINVAL; |
| 788 | } |
| 789 | |
| 790 | int omap3_pm_set_suspend_state(struct powerdomain *pwrdm, int state) |
| 791 | { |
| 792 | struct power_state *pwrst; |
| 793 | |
| 794 | list_for_each_entry(pwrst, &pwrst_list, node) { |
| 795 | if (pwrst->pwrdm == pwrdm) { |
| 796 | pwrst->next_state = state; |
| 797 | return 0; |
| 798 | } |
| 799 | } |
| 800 | return -EINVAL; |
| 801 | } |
| 802 | |
Peter 'p2' De Schrijver | a23456e | 2008-10-15 18:13:47 +0300 | [diff] [blame] | 803 | static int __init pwrdms_setup(struct powerdomain *pwrdm, void *unused) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 804 | { |
| 805 | struct power_state *pwrst; |
| 806 | |
| 807 | if (!pwrdm->pwrsts) |
| 808 | return 0; |
| 809 | |
Ming Lei | d3d381c | 2009-08-22 21:20:26 +0800 | [diff] [blame] | 810 | pwrst = kmalloc(sizeof(struct power_state), GFP_ATOMIC); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 811 | if (!pwrst) |
| 812 | return -ENOMEM; |
| 813 | pwrst->pwrdm = pwrdm; |
| 814 | pwrst->next_state = PWRDM_POWER_RET; |
| 815 | list_add(&pwrst->node, &pwrst_list); |
| 816 | |
| 817 | if (pwrdm_has_hdwr_sar(pwrdm)) |
| 818 | pwrdm_enable_hdwr_sar(pwrdm); |
| 819 | |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 820 | return omap_set_pwrdm_state(pwrst->pwrdm, pwrst->next_state); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 821 | } |
| 822 | |
| 823 | /* |
| 824 | * Enable hw supervised mode for all clockdomains if it's |
| 825 | * supported. Initiate sleep transition for other clockdomains, if |
| 826 | * they are not used |
| 827 | */ |
Peter 'p2' De Schrijver | a23456e | 2008-10-15 18:13:47 +0300 | [diff] [blame] | 828 | static int __init clkdms_setup(struct clockdomain *clkdm, void *unused) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 829 | { |
| 830 | if (clkdm->flags & CLKDM_CAN_ENABLE_AUTO) |
Rajendra Nayak | 5cd1937 | 2011-02-25 16:06:48 -0700 | [diff] [blame] | 831 | clkdm_allow_idle(clkdm); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 832 | else if (clkdm->flags & CLKDM_CAN_FORCE_SLEEP && |
| 833 | atomic_read(&clkdm->usecount) == 0) |
Rajendra Nayak | 68b921a | 2011-02-25 16:06:47 -0700 | [diff] [blame] | 834 | clkdm_sleep(clkdm); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 835 | return 0; |
| 836 | } |
| 837 | |
Jean Pihet | 46e130d | 2011-06-29 18:40:23 +0200 | [diff] [blame] | 838 | /* |
| 839 | * Push functions to SRAM |
| 840 | * |
| 841 | * The minimum set of functions is pushed to SRAM for execution: |
| 842 | * - omap3_do_wfi for erratum i581 WA, |
| 843 | * - save_secure_ram_context for security extensions. |
| 844 | */ |
Rajendra Nayak | 3231fc8 | 2008-09-26 17:49:14 +0530 | [diff] [blame] | 845 | void omap_push_sram_idle(void) |
| 846 | { |
Jean Pihet | 46e130d | 2011-06-29 18:40:23 +0200 | [diff] [blame] | 847 | omap3_do_wfi_sram = omap_sram_push(omap3_do_wfi, omap3_do_wfi_sz); |
| 848 | |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 849 | if (omap_type() != OMAP2_DEVICE_TYPE_GP) |
| 850 | _omap_save_secure_sram = omap_sram_push(save_secure_ram_context, |
| 851 | save_secure_ram_context_sz); |
Rajendra Nayak | 3231fc8 | 2008-09-26 17:49:14 +0530 | [diff] [blame] | 852 | } |
| 853 | |
Nishanth Menon | 8cdfd83 | 2010-12-20 14:05:05 -0600 | [diff] [blame] | 854 | static void __init pm_errata_configure(void) |
| 855 | { |
Peter 'p2' De Schrijver | c4236d2 | 2010-12-20 14:05:07 -0600 | [diff] [blame] | 856 | if (cpu_is_omap3630()) { |
Nishanth Menon | 458e999 | 2010-12-20 14:05:06 -0600 | [diff] [blame] | 857 | pm34xx_errata |= PM_RTA_ERRATUM_i608; |
Peter 'p2' De Schrijver | c4236d2 | 2010-12-20 14:05:07 -0600 | [diff] [blame] | 858 | /* Enable the l2 cache toggling in sleep logic */ |
| 859 | enable_omap3630_toggle_l2_on_restore(); |
Eduardo Valentin | cc1b602 | 2010-12-20 14:05:09 -0600 | [diff] [blame] | 860 | if (omap_rev() < OMAP3630_REV_ES1_2) |
| 861 | pm34xx_errata |= PM_SDRC_WAKEUP_ERRATUM_i583; |
Peter 'p2' De Schrijver | c4236d2 | 2010-12-20 14:05:07 -0600 | [diff] [blame] | 862 | } |
Nishanth Menon | 8cdfd83 | 2010-12-20 14:05:05 -0600 | [diff] [blame] | 863 | } |
| 864 | |
Kevin Hilman | 7cc515f | 2009-06-10 09:02:25 -0700 | [diff] [blame] | 865 | static int __init omap3_pm_init(void) |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 866 | { |
| 867 | struct power_state *pwrst, *tmp; |
Paul Walmsley | 55ed969 | 2010-01-26 20:12:59 -0700 | [diff] [blame] | 868 | struct clockdomain *neon_clkdm, *per_clkdm, *mpu_clkdm, *core_clkdm; |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 869 | int ret; |
| 870 | |
| 871 | if (!cpu_is_omap34xx()) |
| 872 | return -ENODEV; |
| 873 | |
Paul Walmsley | b02b917 | 2011-10-06 17:18:45 -0600 | [diff] [blame] | 874 | if (!omap3_has_io_chain_ctrl()) |
| 875 | pr_warning("PM: no software I/O chain control; some wakeups may be lost\n"); |
| 876 | |
Nishanth Menon | 8cdfd83 | 2010-12-20 14:05:05 -0600 | [diff] [blame] | 877 | pm_errata_configure(); |
| 878 | |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 879 | /* XXX prcm_setup_regs needs to be before enabling hw |
| 880 | * supervised mode for powerdomains */ |
| 881 | prcm_setup_regs(); |
| 882 | |
| 883 | ret = request_irq(INT_34XX_PRCM_MPU_IRQ, |
| 884 | (irq_handler_t)prcm_interrupt_handler, |
| 885 | IRQF_DISABLED, "prcm", NULL); |
| 886 | if (ret) { |
| 887 | printk(KERN_ERR "request_irq failed to register for 0x%x\n", |
| 888 | INT_34XX_PRCM_MPU_IRQ); |
| 889 | goto err1; |
| 890 | } |
| 891 | |
Peter 'p2' De Schrijver | a23456e | 2008-10-15 18:13:47 +0300 | [diff] [blame] | 892 | ret = pwrdm_for_each(pwrdms_setup, NULL); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 893 | if (ret) { |
| 894 | printk(KERN_ERR "Failed to setup powerdomains\n"); |
| 895 | goto err2; |
| 896 | } |
| 897 | |
Peter 'p2' De Schrijver | a23456e | 2008-10-15 18:13:47 +0300 | [diff] [blame] | 898 | (void) clkdm_for_each(clkdms_setup, NULL); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 899 | |
| 900 | mpu_pwrdm = pwrdm_lookup("mpu_pwrdm"); |
| 901 | if (mpu_pwrdm == NULL) { |
| 902 | printk(KERN_ERR "Failed to get mpu_pwrdm\n"); |
| 903 | goto err2; |
| 904 | } |
| 905 | |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 906 | neon_pwrdm = pwrdm_lookup("neon_pwrdm"); |
| 907 | per_pwrdm = pwrdm_lookup("per_pwrdm"); |
| 908 | core_pwrdm = pwrdm_lookup("core_pwrdm"); |
Tero Kristo | c16c3f6 | 2008-12-11 16:46:57 +0200 | [diff] [blame] | 909 | cam_pwrdm = pwrdm_lookup("cam_pwrdm"); |
Rajendra Nayak | fa3c2a4 | 2008-09-26 17:49:22 +0530 | [diff] [blame] | 910 | |
Paul Walmsley | 55ed969 | 2010-01-26 20:12:59 -0700 | [diff] [blame] | 911 | neon_clkdm = clkdm_lookup("neon_clkdm"); |
| 912 | mpu_clkdm = clkdm_lookup("mpu_clkdm"); |
| 913 | per_clkdm = clkdm_lookup("per_clkdm"); |
| 914 | core_clkdm = clkdm_lookup("core_clkdm"); |
| 915 | |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 916 | #ifdef CONFIG_SUSPEND |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 917 | suspend_set_ops(&omap_pm_ops); |
Kevin Hilman | 10f90ed | 2009-06-24 11:39:18 -0700 | [diff] [blame] | 918 | #endif /* CONFIG_SUSPEND */ |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 919 | |
| 920 | pm_idle = omap3_pm_idle; |
Kalle Jokiniemi | 0343371 | 2008-09-26 11:04:20 +0300 | [diff] [blame] | 921 | omap3_idle_init(); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 922 | |
Nishanth Menon | 458e999 | 2010-12-20 14:05:06 -0600 | [diff] [blame] | 923 | /* |
| 924 | * RTA is disabled during initialization as per erratum i608 |
| 925 | * it is safer to disable RTA by the bootloader, but we would like |
| 926 | * to be doubly sure here and prevent any mishaps. |
| 927 | */ |
| 928 | if (IS_PM34XX_ERRATUM(PM_RTA_ERRATUM_i608)) |
| 929 | omap3630_ctrl_disable_rta(); |
| 930 | |
Paul Walmsley | 55ed969 | 2010-01-26 20:12:59 -0700 | [diff] [blame] | 931 | clkdm_add_wkdep(neon_clkdm, mpu_clkdm); |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 932 | if (omap_type() != OMAP2_DEVICE_TYPE_GP) { |
| 933 | omap3_secure_ram_storage = |
| 934 | kmalloc(0x803F, GFP_KERNEL); |
| 935 | if (!omap3_secure_ram_storage) |
| 936 | printk(KERN_ERR "Memory allocation failed when" |
| 937 | "allocating for secure sram context\n"); |
Tero Kristo | 27d59a4 | 2008-10-13 13:15:00 +0300 | [diff] [blame] | 938 | |
Tero Kristo | 9d97140 | 2008-12-12 11:20:05 +0200 | [diff] [blame] | 939 | local_irq_disable(); |
| 940 | local_fiq_disable(); |
| 941 | |
| 942 | omap_dma_global_context_save(); |
Kevin Hilman | 617fcc9 | 2011-01-25 16:40:01 -0800 | [diff] [blame] | 943 | omap3_save_secure_ram_context(); |
Tero Kristo | 9d97140 | 2008-12-12 11:20:05 +0200 | [diff] [blame] | 944 | omap_dma_global_context_restore(); |
| 945 | |
| 946 | local_irq_enable(); |
| 947 | local_fiq_enable(); |
| 948 | } |
| 949 | |
| 950 | omap3_save_scratchpad_contents(); |
Kevin Hilman | 8bd2294 | 2009-05-28 10:56:16 -0700 | [diff] [blame] | 951 | err1: |
| 952 | return ret; |
| 953 | err2: |
| 954 | free_irq(INT_34XX_PRCM_MPU_IRQ, NULL); |
| 955 | list_for_each_entry_safe(pwrst, tmp, &pwrst_list, node) { |
| 956 | list_del(&pwrst->node); |
| 957 | kfree(pwrst); |
| 958 | } |
| 959 | return ret; |
| 960 | } |
| 961 | |
| 962 | late_initcall(omap3_pm_init); |