Bin Meng | 710d215 | 2017-04-21 07:24:37 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2017, Bin Meng <bmeng.cn@gmail.com> |
| 3 | * |
| 4 | * SPDX-License-Identifier: GPL-2.0+ |
| 5 | */ |
| 6 | |
| 7 | #include <common.h> |
| 8 | #include <asm/acpi_s3.h> |
Bin Meng | 280aebe | 2017-04-21 07:24:44 -0700 | [diff] [blame] | 9 | #include <asm/acpi_table.h> |
Bin Meng | 710d215 | 2017-04-21 07:24:37 -0700 | [diff] [blame] | 10 | #include <asm/post.h> |
| 11 | |
| 12 | static void asmlinkage (*acpi_do_wakeup)(void *vector) = (void *)WAKEUP_BASE; |
| 13 | |
| 14 | static void acpi_jump_to_wakeup(void *vector) |
| 15 | { |
| 16 | /* Copy wakeup trampoline in place */ |
| 17 | memcpy((void *)WAKEUP_BASE, __wakeup, __wakeup_size); |
| 18 | |
| 19 | printf("Jumping to OS waking vector %p\n", vector); |
| 20 | acpi_do_wakeup(vector); |
| 21 | } |
| 22 | |
Bin Meng | 280aebe | 2017-04-21 07:24:44 -0700 | [diff] [blame] | 23 | void acpi_resume(struct acpi_fadt *fadt) |
Bin Meng | 710d215 | 2017-04-21 07:24:37 -0700 | [diff] [blame] | 24 | { |
Bin Meng | 280aebe | 2017-04-21 07:24:44 -0700 | [diff] [blame] | 25 | void *wake_vec; |
| 26 | |
Bin Meng | 07d46e6 | 2017-04-21 07:24:45 -0700 | [diff] [blame] | 27 | /* Turn on ACPI mode for S3 */ |
| 28 | enter_acpi_mode(fadt->pm1a_cnt_blk); |
| 29 | |
Bin Meng | 280aebe | 2017-04-21 07:24:44 -0700 | [diff] [blame] | 30 | wake_vec = acpi_find_wakeup_vector(fadt); |
| 31 | |
Bin Meng | 710d215 | 2017-04-21 07:24:37 -0700 | [diff] [blame] | 32 | post_code(POST_OS_RESUME); |
| 33 | acpi_jump_to_wakeup(wake_vec); |
| 34 | } |