diff options
| -rw-r--r-- | kernel/power/main.c | 21 | ||||
| -rw-r--r-- | kernel/power/power.h | 7 | ||||
| -rw-r--r-- | kernel/power/suspend.c | 152 | ||||
| -rw-r--r-- | kernel/power/suspend_test.c | 12 |
4 files changed, 108 insertions, 84 deletions
diff --git a/kernel/power/main.c b/kernel/power/main.c index a18efed75fa7..9a59d042ea84 100644 --- a/kernel/power/main.c +++ b/kernel/power/main.c | |||
| @@ -296,8 +296,8 @@ static ssize_t state_show(struct kobject *kobj, struct kobj_attribute *attr, | |||
| 296 | suspend_state_t i; | 296 | suspend_state_t i; |
| 297 | 297 | ||
| 298 | for (i = PM_SUSPEND_MIN; i < PM_SUSPEND_MAX; i++) | 298 | for (i = PM_SUSPEND_MIN; i < PM_SUSPEND_MAX; i++) |
| 299 | if (pm_states[i].state) | 299 | if (pm_states[i]) |
| 300 | s += sprintf(s,"%s ", pm_states[i].label); | 300 | s += sprintf(s,"%s ", pm_states[i]); |
| 301 | 301 | ||
| 302 | #endif | 302 | #endif |
| 303 | if (hibernation_available()) | 303 | if (hibernation_available()) |
| @@ -311,8 +311,7 @@ static ssize_t state_show(struct kobject *kobj, struct kobj_attribute *attr, | |||
| 311 | static suspend_state_t decode_state(const char *buf, size_t n) | 311 | static suspend_state_t decode_state(const char *buf, size_t n) |
| 312 | { | 312 | { |
| 313 | #ifdef CONFIG_SUSPEND | 313 | #ifdef CONFIG_SUSPEND |
| 314 | suspend_state_t state = PM_SUSPEND_MIN; | 314 | suspend_state_t state; |
| 315 | struct pm_sleep_state *s; | ||
| 316 | #endif | 315 | #endif |
| 317 | char *p; | 316 | char *p; |
| 318 | int len; | 317 | int len; |
| @@ -325,10 +324,12 @@ static suspend_state_t decode_state(const char *buf, size_t n) | |||
| 325 | return PM_SUSPEND_MAX; | 324 | return PM_SUSPEND_MAX; |
| 326 | 325 | ||
| 327 | #ifdef CONFIG_SUSPEND | 326 | #ifdef CONFIG_SUSPEND |
| 328 | for (s = &pm_states[state]; state < PM_SUSPEND_MAX; s++, state++) | 327 | for (state = PM_SUSPEND_MIN; state < PM_SUSPEND_MAX; state++) { |
| 329 | if (s->state && len == strlen(s->label) | 328 | const char *label = pm_states[state]; |
| 330 | && !strncmp(buf, s->label, len)) | 329 | |
| 331 | return s->state; | 330 | if (label && len == strlen(label) && !strncmp(buf, label, len)) |
| 331 | return state; | ||
| 332 | } | ||
| 332 | #endif | 333 | #endif |
| 333 | 334 | ||
| 334 | return PM_SUSPEND_ON; | 335 | return PM_SUSPEND_ON; |
| @@ -446,8 +447,8 @@ static ssize_t autosleep_show(struct kobject *kobj, | |||
| 446 | 447 | ||
| 447 | #ifdef CONFIG_SUSPEND | 448 | #ifdef CONFIG_SUSPEND |
| 448 | if (state < PM_SUSPEND_MAX) | 449 | if (state < PM_SUSPEND_MAX) |
| 449 | return sprintf(buf, "%s\n", pm_states[state].state ? | 450 | return sprintf(buf, "%s\n", pm_states[state] ? |
| 450 | pm_states[state].label : "error"); | 451 | pm_states[state] : "error"); |
| 451 | #endif | 452 | #endif |
| 452 | #ifdef CONFIG_HIBERNATION | 453 | #ifdef CONFIG_HIBERNATION |
| 453 | return sprintf(buf, "disk\n"); | 454 | return sprintf(buf, "disk\n"); |
diff --git a/kernel/power/power.h b/kernel/power/power.h index c60f13b5270a..5d49dcac2537 100644 --- a/kernel/power/power.h +++ b/kernel/power/power.h | |||
| @@ -178,13 +178,8 @@ extern void swsusp_show_speed(struct timeval *, struct timeval *, | |||
| 178 | unsigned int, char *); | 178 | unsigned int, char *); |
| 179 | 179 | ||
| 180 | #ifdef CONFIG_SUSPEND | 180 | #ifdef CONFIG_SUSPEND |
| 181 | struct pm_sleep_state { | ||
| 182 | const char *label; | ||
| 183 | suspend_state_t state; | ||
| 184 | }; | ||
| 185 | |||
| 186 | /* kernel/power/suspend.c */ | 181 | /* kernel/power/suspend.c */ |
| 187 | extern struct pm_sleep_state pm_states[]; | 182 | extern const char *pm_states[]; |
| 188 | 183 | ||
| 189 | extern int suspend_devices_and_enter(suspend_state_t state); | 184 | extern int suspend_devices_and_enter(suspend_state_t state); |
| 190 | #else /* !CONFIG_SUSPEND */ | 185 | #else /* !CONFIG_SUSPEND */ |
diff --git a/kernel/power/suspend.c b/kernel/power/suspend.c index ed35a4790afe..9a071bea80eb 100644 --- a/kernel/power/suspend.c +++ b/kernel/power/suspend.c | |||
| @@ -31,20 +31,11 @@ | |||
| 31 | 31 | ||
| 32 | #include "power.h" | 32 | #include "power.h" |
| 33 | 33 | ||
| 34 | struct pm_sleep_state pm_states[PM_SUSPEND_MAX] = { | 34 | static const char *pm_labels[] = { "mem", "standby", "freeze", }; |
| 35 | [PM_SUSPEND_FREEZE] = { .label = "freeze", .state = PM_SUSPEND_FREEZE }, | 35 | const char *pm_states[PM_SUSPEND_MAX]; |
| 36 | [PM_SUSPEND_STANDBY] = { .label = "standby", }, | ||
| 37 | [PM_SUSPEND_MEM] = { .label = "mem", }, | ||
| 38 | }; | ||
| 39 | 36 | ||
| 40 | static const struct platform_suspend_ops *suspend_ops; | 37 | static const struct platform_suspend_ops *suspend_ops; |
| 41 | static const struct platform_freeze_ops *freeze_ops; | 38 | static const struct platform_freeze_ops *freeze_ops; |
| 42 | |||
| 43 | static bool need_suspend_ops(suspend_state_t state) | ||
| 44 | { | ||
| 45 | return state > PM_SUSPEND_FREEZE; | ||
| 46 | } | ||
| 47 | |||
| 48 | static DECLARE_WAIT_QUEUE_HEAD(suspend_freeze_wait_head); | 39 | static DECLARE_WAIT_QUEUE_HEAD(suspend_freeze_wait_head); |
| 49 | static bool suspend_freeze_wake; | 40 | static bool suspend_freeze_wake; |
| 50 | 41 | ||
| @@ -97,10 +88,7 @@ static bool relative_states; | |||
| 97 | static int __init sleep_states_setup(char *str) | 88 | static int __init sleep_states_setup(char *str) |
| 98 | { | 89 | { |
| 99 | relative_states = !strncmp(str, "1", 1); | 90 | relative_states = !strncmp(str, "1", 1); |
| 100 | if (relative_states) { | 91 | pm_states[PM_SUSPEND_FREEZE] = pm_labels[relative_states ? 0 : 2]; |
| 101 | pm_states[PM_SUSPEND_MEM].state = PM_SUSPEND_FREEZE; | ||
| 102 | pm_states[PM_SUSPEND_FREEZE].state = 0; | ||
| 103 | } | ||
| 104 | return 1; | 92 | return 1; |
| 105 | } | 93 | } |
| 106 | 94 | ||
| @@ -113,20 +101,20 @@ __setup("relative_sleep_states=", sleep_states_setup); | |||
| 113 | void suspend_set_ops(const struct platform_suspend_ops *ops) | 101 | void suspend_set_ops(const struct platform_suspend_ops *ops) |
| 114 | { | 102 | { |
| 115 | suspend_state_t i; | 103 | suspend_state_t i; |
| 116 | int j = PM_SUSPEND_MAX - 1; | 104 | int j = 0; |
| 117 | 105 | ||
| 118 | lock_system_sleep(); | 106 | lock_system_sleep(); |
| 119 | 107 | ||
| 120 | suspend_ops = ops; | 108 | suspend_ops = ops; |
| 121 | for (i = PM_SUSPEND_MEM; i >= PM_SUSPEND_STANDBY; i--) | 109 | for (i = PM_SUSPEND_MEM; i >= PM_SUSPEND_STANDBY; i--) |
| 122 | if (valid_state(i)) | 110 | if (valid_state(i)) { |
| 123 | pm_states[j--].state = i; | 111 | pm_states[i] = pm_labels[j++]; |
| 124 | else if (!relative_states) | 112 | } else if (!relative_states) { |
| 125 | pm_states[j--].state = 0; | 113 | pm_states[i] = NULL; |
| 114 | j++; | ||
| 115 | } | ||
| 126 | 116 | ||
| 127 | pm_states[j--].state = PM_SUSPEND_FREEZE; | 117 | pm_states[PM_SUSPEND_FREEZE] = pm_labels[j]; |
| 128 | while (j >= PM_SUSPEND_MIN) | ||
| 129 | pm_states[j--].state = 0; | ||
| 130 | 118 | ||
| 131 | unlock_system_sleep(); | 119 | unlock_system_sleep(); |
| 132 | } | 120 | } |
| @@ -145,6 +133,65 @@ int suspend_valid_only_mem(suspend_state_t state) | |||
| 145 | } | 133 | } |
| 146 | EXPORT_SYMBOL_GPL(suspend_valid_only_mem); | 134 | EXPORT_SYMBOL_GPL(suspend_valid_only_mem); |
| 147 | 135 | ||
| 136 | static bool sleep_state_supported(suspend_state_t state) | ||
| 137 | { | ||
| 138 | return state == PM_SUSPEND_FREEZE || (suspend_ops && suspend_ops->enter); | ||
| 139 | } | ||
| 140 | |||
| 141 | static int platform_suspend_prepare(suspend_state_t state) | ||
| 142 | { | ||
| 143 | return state != PM_SUSPEND_FREEZE && suspend_ops->prepare ? | ||
| 144 | suspend_ops->prepare() : 0; | ||
| 145 | } | ||
| 146 | |||
| 147 | static int platform_suspend_prepare_late(suspend_state_t state) | ||
| 148 | { | ||
| 149 | return state != PM_SUSPEND_FREEZE && suspend_ops->prepare_late ? | ||
| 150 | suspend_ops->prepare_late() : 0; | ||
| 151 | } | ||
| 152 | |||
| 153 | static void platform_suspend_wake(suspend_state_t state) | ||
| 154 | { | ||
| 155 | if (state != PM_SUSPEND_FREEZE && suspend_ops->wake) | ||
| 156 | suspend_ops->wake(); | ||
| 157 | } | ||
| 158 | |||
| 159 | static void platform_suspend_finish(suspend_state_t state) | ||
| 160 | { | ||
| 161 | if (state != PM_SUSPEND_FREEZE && suspend_ops->finish) | ||
| 162 | suspend_ops->finish(); | ||
| 163 | } | ||
| 164 | |||
| 165 | static int platform_suspend_begin(suspend_state_t state) | ||
| 166 | { | ||
| 167 | if (state == PM_SUSPEND_FREEZE && freeze_ops && freeze_ops->begin) | ||
| 168 | return freeze_ops->begin(); | ||
| 169 | else if (suspend_ops->begin) | ||
| 170 | return suspend_ops->begin(state); | ||
| 171 | else | ||
| 172 | return 0; | ||
| 173 | } | ||
| 174 | |||
| 175 | static void platform_suspend_end(suspend_state_t state) | ||
| 176 | { | ||
| 177 | if (state == PM_SUSPEND_FREEZE && freeze_ops && freeze_ops->end) | ||
| 178 | freeze_ops->end(); | ||
| 179 | else if (suspend_ops->end) | ||
| 180 | suspend_ops->end(); | ||
| 181 | } | ||
| 182 | |||
| 183 | static void platform_suspend_recover(suspend_state_t state) | ||
| 184 | { | ||
| 185 | if (state != PM_SUSPEND_FREEZE && suspend_ops->recover) | ||
| 186 | suspend_ops->recover(); | ||
| 187 | } | ||
| 188 | |||
| 189 | static bool platform_suspend_again(suspend_state_t state) | ||
| 190 | { | ||
| 191 | return state != PM_SUSPEND_FREEZE && suspend_ops->suspend_again ? | ||
| 192 | suspend_ops->suspend_again() : false; | ||
| 193 | } | ||
| 194 | |||
| 148 | static int suspend_test(int level) | 195 | static int suspend_test(int level) |
| 149 | { | 196 | { |
| 150 | #ifdef CONFIG_PM_DEBUG | 197 | #ifdef CONFIG_PM_DEBUG |
| @@ -168,7 +215,7 @@ static int suspend_prepare(suspend_state_t state) | |||
| 168 | { | 215 | { |
| 169 | int error; | 216 | int error; |
| 170 | 217 | ||
| 171 | if (need_suspend_ops(state) && (!suspend_ops || !suspend_ops->enter)) | 218 | if (!sleep_state_supported(state)) |
| 172 | return -EPERM; | 219 | return -EPERM; |
| 173 | 220 | ||
| 174 | pm_prepare_console(); | 221 | pm_prepare_console(); |
| @@ -214,23 +261,18 @@ static int suspend_enter(suspend_state_t state, bool *wakeup) | |||
| 214 | { | 261 | { |
| 215 | int error; | 262 | int error; |
| 216 | 263 | ||
| 217 | if (need_suspend_ops(state) && suspend_ops->prepare) { | 264 | error = platform_suspend_prepare(state); |
| 218 | error = suspend_ops->prepare(); | 265 | if (error) |
| 219 | if (error) | 266 | goto Platform_finish; |
| 220 | goto Platform_finish; | ||
| 221 | } | ||
| 222 | 267 | ||
| 223 | error = dpm_suspend_end(PMSG_SUSPEND); | 268 | error = dpm_suspend_end(PMSG_SUSPEND); |
| 224 | if (error) { | 269 | if (error) { |
| 225 | printk(KERN_ERR "PM: Some devices failed to power down\n"); | 270 | printk(KERN_ERR "PM: Some devices failed to power down\n"); |
| 226 | goto Platform_finish; | 271 | goto Platform_finish; |
| 227 | } | 272 | } |
| 228 | 273 | error = platform_suspend_prepare_late(state); | |
| 229 | if (need_suspend_ops(state) && suspend_ops->prepare_late) { | 274 | if (error) |
| 230 | error = suspend_ops->prepare_late(); | 275 | goto Platform_wake; |
| 231 | if (error) | ||
| 232 | goto Platform_wake; | ||
| 233 | } | ||
| 234 | 276 | ||
| 235 | if (suspend_test(TEST_PLATFORM)) | 277 | if (suspend_test(TEST_PLATFORM)) |
| 236 | goto Platform_wake; | 278 | goto Platform_wake; |
| @@ -278,15 +320,11 @@ static int suspend_enter(suspend_state_t state, bool *wakeup) | |||
| 278 | ftrace_start(); | 320 | ftrace_start(); |
| 279 | 321 | ||
| 280 | Platform_wake: | 322 | Platform_wake: |
| 281 | if (need_suspend_ops(state) && suspend_ops->wake) | 323 | platform_suspend_wake(state); |
| 282 | suspend_ops->wake(); | ||
| 283 | |||
| 284 | dpm_resume_start(PMSG_RESUME); | 324 | dpm_resume_start(PMSG_RESUME); |
| 285 | 325 | ||
| 286 | Platform_finish: | 326 | Platform_finish: |
| 287 | if (need_suspend_ops(state) && suspend_ops->finish) | 327 | platform_suspend_finish(state); |
| 288 | suspend_ops->finish(); | ||
| 289 | |||
| 290 | return error; | 328 | return error; |
| 291 | } | 329 | } |
| 292 | 330 | ||
| @@ -299,18 +337,13 @@ int suspend_devices_and_enter(suspend_state_t state) | |||
| 299 | int error; | 337 | int error; |
| 300 | bool wakeup = false; | 338 | bool wakeup = false; |
| 301 | 339 | ||
| 302 | if (need_suspend_ops(state) && !suspend_ops) | 340 | if (!sleep_state_supported(state)) |
| 303 | return -ENOSYS; | 341 | return -ENOSYS; |
| 304 | 342 | ||
| 305 | if (need_suspend_ops(state) && suspend_ops->begin) { | 343 | error = platform_suspend_begin(state); |
| 306 | error = suspend_ops->begin(state); | 344 | if (error) |
| 307 | if (error) | 345 | goto Close; |
| 308 | goto Close; | 346 | |
| 309 | } else if (state == PM_SUSPEND_FREEZE && freeze_ops && freeze_ops->begin) { | ||
| 310 | error = freeze_ops->begin(); | ||
| 311 | if (error) | ||
| 312 | goto Close; | ||
| 313 | } | ||
| 314 | suspend_console(); | 347 | suspend_console(); |
| 315 | suspend_test_start(); | 348 | suspend_test_start(); |
| 316 | error = dpm_suspend_start(PMSG_SUSPEND); | 349 | error = dpm_suspend_start(PMSG_SUSPEND); |
| @@ -324,25 +357,20 @@ int suspend_devices_and_enter(suspend_state_t state) | |||
| 324 | 357 | ||
| 325 | do { | 358 | do { |
| 326 | error = suspend_enter(state, &wakeup); | 359 | error = suspend_enter(state, &wakeup); |
| 327 | } while (!error && !wakeup && need_suspend_ops(state) | 360 | } while (!error && !wakeup && platform_suspend_again(state)); |
| 328 | && suspend_ops->suspend_again && suspend_ops->suspend_again()); | ||
| 329 | 361 | ||
| 330 | Resume_devices: | 362 | Resume_devices: |
| 331 | suspend_test_start(); | 363 | suspend_test_start(); |
| 332 | dpm_resume_end(PMSG_RESUME); | 364 | dpm_resume_end(PMSG_RESUME); |
| 333 | suspend_test_finish("resume devices"); | 365 | suspend_test_finish("resume devices"); |
| 334 | resume_console(); | 366 | resume_console(); |
| 335 | Close: | ||
| 336 | if (need_suspend_ops(state) && suspend_ops->end) | ||
| 337 | suspend_ops->end(); | ||
| 338 | else if (state == PM_SUSPEND_FREEZE && freeze_ops && freeze_ops->end) | ||
| 339 | freeze_ops->end(); | ||
| 340 | 367 | ||
| 368 | Close: | ||
| 369 | platform_suspend_end(state); | ||
| 341 | return error; | 370 | return error; |
| 342 | 371 | ||
| 343 | Recover_platform: | 372 | Recover_platform: |
| 344 | if (need_suspend_ops(state) && suspend_ops->recover) | 373 | platform_suspend_recover(state); |
| 345 | suspend_ops->recover(); | ||
| 346 | goto Resume_devices; | 374 | goto Resume_devices; |
| 347 | } | 375 | } |
| 348 | 376 | ||
| @@ -395,7 +423,7 @@ static int enter_state(suspend_state_t state) | |||
| 395 | printk("done.\n"); | 423 | printk("done.\n"); |
| 396 | trace_suspend_resume(TPS("sync_filesystems"), 0, false); | 424 | trace_suspend_resume(TPS("sync_filesystems"), 0, false); |
| 397 | 425 | ||
| 398 | pr_debug("PM: Preparing system for %s sleep\n", pm_states[state].label); | 426 | pr_debug("PM: Preparing system for %s sleep\n", pm_states[state]); |
| 399 | error = suspend_prepare(state); | 427 | error = suspend_prepare(state); |
| 400 | if (error) | 428 | if (error) |
| 401 | goto Unlock; | 429 | goto Unlock; |
| @@ -404,7 +432,7 @@ static int enter_state(suspend_state_t state) | |||
| 404 | goto Finish; | 432 | goto Finish; |
| 405 | 433 | ||
| 406 | trace_suspend_resume(TPS("suspend_enter"), state, false); | 434 | trace_suspend_resume(TPS("suspend_enter"), state, false); |
| 407 | pr_debug("PM: Entering %s sleep\n", pm_states[state].label); | 435 | pr_debug("PM: Entering %s sleep\n", pm_states[state]); |
| 408 | pm_restrict_gfp_mask(); | 436 | pm_restrict_gfp_mask(); |
| 409 | error = suspend_devices_and_enter(state); | 437 | error = suspend_devices_and_enter(state); |
| 410 | pm_restore_gfp_mask(); | 438 | pm_restore_gfp_mask(); |
diff --git a/kernel/power/suspend_test.c b/kernel/power/suspend_test.c index 269b097e78ea..2f524928b6aa 100644 --- a/kernel/power/suspend_test.c +++ b/kernel/power/suspend_test.c | |||
| @@ -92,13 +92,13 @@ static void __init test_wakealarm(struct rtc_device *rtc, suspend_state_t state) | |||
| 92 | } | 92 | } |
| 93 | 93 | ||
| 94 | if (state == PM_SUSPEND_MEM) { | 94 | if (state == PM_SUSPEND_MEM) { |
| 95 | printk(info_test, pm_states[state].label); | 95 | printk(info_test, pm_states[state]); |
| 96 | status = pm_suspend(state); | 96 | status = pm_suspend(state); |
| 97 | if (status == -ENODEV) | 97 | if (status == -ENODEV) |
| 98 | state = PM_SUSPEND_STANDBY; | 98 | state = PM_SUSPEND_STANDBY; |
| 99 | } | 99 | } |
| 100 | if (state == PM_SUSPEND_STANDBY) { | 100 | if (state == PM_SUSPEND_STANDBY) { |
| 101 | printk(info_test, pm_states[state].label); | 101 | printk(info_test, pm_states[state]); |
| 102 | status = pm_suspend(state); | 102 | status = pm_suspend(state); |
| 103 | } | 103 | } |
| 104 | if (status < 0) | 104 | if (status < 0) |
| @@ -141,8 +141,8 @@ static int __init setup_test_suspend(char *value) | |||
| 141 | /* "=mem" ==> "mem" */ | 141 | /* "=mem" ==> "mem" */ |
| 142 | value++; | 142 | value++; |
| 143 | for (i = PM_SUSPEND_MIN; i < PM_SUSPEND_MAX; i++) | 143 | for (i = PM_SUSPEND_MIN; i < PM_SUSPEND_MAX; i++) |
| 144 | if (!strcmp(pm_states[i].label, value)) { | 144 | if (!strcmp(pm_states[i], value)) { |
| 145 | test_state = pm_states[i].state; | 145 | test_state = i; |
| 146 | return 0; | 146 | return 0; |
| 147 | } | 147 | } |
| 148 | 148 | ||
| @@ -162,8 +162,8 @@ static int __init test_suspend(void) | |||
| 162 | /* PM is initialized by now; is that state testable? */ | 162 | /* PM is initialized by now; is that state testable? */ |
| 163 | if (test_state == PM_SUSPEND_ON) | 163 | if (test_state == PM_SUSPEND_ON) |
| 164 | goto done; | 164 | goto done; |
| 165 | if (!pm_states[test_state].state) { | 165 | if (!pm_states[test_state]) { |
| 166 | printk(warn_bad_state, pm_states[test_state].label); | 166 | printk(warn_bad_state, pm_states[test_state]); |
| 167 | goto done; | 167 | goto done; |
| 168 | } | 168 | } |
| 169 | 169 | ||
