acpi_wakecode.S revision 1.9 1 1.9 jmcneill /* $NetBSD: acpi_wakecode.S,v 1.9 2009/08/24 10:16:12 jmcneill Exp $ */
2 1.2 jmcneill
3 1.2 jmcneill /*-
4 1.2 jmcneill * Copyright (c) 2007 Joerg Sonnenberger <joerg (at) netbsd.org>
5 1.2 jmcneill *
6 1.2 jmcneill * Copyright (c) 2002 The NetBSD Foundation, Inc.
7 1.2 jmcneill * All rights reserved.
8 1.2 jmcneill *
9 1.2 jmcneill * This code is derived from software contributed to The NetBSD Foundation
10 1.2 jmcneill * by Takuya SHIOZAKI.
11 1.2 jmcneill *
12 1.2 jmcneill * Redistribution and use in source and binary forms, with or without
13 1.2 jmcneill * modification, are permitted provided that the following conditions
14 1.2 jmcneill * are met:
15 1.2 jmcneill * 1. Redistributions of source code must retain the above copyright
16 1.2 jmcneill * notice, this list of conditions and the following disclaimer.
17 1.2 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
18 1.2 jmcneill * notice, this list of conditions and the following disclaimer in the
19 1.2 jmcneill * documentation and/or other materials provided with the distribution.
20 1.2 jmcneill *
21 1.2 jmcneill * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22 1.2 jmcneill * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.2 jmcneill * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.2 jmcneill * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25 1.2 jmcneill * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 1.2 jmcneill * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 1.2 jmcneill * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 1.2 jmcneill * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.2 jmcneill * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.2 jmcneill * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.2 jmcneill * POSSIBILITY OF SUCH DAMAGE.
32 1.2 jmcneill */
33 1.2 jmcneill
34 1.2 jmcneill
35 1.2 jmcneill /*
36 1.2 jmcneill * This code is derived from FreeBSD. Original copyrights:
37 1.2 jmcneill *
38 1.2 jmcneill * Copyright (c) 2001 Takanori Watanabe <takawata (at) jp.freebsd.org>
39 1.2 jmcneill * Copyright (c) 2001 Mitsuru IWASAKI <iwasaki (at) jp.freebsd.org>
40 1.2 jmcneill * All rights reserved.
41 1.2 jmcneill *
42 1.2 jmcneill * Redistribution and use in source and binary forms, with or without
43 1.2 jmcneill * modification, are permitted provided that the following conditions
44 1.2 jmcneill * are met:
45 1.2 jmcneill * 1. Redistributions of source code must retain the above copyright
46 1.2 jmcneill * notice, this list of conditions and the following disclaimer.
47 1.2 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
48 1.2 jmcneill * notice, this list of conditions and the following disclaimer in the
49 1.2 jmcneill * documentation and/or other materials provided with the distribution.
50 1.2 jmcneill *
51 1.2 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
52 1.2 jmcneill * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
53 1.2 jmcneill * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
54 1.2 jmcneill * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
55 1.2 jmcneill * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
56 1.2 jmcneill * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
57 1.2 jmcneill * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
58 1.2 jmcneill * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
59 1.2 jmcneill * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
60 1.2 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
61 1.2 jmcneill * SUCH DAMAGE.
62 1.2 jmcneill *
63 1.2 jmcneill * FreeBSD: src/sys/i386/acpica/acpi_wakecode.S,v 1.1 2001/07/20 06:07:31 takawata Exp
64 1.2 jmcneill */
65 1.2 jmcneill
66 1.2 jmcneill #define _LOCORE
67 1.2 jmcneill
68 1.2 jmcneill #include <machine/psl.h>
69 1.3 joerg #include <machine/segments.h>
70 1.2 jmcneill #include <machine/specialreg.h>
71 1.2 jmcneill
72 1.2 jmcneill #define ACPI_WAKEUP_ADDR 0x3000
73 1.2 jmcneill
74 1.2 jmcneill .text
75 1.2 jmcneill .code16
76 1.2 jmcneill .org 0 /* ACPI spec says: cs==(phys>>8), ip==(phys&0x000F) */
77 1.2 jmcneill .globl wakeup_16
78 1.2 jmcneill wakeup_16:
79 1.2 jmcneill nop
80 1.2 jmcneill cli
81 1.2 jmcneill cld
82 1.2 jmcneill
83 1.2 jmcneill /* Set up segment registers for real mode */
84 1.2 jmcneill movw %cs,%ax
85 1.2 jmcneill movw %ax,%ds
86 1.2 jmcneill movw %ax,%ss
87 1.2 jmcneill
88 1.2 jmcneill /* Small call stack */
89 1.2 jmcneill mov $0x1000,%sp
90 1.2 jmcneill
91 1.2 jmcneill /* Clear flags */
92 1.2 jmcneill pushl $0
93 1.2 jmcneill popfl
94 1.2 jmcneill
95 1.2 jmcneill /* Only beep on reset if machdep.acpi_beep_on_reset=1 */
96 1.2 jmcneill cmpb $1,WAKEUP_beep_on_reset
97 1.2 jmcneill jne 1f
98 1.2 jmcneill movb $0xc0,%al
99 1.2 jmcneill outb %al,$0x42
100 1.2 jmcneill movb $0x04,%al
101 1.2 jmcneill outb %al,$0x42
102 1.2 jmcneill inb $0x61,%al
103 1.2 jmcneill orb $0x3,%al
104 1.2 jmcneill outb %al,$0x61
105 1.2 jmcneill 1:
106 1.2 jmcneill
107 1.2 jmcneill /* Only reset the VBIOS if machdep.acpi_vbios_reset=1 */
108 1.2 jmcneill cmpb $1,WAKEUP_vbios_reset
109 1.2 jmcneill jne 1f
110 1.2 jmcneill
111 1.2 jmcneill /* Kick the VBIOS. */
112 1.2 jmcneill lcall $0xc000,$3
113 1.2 jmcneill
114 1.2 jmcneill /* Reset registers in case the VBIOS changed them. */
115 1.2 jmcneill movw %cs,%ax
116 1.2 jmcneill movw %ax,%ds
117 1.2 jmcneill movw %ax,%ss
118 1.2 jmcneill
119 1.8 jmcneill /* If we need to restore a VESA VBE mode, do it now */
120 1.8 jmcneill cmpb $0,WAKEUP_vesa_modenum
121 1.8 jmcneill je 1f
122 1.8 jmcneill movw WAKEUP_vesa_modenum,%bx
123 1.8 jmcneill orw $0x4000,%bx
124 1.8 jmcneill movw $0x4f02,%ax
125 1.8 jmcneill int $0x10
126 1.8 jmcneill
127 1.8 jmcneill movw %cs,%ax
128 1.8 jmcneill movw %ax,%ds
129 1.8 jmcneill movw %ax,%ss
130 1.8 jmcneill 1:
131 1.8 jmcneill
132 1.9 jmcneill /* Disable beep again if machdep.acpi_beep_on_reset=1 */
133 1.9 jmcneill cmpb $1,WAKEUP_beep_on_reset
134 1.9 jmcneill jne 1f
135 1.9 jmcneill inb $0x61,%al
136 1.9 jmcneill andb $0xfc,%al
137 1.9 jmcneill outb %al,$0x61
138 1.9 jmcneill 1:
139 1.9 jmcneill
140 1.2 jmcneill /* Load temporary 32bit GDT */
141 1.2 jmcneill data32 addr32 lgdt tmp_gdt
142 1.2 jmcneill
143 1.2 jmcneill /* Enable protected mode w/o paging */
144 1.2 jmcneill mov %cr0,%eax
145 1.2 jmcneill orl $(CR0_PE),%eax
146 1.2 jmcneill mov %eax,%cr0
147 1.2 jmcneill
148 1.2 jmcneill wakeup_sw32:
149 1.2 jmcneill /*
150 1.2 jmcneill * Switch to protected mode by intersegmental jump.
151 1.2 jmcneill * Target and everything else has to compensate for the new origin
152 1.2 jmcneill * as this is using the flat memory model now.
153 1.2 jmcneill */
154 1.2 jmcneill
155 1.2 jmcneill ljmpl $0x8,$wakeup_32 + ACPI_WAKEUP_ADDR
156 1.2 jmcneill
157 1.2 jmcneill .code32
158 1.2 jmcneill .align 16
159 1.2 jmcneill wakeup_32:
160 1.2 jmcneill /*
161 1.2 jmcneill * Switched to protected mode w/o paging
162 1.2 jmcneill */
163 1.2 jmcneill
164 1.2 jmcneill nop
165 1.2 jmcneill /* Set up segment registers and initial stack for protected mode */
166 1.2 jmcneill movw $0x10, %ax
167 1.2 jmcneill movw %ax,%ds
168 1.2 jmcneill movw %ax,%ss
169 1.2 jmcneill
170 1.2 jmcneill movl $(ACPI_WAKEUP_ADDR + 4096),%esp
171 1.2 jmcneill
172 1.2 jmcneill /* First, reset the PSL. */
173 1.2 jmcneill pushl $PSL_MBO
174 1.2 jmcneill popfl
175 1.2 jmcneill
176 1.2 jmcneill /* Enable PAE and potentially PSE */
177 1.2 jmcneill movl $(CR4_PAE|CR4_OSFXSR|CR4_OSXMMEXCPT|CR4_PSE),%eax
178 1.2 jmcneill movl %eax,%cr4
179 1.2 jmcneill
180 1.7 joerg /*
181 1.7 joerg * First switch to Long Mode. Do not restore the original
182 1.7 joerg * MSR EFER value directly, as enabling the NX bit without
183 1.7 joerg * paging will result in a GPF on AMD CPUs.
184 1.7 joerg *
185 1.7 joerg * Load the correct MSR EFER value now to not depend on the
186 1.7 joerg * data segment register directly after switching to Long Mode.
187 1.7 joerg * After this point, no instruction is allowed to clobber %ebx.
188 1.7 joerg */
189 1.7 joerg movl WAKEUP_efer + ACPI_WAKEUP_ADDR,%ebx
190 1.2 jmcneill movl $MSR_EFER,%ecx
191 1.7 joerg rdmsr
192 1.7 joerg orl $EFER_LME, %eax
193 1.2 jmcneill wrmsr
194 1.2 jmcneill
195 1.2 jmcneill /* Load temporary PML4, code will switch to full PML4 later */
196 1.2 jmcneill movl WAKEUP_r_cr3 + ACPI_WAKEUP_ADDR,%eax
197 1.2 jmcneill movl %eax,%cr3
198 1.2 jmcneill
199 1.2 jmcneill /* Enable paging */
200 1.2 jmcneill movl %cr0,%eax
201 1.2 jmcneill orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP),%eax
202 1.2 jmcneill movl %eax,%cr0
203 1.2 jmcneill /* Flush prefetch queue */
204 1.2 jmcneill jmp 1f
205 1.2 jmcneill 1:
206 1.2 jmcneill /* Switch to temporary 64bit GDT */
207 1.2 jmcneill lgdt tmp_gdt64 + ACPI_WAKEUP_ADDR
208 1.2 jmcneill
209 1.2 jmcneill /* Switch to long mode using intersegmental jump. */
210 1.2 jmcneill ljmp $0x8, $wakeup_64 + ACPI_WAKEUP_ADDR
211 1.2 jmcneill
212 1.2 jmcneill .code64
213 1.2 jmcneill wakeup_64:
214 1.2 jmcneill
215 1.7 joerg /*
216 1.7 joerg * Load the normal system value of MSR EFER. This includes
217 1.7 joerg * enabling the SYSCALL extension and NXE (if supported).
218 1.7 joerg */
219 1.7 joerg movl %ebx, %eax
220 1.7 joerg movl $MSR_EFER,%ecx
221 1.7 joerg wrmsr
222 1.7 joerg
223 1.3 joerg /* Reload data segment with default value */
224 1.2 jmcneill movw $GSEL(GDATA_SEL, SEL_KPL),%ax
225 1.2 jmcneill movw %ax,%ds
226 1.2 jmcneill
227 1.3 joerg movq WAKEUP_curcpu + ACPI_WAKEUP_ADDR,%r8
228 1.2 jmcneill movq WAKEUP_restorecpu + ACPI_WAKEUP_ADDR,%rbx
229 1.2 jmcneill
230 1.2 jmcneill /* Continue with wakeup in the high-level wakeup code */
231 1.2 jmcneill jmp *%rbx
232 1.2 jmcneill
233 1.2 jmcneill .align 8
234 1.2 jmcneill tmp_gdt:
235 1.2 jmcneill .word 0xffff
236 1.2 jmcneill .long tmp_gdtable + ACPI_WAKEUP_ADDR
237 1.2 jmcneill
238 1.2 jmcneill .align 8, 0
239 1.2 jmcneill tmp_gdtable:
240 1.2 jmcneill /* null */
241 1.2 jmcneill .word 0, 0
242 1.2 jmcneill .byte 0, 0, 0, 0
243 1.2 jmcneill /* code */
244 1.2 jmcneill .word 0xffff, 0
245 1.2 jmcneill .byte 0, 0x9f, 0xcf, 0
246 1.2 jmcneill /* data */
247 1.2 jmcneill .word 0xffff, 0
248 1.2 jmcneill .byte 0, 0x93, 0xcf, 0
249 1.2 jmcneill
250 1.2 jmcneill tmp_gdt64:
251 1.2 jmcneill .word 0xffff
252 1.2 jmcneill .long tmp_gdtable64 + ACPI_WAKEUP_ADDR
253 1.2 jmcneill
254 1.2 jmcneill tmp_gdtable64:
255 1.2 jmcneill .quad 0x0000000000000000
256 1.2 jmcneill .quad 0x00af9a000000ffff
257 1.2 jmcneill .quad 0x00cf92000000ffff
258 1.2 jmcneill
259 1.2 jmcneill .align 16, 0
260 1.2 jmcneill .global WAKEUP_r_cr3
261 1.2 jmcneill WAKEUP_r_cr3: .quad 0
262 1.2 jmcneill
263 1.2 jmcneill .global WAKEUP_restorecpu
264 1.2 jmcneill WAKEUP_restorecpu: .quad 0
265 1.2 jmcneill
266 1.2 jmcneill .global WAKEUP_vbios_reset
267 1.2 jmcneill WAKEUP_vbios_reset: .byte 0
268 1.2 jmcneill .global WAKEUP_beep_on_reset
269 1.2 jmcneill WAKEUP_beep_on_reset: .byte 0
270 1.3 joerg
271 1.3 joerg .global WAKEUP_curcpu
272 1.3 joerg WAKEUP_curcpu: .quad 0
273 1.5 ad .global WAKEUP_efer
274 1.5 ad WAKEUP_efer: .long 0
275