acpi_s3.c 738 B

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