acpi_wakecode.S revision 1.10.12.2
1 1.10.12.2 yamt /* $NetBSD: acpi_wakecode.S,v 1.10.12.2 2014/05/22 11:39:28 yamt 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.10.12.2 yamt #ifdef __clang__ 142 1.10.12.2 yamt lgdt tmp_gdt 143 1.10.12.2 yamt #else 144 1.2 jmcneill data32 addr32 lgdt tmp_gdt 145 1.10.12.2 yamt #endif 146 1.2 jmcneill 147 1.2 jmcneill /* Enable protected mode w/o paging */ 148 1.2 jmcneill mov %cr0,%eax 149 1.2 jmcneill orl $(CR0_PE),%eax 150 1.2 jmcneill mov %eax,%cr0 151 1.2 jmcneill 152 1.2 jmcneill wakeup_sw32: 153 1.2 jmcneill /* 154 1.2 jmcneill * Switch to protected mode by intersegmental jump. 155 1.2 jmcneill * Target and everything else has to compensate for the new origin 156 1.2 jmcneill * as this is using the flat memory model now. 157 1.2 jmcneill */ 158 1.2 jmcneill 159 1.2 jmcneill ljmpl $0x8,$wakeup_32 + ACPI_WAKEUP_ADDR 160 1.2 jmcneill 161 1.2 jmcneill .code32 162 1.2 jmcneill .align 16 163 1.2 jmcneill wakeup_32: 164 1.2 jmcneill /* 165 1.2 jmcneill * Switched to protected mode w/o paging 166 1.2 jmcneill */ 167 1.2 jmcneill 168 1.2 jmcneill nop 169 1.2 jmcneill /* Set up segment registers and initial stack for protected mode */ 170 1.2 jmcneill movw $0x10, %ax 171 1.2 jmcneill movw %ax,%ds 172 1.2 jmcneill movw %ax,%ss 173 1.2 jmcneill 174 1.2 jmcneill movl $(ACPI_WAKEUP_ADDR + 4096),%esp 175 1.2 jmcneill 176 1.2 jmcneill /* First, reset the PSL. */ 177 1.2 jmcneill pushl $PSL_MBO 178 1.2 jmcneill popfl 179 1.2 jmcneill 180 1.2 jmcneill /* Enable PAE and potentially PSE */ 181 1.2 jmcneill movl $(CR4_PAE|CR4_OSFXSR|CR4_OSXMMEXCPT|CR4_PSE),%eax 182 1.2 jmcneill movl %eax,%cr4 183 1.2 jmcneill 184 1.7 joerg /* 185 1.7 joerg * First switch to Long Mode. Do not restore the original 186 1.7 joerg * MSR EFER value directly, as enabling the NX bit without 187 1.7 joerg * paging will result in a GPF on AMD CPUs. 188 1.7 joerg * 189 1.7 joerg * Load the correct MSR EFER value now to not depend on the 190 1.7 joerg * data segment register directly after switching to Long Mode. 191 1.7 joerg * After this point, no instruction is allowed to clobber %ebx. 192 1.7 joerg */ 193 1.7 joerg movl WAKEUP_efer + ACPI_WAKEUP_ADDR,%ebx 194 1.2 jmcneill movl $MSR_EFER,%ecx 195 1.7 joerg rdmsr 196 1.7 joerg orl $EFER_LME, %eax 197 1.2 jmcneill wrmsr 198 1.2 jmcneill 199 1.2 jmcneill /* Load temporary PML4, code will switch to full PML4 later */ 200 1.2 jmcneill movl WAKEUP_r_cr3 + ACPI_WAKEUP_ADDR,%eax 201 1.2 jmcneill movl %eax,%cr3 202 1.2 jmcneill 203 1.2 jmcneill /* Enable paging */ 204 1.2 jmcneill movl %cr0,%eax 205 1.10.12.1 yamt orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP|CR0_AM),%eax 206 1.2 jmcneill movl %eax,%cr0 207 1.2 jmcneill /* Flush prefetch queue */ 208 1.2 jmcneill jmp 1f 209 1.2 jmcneill 1: 210 1.2 jmcneill /* Switch to temporary 64bit GDT */ 211 1.2 jmcneill lgdt tmp_gdt64 + ACPI_WAKEUP_ADDR 212 1.2 jmcneill 213 1.2 jmcneill /* Switch to long mode using intersegmental jump. */ 214 1.2 jmcneill ljmp $0x8, $wakeup_64 + ACPI_WAKEUP_ADDR 215 1.2 jmcneill 216 1.2 jmcneill .code64 217 1.2 jmcneill wakeup_64: 218 1.2 jmcneill 219 1.7 joerg /* 220 1.7 joerg * Load the normal system value of MSR EFER. This includes 221 1.7 joerg * enabling the SYSCALL extension and NXE (if supported). 222 1.7 joerg */ 223 1.7 joerg movl %ebx, %eax 224 1.7 joerg movl $MSR_EFER,%ecx 225 1.7 joerg wrmsr 226 1.7 joerg 227 1.3 joerg /* Reload data segment with default value */ 228 1.2 jmcneill movw $GSEL(GDATA_SEL, SEL_KPL),%ax 229 1.2 jmcneill movw %ax,%ds 230 1.2 jmcneill 231 1.3 joerg movq WAKEUP_curcpu + ACPI_WAKEUP_ADDR,%r8 232 1.2 jmcneill movq WAKEUP_restorecpu + ACPI_WAKEUP_ADDR,%rbx 233 1.2 jmcneill 234 1.2 jmcneill /* Continue with wakeup in the high-level wakeup code */ 235 1.2 jmcneill jmp *%rbx 236 1.2 jmcneill 237 1.2 jmcneill .align 8 238 1.2 jmcneill tmp_gdt: 239 1.2 jmcneill .word 0xffff 240 1.2 jmcneill .long tmp_gdtable + ACPI_WAKEUP_ADDR 241 1.2 jmcneill 242 1.2 jmcneill .align 8, 0 243 1.2 jmcneill tmp_gdtable: 244 1.2 jmcneill /* null */ 245 1.2 jmcneill .word 0, 0 246 1.2 jmcneill .byte 0, 0, 0, 0 247 1.2 jmcneill /* code */ 248 1.2 jmcneill .word 0xffff, 0 249 1.2 jmcneill .byte 0, 0x9f, 0xcf, 0 250 1.2 jmcneill /* data */ 251 1.2 jmcneill .word 0xffff, 0 252 1.2 jmcneill .byte 0, 0x93, 0xcf, 0 253 1.2 jmcneill 254 1.2 jmcneill tmp_gdt64: 255 1.2 jmcneill .word 0xffff 256 1.2 jmcneill .long tmp_gdtable64 + ACPI_WAKEUP_ADDR 257 1.2 jmcneill 258 1.2 jmcneill tmp_gdtable64: 259 1.2 jmcneill .quad 0x0000000000000000 260 1.2 jmcneill .quad 0x00af9a000000ffff 261 1.2 jmcneill .quad 0x00cf92000000ffff 262 1.2 jmcneill 263 1.2 jmcneill .align 16, 0 264 1.2 jmcneill .global WAKEUP_r_cr3 265 1.2 jmcneill WAKEUP_r_cr3: .quad 0 266 1.2 jmcneill 267 1.2 jmcneill .global WAKEUP_restorecpu 268 1.2 jmcneill WAKEUP_restorecpu: .quad 0 269 1.2 jmcneill 270 1.2 jmcneill .global WAKEUP_vbios_reset 271 1.2 jmcneill WAKEUP_vbios_reset: .byte 0 272 1.10 jmcneill .global WAKEUP_vesa_modenum 273 1.10 jmcneill WAKEUP_vesa_modenum: .word 0 274 1.2 jmcneill .global WAKEUP_beep_on_reset 275 1.2 jmcneill WAKEUP_beep_on_reset: .byte 0 276 1.3 joerg 277 1.3 joerg .global WAKEUP_curcpu 278 1.3 joerg WAKEUP_curcpu: .quad 0 279 1.5 ad .global WAKEUP_efer 280 1.5 ad WAKEUP_efer: .long 0 281
Indexes created Thu Oct 02 14:10:14 GMT 2025