blob: 1deb3244b99b766977565019790516ea98c48211 [file] [log] [blame]
Rafael J. Wysockicf7700f2008-02-09 23:24:09 +01001/*
2 * Hibernation support for x86-64
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * Distribute under GPLv2.
5 *
Rafael J. Wysockicf7700f2008-02-09 23:24:09 +01006 * Copyright 2007 Rafael J. Wysocki <rjw@sisk.pl>
7 * Copyright 2005 Andi Kleen <ak@suse.de>
8 * Copyright 2004 Pavel Machek <pavel@suse.cz>
9 *
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070010 * swsusp_arch_resume must not use any stack or any nonlocal variables while
11 * copying pages:
Linus Torvalds1da177e2005-04-16 15:20:36 -070012 *
13 * Its rewriting one kernel image with another. What is stack in "old"
14 * image could very well be data page in "new" image, and overwriting
15 * your own stack under you is bad idea.
16 */
Rafael J. Wysockicf7700f2008-02-09 23:24:09 +010017
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 .text
19#include <linux/linkage.h>
20#include <asm/segment.h>
21#include <asm/page.h>
Sam Ravnborge2d5df92005-09-09 21:28:48 +020022#include <asm/asm-offsets.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023
24ENTRY(swsusp_arch_suspend)
Rafael J. Wysocki0de80bc2007-10-23 22:37:24 +020025 movq $saved_context, %rax
H. Peter Anvin65ea5b02008-01-30 13:30:56 +010026 movq %rsp, pt_regs_sp(%rax)
27 movq %rbp, pt_regs_bp(%rax)
28 movq %rsi, pt_regs_si(%rax)
29 movq %rdi, pt_regs_di(%rax)
30 movq %rbx, pt_regs_bx(%rax)
31 movq %rcx, pt_regs_cx(%rax)
32 movq %rdx, pt_regs_dx(%rax)
Rafael J. Wysocki0de80bc2007-10-23 22:37:24 +020033 movq %r8, pt_regs_r8(%rax)
34 movq %r9, pt_regs_r9(%rax)
35 movq %r10, pt_regs_r10(%rax)
36 movq %r11, pt_regs_r11(%rax)
37 movq %r12, pt_regs_r12(%rax)
38 movq %r13, pt_regs_r13(%rax)
39 movq %r14, pt_regs_r14(%rax)
40 movq %r15, pt_regs_r15(%rax)
41 pushfq
H. Peter Anvin65ea5b02008-01-30 13:30:56 +010042 popq pt_regs_flags(%rax)
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070044 /* save the address of restore_registers */
45 movq $restore_registers, %rax
46 movq %rax, restore_jump_address(%rip)
Rafael J. Wysockic30bb682007-10-18 03:04:54 -070047 /* save cr3 */
48 movq %cr3, %rax
49 movq %rax, restore_cr3(%rip)
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070050
Linus Torvalds1da177e2005-04-16 15:20:36 -070051 call swsusp_save
52 ret
53
Rafael J. Wysocki3dd08322005-10-09 21:19:40 +020054ENTRY(restore_image)
55 /* switch to temporary page tables */
56 movq $__PAGE_OFFSET, %rdx
57 movq temp_level4_pgt(%rip), %rax
58 subq %rdx, %rax
59 movq %rax, %cr3
60 /* Flush TLB */
Linus Torvalds1da177e2005-04-16 15:20:36 -070061 movq mmu_cr4_features(%rip), %rax
62 movq %rax, %rdx
63 andq $~(1<<7), %rdx # PGE
64 movq %rdx, %cr4; # turn off PGE
65 movq %cr3, %rcx; # flush TLB
66 movq %rcx, %cr3;
67 movq %rax, %cr4; # turn PGE back on
68
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070069 /* prepare to jump to the image kernel */
70 movq restore_jump_address(%rip), %rax
Rafael J. Wysockic30bb682007-10-18 03:04:54 -070071 movq restore_cr3(%rip), %rbx
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070072
73 /* prepare to copy image data to their original locations */
Rafael J. Wysocki75534b52006-09-25 23:32:52 -070074 movq restore_pblist(%rip), %rdx
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070075 movq relocated_restore_code(%rip), %rcx
76 jmpq *%rcx
77
78 /* code below has been relocated to a safe page */
79ENTRY(core_restore_code)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080loop:
81 testq %rdx, %rdx
82 jz done
83
84 /* get addresses from the pbe and copy the page */
85 movq pbe_address(%rdx), %rsi
86 movq pbe_orig_address(%rdx), %rdi
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070087 movq $(PAGE_SIZE >> 3), %rcx
Linus Torvalds1da177e2005-04-16 15:20:36 -070088 rep
89 movsq
90
91 /* progress to the next pbe */
92 movq pbe_next(%rdx), %rdx
93 jmp loop
94done:
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -070095 /* jump to the restore_registers address from the image header */
96 jmpq *%rax
97 /*
98 * NOTE: This assumes that the boot kernel's text mapping covers the
99 * image kernel's page containing restore_registers and the address of
100 * this page is the same as in the image kernel's text mapping (it
101 * should always be true, because the text mapping is linear, starting
102 * from 0, and is supposed to cover the entire kernel text for every
103 * kernel).
104 *
105 * code below belongs to the image kernel
106 */
107
108ENTRY(restore_registers)
Rafael J. Wysocki3dd08322005-10-09 21:19:40 +0200109 /* go back to the original page tables */
Rafael J. Wysockic30bb682007-10-18 03:04:54 -0700110 movq %rbx, %cr3
Vivek Goyal1ab60e02007-05-02 19:27:07 +0200111
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 /* Flush TLB, including "global" things (vmalloc) */
113 movq mmu_cr4_features(%rip), %rax
114 movq %rax, %rdx
115 andq $~(1<<7), %rdx; # PGE
116 movq %rdx, %cr4; # turn off PGE
117 movq %cr3, %rcx; # flush TLB
118 movq %rcx, %cr3
119 movq %rax, %cr4; # turn PGE back on
120
Rafael J. Wysocki0de80bc2007-10-23 22:37:24 +0200121 /* We don't restore %rax, it must be 0 anyway */
122 movq $saved_context, %rax
H. Peter Anvin65ea5b02008-01-30 13:30:56 +0100123 movq pt_regs_sp(%rax), %rsp
124 movq pt_regs_bp(%rax), %rbp
125 movq pt_regs_si(%rax), %rsi
126 movq pt_regs_di(%rax), %rdi
127 movq pt_regs_bx(%rax), %rbx
128 movq pt_regs_cx(%rax), %rcx
129 movq pt_regs_dx(%rax), %rdx
Rafael J. Wysocki0de80bc2007-10-23 22:37:24 +0200130 movq pt_regs_r8(%rax), %r8
131 movq pt_regs_r9(%rax), %r9
132 movq pt_regs_r10(%rax), %r10
133 movq pt_regs_r11(%rax), %r11
134 movq pt_regs_r12(%rax), %r12
135 movq pt_regs_r13(%rax), %r13
136 movq pt_regs_r14(%rax), %r14
137 movq pt_regs_r15(%rax), %r15
H. Peter Anvin65ea5b02008-01-30 13:30:56 +0100138 pushq pt_regs_flags(%rax)
Rafael J. Wysocki0de80bc2007-10-23 22:37:24 +0200139 popfq
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140
141 xorq %rax, %rax
142
Rafael J. Wysockid158cbd2007-10-18 03:04:53 -0700143 /* tell the hibernation core that we've just restored the memory */
144 movq %rax, in_suspend(%rip)
145
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146 ret