Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* Copyright 2004,2005 Pavel Machek <pavel@suse.cz>, Andi Kleen <ak@suse.de>, Rafael J. Wysocki <rjw@sisk.pl> |
| 2 | * |
| 3 | * Distribute under GPLv2. |
| 4 | * |
| 5 | * swsusp_arch_resume may not use any stack, nor any variable that is |
| 6 | * not "NoSave" during copying pages: |
| 7 | * |
| 8 | * Its rewriting one kernel image with another. What is stack in "old" |
| 9 | * image could very well be data page in "new" image, and overwriting |
| 10 | * your own stack under you is bad idea. |
| 11 | */ |
| 12 | |
| 13 | .text |
| 14 | #include <linux/linkage.h> |
| 15 | #include <asm/segment.h> |
| 16 | #include <asm/page.h> |
Sam Ravnborg | e2d5df9 | 2005-09-09 21:28:48 +0200 | [diff] [blame] | 17 | #include <asm/asm-offsets.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 | |
| 19 | ENTRY(swsusp_arch_suspend) |
| 20 | |
| 21 | movq %rsp, saved_context_esp(%rip) |
| 22 | movq %rax, saved_context_eax(%rip) |
| 23 | movq %rbx, saved_context_ebx(%rip) |
| 24 | movq %rcx, saved_context_ecx(%rip) |
| 25 | movq %rdx, saved_context_edx(%rip) |
| 26 | movq %rbp, saved_context_ebp(%rip) |
| 27 | movq %rsi, saved_context_esi(%rip) |
| 28 | movq %rdi, saved_context_edi(%rip) |
| 29 | movq %r8, saved_context_r08(%rip) |
| 30 | movq %r9, saved_context_r09(%rip) |
| 31 | movq %r10, saved_context_r10(%rip) |
| 32 | movq %r11, saved_context_r11(%rip) |
| 33 | movq %r12, saved_context_r12(%rip) |
| 34 | movq %r13, saved_context_r13(%rip) |
| 35 | movq %r14, saved_context_r14(%rip) |
| 36 | movq %r15, saved_context_r15(%rip) |
| 37 | pushfq ; popq saved_context_eflags(%rip) |
| 38 | |
| 39 | call swsusp_save |
| 40 | ret |
| 41 | |
Rafael J. Wysocki | 3dd0832 | 2005-10-09 21:19:40 +0200 | [diff] [blame] | 42 | ENTRY(restore_image) |
| 43 | /* switch to temporary page tables */ |
| 44 | movq $__PAGE_OFFSET, %rdx |
| 45 | movq temp_level4_pgt(%rip), %rax |
| 46 | subq %rdx, %rax |
| 47 | movq %rax, %cr3 |
| 48 | /* Flush TLB */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | movq mmu_cr4_features(%rip), %rax |
| 50 | movq %rax, %rdx |
| 51 | andq $~(1<<7), %rdx # PGE |
| 52 | movq %rdx, %cr4; # turn off PGE |
| 53 | movq %cr3, %rcx; # flush TLB |
| 54 | movq %rcx, %cr3; |
| 55 | movq %rax, %cr4; # turn PGE back on |
| 56 | |
Rafael J. Wysocki | 75534b5 | 2006-09-25 23:32:52 -0700 | [diff] [blame] | 57 | movq restore_pblist(%rip), %rdx |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | loop: |
| 59 | testq %rdx, %rdx |
| 60 | jz done |
| 61 | |
| 62 | /* get addresses from the pbe and copy the page */ |
| 63 | movq pbe_address(%rdx), %rsi |
| 64 | movq pbe_orig_address(%rdx), %rdi |
| 65 | movq $512, %rcx |
| 66 | rep |
| 67 | movsq |
| 68 | |
| 69 | /* progress to the next pbe */ |
| 70 | movq pbe_next(%rdx), %rdx |
| 71 | jmp loop |
| 72 | done: |
Rafael J. Wysocki | 3dd0832 | 2005-10-09 21:19:40 +0200 | [diff] [blame] | 73 | /* go back to the original page tables */ |
Vivek Goyal | 1ab60e0 | 2007-05-02 19:27:07 +0200 | [diff] [blame] | 74 | movq $(init_level4_pgt - __START_KERNEL_map), %rax |
| 75 | addq phys_base(%rip), %rax |
| 76 | movq %rax, %cr3 |
| 77 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | /* Flush TLB, including "global" things (vmalloc) */ |
| 79 | movq mmu_cr4_features(%rip), %rax |
| 80 | movq %rax, %rdx |
| 81 | andq $~(1<<7), %rdx; # PGE |
| 82 | movq %rdx, %cr4; # turn off PGE |
| 83 | movq %cr3, %rcx; # flush TLB |
| 84 | movq %rcx, %cr3 |
| 85 | movq %rax, %cr4; # turn PGE back on |
| 86 | |
| 87 | movl $24, %eax |
| 88 | movl %eax, %ds |
| 89 | |
| 90 | movq saved_context_esp(%rip), %rsp |
| 91 | movq saved_context_ebp(%rip), %rbp |
| 92 | /* Don't restore %rax, it must be 0 anyway */ |
| 93 | movq saved_context_ebx(%rip), %rbx |
| 94 | movq saved_context_ecx(%rip), %rcx |
| 95 | movq saved_context_edx(%rip), %rdx |
| 96 | movq saved_context_esi(%rip), %rsi |
| 97 | movq saved_context_edi(%rip), %rdi |
| 98 | movq saved_context_r08(%rip), %r8 |
| 99 | movq saved_context_r09(%rip), %r9 |
| 100 | movq saved_context_r10(%rip), %r10 |
| 101 | movq saved_context_r11(%rip), %r11 |
| 102 | movq saved_context_r12(%rip), %r12 |
| 103 | movq saved_context_r13(%rip), %r13 |
| 104 | movq saved_context_r14(%rip), %r14 |
| 105 | movq saved_context_r15(%rip), %r15 |
| 106 | pushq saved_context_eflags(%rip) ; popfq |
| 107 | |
| 108 | xorq %rax, %rax |
| 109 | |
| 110 | ret |