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);
v6.13.7
  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 <linux/soc/ti/omap1-io.h>
 56#include "tc.h"
 57#include <linux/omap-dma.h>
 58#include <clocksource/timer-ti-dm.h>
 
 
 59
 60#include "hardware.h"
 61#include "mux.h"
 62#include "irqs.h"
 63#include "iomap.h"
 64#include "clock.h"
 65#include "pm.h"
 66#include "soc.h"
 67#include "sram.h"
 68
 69static unsigned int arm_sleep_save[ARM_SLEEP_SAVE_SIZE];
 70static unsigned short dsp_sleep_save[DSP_SLEEP_SAVE_SIZE];
 71static unsigned short ulpd_sleep_save[ULPD_SLEEP_SAVE_SIZE];
 
 72static unsigned int mpui1510_sleep_save[MPUI1510_SLEEP_SAVE_SIZE];
 73static unsigned int mpui1610_sleep_save[MPUI1610_SLEEP_SAVE_SIZE];
 74
 75static unsigned short enable_dyn_sleep;
 
 
 
 
 
 
 76
 77static ssize_t idle_show(struct kobject *kobj, struct kobj_attribute *attr,
 78			 char *buf)
 79{
 80	return sprintf(buf, "%hu\n", enable_dyn_sleep);
 81}
 82
 83static ssize_t idle_store(struct kobject *kobj, struct kobj_attribute *attr,
 84			  const char * buf, size_t n)
 85{
 86	unsigned short value;
 87	if (sscanf(buf, "%hu", &value) != 1 ||
 88	    (value != 0 && value != 1) ||
 89	    (value != 0 && !IS_ENABLED(CONFIG_OMAP_32K_TIMER))) {
 90		pr_err("idle_sleep_store: Invalid value\n");
 91		return -EINVAL;
 92	}
 93	enable_dyn_sleep = value;
 94	return n;
 95}
 96
 97static struct kobj_attribute sleep_while_idle_attr =
 98	__ATTR(sleep_while_idle, 0644, idle_show, idle_store);
 99
 
