Linux Audio

Check our new training course

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