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
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
|
/*
* Copyright (C) STMicroelectronics 2009
* Copyright (C) ST-Ericsson SA 2010-2011
*
* License Terms: GNU General Public License v2
*
* Authors: Rickard Andersson <rickard.andersson@stericsson.com>,
* Jonas Aaberg <jonas.aberg@stericsson.com>,
* Sundar Iyer for ST-Ericsson.
*
*/
#include <linux/suspend.h>
#include <linux/gpio.h>
#include <linux/delay.h>
#include <linux/regulator/ab8500-debug.h>
#include <mach/prcmu.h>
#include <mach/prcmu-regs.h>
#include "context.h"
#include "pm.h"
#include "suspend_dbg.h"
static void (*pins_suspend_force)(void);
static void (*pins_suspend_force_mux)(void);
void suspend_set_pins_force_fn(void (*force)(void), void (*force_mux)(void))
{
pins_suspend_force = force;
pins_suspend_force_mux = force_mux;
}
static atomic_t block_sleep = ATOMIC_INIT(0);
void suspend_block_sleep(void)
{
atomic_inc(&block_sleep);
}
void suspend_unblock_sleep(void)
{
atomic_dec(&block_sleep);
}
static bool sleep_is_blocked(void)
{
return (atomic_read(&block_sleep) != 0);
}
static int suspend(bool do_deepsleep)
{
bool pins_force = pins_suspend_force_mux && pins_suspend_force;
int ret = 0;
if (sleep_is_blocked()) {
pr_info("suspend/resume: interrupted by modem.\n");
return -EBUSY;
}
nmk_gpio_clocks_enable();
ux500_suspend_dbg_add_wake_on_uart();
nmk_gpio_wakeups_suspend();
/* configure the prcm for a sleep wakeup */
prcmu_enable_wakeups(PRCMU_WAKEUP(ABB));
context_vape_save();
if (pins_force) {
/*
* Save GPIO settings before applying power save
* settings
*/
context_gpio_save();
/* Apply GPIO power save mux settings */
context_gpio_mux_safe_switch(true);
pins_suspend_force_mux();
context_gpio_mux_safe_switch(false);
/* Apply GPIO power save settings */
pins_suspend_force();
}
ux500_pm_gic_decouple();
/* TODO: decouple gic should look at status bit.*/
udelay(100);
if (ux500_pm_gic_pending_interrupt()) {
pr_info("suspend/resume: pending interrupt\n");
/* Recouple GIC with the interrupt bus */
ux500_pm_gic_recouple();
ret = -EBUSY;
goto exit;
}
ux500_pm_prcmu_set_ioforce(true);
if (do_deepsleep) {
context_varm_save_common();
context_varm_save_core();
context_save_cpu_registers();
/*
* Due to we have only 100us between requesting a powerstate
* and wfi, we clean the cache before as well to assure the
* final cache clean before wfi has as little as possible to
* do.
*/
context_clean_l1_cache_all();
(void) prcmu_set_power_state(PRCMU_AP_DEEP_SLEEP,
false, false);
context_save_to_sram_and_wfi(true, true);
context_restore_cpu_registers();
context_varm_restore_core();
context_varm_restore_common();
} else {
context_clean_l1_cache_all();
(void) prcmu_set_power_state(APEXECUTE_TO_APSLEEP,
false, false);
dsb();
__asm__ __volatile__("wfi\n\t" : : : "memory");
}
context_vape_restore();
/* If GPIO woke us up then save the pins that caused the wake up */
ux500_pm_gpio_save_wake_up_status();
ux500_suspend_dbg_sleep_status(do_deepsleep);
/* APE was turned off, restore IO ring */
ux500_pm_prcmu_set_ioforce(false);
exit:
if (pins_force) {
/* Restore gpio settings */
context_gpio_mux_safe_switch(true);
context_gpio_restore_mux();
context_gpio_mux_safe_switch(false);
context_gpio_restore();
}
/* This is what cpuidle wants */
prcmu_enable_wakeups(PRCMU_WAKEUP(ARM) | PRCMU_WAKEUP(RTC) |
PRCMU_WAKEUP(ABB));
nmk_gpio_wakeups_resume();
ux500_suspend_dbg_remove_wake_on_uart();
nmk_gpio_clocks_disable();
return ret;
}
static int ux500_suspend_enter(suspend_state_t state)
{
if (ux500_suspend_enabled()) {
if (ux500_suspend_deepsleep_enabled() &&
state == PM_SUSPEND_MEM)
return suspend(true);
if (ux500_suspend_sleep_enabled())
return suspend(false);
/* For debugging, if Sleep and DeepSleep disabled, do Idle */
prcmu_set_power_state(PRCMU_AP_IDLE, true, true);
}
dsb();
__asm__ __volatile__("wfi\n\t" : : : "memory");
return 0;
}
static int ux500_suspend_valid(suspend_state_t state)
{
return state == PM_SUSPEND_MEM || state == PM_SUSPEND_STANDBY;
}
static int ux500_suspend_prepare_late(void)
{
(void)prcmu_config_esram0_deep_sleep(ESRAM0_DEEP_SLEEP_STATE_OFF);
ab8500_regulator_debug_force();
return 0;
}
static void ux500_suspend_wake(void)
{
ab8500_regulator_debug_restore();
(void)prcmu_config_esram0_deep_sleep(ESRAM0_DEEP_SLEEP_STATE_RET);
}
static struct platform_suspend_ops ux500_suspend_ops = {
.enter = ux500_suspend_enter,
.valid = ux500_suspend_valid,
.prepare_late = ux500_suspend_prepare_late,
.wake = ux500_suspend_wake,
.begin = ux500_suspend_dbg_begin,
};
static __init int ux500_suspend_init(void)
{
ux500_suspend_dbg_init();
suspend_set_ops(&ux500_suspend_ops);
return 0;
}
device_initcall(ux500_suspend_init);
|