100
101static void (*omap_sram_suspend)(unsigned long r0, unsigned long r1) = NULL;
102
103/*
104 * Let's power down on idle, but only if we are really
105 * idle, because once we start down the path of
106 * going idle we continue to do idle even if we get
107 * a clock tick interrupt . .
108 */
109void omap1_pm_idle(void)
110{
111	extern __u32 arm_idlect1_mask;
112	__u32 use_idlect1 = arm_idlect1_mask;
 
113
114	local_fiq_disable();
115
116#if defined(CONFIG_OMAP_MPU_TIMER) && !defined(CONFIG_OMAP_DM_TIMER)
 
117	use_idlect1 = use_idlect1 & ~(1 << 9);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
118#endif
119
120#ifdef CONFIG_OMAP_DM_TIMER
121	use_idlect1 = omap_dm_timer_modify_idlect_mask(use_idlect1);
122#endif
123
124	if (omap_dma_running())
125		use_idlect1 &= ~(1 << 6);
126
127	/*
128	 * We should be able to remove the do_sleep variable and multiple
129	 * tests above as soon as drivers, timer and DMA code have been fixed.
130	 * Even the sleep block count should become obsolete.
131	 */
132	if ((use_idlect1 != ~0) || !enable_dyn_sleep) {
133
134		__u32 saved_idlect1 = omap_readl(ARM_IDLECT1);
135		if (cpu_is_omap15xx())
136			use_idlect1 &= OMAP1510_BIG_SLEEP_REQUEST;
137		else
138			use_idlect1 &= OMAP1610_IDLECT1_SLEEP_VAL;
139		omap_writel(use_idlect1, ARM_IDLECT1);
140		__asm__ volatile ("mcr	p15, 0, r0, c7, c0, 4");
141		omap_writel(saved_idlect1, ARM_IDLECT1);
142
143		local_fiq_enable();
144		return;
145	}
146	omap_sram_suspend(omap_readl(ARM_IDLECT1),
147			  omap_readl(ARM_IDLECT2));
148
149	local_fiq_enable();
150}
151
152/*
153 * Configuration of the wakeup event is board specific. For the
154 * moment we put it into this helper function. Later it may move
155 * to board specific files.
156 */
157static void omap_pm_wakeup_setup(void)
158{
159	u32 level1_wake = 0;
160	u32 level2_wake = OMAP_IRQ_BIT(INT_UART2);
161
162	/*
163	 * Turn off all interrupts except GPIO bank 1, L1-2nd level cascade,
164	 * and the L2 wakeup interrupts: keypad and UART2. Note that the
165	 * drivers must still separately call omap_set_gpio_wakeup() to
166	 * wake up to a GPIO interrupt.
167	 */
168	if (cpu_is_omap15xx())
 
 
 
169		level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
170			OMAP_IRQ_BIT(INT_1510_IH2_IRQ);
171	else if (cpu_is_omap16xx())
172		level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
173			OMAP_IRQ_BIT(INT_1610_IH2_IRQ);
174
175	omap_writel(~level1_wake, OMAP_IH1_MIR);
176
177	if (cpu_is_omap15xx()) {
 
 
 
 
 
178		level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
179		omap_writel(~level2_wake,  OMAP_IH2_MIR);
180	} else if (cpu_is_omap16xx()) {
181		level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
182		omap_writel(~level2_wake, OMAP_IH2_0_MIR);
183
184		/* INT_1610_WAKE_UP_REQ is needed for GPIO wakeup... */
185		omap_writel(~OMAP_IRQ_BIT(INT_1610_WAKE_UP_REQ),
186			    OMAP_IH2_1_MIR);
187		omap_writel(~0x0, OMAP_IH2_2_MIR);
188		omap_writel(~0x0, OMAP_IH2_3_MIR);
189	}
190
191	/*  New IRQ agreement, recalculate in cascade order */
192	omap_writel(1, OMAP_IH2_CONTROL);
193	omap_writel(1, OMAP_IH1_CONTROL);
194}
195
196#define EN_DSPCK	13	/* ARM_CKCTL */
197#define EN_APICK	6	/* ARM_IDLECT2 */
198#define DSP_EN		1	/* ARM_RSTCT1 */
199
200void omap1_pm_suspend(void)
201{
202	unsigned long arg0 = 0, arg1 = 0;
203
204	printk(KERN_INFO "PM: OMAP%x is trying to enter deep sleep...\n",
205		omap_rev());
206
207	omap_serial_wake_trigger(1);
208
209	if (!cpu_is_omap15xx())
210		omap_writew(0xffff, ULPD_SOFT_DISABLE_REQ_REG);
211
212	/*
213	 * Step 1: turn off interrupts (FIXME: NOTE: already disabled)
214	 */
215
216	local_irq_disable();
217	local_fiq_disable();
218
219	/*
220	 * Step 2: save registers
221	 *
222	 * The omap is a strange/beautiful device. The caches, memory
223	 * and register state are preserved across power saves.
224	 * We have to save and restore very little register state to
225	 * idle the omap.
226         *
227	 * Save interrupt, MPUI, ARM and UPLD control registers.
228	 */
229
230	if (cpu_is_omap15xx()) {
 
 
 
 
 
 
 
 
 
 
231		MPUI1510_SAVE(OMAP_IH1_MIR);
232		MPUI1510_SAVE(OMAP_IH2_MIR);
233		MPUI1510_SAVE(MPUI_CTRL);
234		MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
235		MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
236		MPUI1510_SAVE(EMIFS_CONFIG);
237		MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
238	} else if (cpu_is_omap16xx()) {
239		MPUI1610_SAVE(OMAP_IH1_MIR);
240		MPUI1610_SAVE(OMAP_IH2_0_MIR);
241		MPUI1610_SAVE(OMAP_IH2_1_MIR);
242		MPUI1610_SAVE(OMAP_IH2_2_MIR);
243		MPUI1610_SAVE(OMAP_IH2_3_MIR);
244		MPUI1610_SAVE(MPUI_CTRL);
245		MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
246		MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
247		MPUI1610_SAVE(EMIFS_CONFIG);
248		MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
249	}
250
251	ARM_SAVE(ARM_CKCTL);
252	ARM_SAVE(ARM_IDLECT1);
253	ARM_SAVE(ARM_IDLECT2);
254	if (!(cpu_is_omap15xx()))
255		ARM_SAVE(ARM_IDLECT3);
256	ARM_SAVE(ARM_EWUPCT);
257	ARM_SAVE(ARM_RSTCT1);
258	ARM_SAVE(ARM_RSTCT2);
259	ARM_SAVE(ARM_SYSST);
260	ULPD_SAVE(ULPD_CLOCK_CTRL);
261	ULPD_SAVE(ULPD_STATUS_REQ);
262
263	/* (Step 3 removed - we now allow deep sleep by default) */
264
265	/*
266	 * Step 4: OMAP DSP Shutdown
267	 */
268
269	/* stop DSP */
270	omap_writew(omap_readw(ARM_RSTCT1) & ~(1 << DSP_EN), ARM_RSTCT1);
271
272	/* shut down dsp_ck */
273	omap_writew(omap_readw(ARM_CKCTL) & ~(1 << EN_DSPCK), ARM_CKCTL);
 
274
275	/* temporarily enabling api_ck to access DSP registers */
276	omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
277
278	/* save DSP registers */
279	DSP_SAVE(DSP_IDLECT2);
280
281	/* Stop all DSP domain clocks */
282	__raw_writew(0, DSP_IDLECT2);
283
284	/*
285	 * Step 5: Wakeup Event Setup
286	 */
287
288	omap_pm_wakeup_setup();
289
290	/*
291	 * Step 6: ARM and Traffic controller shutdown
292	 */
293
294	/* disable ARM watchdog */
295	omap_writel(0x00F5, OMAP_WDT_TIMER_MODE);
296	omap_writel(0x00A0, OMAP_WDT_TIMER_MODE);
297
298	/*
299	 * Step 6b: ARM and Traffic controller shutdown
300	 *
301	 * Step 6 continues here. Prepare jump to power management
302	 * assembly code in internal SRAM.
303	 *
304	 * Since the omap_cpu_suspend routine has been copied to
305	 * SRAM, we'll do an indirect procedure call to it and pass the
306	 * contents of arm_idlect1 and arm_idlect2 so it can restore
307	 * them when it wakes up and it will return.
308	 */
309
310	arg0 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT1];
311	arg1 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT2];
312
313	/*
314	 * Step 6c: ARM and Traffic controller shutdown
315	 *
316	 * Jump to assembly code. The processor will stay there
317	 * until wake up.
318	 */
319	omap_sram_suspend(arg0, arg1);
320
321	/*
322	 * If we are here, processor is woken up!
323	 */
324
325	/*
326	 * Restore DSP clocks
327	 */
328
329	/* again temporarily enabling api_ck to access DSP registers */
330	omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
331
332	/* Restore DSP domain clocks */
333	DSP_RESTORE(DSP_IDLECT2);
334
335	/*
336	 * Restore ARM state, except ARM_IDLECT1/2 which omap_cpu_suspend did
337	 */
338
339	if (!(cpu_is_omap15xx()))
340		ARM_RESTORE(ARM_IDLECT3);
341	ARM_RESTORE(ARM_CKCTL);
342	ARM_RESTORE(ARM_EWUPCT);
343	ARM_RESTORE(ARM_RSTCT1);
344	ARM_RESTORE(ARM_RSTCT2);
345	ARM_RESTORE(ARM_SYSST);
346	ULPD_RESTORE(ULPD_CLOCK_CTRL);
347	ULPD_RESTORE(ULPD_STATUS_REQ);
348
349	if (cpu_is_omap15xx()) {
 
 
 
 
 
 
350		MPUI1510_RESTORE(MPUI_CTRL);
351		MPUI1510_RESTORE(MPUI_DSP_BOOT_CONFIG);
352		MPUI1510_RESTORE(MPUI_DSP_API_CONFIG);
353		MPUI1510_RESTORE(EMIFS_CONFIG);
354		MPUI1510_RESTORE(EMIFF_SDRAM_CONFIG);
355		MPUI1510_RESTORE(OMAP_IH1_MIR);
356		MPUI1510_RESTORE(OMAP_IH2_MIR);
357	} else if (cpu_is_omap16xx()) {
358		MPUI1610_RESTORE(MPUI_CTRL);
359		MPUI1610_RESTORE(MPUI_DSP_BOOT_CONFIG);
360		MPUI1610_RESTORE(MPUI_DSP_API_CONFIG);
361		MPUI1610_RESTORE(EMIFS_CONFIG);
362		MPUI1610_RESTORE(EMIFF_SDRAM_CONFIG);
363
364		MPUI1610_RESTORE(OMAP_IH1_MIR);
365		MPUI1610_RESTORE(OMAP_IH2_0_MIR);
366		MPUI1610_RESTORE(OMAP_IH2_1_MIR);
367		MPUI1610_RESTORE(OMAP_IH2_2_MIR);
368		MPUI1610_RESTORE(OMAP_IH2_3_MIR);
369	}
370
371	if (!cpu_is_omap15xx())
372		omap_writew(0, ULPD_SOFT_DISABLE_REQ_REG);
373
374	/*
375	 * Re-enable interrupts
376	 */
377
378	local_irq_enable();
379	local_fiq_enable();
380
381	omap_serial_wake_trigger(0);
382
383	printk(KERN_INFO "PM: OMAP%x is re-starting from deep sleep...\n",
384		omap_rev());
385}
386
387#ifdef CONFIG_DEBUG_FS
388/*
389 * Read system PM registers for debugging
390 */
391static int omap_pm_debug_show(struct seq_file *m, void *v)
392{
393	ARM_SAVE(ARM_CKCTL);
394	ARM_SAVE(ARM_IDLECT1);
395	ARM_SAVE(ARM_IDLECT2);
396	if (!(cpu_is_omap15xx()))
397		ARM_SAVE(ARM_IDLECT3);
398	ARM_SAVE(ARM_EWUPCT);
399	ARM_SAVE(ARM_RSTCT1);
400	ARM_SAVE(ARM_RSTCT2);
401	ARM_SAVE(ARM_SYSST);
402
403	ULPD_SAVE(ULPD_IT_STATUS);
404	ULPD_SAVE(ULPD_CLOCK_CTRL);
405	ULPD_SAVE(ULPD_SOFT_REQ);
406	ULPD_SAVE(ULPD_STATUS_REQ);
407	ULPD_SAVE(ULPD_DPLL_CTRL);
408	ULPD_SAVE(ULPD_POWER_CTRL);
409
410	if (cpu_is_omap15xx()) {
 
 
 
 
 
 
 
411		MPUI1510_SAVE(MPUI_CTRL);
412		MPUI1510_SAVE(MPUI_DSP_STATUS);
413		MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
414		MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
415		MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
416		MPUI1510_SAVE(EMIFS_CONFIG);
417	} else if (cpu_is_omap16xx()) {
418		MPUI1610_SAVE(MPUI_CTRL);
419		MPUI1610_SAVE(MPUI_DSP_STATUS);
420		MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
421		MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
422		MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
423		MPUI1610_SAVE(EMIFS_CONFIG);
424	}
425
426	seq_printf(m,
427		   "ARM_CKCTL_REG:            0x%-8x     \n"
428		   "ARM_IDLECT1_REG:          0x%-8x     \n"
429		   "ARM_IDLECT2_REG:          0x%-8x     \n"
430		   "ARM_IDLECT3_REG:	      0x%-8x     \n"
431		   "ARM_EWUPCT_REG:           0x%-8x     \n"
432		   "ARM_RSTCT1_REG:           0x%-8x     \n"
433		   "ARM_RSTCT2_REG:           0x%-8x     \n"
434		   "ARM_SYSST_REG:            0x%-8x     \n"
435		   "ULPD_IT_STATUS_REG:       0x%-4x     \n"
436		   "ULPD_CLOCK_CTRL_REG:      0x%-4x     \n"
437		   "ULPD_SOFT_REQ_REG:        0x%-4x     \n"
438		   "ULPD_DPLL_CTRL_REG:       0x%-4x     \n"
439		   "ULPD_STATUS_REQ_REG:      0x%-4x     \n"
440		   "ULPD_POWER_CTRL_REG:      0x%-4x     \n",
441		   ARM_SHOW(ARM_CKCTL),
442		   ARM_SHOW(ARM_IDLECT1),
443		   ARM_SHOW(ARM_IDLECT2),
444		   ARM_SHOW(ARM_IDLECT3),
445		   ARM_SHOW(ARM_EWUPCT),
446		   ARM_SHOW(ARM_RSTCT1),
447		   ARM_SHOW(ARM_RSTCT2),
448		   ARM_SHOW(ARM_SYSST),
449		   ULPD_SHOW(ULPD_IT_STATUS),
450		   ULPD_SHOW(ULPD_CLOCK_CTRL),
451		   ULPD_SHOW(ULPD_SOFT_REQ),
452		   ULPD_SHOW(ULPD_DPLL_CTRL),
453		   ULPD_SHOW(ULPD_STATUS_REQ),
454		   ULPD_SHOW(ULPD_POWER_CTRL));
455
456	if (cpu_is_omap15xx()) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
457		seq_printf(m,
458			   "MPUI1510_CTRL_REG             0x%-8x \n"
459			   "MPUI1510_DSP_STATUS_REG:      0x%-8x \n"
460			   "MPUI1510_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
461			   "MPUI1510_DSP_API_CONFIG_REG:  0x%-8x \n"
462			   "MPUI1510_SDRAM_CONFIG_REG:    0x%-8x \n"
463			   "MPUI1510_EMIFS_CONFIG_REG:    0x%-8x \n",
464			   MPUI1510_SHOW(MPUI_CTRL),
465			   MPUI1510_SHOW(MPUI_DSP_STATUS),
466			   MPUI1510_SHOW(MPUI_DSP_BOOT_CONFIG),
467			   MPUI1510_SHOW(MPUI_DSP_API_CONFIG),
468			   MPUI1510_SHOW(EMIFF_SDRAM_CONFIG),
469			   MPUI1510_SHOW(EMIFS_CONFIG));
470	} else if (cpu_is_omap16xx()) {
471		seq_printf(m,
472			   "MPUI1610_CTRL_REG             0x%-8x \n"
473			   "MPUI1610_DSP_STATUS_REG:      0x%-8x \n"
474			   "MPUI1610_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
475			   "MPUI1610_DSP_API_CONFIG_REG:  0x%-8x \n"
476			   "MPUI1610_SDRAM_CONFIG_REG:    0x%-8x \n"
477			   "MPUI1610_EMIFS_CONFIG_REG:    0x%-8x \n",
478			   MPUI1610_SHOW(MPUI_CTRL),
479			   MPUI1610_SHOW(MPUI_DSP_STATUS),
480			   MPUI1610_SHOW(MPUI_DSP_BOOT_CONFIG),
481			   MPUI1610_SHOW(MPUI_DSP_API_CONFIG),
482			   MPUI1610_SHOW(EMIFF_SDRAM_CONFIG),
483			   MPUI1610_SHOW(EMIFS_CONFIG));
484	}
485
486	return 0;
487}
488
489DEFINE_SHOW_ATTRIBUTE(omap_pm_debug);
 
 
 
 
 
 
 
 
 
 
 
