projects / linux-2.6-block.git / blame
| Commit | Line | Data |
|---|---|---|
| 0adf882b DN |
1 | /* |
| 2 | * Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved. | |
| 3 | */ | |
| 4 | ||
| 5 | /* | |
| 6 | * The code contained herein is licensed under the GNU General Public | |
| 7 | * License. You may obtain a copy of the GNU General Public License | |
| 8 | * Version 2 or later at the following locations: | |
| 9 | * | |
| 10 | * http://www.opensource.org/licenses/gpl-license.html | |
| 11 | * http://www.gnu.org/copyleft/gpl.html | |
| 12 | */ | |
| 13 | #include <linux/platform_device.h> | |
| 14 | #include <linux/io.h> | |
| 15 | #include <mach/hardware.h> | |
| 16 | #include "crm_regs.h" | |
| 17 | ||
| 18 | /* set cpu low power mode before WFI instruction. This function is called | |
| 19 | * mx5 because it can be used for mx50, mx51, and mx53.*/ | |
| 20 | void mx5_cpu_lp_set(enum mxc_cpu_pwr_mode mode) | |
| 21 | { | |
| 22 | u32 plat_lpc, arm_srpgcr, ccm_clpcr; | |
| 23 | u32 empgc0, empgc1; | |
| 24 | int stop_mode = 0; | |
| 25 | ||
| 26 | /* always allow platform to issue a deep sleep mode request */ | |
| 27 | plat_lpc = __raw_readl(MXC_CORTEXA8_PLAT_LPC) & | |
| 28 | ~(MXC_CORTEXA8_PLAT_LPC_DSM); | |
| 29 | ccm_clpcr = __raw_readl(MXC_CCM_CLPCR) & ~(MXC_CCM_CLPCR_LPM_MASK); | |
| 30 | arm_srpgcr = __raw_readl(MXC_SRPG_ARM_SRPGCR) & ~(MXC_SRPGCR_PCR); | |
| 31 | empgc0 = __raw_readl(MXC_SRPG_EMPGC0_SRPGCR) & ~(MXC_SRPGCR_PCR); | |
| 32 | empgc1 = __raw_readl(MXC_SRPG_EMPGC1_SRPGCR) & ~(MXC_SRPGCR_PCR); | |
| 33 | ||
| 34 | switch (mode) { | |
| 35 | case WAIT_CLOCKED: | |
| 36 | break; | |
| 37 | case WAIT_UNCLOCKED: | |
| 38 | ccm_clpcr |= 0x1 << MXC_CCM_CLPCR_LPM_OFFSET; | |
| 39 | break; | |
| 40 | case WAIT_UNCLOCKED_POWER_OFF: | |
| 41 | case STOP_POWER_OFF: | |
| 42 | plat_lpc |= MXC_CORTEXA8_PLAT_LPC_DSM | |
| 43 | | MXC_CORTEXA8_PLAT_LPC_DBG_DSM; | |
| 44 | if (mode == WAIT_UNCLOCKED_POWER_OFF) { | |
| 45 | ccm_clpcr |= 0x1 << MXC_CCM_CLPCR_LPM_OFFSET; | |
| 46 | ccm_clpcr &= ~MXC_CCM_CLPCR_VSTBY; | |
| 47 | ccm_clpcr &= ~MXC_CCM_CLPCR_SBYOS; | |
| 48 | stop_mode = 0; | |
| 49 | } else { | |
| 50 | ccm_clpcr |= 0x2 << MXC_CCM_CLPCR_LPM_OFFSET; | |
| 51 | ccm_clpcr |= 0x3 << MXC_CCM_CLPCR_STBY_COUNT_OFFSET; | |
| 52 | ccm_clpcr |= MXC_CCM_CLPCR_VSTBY; | |
| 53 | ccm_clpcr |= MXC_CCM_CLPCR_SBYOS; | |
| 54 | stop_mode = 1; | |
| 55 | } | |
| 56 | arm_srpgcr |= MXC_SRPGCR_PCR; | |
| 57 | ||
| 58 | if (tzic_enable_wake(1) != 0) | |
| 59 | return; | |
| 60 | break; | |
| 61 | case STOP_POWER_ON: | |
| 62 | ccm_clpcr |= 0x2 << MXC_CCM_CLPCR_LPM_OFFSET; | |
| 63 | break; | |
| 64 | default: | |
| 65 | printk(KERN_WARNING "UNKNOWN cpu power mode: %d\n", mode); | |
| 66 | return; | |
| 67 | } | |
| 68 | ||
| 69 | __raw_writel(plat_lpc, MXC_CORTEXA8_PLAT_LPC); | |
| 70 | __raw_writel(ccm_clpcr, MXC_CCM_CLPCR); | |
| 71 | __raw_writel(arm_srpgcr, MXC_SRPG_ARM_SRPGCR); | |
| 72 | ||
| 73 | /* Enable NEON SRPG for all but MX50TO1.0. */ | |
| 74 | if (mx50_revision() != IMX_CHIP_REVISION_1_0) | |
| 75 | __raw_writel(arm_srpgcr, MXC_SRPG_NEON_SRPGCR); | |
| 76 | ||
| 77 | if (stop_mode) { | |
| 78 | empgc0 |= MXC_SRPGCR_PCR; | |
| 79 | empgc1 |= MXC_SRPGCR_PCR; | |
| 80 | ||
| 81 | __raw_writel(empgc0, MXC_SRPG_EMPGC0_SRPGCR); | |
| 82 | __raw_writel(empgc1, MXC_SRPG_EMPGC1_SRPGCR); | |
| 83 | } | |
| 84 | } |