mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
112 lines
2.4 KiB
112 lines
2.4 KiB
/* SPDX-License-Identifier: GPL-2.0 */ |
|
/* |
|
* This may not use any stack, nor any variable that is not "NoSave": |
|
* |
|
* Its rewriting one kernel image with another. What is stack in "old" |
|
* image could very well be data page in "new" image, and overwriting |
|
* your own stack under you is bad idea. |
|
*/ |
|
|
|
#include <linux/linkage.h> |
|
#include <asm/segment.h> |
|
#include <asm/page_types.h> |
|
#include <asm/asm-offsets.h> |
|
#include <asm/processor-flags.h> |
|
#include <asm/frame.h> |
|
|
|
.text |
|
|
|
SYM_FUNC_START(swsusp_arch_suspend) |
|
movl %esp, saved_context_esp |
|
movl %ebx, saved_context_ebx |
|
movl %ebp, saved_context_ebp |
|
movl %esi, saved_context_esi |
|
movl %edi, saved_context_edi |
|
pushfl |
|
popl saved_context_eflags |
|
|
|
/* save cr3 */ |
|
movl %cr3, %eax |
|
movl %eax, restore_cr3 |
|
|
|
FRAME_BEGIN |
|
call swsusp_save |
|
FRAME_END |
|
ret |
|
SYM_FUNC_END(swsusp_arch_suspend) |
|
|
|
SYM_CODE_START(restore_image) |
|
/* prepare to jump to the image kernel */ |
|
movl restore_jump_address, %ebx |
|
movl restore_cr3, %ebp |
|
|
|
movl mmu_cr4_features, %ecx |
|
|
|
/* jump to relocated restore code */ |
|
movl relocated_restore_code, %eax |
|
jmpl *%eax |
|
SYM_CODE_END(restore_image) |
|
|
|
/* code below has been relocated to a safe page */ |
|
SYM_CODE_START(core_restore_code) |
|
movl temp_pgt, %eax |
|
movl %eax, %cr3 |
|
|
|
jecxz 1f # cr4 Pentium and higher, skip if zero |
|
andl $~(X86_CR4_PGE), %ecx |
|
movl %ecx, %cr4; # turn off PGE |
|
movl %cr3, %eax; # flush TLB |
|
movl %eax, %cr3 |
|
1: |
|
movl restore_pblist, %edx |
|
.p2align 4,,7 |
|
|
|
copy_loop: |
|
testl %edx, %edx |
|
jz done |
|
|
|
movl pbe_address(%edx), %esi |
|
movl pbe_orig_address(%edx), %edi |
|
|
|
movl $(PAGE_SIZE >> 2), %ecx |
|
rep |
|
movsl |
|
|
|
movl pbe_next(%edx), %edx |
|
jmp copy_loop |
|
.p2align 4,,7 |
|
|
|
done: |
|
jmpl *%ebx |
|
SYM_CODE_END(core_restore_code) |
|
|
|
/* code below belongs to the image kernel */ |
|
.align PAGE_SIZE |
|
SYM_FUNC_START(restore_registers) |
|
/* go back to the original page tables */ |
|
movl %ebp, %cr3 |
|
movl mmu_cr4_features, %ecx |
|
jecxz 1f # cr4 Pentium and higher, skip if zero |
|
movl %ecx, %cr4; # turn PGE back on |
|
1: |
|
|
|
movl saved_context_esp, %esp |
|
movl saved_context_ebp, %ebp |
|
movl saved_context_ebx, %ebx |
|
movl saved_context_esi, %esi |
|
movl saved_context_edi, %edi |
|
|
|
pushl saved_context_eflags |
|
popfl |
|
|
|
/* Saved in save_processor_state. */ |
|
movl $saved_context, %eax |
|
lgdt saved_context_gdt_desc(%eax) |
|
|
|
xorl %eax, %eax |
|
|
|
/* tell the hibernation core that we've just restored the memory */ |
|
movl %eax, in_suspend |
|
|
|
ret |
|
SYM_FUNC_END(restore_registers)
|
|
|