490
491static void omap_pm_init_debugfs(void)
492{
493	struct dentry *d;
494
495	d = debugfs_create_dir("pm_debug", NULL);
496	debugfs_create_file("omap_pm", S_IWUSR | S_IRUGO, d, NULL,
497			    &omap_pm_debug_fops);
 
 
 
498}
499
500#endif /* CONFIG_DEBUG_FS */
501
502/*
503 *	omap_pm_prepare - Do preliminary suspend work.
504 *
505 */
506static int omap_pm_prepare(void)
507{
508	/* We cannot sleep in idle until we have resumed */
509	cpu_idle_poll_ctrl(true);
510	return 0;
511}
512
513
514/*
515 *	omap_pm_enter - Actually enter a sleep state.
516 *	@state:		State we're entering.
517 *
518 */
519
520static int omap_pm_enter(suspend_state_t state)
521{
522	switch (state)
523	{
 
524	case PM_SUSPEND_MEM:
525		omap1_pm_suspend();
526		break;
527	default:
528		return -EINVAL;
529	}
530
531	return 0;
532}
533
534
535/**
536 *	omap_pm_finish - Finish up suspend sequence.
537 *
538 *	This is called after we wake back up (or if entering the sleep state
539 *	failed).
540 */
541
542static void omap_pm_finish(void)
543{
544	cpu_idle_poll_ctrl(false);
545}
546
547
548static irqreturn_t omap_wakeup_interrupt(int irq, void *dev)
549{
550	return IRQ_HANDLED;
551}
552
 
 
 
 
 
