blob: 0b62b759087aee644e42454dee113a34c64ecf2d [file] [log] [blame]
Bin Meng710d2152017-04-21 07:24:37 -07001/*
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 Meng280aebe2017-04-21 07:24:44 -07009#include <asm/acpi_table.h>
Bin Meng710d2152017-04-21 07:24:37 -070010#include <asm/post.h>
11
12static void asmlinkage (*acpi_do_wakeup)(void *vector) = (void *)WAKEUP_BASE;
13
14static 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 Meng280aebe2017-04-21 07:24:44 -070023void acpi_resume(struct acpi_fadt *fadt)
Bin Meng710d2152017-04-21 07:24:37 -070024{
Bin Meng280aebe2017-04-21 07:24:44 -070025 void *wake_vec;
26
Bin Meng07d46e62017-04-21 07:24:45 -070027 /* Turn on ACPI mode for S3 */
28 enter_acpi_mode(fadt->pm1a_cnt_blk);
29
Bin Meng280aebe2017-04-21 07:24:44 -070030 wake_vec = acpi_find_wakeup_vector(fadt);
31
Bin Meng710d2152017-04-21 07:24:37 -070032 post_code(POST_OS_RESUME);
33 acpi_jump_to_wakeup(wake_vec);
34}