Pull error-inject into release branch
[linux-2.6] / arch / arm / mach-omap1 / pm.c
1 //kernel/linux-omap-fsample/arch/arm/mach-omap1/pm.c#3 - integrate change 4545 (text)
2 /*
3  * linux/arch/arm/mach-omap1/pm.c
4  *
5  * OMAP Power Management Routines
6  *
7  * Original code for the SA11x0:
8  * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
9  *
10  * Modified for the PXA250 by Nicolas Pitre:
11  * Copyright (c) 2002 Monta Vista Software, Inc.
12  *
13  * Modified for the OMAP1510 by David Singleton:
14  * Copyright (c) 2002 Monta Vista Software, Inc.
15  *
16  * Cleanup 2004 for OMAP1510/1610 by Dirk Behme <dirk.behme@de.bosch.com>
17  *
18  * This program is free software; you can redistribute it and/or modify it
19  * under the terms of the GNU General Public License as published by the
20  * Free Software Foundation; either version 2 of the License, or (at your
21  * option) any later version.
22  *
23  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
24  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
25  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
26  * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
29  * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
30  * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33  *
34  * You should have received a copy of the GNU General Public License along
35  * with this program; if not, write to the Free Software Foundation, Inc.,
36  * 675 Mass Ave, Cambridge, MA 02139, USA.
37  */
38
39 #include <linux/pm.h>
40 #include <linux/sched.h>
41 #include <linux/proc_fs.h>
42 #include <linux/pm.h>
43 #include <linux/interrupt.h>
44 #include <linux/sysfs.h>
45 #include <linux/module.h>
46
47 #include <asm/io.h>
48 #include <asm/irq.h>
49 #include <asm/atomic.h>
50 #include <asm/mach/time.h>
51 #include <asm/mach/irq.h>
52 #include <asm/mach-types.h>
53
54 #include <asm/arch/cpu.h>
55 #include <asm/arch/irqs.h>
56 #include <asm/arch/clock.h>
57 #include <asm/arch/sram.h>
58 #include <asm/arch/tc.h>
59 #include <asm/arch/pm.h>
60 #include <asm/arch/mux.h>
61 #include <asm/arch/tps65010.h>
62 #include <asm/arch/dma.h>
63 #include <asm/arch/dsp_common.h>
64 #include <asm/arch/dmtimer.h>
65
66 static unsigned int arm_sleep_save[ARM_SLEEP_SAVE_SIZE];
67 static unsigned short dsp_sleep_save[DSP_SLEEP_SAVE_SIZE];
68 static unsigned short ulpd_sleep_save[ULPD_SLEEP_SAVE_SIZE];
69 static unsigned int mpui730_sleep_save[MPUI730_SLEEP_SAVE_SIZE];
70 static unsigned int mpui1510_sleep_save[MPUI1510_SLEEP_SAVE_SIZE];
71 static unsigned int mpui1610_sleep_save[MPUI1610_SLEEP_SAVE_SIZE];
72
73 static unsigned short enable_dyn_sleep = 1;
74
75 static ssize_t omap_pm_sleep_while_idle_show(struct subsystem * subsys, char *buf)
76 {
77         return sprintf(buf, "%hu\n", enable_dyn_sleep);
78 }
79
80 static ssize_t omap_pm_sleep_while_idle_store(struct subsystem * subsys,
81                                               const char * buf,
82                                               size_t n)
83 {
84         unsigned short value;
85         if (sscanf(buf, "%hu", &value) != 1 ||
86             (value != 0 && value != 1)) {
87                 printk(KERN_ERR "idle_sleep_store: Invalid value\n");
88                 return -EINVAL;
89         }
90         enable_dyn_sleep = value;
91         return n;
92 }
93
94 static struct subsys_attribute sleep_while_idle_attr = {
95         .attr   = {
96                 .name = __stringify(sleep_while_idle),
97                 .mode = 0644,
98         },
99         .show   = omap_pm_sleep_while_idle_show,
100         .store  = omap_pm_sleep_while_idle_store,
101 };
102
103 extern struct subsystem power_subsys;
104 static void (*omap_sram_idle)(void) = NULL;
105 static void (*omap_sram_suspend)(unsigned long r0, unsigned long r1) = NULL;
106
107 /*
108  * Let's power down on idle, but only if we are really
109  * idle, because once we start down the path of
110  * going idle we continue to do idle even if we get
111  * a clock tick interrupt . .
112  */
113 void omap_pm_idle(void)
114 {
115         extern __u32 arm_idlect1_mask;
116         __u32 use_idlect1 = arm_idlect1_mask;
117 #ifndef CONFIG_OMAP_MPU_TIMER
118         int do_sleep;
119 #endif
120
121         local_irq_disable();
122         local_fiq_disable();
123         if (need_resched()) {
124                 local_fiq_enable();
125                 local_irq_enable();
126                 return;
127         }
128
129         /*
130          * Since an interrupt may set up a timer, we don't want to
131          * reprogram the hardware timer with interrupts enabled.
132          * Re-enable interrupts only after returning from idle.
133          */
134         timer_dyn_reprogram();
135
136 #ifdef CONFIG_OMAP_MPU_TIMER
137 #warning Enable 32kHz OS timer in order to allow sleep states in idle
138         use_idlect1 = use_idlect1 & ~(1 << 9);
139 #else
140
141         do_sleep = 0;
142         while (enable_dyn_sleep) {
143
144 #ifdef CONFIG_CBUS_TAHVO_USB
145                 extern int vbus_active;
146                 /* Clock requirements? */
147                 if (vbus_active)
148                         break;
149 #endif
150                 do_sleep = 1;
151                 break;
152         }
153
154 #ifdef CONFIG_OMAP_DM_TIMER
155         use_idlect1 = omap_dm_timer_modify_idlect_mask(use_idlect1);
156 #endif
157
158         if (omap_dma_running()) {
159                 use_idlect1 &= ~(1 << 6);
160                 if (omap_lcd_dma_ext_running())
161                         use_idlect1 &= ~(1 << 12);
162         }
163
164         /* We should be able to remove the do_sleep variable and multiple
165          * tests above as soon as drivers, timer and DMA code have been fixed.
166          * Even the sleep block count should become obsolete. */
167         if ((use_idlect1 != ~0) || !do_sleep) {
168
169                 __u32 saved_idlect1 = omap_readl(ARM_IDLECT1);
170                 if (cpu_is_omap15xx())
171                         use_idlect1 &= OMAP1510_BIG_SLEEP_REQUEST;
172                 else
173                         use_idlect1 &= OMAP1610_IDLECT1_SLEEP_VAL;
174                 omap_writel(use_idlect1, ARM_IDLECT1);
175                 __asm__ volatile ("mcr  p15, 0, r0, c7, c0, 4");
176                 omap_writel(saved_idlect1, ARM_IDLECT1);
177
178                 local_fiq_enable();
179                 local_irq_enable();
180                 return;
181         }
182         omap_sram_suspend(omap_readl(ARM_IDLECT1),
183                           omap_readl(ARM_IDLECT2));
184 #endif
185
186         local_fiq_enable();
187         local_irq_enable();
188 }
189
190 /*
191  * Configuration of the wakeup event is board specific. For the
192  * moment we put it into this helper function. Later it may move
193  * to board specific files.
194  */
195 static void omap_pm_wakeup_setup(void)
196 {
197         u32 level1_wake = 0;
198         u32 level2_wake = OMAP_IRQ_BIT(INT_UART2);
199
200         /*
201          * Turn off all interrupts except GPIO bank 1, L1-2nd level cascade,
202          * and the L2 wakeup interrupts: keypad and UART2. Note that the
203          * drivers must still separately call omap_set_gpio_wakeup() to
204          * wake up to a GPIO interrupt.
205          */
206         if (cpu_is_omap730())
207                 level1_wake = OMAP_IRQ_BIT(INT_730_GPIO_BANK1) |
208                         OMAP_IRQ_BIT(INT_730_IH2_IRQ);
209         else if (cpu_is_omap15xx())
210                 level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
211                         OMAP_IRQ_BIT(INT_1510_IH2_IRQ);
212         else if (cpu_is_omap16xx())
213                 level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
214                         OMAP_IRQ_BIT(INT_1610_IH2_IRQ);
215
216         omap_writel(~level1_wake, OMAP_IH1_MIR);
217
218         if (cpu_is_omap730()) {
219                 omap_writel(~level2_wake, OMAP_IH2_0_MIR);
220                 omap_writel(~(OMAP_IRQ_BIT(INT_730_WAKE_UP_REQ) |
221                                 OMAP_IRQ_BIT(INT_730_MPUIO_KEYPAD)),
222                                 OMAP_IH2_1_MIR);
223         } else if (cpu_is_omap15xx()) {
224                 level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
225                 omap_writel(~level2_wake,  OMAP_IH2_MIR);
226         } else if (cpu_is_omap16xx()) {
227                 level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
228                 omap_writel(~level2_wake, OMAP_IH2_0_MIR);
229
230                 /* INT_1610_WAKE_UP_REQ is needed for GPIO wakeup... */
231                 omap_writel(~OMAP_IRQ_BIT(INT_1610_WAKE_UP_REQ),
232                             OMAP_IH2_1_MIR);
233                 omap_writel(~0x0, OMAP_IH2_2_MIR);
234                 omap_writel(~0x0, OMAP_IH2_3_MIR);
235         }
236
237         /*  New IRQ agreement, recalculate in cascade order */
238         omap_writel(1, OMAP_IH2_CONTROL);
239         omap_writel(1, OMAP_IH1_CONTROL);
240 }
241
242 #define EN_DSPCK        13      /* ARM_CKCTL */
243 #define EN_APICK        6       /* ARM_IDLECT2 */
244 #define DSP_EN          1       /* ARM_RSTCT1 */
245
246 void omap_pm_suspend(void)
247 {
248         unsigned long arg0 = 0, arg1 = 0;
249
250         printk("PM: OMAP%x is trying to enter deep sleep...\n", system_rev);
251
252         omap_serial_wake_trigger(1);
253
254         if (machine_is_omap_osk()) {
255                 /* Stop LED1 (D9) blink */
256                 tps65010_set_led(LED1, OFF);
257         }
258
259         if (!cpu_is_omap15xx())
260                 omap_writew(0xffff, ULPD_SOFT_DISABLE_REQ_REG);
261
262         /*
263          * Step 1: turn off interrupts (FIXME: NOTE: already disabled)
264          */
265
266         local_irq_disable();
267         local_fiq_disable();
268
269         /*
270          * Step 2: save registers
271          *
272          * The omap is a strange/beautiful device. The caches, memory
273          * and register state are preserved across power saves.
274          * We have to save and restore very little register state to
275          * idle the omap.
276          *
277          * Save interrupt, MPUI, ARM and UPLD control registers.
278          */
279
280         if (cpu_is_omap730()) {
281                 MPUI730_SAVE(OMAP_IH1_MIR);
282                 MPUI730_SAVE(OMAP_IH2_0_MIR);
283                 MPUI730_SAVE(OMAP_IH2_1_MIR);
284                 MPUI730_SAVE(MPUI_CTRL);
285                 MPUI730_SAVE(MPUI_DSP_BOOT_CONFIG);
286                 MPUI730_SAVE(MPUI_DSP_API_CONFIG);
287                 MPUI730_SAVE(EMIFS_CONFIG);
288                 MPUI730_SAVE(EMIFF_SDRAM_CONFIG);
289
290         } else if (cpu_is_omap15xx()) {
291                 MPUI1510_SAVE(OMAP_IH1_MIR);
292                 MPUI1510_SAVE(OMAP_IH2_MIR);
293                 MPUI1510_SAVE(MPUI_CTRL);
294                 MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
295                 MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
296                 MPUI1510_SAVE(EMIFS_CONFIG);
297                 MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
298         } else if (cpu_is_omap16xx()) {
299                 MPUI1610_SAVE(OMAP_IH1_MIR);
300                 MPUI1610_SAVE(OMAP_IH2_0_MIR);
301                 MPUI1610_SAVE(OMAP_IH2_1_MIR);
302                 MPUI1610_SAVE(OMAP_IH2_2_MIR);
303                 MPUI1610_SAVE(OMAP_IH2_3_MIR);
304                 MPUI1610_SAVE(MPUI_CTRL);
305                 MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
306                 MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
307                 MPUI1610_SAVE(EMIFS_CONFIG);
308                 MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
309         }
310
311         ARM_SAVE(ARM_CKCTL);
312         ARM_SAVE(ARM_IDLECT1);
313         ARM_SAVE(ARM_IDLECT2);
314         if (!(cpu_is_omap15xx()))
315                 ARM_SAVE(ARM_IDLECT3);
316         ARM_SAVE(ARM_EWUPCT);
317         ARM_SAVE(ARM_RSTCT1);
318         ARM_SAVE(ARM_RSTCT2);
319         ARM_SAVE(ARM_SYSST);
320         ULPD_SAVE(ULPD_CLOCK_CTRL);
321         ULPD_SAVE(ULPD_STATUS_REQ);
322
323         /* (Step 3 removed - we now allow deep sleep by default) */
324
325         /*
326          * Step 4: OMAP DSP Shutdown
327          */
328
329         /* stop DSP */
330         omap_writew(omap_readw(ARM_RSTCT1) & ~(1 << DSP_EN), ARM_RSTCT1);
331
332                 /* shut down dsp_ck */
333         if (!cpu_is_omap730())
334                 omap_writew(omap_readw(ARM_CKCTL) & ~(1 << EN_DSPCK), ARM_CKCTL);
335
336         /* temporarily enabling api_ck to access DSP registers */
337         omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
338
339         /* save DSP registers */
340         DSP_SAVE(DSP_IDLECT2);
341
342         /* Stop all DSP domain clocks */
343         __raw_writew(0, DSP_IDLECT2);
344
345         /*
346          * Step 5: Wakeup Event Setup
347          */
348
349         omap_pm_wakeup_setup();
350
351         /*
352          * Step 6: ARM and Traffic controller shutdown
353          */
354
355         /* disable ARM watchdog */
356         omap_writel(0x00F5, OMAP_WDT_TIMER_MODE);
357         omap_writel(0x00A0, OMAP_WDT_TIMER_MODE);
358
359         /*
360          * Step 6b: ARM and Traffic controller shutdown
361          *
362          * Step 6 continues here. Prepare jump to power management
363          * assembly code in internal SRAM.
364          *
365          * Since the omap_cpu_suspend routine has been copied to
366          * SRAM, we'll do an indirect procedure call to it and pass the
367          * contents of arm_idlect1 and arm_idlect2 so it can restore
368          * them when it wakes up and it will return.
369          */
370
371         arg0 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT1];
372         arg1 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT2];
373
374         /*
375          * Step 6c: ARM and Traffic controller shutdown
376          *
377          * Jump to assembly code. The processor will stay there
378          * until wake up.
379          */
380         omap_sram_suspend(arg0, arg1);
381
382         /*
383          * If we are here, processor is woken up!
384          */
385
386         /*
387          * Restore DSP clocks
388          */
389
390         /* again temporarily enabling api_ck to access DSP registers */
391         omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
392
393         /* Restore DSP domain clocks */
394         DSP_RESTORE(DSP_IDLECT2);
395
396         /*
397          * Restore ARM state, except ARM_IDLECT1/2 which omap_cpu_suspend did
398          */
399
400         if (!(cpu_is_omap15xx()))
401                 ARM_RESTORE(ARM_IDLECT3);
402         ARM_RESTORE(ARM_CKCTL);
403         ARM_RESTORE(ARM_EWUPCT);
404         ARM_RESTORE(ARM_RSTCT1);
405         ARM_RESTORE(ARM_RSTCT2);
406         ARM_RESTORE(ARM_SYSST);
407         ULPD_RESTORE(ULPD_CLOCK_CTRL);
408         ULPD_RESTORE(ULPD_STATUS_REQ);
409
410         if (cpu_is_omap730()) {
411                 MPUI730_RESTORE(EMIFS_CONFIG);
412                 MPUI730_RESTORE(EMIFF_SDRAM_CONFIG);
413                 MPUI730_RESTORE(OMAP_IH1_MIR);
414                 MPUI730_RESTORE(OMAP_IH2_0_MIR);
415                 MPUI730_RESTORE(OMAP_IH2_1_MIR);
416         } else if (cpu_is_omap15xx()) {
417                 MPUI1510_RESTORE(MPUI_CTRL);
418                 MPUI1510_RESTORE(MPUI_DSP_BOOT_CONFIG);
419                 MPUI1510_RESTORE(MPUI_DSP_API_CONFIG);
420                 MPUI1510_RESTORE(EMIFS_CONFIG);
421                 MPUI1510_RESTORE(EMIFF_SDRAM_CONFIG);
422                 MPUI1510_RESTORE(OMAP_IH1_MIR);
423                 MPUI1510_RESTORE(OMAP_IH2_MIR);
424         } else if (cpu_is_omap16xx()) {
425                 MPUI1610_RESTORE(MPUI_CTRL);
426                 MPUI1610_RESTORE(MPUI_DSP_BOOT_CONFIG);
427                 MPUI1610_RESTORE(MPUI_DSP_API_CONFIG);
428                 MPUI1610_RESTORE(EMIFS_CONFIG);
429                 MPUI1610_RESTORE(EMIFF_SDRAM_CONFIG);
430
431                 MPUI1610_RESTORE(OMAP_IH1_MIR);
432                 MPUI1610_RESTORE(OMAP_IH2_0_MIR);
433                 MPUI1610_RESTORE(OMAP_IH2_1_MIR);
434                 MPUI1610_RESTORE(OMAP_IH2_2_MIR);
435                 MPUI1610_RESTORE(OMAP_IH2_3_MIR);
436         }
437
438         if (!cpu_is_omap15xx())
439                 omap_writew(0, ULPD_SOFT_DISABLE_REQ_REG);
440
441         /*
442          * Reenable interrupts
443          */
444
445         local_irq_enable();
446         local_fiq_enable();
447
448         omap_serial_wake_trigger(0);
449
450         printk("PM: OMAP%x is re-starting from deep sleep...\n", system_rev);
451
452         if (machine_is_omap_osk()) {
453                 /* Let LED1 (D9) blink again */
454                 tps65010_set_led(LED1, BLINK);
455         }
456 }
457
458 #if defined(DEBUG) && defined(CONFIG_PROC_FS)
459 static int g_read_completed;
460
461 /*
462  * Read system PM registers for debugging
463  */
464 static int omap_pm_read_proc(
465         char *page_buffer,
466         char **my_first_byte,
467         off_t virtual_start,
468         int length,
469         int *eof,
470         void *data)
471 {
472         int my_buffer_offset = 0;
473         char * const my_base = page_buffer;
474
475         ARM_SAVE(ARM_CKCTL);
476         ARM_SAVE(ARM_IDLECT1);
477         ARM_SAVE(ARM_IDLECT2);
478         if (!(cpu_is_omap15xx()))
479                 ARM_SAVE(ARM_IDLECT3);
480         ARM_SAVE(ARM_EWUPCT);
481         ARM_SAVE(ARM_RSTCT1);
482         ARM_SAVE(ARM_RSTCT2);
483         ARM_SAVE(ARM_SYSST);
484
485         ULPD_SAVE(ULPD_IT_STATUS);
486         ULPD_SAVE(ULPD_CLOCK_CTRL);
487         ULPD_SAVE(ULPD_SOFT_REQ);
488         ULPD_SAVE(ULPD_STATUS_REQ);
489         ULPD_SAVE(ULPD_DPLL_CTRL);
490         ULPD_SAVE(ULPD_POWER_CTRL);
491
492         if (cpu_is_omap730()) {
493                 MPUI730_SAVE(MPUI_CTRL);
494                 MPUI730_SAVE(MPUI_DSP_STATUS);
495                 MPUI730_SAVE(MPUI_DSP_BOOT_CONFIG);
496                 MPUI730_SAVE(MPUI_DSP_API_CONFIG);
497                 MPUI730_SAVE(EMIFF_SDRAM_CONFIG);
498                 MPUI730_SAVE(EMIFS_CONFIG);
499         } else if (cpu_is_omap15xx()) {
500                 MPUI1510_SAVE(MPUI_CTRL);
501                 MPUI1510_SAVE(MPUI_DSP_STATUS);
502                 MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
503                 MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
504                 MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
505                 MPUI1510_SAVE(EMIFS_CONFIG);
506         } else if (cpu_is_omap16xx()) {
507                 MPUI1610_SAVE(MPUI_CTRL);
508                 MPUI1610_SAVE(MPUI_DSP_STATUS);
509                 MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
510                 MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
511                 MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
512                 MPUI1610_SAVE(EMIFS_CONFIG);
513         }
514
515         if (virtual_start == 0) {
516                 g_read_completed = 0;
517
518                 my_buffer_offset += sprintf(my_base + my_buffer_offset,
519                    "ARM_CKCTL_REG:            0x%-8x     \n"
520                    "ARM_IDLECT1_REG:          0x%-8x     \n"
521                    "ARM_IDLECT2_REG:          0x%-8x     \n"
522                    "ARM_IDLECT3_REG:          0x%-8x     \n"
523                    "ARM_EWUPCT_REG:           0x%-8x     \n"
524                    "ARM_RSTCT1_REG:           0x%-8x     \n"
525                    "ARM_RSTCT2_REG:           0x%-8x     \n"
526                    "ARM_SYSST_REG:            0x%-8x     \n"
527                    "ULPD_IT_STATUS_REG:       0x%-4x     \n"
528                    "ULPD_CLOCK_CTRL_REG:      0x%-4x     \n"
529                    "ULPD_SOFT_REQ_REG:        0x%-4x     \n"
530                    "ULPD_DPLL_CTRL_REG:       0x%-4x     \n"
531                    "ULPD_STATUS_REQ_REG:      0x%-4x     \n"
532                    "ULPD_POWER_CTRL_REG:      0x%-4x     \n",
533                    ARM_SHOW(ARM_CKCTL),
534                    ARM_SHOW(ARM_IDLECT1),
535                    ARM_SHOW(ARM_IDLECT2),
536                    ARM_SHOW(ARM_IDLECT3),
537                    ARM_SHOW(ARM_EWUPCT),
538                    ARM_SHOW(ARM_RSTCT1),
539                    ARM_SHOW(ARM_RSTCT2),
540                    ARM_SHOW(ARM_SYSST),
541                    ULPD_SHOW(ULPD_IT_STATUS),
542                    ULPD_SHOW(ULPD_CLOCK_CTRL),
543                    ULPD_SHOW(ULPD_SOFT_REQ),
544                    ULPD_SHOW(ULPD_DPLL_CTRL),
545                    ULPD_SHOW(ULPD_STATUS_REQ),
546                    ULPD_SHOW(ULPD_POWER_CTRL));
547
548                 if (cpu_is_omap730()) {
549                         my_buffer_offset += sprintf(my_base + my_buffer_offset,
550                            "MPUI730_CTRL_REG         0x%-8x \n"
551                            "MPUI730_DSP_STATUS_REG:      0x%-8x \n"
552                            "MPUI730_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
553                            "MPUI730_DSP_API_CONFIG_REG:  0x%-8x \n"
554                            "MPUI730_SDRAM_CONFIG_REG:    0x%-8x \n"
555                            "MPUI730_EMIFS_CONFIG_REG:    0x%-8x \n",
556                            MPUI730_SHOW(MPUI_CTRL),
557                            MPUI730_SHOW(MPUI_DSP_STATUS),
558                            MPUI730_SHOW(MPUI_DSP_BOOT_CONFIG),
559                            MPUI730_SHOW(MPUI_DSP_API_CONFIG),
560                            MPUI730_SHOW(EMIFF_SDRAM_CONFIG),
561                            MPUI730_SHOW(EMIFS_CONFIG));
562                 } else if (cpu_is_omap15xx()) {
563                         my_buffer_offset += sprintf(my_base + my_buffer_offset,
564                            "MPUI1510_CTRL_REG             0x%-8x \n"
565                            "MPUI1510_DSP_STATUS_REG:      0x%-8x \n"
566                            "MPUI1510_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
567                            "MPUI1510_DSP_API_CONFIG_REG:  0x%-8x \n"
568                            "MPUI1510_SDRAM_CONFIG_REG:    0x%-8x \n"
569                            "MPUI1510_EMIFS_CONFIG_REG:    0x%-8x \n",
570                            MPUI1510_SHOW(MPUI_CTRL),
571                            MPUI1510_SHOW(MPUI_DSP_STATUS),
572                            MPUI1510_SHOW(MPUI_DSP_BOOT_CONFIG),
573                            MPUI1510_SHOW(MPUI_DSP_API_CONFIG),
574                            MPUI1510_SHOW(EMIFF_SDRAM_CONFIG),
575                            MPUI1510_SHOW(EMIFS_CONFIG));
576                 } else if (cpu_is_omap16xx()) {
577                         my_buffer_offset += sprintf(my_base + my_buffer_offset,
578                            "MPUI1610_CTRL_REG             0x%-8x \n"
579                            "MPUI1610_DSP_STATUS_REG:      0x%-8x \n"
580                            "MPUI1610_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
581                            "MPUI1610_DSP_API_CONFIG_REG:  0x%-8x \n"
582                            "MPUI1610_SDRAM_CONFIG_REG:    0x%-8x \n"
583                            "MPUI1610_EMIFS_CONFIG_REG:    0x%-8x \n",
584                            MPUI1610_SHOW(MPUI_CTRL),
585                            MPUI1610_SHOW(MPUI_DSP_STATUS),
586                            MPUI1610_SHOW(MPUI_DSP_BOOT_CONFIG),
587                            MPUI1610_SHOW(MPUI_DSP_API_CONFIG),
588                            MPUI1610_SHOW(EMIFF_SDRAM_CONFIG),
589                            MPUI1610_SHOW(EMIFS_CONFIG));
590                 }
591
592                 g_read_completed++;
593         } else if (g_read_completed >= 1) {
594                  *eof = 1;
595                  return 0;
596         }
597         g_read_completed++;
598
599         *my_first_byte = page_buffer;
600         return  my_buffer_offset;
601 }
602
603 static void omap_pm_init_proc(void)
604 {
605         struct proc_dir_entry *entry;
606
607         entry = create_proc_read_entry("driver/omap_pm",
608                                        S_IWUSR | S_IRUGO, NULL,
609                                        omap_pm_read_proc, NULL);
610 }
611
612 #endif /* DEBUG && CONFIG_PROC_FS */
613
614 static void (*saved_idle)(void) = NULL;
615
616 /*
617  *      omap_pm_prepare - Do preliminary suspend work.
618  *      @state:         suspend state we're entering.
619  *
620  */
621 static int omap_pm_prepare(suspend_state_t state)
622 {
623         int error = 0;
624
625         /* We cannot sleep in idle until we have resumed */
626         saved_idle = pm_idle;
627         pm_idle = NULL;
628
629         switch (state)
630         {
631         case PM_SUSPEND_STANDBY:
632         case PM_SUSPEND_MEM:
633                 break;
634
635         case PM_SUSPEND_DISK:
636                 return -ENOTSUPP;
637
638         default:
639                 return -EINVAL;
640         }
641
642         return error;
643 }
644
645
646 /*
647  *      omap_pm_enter - Actually enter a sleep state.
648  *      @state:         State we're entering.
649  *
650  */
651
652 static int omap_pm_enter(suspend_state_t state)
653 {
654         switch (state)
655         {
656         case PM_SUSPEND_STANDBY:
657         case PM_SUSPEND_MEM:
658                 omap_pm_suspend();
659                 break;
660
661         case PM_SUSPEND_DISK:
662                 return -ENOTSUPP;
663
664         default:
665                 return -EINVAL;
666         }
667
668         return 0;
669 }
670
671
672 /**
673  *      omap_pm_finish - Finish up suspend sequence.
674  *      @state:         State we're coming out of.
675  *
676  *      This is called after we wake back up (or if entering the sleep state
677  *      failed).
678  */
679
680 static int omap_pm_finish(suspend_state_t state)
681 {
682         pm_idle = saved_idle;
683         return 0;
684 }
685
686
687 static irqreturn_t  omap_wakeup_interrupt(int irq, void *dev)
688 {
689         return IRQ_HANDLED;
690 }
691
692 static struct irqaction omap_wakeup_irq = {
693         .name           = "peripheral wakeup",
694         .flags          = IRQF_DISABLED,
695         .handler        = omap_wakeup_interrupt
696 };
697
698
699
700 static struct pm_ops omap_pm_ops ={
701         .pm_disk_mode   = 0,
702         .prepare        = omap_pm_prepare,
703         .enter          = omap_pm_enter,
704         .finish         = omap_pm_finish,
705 };
706
707 static int __init omap_pm_init(void)
708 {
709         int error;
710
711         printk("Power Management for TI OMAP.\n");
712
713         /*
714          * We copy the assembler sleep/wakeup routines to SRAM.
715          * These routines need to be in SRAM as that's the only
716          * memory the MPU can see when it wakes up.
717          */
718         if (cpu_is_omap730()) {
719                 omap_sram_idle = omap_sram_push(omap730_idle_loop_suspend,
720                                                 omap730_idle_loop_suspend_sz);
721                 omap_sram_suspend = omap_sram_push(omap730_cpu_suspend,
722                                                    omap730_cpu_suspend_sz);
723         } else if (cpu_is_omap15xx()) {
724                 omap_sram_idle = omap_sram_push(omap1510_idle_loop_suspend,
725                                                 omap1510_idle_loop_suspend_sz);
726                 omap_sram_suspend = omap_sram_push(omap1510_cpu_suspend,
727                                                    omap1510_cpu_suspend_sz);
728         } else if (cpu_is_omap16xx()) {
729                 omap_sram_idle = omap_sram_push(omap1610_idle_loop_suspend,
730                                                 omap1610_idle_loop_suspend_sz);
731                 omap_sram_suspend = omap_sram_push(omap1610_cpu_suspend,
732                                                    omap1610_cpu_suspend_sz);
733         }
734
735         if (omap_sram_idle == NULL || omap_sram_suspend == NULL) {
736                 printk(KERN_ERR "PM not initialized: Missing SRAM support\n");
737                 return -ENODEV;
738         }
739
740         pm_idle = omap_pm_idle;
741
742         if (cpu_is_omap730())
743                 setup_irq(INT_730_WAKE_UP_REQ, &omap_wakeup_irq);
744         else if (cpu_is_omap16xx())
745                 setup_irq(INT_1610_WAKE_UP_REQ, &omap_wakeup_irq);
746
747         /* Program new power ramp-up time
748          * (0 for most boards since we don't lower voltage when in deep sleep)
749          */
750         omap_writew(ULPD_SETUP_ANALOG_CELL_3_VAL, ULPD_SETUP_ANALOG_CELL_3);
751
752         /* Setup ULPD POWER_CTRL_REG - enter deep sleep whenever possible */
753         omap_writew(ULPD_POWER_CTRL_REG_VAL, ULPD_POWER_CTRL);
754
755         /* Configure IDLECT3 */
756         if (cpu_is_omap730())
757                 omap_writel(OMAP730_IDLECT3_VAL, OMAP730_IDLECT3);
758         else if (cpu_is_omap16xx())
759                 omap_writel(OMAP1610_IDLECT3_VAL, OMAP1610_IDLECT3);
760
761         pm_set_ops(&omap_pm_ops);
762
763 #if defined(DEBUG) && defined(CONFIG_PROC_FS)
764         omap_pm_init_proc();
765 #endif
766
767         error = subsys_create_file(&power_subsys, &sleep_while_idle_attr);
768         if (error)
769                 printk(KERN_ERR "subsys_create_file failed: %d\n", error);
770
771         if (cpu_is_omap16xx()) {
772                 /* configure LOW_PWR pin */
773                 omap_cfg_reg(T20_1610_LOW_PWR);
774         }
775
776         return 0;
777 }
778 __initcall(omap_pm_init);