553
554
555static const struct platform_suspend_ops omap_pm_ops = {
556	.prepare	= omap_pm_prepare,
557	.enter		= omap_pm_enter,
558	.finish		= omap_pm_finish,
559	.valid		= suspend_valid_only_mem,
560};
561
562static int __init omap_pm_init(void)
563{
564	int error = 0;
565	int irq;
 
 
566
567	if (!cpu_class_is_omap1())
568		return -ENODEV;
569
570	pr_info("Power Management for TI OMAP.\n");
571
572	if (!IS_ENABLED(CONFIG_OMAP_32K_TIMER))
573		pr_info("OMAP1 PM: sleep states in idle disabled due to no 32KiHz timer\n");
574
575	if (!IS_ENABLED(CONFIG_OMAP_DM_TIMER))
576		pr_info("OMAP1 PM: sleep states in idle disabled due to no DMTIMER support\n");
577
578	if (IS_ENABLED(CONFIG_OMAP_32K_TIMER) &&
579	    IS_ENABLED(CONFIG_OMAP_DM_TIMER)) {
580		/* OMAP16xx only */
581		pr_info("OMAP1 PM: sleep states in idle enabled\n");
582		enable_dyn_sleep = 1;
583	}
584
585	/*
586	 * We copy the assembler sleep/wakeup routines to SRAM.
587	 * These routines need to be in SRAM as that's the only
588	 * memory the MPU can see when it wakes up.
589	 */
590	if (cpu_is_omap15xx()) {
 
 
 
591		omap_sram_suspend = omap_sram_push(omap1510_cpu_suspend,
592						   omap1510_cpu_suspend_sz);
593	} else if (cpu_is_omap16xx()) {
594		omap_sram_suspend = omap_sram_push(omap1610_cpu_suspend,
595						   omap1610_cpu_suspend_sz);
596	}
597
598	if (omap_sram_suspend == NULL) {
599		printk(KERN_ERR "PM not initialized: Missing SRAM support\n");
600		return -ENODEV;
601	}
602
603	arm_pm_idle = omap1_pm_idle;
604
605	if (cpu_is_omap16xx())
606		irq = INT_1610_WAKE_UP_REQ;
607	else
608		irq = -1;
609
610	if (irq >= 0) {
611		if (request_irq(irq, omap_wakeup_interrupt, 0, "peripheral wakeup", NULL))
612			pr_err("Failed to request irq %d (peripheral wakeup)\n", irq);
613	}
614
615	/* Program new power ramp-up time
616	 * (0 for most boards since we don't lower voltage when in deep sleep)
617	 */
618	omap_writew(ULPD_SETUP_ANALOG_CELL_3_VAL, ULPD_SETUP_ANALOG_CELL_3);
619
620	/* Setup ULPD POWER_CTRL_REG - enter deep sleep whenever possible */
621	omap_writew(ULPD_POWER_CTRL_REG_VAL, ULPD_POWER_CTRL);
622
623	/* Configure IDLECT3 */
624	if (cpu_is_omap16xx())
 
 
625		omap_writel(OMAP1610_IDLECT3_VAL, OMAP1610_IDLECT3);
626
627	suspend_set_ops(&omap_pm_ops);
628
629#ifdef CONFIG_DEBUG_FS
630	omap_pm_init_debugfs();
631#endif
632
 
633	error = sysfs_create_file(power_kobj, &sleep_while_idle_attr.attr);
634	if (error)
635		pr_err("sysfs_create_file failed: %d\n", error);
 
636
637	if (cpu_is_omap16xx()) {
638		/* configure LOW_PWR pin */
639		omap_cfg_reg(T20_1610_LOW_PWR);
640	}
641
642	return error;
643}
644__initcall(omap_pm_init);