arm: lpc2xx: PM fixes and enhancements
[linux-2.6.34-lpc32xx.git] / arch / arm / mach-lpc32xx / pm.c
1 /*
2  * arch/arm/mach-lpc32xx/pm.c
3  *
4  * Original authors: Vitaly Wool, Dmitry Chigirev <source@mvista.com>
5  * Modified by Kevin Wells <kevin.wells@nxp.com>
6  *
7  * 2005 (c) MontaVista Software, Inc. This file is licensed under
8  * the terms of the GNU General Public License version 2. This program
9  * is licensed "as is" without any warranty of any kind, whether express
10  * or implied.
11  */
12
13 /*
14  * LPC32XX CPU and system power management
15  *
16  * The LCP32XX has three CPU modes for controlling system power: run,
17  * direct-run, and halt modes. When switching between halt and run modes,
18  * the CPU transistions through direct-run mode. For Linux, direct-run
19  * mode is not used in normal operation. Halt mode is used when the
20  * system is fully suspended.
21  *
22  * Run mode:
23  * The ARM CPU clock (HCLK_PLL), HCLK bus clock, and PCLK bus clocks are
24  * derived from the HCLK PLL. The HCLK and PCLK bus rates are divided from
25  * the HCLK_PLL rate. Linux runs in this mode.
26  *
27  * Direct-run mode:
28  * The ARM CPU clock, HCLK bus clock, and PCLK bus clocks are driven from
29  * SYSCLK. SYSCLK is usually around 13MHz, but may vary based on SYSCLK
30  * source or the frequency of the main oscillator. In this mode, the
31  * HCLK_PLL can be safely enabled, changed, or disabled.
32  *
33  * Halt mode:
34  * SYSCLK is gated off and the CPU and system clocks are halted.
35  * Peripherals based on the 32KHz oscillator clock (ie, RTC, touch,
36  * key scanner, etc.) still operate if enabled. In this state, an enabled
37  * system event (ie, GPIO state change, RTC match, key press, etc.) will
38  * wake the system up back into direct-run mode.
39  *
40  * DRAM refresh
41  * DRAM clocking and refresh are slightly different for systems with DDR
42  * DRAM or regular SDRAM devices. If SDRAM is used in the system, the
43  * SDRAM will still be accessible in direct-run mode. In DDR based systems,
44  * a transistion to direct-run mode will stop all DDR accesses (no clocks).
45  * Because of this, the code to switch power modes and the code to enter
46  * and exit DRAM self-refresh modes must not be executed in DRAM. A small
47  * section of IRAM is used instead for this.
48  *
49  * Suspend is handled with the following logic:
50  *  Backup a small area of IRAM used for the suspend code
51  *  Copy suspend code to IRAM
52  *  Transfer control to code in IRAM
53  *  Places DRAMs in self-refresh mode
54  *  Enter direct-run mode
55  *  Save state of HCLK_PLL PLL
56  *  Disable HCLK_PLL PLL
57  *  Enter halt mode - CPU and buses will stop
58  *  System enters direct-run mode when an enabled event occurs
59  *  HCLK PLL state is restored
60  *  Run mode is entered
61  *  DRAMS are placed back into normal mode
62  *  Code execution returns from IRAM
63  *  IRAM code are used for suspend is restored
64  *  Suspend mode is exited
65  */
66
67 #include <linux/pm.h>
68 #include <linux/suspend.h>
69 #include <linux/io.h>
70 #include <linux/slab.h>
71 #include <linux/delay.h>
72
73 #include <asm/cacheflush.h>
74
75 #include <mach/hardware.h>
76 #include <mach/platform.h>
77 #include "common.h"
78 #include "clock.h"
79
80 #define TEMP_IRAM_AREA  IO_ADDRESS(LPC32XX_IRAM_BASE)
81 static void *iram_swap_area;
82 static int (*lpc32xx_suspend_ptr) (void);
83
84 static inline int lpc32xx_suspend(void)
85  {
86         /* Backup a small area of IRAM used for the suspend code */
87         memcpy(iram_swap_area, (void *) TEMP_IRAM_AREA,
88                 lpc32xx_sys_suspend_sz);
89
90         /*
91          * Copy code to suspend system into IRAM. The suspend code
92          * needs to run from IRAM as DRAM may no longer be available
93          * when the PLL is stopped.
94          */
95         memcpy((void *) TEMP_IRAM_AREA, &lpc32xx_sys_suspend,
96                 lpc32xx_sys_suspend_sz);
97         flush_cache_all();
98         flush_icache_range((unsigned long)TEMP_IRAM_AREA,
99                 (unsigned long)(TEMP_IRAM_AREA) + lpc32xx_sys_suspend_sz);
100
101         /* Transfer to suspend code in IRAM */
102         (void) lpc32xx_suspend_ptr();
103
104         /* Restore original IRAM contents */
105         memcpy((void *) TEMP_IRAM_AREA, iram_swap_area,
106                 lpc32xx_sys_suspend_sz);
107
108         return 0;
109 }
110
111 static int lpc32xx_pm_enter(suspend_state_t state)
112 {
113         int ret = 0;
114
115         lpc32xx_irq_suspend(state);
116
117         switch (state)
118         {
119                 case PM_SUSPEND_STANDBY:
120                         asm("mcr p15, 0, r0, c7, c0, 4");
121                         break;
122                 case PM_SUSPEND_MEM:
123                         ret = lpc32xx_suspend();
124                         break;
125         }
126
127         lpc32xx_irq_resume(state);
128
129         return ret;
130 }
131
132 static int lpc32xx_pm_valid(suspend_state_t state)
133 {
134         return (state == PM_SUSPEND_STANDBY) ||
135                (state == PM_SUSPEND_MEM);
136 }
137
138
139 static struct platform_suspend_ops lpc32xx_pm_ops = {
140         .valid  = lpc32xx_pm_valid,
141         .enter  = lpc32xx_pm_enter,
142 };
143
144 #define EMC_DYN_MEM_CTRL_OFS 0x20
145 #define EMC_SRMMC           (1 << 3)
146 #define EMC_CTRL_REG io_p2v(LPC32XX_EMC_BASE + EMC_DYN_MEM_CTRL_OFS)
147 static int __init lpc32xx_pm_init(void)
148 {
149         /*
150          * Setup SDRAM self-refresh clock to automatically disable on
151          * start of self-refresh. This only needs to be done once.
152          */
153         __raw_writel(__raw_readl(EMC_CTRL_REG) | EMC_SRMMC, EMC_CTRL_REG);
154
155         /* Allocate some space for temporary IRAM storage */
156         iram_swap_area = kmalloc(lpc32xx_sys_suspend_sz, GFP_KERNEL);
157         if (!iram_swap_area) {
158                 printk(KERN_ERR
159                        "PM Suspend: cannot allocate memory to save portion "
160                         "of SRAM\n");
161                 return -ENOMEM;
162         }
163
164         lpc32xx_suspend_ptr = (void *) TEMP_IRAM_AREA;
165         suspend_set_ops(&lpc32xx_pm_ops);
166
167         return 0;
168 }
169 arch_initcall(lpc32xx_pm_init);