Linux Audio

Check our new training course

Linux debugging, profiling, tracing and performance analysis training

Mar 24-27, 2025, special US time zones
Register
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);
v4.17
  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 <clocksource/timer-ti-dm.h>
 59
 60#include <mach/irqs.h>
 61
 62#include "iomap.h"
 63#include "clock.h"
 64#include "pm.h"
 65#include "soc.h"
 66#include "sram.h"
 67
 68static unsigned int arm_sleep_save[ARM_SLEEP_SAVE_SIZE];
 69static unsigned short dsp_sleep_save[DSP_SLEEP_SAVE_SIZE];
 70static unsigned short ulpd_sleep_save[ULPD_SLEEP_SAVE_SIZE];
 71static unsigned int mpui7xx_sleep_save[MPUI7XX_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_omap7xx())
169		level1_wake = OMAP_IRQ_BIT(INT_7XX_GPIO_BANK1) |
170			OMAP_IRQ_BIT(INT_7XX_IH2_IRQ);
171	else if (cpu_is_omap15xx())
172		level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
173			OMAP_IRQ_BIT(INT_1510_IH2_IRQ);
174	else if (cpu_is_omap16xx())
175		level1_wake = OMAP_IRQ_BIT(INT_GPIO_BANK1) |
176			OMAP_IRQ_BIT(INT_1610_IH2_IRQ);
177
178	omap_writel(~level1_wake, OMAP_IH1_MIR);
179
180	if (cpu_is_omap7xx()) {
181		omap_writel(~level2_wake, OMAP_IH2_0_MIR);
182		omap_writel(~(OMAP_IRQ_BIT(INT_7XX_WAKE_UP_REQ) |
183				OMAP_IRQ_BIT(INT_7XX_MPUIO_KEYPAD)),
184				OMAP_IH2_1_MIR);
185	} else if (cpu_is_omap15xx()) {
186		level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
187		omap_writel(~level2_wake,  OMAP_IH2_MIR);
188	} else if (cpu_is_omap16xx()) {
189		level2_wake |= OMAP_IRQ_BIT(INT_KEYBOARD);
190		omap_writel(~level2_wake, OMAP_IH2_0_MIR);
191
192		/* INT_1610_WAKE_UP_REQ is needed for GPIO wakeup... */
193		omap_writel(~OMAP_IRQ_BIT(INT_1610_WAKE_UP_REQ),
194			    OMAP_IH2_1_MIR);
195		omap_writel(~0x0, OMAP_IH2_2_MIR);
196		omap_writel(~0x0, OMAP_IH2_3_MIR);
197	}
198
199	/*  New IRQ agreement, recalculate in cascade order */
200	omap_writel(1, OMAP_IH2_CONTROL);
201	omap_writel(1, OMAP_IH1_CONTROL);
202}
203
204#define EN_DSPCK	13	/* ARM_CKCTL */
205#define EN_APICK	6	/* ARM_IDLECT2 */
206#define DSP_EN		1	/* ARM_RSTCT1 */
207
208void omap1_pm_suspend(void)
209{
210	unsigned long arg0 = 0, arg1 = 0;
211
212	printk(KERN_INFO "PM: OMAP%x is trying to enter deep sleep...\n",
213		omap_rev());
214
215	omap_serial_wake_trigger(1);
216
217	if (!cpu_is_omap15xx())
218		omap_writew(0xffff, ULPD_SOFT_DISABLE_REQ_REG);
219
220	/*
221	 * Step 1: turn off interrupts (FIXME: NOTE: already disabled)
222	 */
223
224	local_irq_disable();
225	local_fiq_disable();
226
227	/*
228	 * Step 2: save registers
229	 *
230	 * The omap is a strange/beautiful device. The caches, memory
231	 * and register state are preserved across power saves.
232	 * We have to save and restore very little register state to
233	 * idle the omap.
234         *
235	 * Save interrupt, MPUI, ARM and UPLD control registers.
236	 */
237
238	if (cpu_is_omap7xx()) {
239		MPUI7XX_SAVE(OMAP_IH1_MIR);
240		MPUI7XX_SAVE(OMAP_IH2_0_MIR);
241		MPUI7XX_SAVE(OMAP_IH2_1_MIR);
242		MPUI7XX_SAVE(MPUI_CTRL);
243		MPUI7XX_SAVE(MPUI_DSP_BOOT_CONFIG);
244		MPUI7XX_SAVE(MPUI_DSP_API_CONFIG);
245		MPUI7XX_SAVE(EMIFS_CONFIG);
246		MPUI7XX_SAVE(EMIFF_SDRAM_CONFIG);
247
248	} else if (cpu_is_omap15xx()) {
249		MPUI1510_SAVE(OMAP_IH1_MIR);
250		MPUI1510_SAVE(OMAP_IH2_MIR);
251		MPUI1510_SAVE(MPUI_CTRL);
252		MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
253		MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
254		MPUI1510_SAVE(EMIFS_CONFIG);
255		MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
256	} else if (cpu_is_omap16xx()) {
257		MPUI1610_SAVE(OMAP_IH1_MIR);
258		MPUI1610_SAVE(OMAP_IH2_0_MIR);
259		MPUI1610_SAVE(OMAP_IH2_1_MIR);
260		MPUI1610_SAVE(OMAP_IH2_2_MIR);
261		MPUI1610_SAVE(OMAP_IH2_3_MIR);
262		MPUI1610_SAVE(MPUI_CTRL);
263		MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
264		MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
265		MPUI1610_SAVE(EMIFS_CONFIG);
266		MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
267	}
268
269	ARM_SAVE(ARM_CKCTL);
270	ARM_SAVE(ARM_IDLECT1);
271	ARM_SAVE(ARM_IDLECT2);
272	if (!(cpu_is_omap15xx()))
273		ARM_SAVE(ARM_IDLECT3);
274	ARM_SAVE(ARM_EWUPCT);
275	ARM_SAVE(ARM_RSTCT1);
276	ARM_SAVE(ARM_RSTCT2);
277	ARM_SAVE(ARM_SYSST);
278	ULPD_SAVE(ULPD_CLOCK_CTRL);
279	ULPD_SAVE(ULPD_STATUS_REQ);
280
281	/* (Step 3 removed - we now allow deep sleep by default) */
282
283	/*
284	 * Step 4: OMAP DSP Shutdown
285	 */
286
287	/* stop DSP */
288	omap_writew(omap_readw(ARM_RSTCT1) & ~(1 << DSP_EN), ARM_RSTCT1);
289
290		/* shut down dsp_ck */
291	if (!cpu_is_omap7xx())
292		omap_writew(omap_readw(ARM_CKCTL) & ~(1 << EN_DSPCK), ARM_CKCTL);
293
294	/* temporarily enabling api_ck to access DSP registers */
295	omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
296
297	/* save DSP registers */
298	DSP_SAVE(DSP_IDLECT2);
299
300	/* Stop all DSP domain clocks */
301	__raw_writew(0, DSP_IDLECT2);
302
303	/*
304	 * Step 5: Wakeup Event Setup
305	 */
306
307	omap_pm_wakeup_setup();
308
309	/*
310	 * Step 6: ARM and Traffic controller shutdown
311	 */
312
313	/* disable ARM watchdog */
314	omap_writel(0x00F5, OMAP_WDT_TIMER_MODE);
315	omap_writel(0x00A0, OMAP_WDT_TIMER_MODE);
316
317	/*
318	 * Step 6b: ARM and Traffic controller shutdown
319	 *
320	 * Step 6 continues here. Prepare jump to power management
321	 * assembly code in internal SRAM.
322	 *
323	 * Since the omap_cpu_suspend routine has been copied to
324	 * SRAM, we'll do an indirect procedure call to it and pass the
325	 * contents of arm_idlect1 and arm_idlect2 so it can restore
326	 * them when it wakes up and it will return.
327	 */
328
329	arg0 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT1];
330	arg1 = arm_sleep_save[ARM_SLEEP_SAVE_ARM_IDLECT2];
331
332	/*
333	 * Step 6c: ARM and Traffic controller shutdown
334	 *
335	 * Jump to assembly code. The processor will stay there
336	 * until wake up.
337	 */
338	omap_sram_suspend(arg0, arg1);
339
340	/*
341	 * If we are here, processor is woken up!
342	 */
343
344	/*
345	 * Restore DSP clocks
346	 */
347
348	/* again temporarily enabling api_ck to access DSP registers */
349	omap_writew(omap_readw(ARM_IDLECT2) | 1 << EN_APICK, ARM_IDLECT2);
350
351	/* Restore DSP domain clocks */
352	DSP_RESTORE(DSP_IDLECT2);
353
354	/*
355	 * Restore ARM state, except ARM_IDLECT1/2 which omap_cpu_suspend did
356	 */
357
358	if (!(cpu_is_omap15xx()))
359		ARM_RESTORE(ARM_IDLECT3);
360	ARM_RESTORE(ARM_CKCTL);
361	ARM_RESTORE(ARM_EWUPCT);
362	ARM_RESTORE(ARM_RSTCT1);
363	ARM_RESTORE(ARM_RSTCT2);
364	ARM_RESTORE(ARM_SYSST);
365	ULPD_RESTORE(ULPD_CLOCK_CTRL);
366	ULPD_RESTORE(ULPD_STATUS_REQ);
367
368	if (cpu_is_omap7xx()) {
369		MPUI7XX_RESTORE(EMIFS_CONFIG);
370		MPUI7XX_RESTORE(EMIFF_SDRAM_CONFIG);
371		MPUI7XX_RESTORE(OMAP_IH1_MIR);
372		MPUI7XX_RESTORE(OMAP_IH2_0_MIR);
373		MPUI7XX_RESTORE(OMAP_IH2_1_MIR);
374	} else if (cpu_is_omap15xx()) {
375		MPUI1510_RESTORE(MPUI_CTRL);
376		MPUI1510_RESTORE(MPUI_DSP_BOOT_CONFIG);
377		MPUI1510_RESTORE(MPUI_DSP_API_CONFIG);
378		MPUI1510_RESTORE(EMIFS_CONFIG);
379		MPUI1510_RESTORE(EMIFF_SDRAM_CONFIG);
380		MPUI1510_RESTORE(OMAP_IH1_MIR);
381		MPUI1510_RESTORE(OMAP_IH2_MIR);
382	} else if (cpu_is_omap16xx()) {
383		MPUI1610_RESTORE(MPUI_CTRL);
384		MPUI1610_RESTORE(MPUI_DSP_BOOT_CONFIG);
385		MPUI1610_RESTORE(MPUI_DSP_API_CONFIG);
386		MPUI1610_RESTORE(EMIFS_CONFIG);
387		MPUI1610_RESTORE(EMIFF_SDRAM_CONFIG);
388
389		MPUI1610_RESTORE(OMAP_IH1_MIR);
390		MPUI1610_RESTORE(OMAP_IH2_0_MIR);
391		MPUI1610_RESTORE(OMAP_IH2_1_MIR);
392		MPUI1610_RESTORE(OMAP_IH2_2_MIR);
393		MPUI1610_RESTORE(OMAP_IH2_3_MIR);
394	}
395
396	if (!cpu_is_omap15xx())
397		omap_writew(0, ULPD_SOFT_DISABLE_REQ_REG);
398
399	/*
400	 * Re-enable interrupts
401	 */
402
403	local_irq_enable();
404	local_fiq_enable();
405
406	omap_serial_wake_trigger(0);
407
408	printk(KERN_INFO "PM: OMAP%x is re-starting from deep sleep...\n",
409		omap_rev());
410}
411
412#ifdef CONFIG_DEBUG_FS
413/*
414 * Read system PM registers for debugging
415 */
416static int omap_pm_debug_show(struct seq_file *m, void *v)
417{
418	ARM_SAVE(ARM_CKCTL);
419	ARM_SAVE(ARM_IDLECT1);
420	ARM_SAVE(ARM_IDLECT2);
421	if (!(cpu_is_omap15xx()))
422		ARM_SAVE(ARM_IDLECT3);
423	ARM_SAVE(ARM_EWUPCT);
424	ARM_SAVE(ARM_RSTCT1);
425	ARM_SAVE(ARM_RSTCT2);
426	ARM_SAVE(ARM_SYSST);
427
428	ULPD_SAVE(ULPD_IT_STATUS);
429	ULPD_SAVE(ULPD_CLOCK_CTRL);
430	ULPD_SAVE(ULPD_SOFT_REQ);
431	ULPD_SAVE(ULPD_STATUS_REQ);
432	ULPD_SAVE(ULPD_DPLL_CTRL);
433	ULPD_SAVE(ULPD_POWER_CTRL);
434
435	if (cpu_is_omap7xx()) {
436		MPUI7XX_SAVE(MPUI_CTRL);
437		MPUI7XX_SAVE(MPUI_DSP_STATUS);
438		MPUI7XX_SAVE(MPUI_DSP_BOOT_CONFIG);
439		MPUI7XX_SAVE(MPUI_DSP_API_CONFIG);
440		MPUI7XX_SAVE(EMIFF_SDRAM_CONFIG);
441		MPUI7XX_SAVE(EMIFS_CONFIG);
442	} else if (cpu_is_omap15xx()) {
443		MPUI1510_SAVE(MPUI_CTRL);
444		MPUI1510_SAVE(MPUI_DSP_STATUS);
445		MPUI1510_SAVE(MPUI_DSP_BOOT_CONFIG);
446		MPUI1510_SAVE(MPUI_DSP_API_CONFIG);
447		MPUI1510_SAVE(EMIFF_SDRAM_CONFIG);
448		MPUI1510_SAVE(EMIFS_CONFIG);
449	} else if (cpu_is_omap16xx()) {
450		MPUI1610_SAVE(MPUI_CTRL);
451		MPUI1610_SAVE(MPUI_DSP_STATUS);
452		MPUI1610_SAVE(MPUI_DSP_BOOT_CONFIG);
453		MPUI1610_SAVE(MPUI_DSP_API_CONFIG);
454		MPUI1610_SAVE(EMIFF_SDRAM_CONFIG);
455		MPUI1610_SAVE(EMIFS_CONFIG);
456	}
457
458	seq_printf(m,
459		   "ARM_CKCTL_REG:            0x%-8x     \n"
460		   "ARM_IDLECT1_REG:          0x%-8x     \n"
461		   "ARM_IDLECT2_REG:          0x%-8x     \n"
462		   "ARM_IDLECT3_REG:	      0x%-8x     \n"
463		   "ARM_EWUPCT_REG:           0x%-8x     \n"
464		   "ARM_RSTCT1_REG:           0x%-8x     \n"
465		   "ARM_RSTCT2_REG:           0x%-8x     \n"
466		   "ARM_SYSST_REG:            0x%-8x     \n"
467		   "ULPD_IT_STATUS_REG:       0x%-4x     \n"
468		   "ULPD_CLOCK_CTRL_REG:      0x%-4x     \n"
469		   "ULPD_SOFT_REQ_REG:        0x%-4x     \n"
470		   "ULPD_DPLL_CTRL_REG:       0x%-4x     \n"
471		   "ULPD_STATUS_REQ_REG:      0x%-4x     \n"
472		   "ULPD_POWER_CTRL_REG:      0x%-4x     \n",
473		   ARM_SHOW(ARM_CKCTL),
474		   ARM_SHOW(ARM_IDLECT1),
475		   ARM_SHOW(ARM_IDLECT2),
476		   ARM_SHOW(ARM_IDLECT3),
477		   ARM_SHOW(ARM_EWUPCT),
478		   ARM_SHOW(ARM_RSTCT1),
479		   ARM_SHOW(ARM_RSTCT2),
480		   ARM_SHOW(ARM_SYSST),
481		   ULPD_SHOW(ULPD_IT_STATUS),
482		   ULPD_SHOW(ULPD_CLOCK_CTRL),
483		   ULPD_SHOW(ULPD_SOFT_REQ),
484		   ULPD_SHOW(ULPD_DPLL_CTRL),
485		   ULPD_SHOW(ULPD_STATUS_REQ),
486		   ULPD_SHOW(ULPD_POWER_CTRL));
487
488	if (cpu_is_omap7xx()) {
489		seq_printf(m,
490			   "MPUI7XX_CTRL_REG	     0x%-8x \n"
491			   "MPUI7XX_DSP_STATUS_REG:      0x%-8x \n"
492			   "MPUI7XX_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
493			   "MPUI7XX_DSP_API_CONFIG_REG:  0x%-8x \n"
494			   "MPUI7XX_SDRAM_CONFIG_REG:    0x%-8x \n"
495			   "MPUI7XX_EMIFS_CONFIG_REG:    0x%-8x \n",
496			   MPUI7XX_SHOW(MPUI_CTRL),
497			   MPUI7XX_SHOW(MPUI_DSP_STATUS),
498			   MPUI7XX_SHOW(MPUI_DSP_BOOT_CONFIG),
499			   MPUI7XX_SHOW(MPUI_DSP_API_CONFIG),
500			   MPUI7XX_SHOW(EMIFF_SDRAM_CONFIG),
501			   MPUI7XX_SHOW(EMIFS_CONFIG));
502	} else if (cpu_is_omap15xx()) {
503		seq_printf(m,
504			   "MPUI1510_CTRL_REG             0x%-8x \n"
505			   "MPUI1510_DSP_STATUS_REG:      0x%-8x \n"
506			   "MPUI1510_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
507			   "MPUI1510_DSP_API_CONFIG_REG:  0x%-8x \n"
508			   "MPUI1510_SDRAM_CONFIG_REG:    0x%-8x \n"
509			   "MPUI1510_EMIFS_CONFIG_REG:    0x%-8x \n",
510			   MPUI1510_SHOW(MPUI_CTRL),
511			   MPUI1510_SHOW(MPUI_DSP_STATUS),
512			   MPUI1510_SHOW(MPUI_DSP_BOOT_CONFIG),
513			   MPUI1510_SHOW(MPUI_DSP_API_CONFIG),
514			   MPUI1510_SHOW(EMIFF_SDRAM_CONFIG),
515			   MPUI1510_SHOW(EMIFS_CONFIG));
516	} else if (cpu_is_omap16xx()) {
517		seq_printf(m,
518			   "MPUI1610_CTRL_REG             0x%-8x \n"
519			   "MPUI1610_DSP_STATUS_REG:      0x%-8x \n"
520			   "MPUI1610_DSP_BOOT_CONFIG_REG: 0x%-8x \n"
521			   "MPUI1610_DSP_API_CONFIG_REG:  0x%-8x \n"
522			   "MPUI1610_SDRAM_CONFIG_REG:    0x%-8x \n"
523			   "MPUI1610_EMIFS_CONFIG_REG:    0x%-8x \n",
524			   MPUI1610_SHOW(MPUI_CTRL),
525			   MPUI1610_SHOW(MPUI_DSP_STATUS),
526			   MPUI1610_SHOW(MPUI_DSP_BOOT_CONFIG),
527			   MPUI1610_SHOW(MPUI_DSP_API_CONFIG),
528			   MPUI1610_SHOW(EMIFF_SDRAM_CONFIG),
529			   MPUI1610_SHOW(EMIFS_CONFIG));
530	}
531
532	return 0;
533}
534
535static int omap_pm_debug_open(struct inode *inode, struct file *file)
536{
537	return single_open(file, omap_pm_debug_show,
538				&inode->i_private);
539}
540
541static const struct file_operations omap_pm_debug_fops = {
542	.open		= omap_pm_debug_open,
543	.read		= seq_read,
544	.llseek		= seq_lseek,
545	.release	= single_release,
546};
547
548static void omap_pm_init_debugfs(void)
549{
550	struct dentry *d;
551
552	d = debugfs_create_dir("pm_debug", NULL);
553	if (!d)
554		return;
555
556	(void) debugfs_create_file("omap_pm", S_IWUSR | S_IRUGO,
557					d, NULL, &omap_pm_debug_fops);
558}
559
560#endif /* CONFIG_DEBUG_FS */
561
562/*
563 *	omap_pm_prepare - Do preliminary suspend work.
564 *
565 */
566static int omap_pm_prepare(void)
567{
568	/* We cannot sleep in idle until we have resumed */
569	cpu_idle_poll_ctrl(true);
570	return 0;
571}
572
573
574/*
575 *	omap_pm_enter - Actually enter a sleep state.
576 *	@state:		State we're entering.
577 *
578 */
579
580static int omap_pm_enter(suspend_state_t state)
581{
582	switch (state)
583	{
 
584	case PM_SUSPEND_MEM:
585		omap1_pm_suspend();
586		break;
587	default:
588		return -EINVAL;
589	}
590
591	return 0;
592}
593
594
595/**
596 *	omap_pm_finish - Finish up suspend sequence.
597 *
598 *	This is called after we wake back up (or if entering the sleep state
599 *	failed).
600 */
601
602static void omap_pm_finish(void)
603{
604	cpu_idle_poll_ctrl(false);
605}
606
607
608static irqreturn_t omap_wakeup_interrupt(int irq, void *dev)
609{
610	return IRQ_HANDLED;
611}
612
613static struct irqaction omap_wakeup_irq = {
614	.name		= "peripheral wakeup",
615	.handler	= omap_wakeup_interrupt
616};
617
618
619
620static const struct platform_suspend_ops omap_pm_ops = {
621	.prepare	= omap_pm_prepare,
622	.enter		= omap_pm_enter,
623	.finish		= omap_pm_finish,
624	.valid		= suspend_valid_only_mem,
625};
626
627static int __init omap_pm_init(void)
628{
629	int error = 0;
 
 
 
630
631	if (!cpu_class_is_omap1())
632		return -ENODEV;
633
634	pr_info("Power Management for TI OMAP.\n");
635
636	if (!IS_ENABLED(CONFIG_OMAP_32K_TIMER))
637		pr_info("OMAP1 PM: sleep states in idle disabled due to no 32KiHz timer\n");
638
639	if (!IS_ENABLED(CONFIG_OMAP_DM_TIMER))
640		pr_info("OMAP1 PM: sleep states in idle disabled due to no DMTIMER support\n");
641
642	if (IS_ENABLED(CONFIG_OMAP_32K_TIMER) &&
643	    IS_ENABLED(CONFIG_OMAP_DM_TIMER)) {
644		/* OMAP16xx only */
645		pr_info("OMAP1 PM: sleep states in idle enabled\n");
646		enable_dyn_sleep = 1;
647	}
648
649	/*
650	 * We copy the assembler sleep/wakeup routines to SRAM.
651	 * These routines need to be in SRAM as that's the only
652	 * memory the MPU can see when it wakes up.
653	 */
654	if (cpu_is_omap7xx()) {
655		omap_sram_suspend = omap_sram_push(omap7xx_cpu_suspend,
656						   omap7xx_cpu_suspend_sz);
657	} else if (cpu_is_omap15xx()) {
658		omap_sram_suspend = omap_sram_push(omap1510_cpu_suspend,
659						   omap1510_cpu_suspend_sz);
660	} else if (cpu_is_omap16xx()) {
661		omap_sram_suspend = omap_sram_push(omap1610_cpu_suspend,
662						   omap1610_cpu_suspend_sz);
663	}
664
665	if (omap_sram_suspend == NULL) {
666		printk(KERN_ERR "PM not initialized: Missing SRAM support\n");
667		return -ENODEV;
668	}
669
670	arm_pm_idle = omap1_pm_idle;
671
672	if (cpu_is_omap7xx())
673		setup_irq(INT_7XX_WAKE_UP_REQ, &omap_wakeup_irq);
674	else if (cpu_is_omap16xx())
675		setup_irq(INT_1610_WAKE_UP_REQ, &omap_wakeup_irq);
676
677	/* Program new power ramp-up time
678	 * (0 for most boards since we don't lower voltage when in deep sleep)
679	 */
680	omap_writew(ULPD_SETUP_ANALOG_CELL_3_VAL, ULPD_SETUP_ANALOG_CELL_3);
681
682	/* Setup ULPD POWER_CTRL_REG - enter deep sleep whenever possible */
683	omap_writew(ULPD_POWER_CTRL_REG_VAL, ULPD_POWER_CTRL);
684
685	/* Configure IDLECT3 */
686	if (cpu_is_omap7xx())
687		omap_writel(OMAP7XX_IDLECT3_VAL, OMAP7XX_IDLECT3);
688	else if (cpu_is_omap16xx())
689		omap_writel(OMAP1610_IDLECT3_VAL, OMAP1610_IDLECT3);
690
691	suspend_set_ops(&omap_pm_ops);
692
693#ifdef CONFIG_DEBUG_FS
694	omap_pm_init_debugfs();
695#endif
696
 
697	error = sysfs_create_file(power_kobj, &sleep_while_idle_attr.attr);
698	if (error)
699		printk(KERN_ERR "sysfs_create_file failed: %d\n", error);
 
700
701	if (cpu_is_omap16xx()) {
702		/* configure LOW_PWR pin */
703		omap_cfg_reg(T20_1610_LOW_PWR);
704	}
705
706	return error;
707}
708__initcall(omap_pm_init);