에프에이리눅스 / 1611_0007_prime_oven

Blame view

kernel/linux-imx6_3.14.28/arch/arm/mach-sa1100/pm.c 2.57 KB
edit raw normal view history
6b13f685e   김민수   BSP 최초 추가 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
 
  /*
   * SA1100 Power Management Routines
   *
   * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License.
   *
   * History:
   *
   * 2001-02-06:	Cliff Brake         Initial code
   *
   * 2001-02-25:	Sukjae Cho <sjcho@east.isi.edu> &
   * 		Chester Kuo <chester@linux.org.tw>
   * 			Save more value for the resume function! Support
   * 			Bitsy/Assabet/Freebird board
   *
   * 2001-08-29:	Nicolas Pitre <nico@fluxnic.net>
   * 			Cleaned up, pushed platform dependent stuff
   * 			in the platform specific files.
   *
   * 2002-05-27:	Nicolas Pitre	Killed sleep.h and the kmalloced save array.
   * 				Storage is local on the stack now.
   */
  #include <linux/init.h>
  #include <linux/io.h>
  #include <linux/suspend.h>
  #include <linux/errno.h>
  #include <linux/time.h>
  
  #include <mach/hardware.h>
  #include <asm/memory.h>
  #include <asm/suspend.h>
  #include <asm/mach/time.h>
  
  extern int sa1100_finish_suspend(unsigned long);
  
  #define SAVE(x)		sleep_save[SLEEP_SAVE_##x] = x
  #define RESTORE(x)	x = sleep_save[SLEEP_SAVE_##x]
  
  /*
   * List of global SA11x0 peripheral registers to preserve.
   * More ones like CP and general purpose register values are preserved
   * on the stack and then the stack pointer is stored last in sleep.S.
   */
  enum {	SLEEP_SAVE_GPDR, SLEEP_SAVE_GAFR,
  	SLEEP_SAVE_PPDR, SLEEP_SAVE_PPSR, SLEEP_SAVE_PPAR, SLEEP_SAVE_PSDR,
  
  	SLEEP_SAVE_Ser1SDCR0,
  
  	SLEEP_SAVE_COUNT
  };
  
  
  static int sa11x0_pm_enter(suspend_state_t state)
  {
  	unsigned long gpio, sleep_save[SLEEP_SAVE_COUNT];
  
  	gpio = GPLR;
  
  	/* save vital registers */
  	SAVE(GPDR);
  	SAVE(GAFR);
  
  	SAVE(PPDR);
  	SAVE(PPSR);
  	SAVE(PPAR);
  	SAVE(PSDR);
  
  	SAVE(Ser1SDCR0);
  
  	/* Clear previous reset status */
  	RCSR = RCSR_HWR | RCSR_SWR | RCSR_WDR | RCSR_SMR;
  
  	/* set resume return address */
  	PSPR = virt_to_phys(cpu_resume);
  
  	/* go zzz */
  	cpu_suspend(0, sa1100_finish_suspend);
  
  	/*
  	 * Ensure not to come back here if it wasn't intended
  	 */
  	PSPR = 0;
  
  	/*
  	 * Ensure interrupt sources are disabled; we will re-init
  	 * the interrupt subsystem via the device manager.
  	 */
  	ICLR = 0;
  	ICCR = 1;
  	ICMR = 0;
  
  	/* restore registers */
  	RESTORE(GPDR);
  	RESTORE(GAFR);
  
  	RESTORE(PPDR);
  	RESTORE(PPSR);
  	RESTORE(PPAR);
  	RESTORE(PSDR);
  
  	RESTORE(Ser1SDCR0);
  
  	GPSR = gpio;
  	GPCR = ~gpio;
  
  	/*
  	 * Clear the peripheral sleep-hold bit.
  	 */
  	PSSR = PSSR_PH;
  
  	return 0;
  }
  
  static const struct platform_suspend_ops sa11x0_pm_ops = {
  	.enter		= sa11x0_pm_enter,
  	.valid		= suspend_valid_only_mem,
  };
  
  int __init sa11x0_pm_init(void)
  {
  	suspend_set_ops(&sa11x0_pm_ops);
  	return 0;
  }