/* $NetBSD: acpi_wakecode.S,v 1.13 2016/07/24 13:04:58 maxv Exp $ */ /*- * Copyright (c) 2007 Joerg Sonnenberger <joerg@netbsd.org> * * Copyright (c) 2002 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Takuya SHIOZAKI. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * This code is derived from FreeBSD. Original copyrights: * * Copyright (c) 2001 Takanori Watanabe <takawata@jp.freebsd.org> * Copyright (c) 2001 Mitsuru IWASAKI <iwasaki@jp.freebsd.org> * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * FreeBSD: src/sys/i386/acpica/acpi_wakecode.S,v 1.1 2001/07/20 06:07:31 takawata Exp */ #define _LOCORE #include <machine/psl.h> #include <machine/segments.h> #include <machine/specialreg.h> #define ACPI_WAKEUP_ADDR 0x3000 .text .code16 .org 0 /* ACPI spec says: cs==(phys>>8), ip==(phys&0x000F) */ .globl wakeup_16 wakeup_16: nop cli cld /* Set up segment registers for real mode */ movw %cs,%ax movw %ax,%ds movw %ax,%ss /* Small call stack */ mov $0x1000,%sp /* Clear flags */ pushl $0 popfl /* Only beep on reset if machdep.acpi_beep_on_reset=1 */ cmpb $1,WAKEUP_beep_on_reset jne 1f movb $0xc0,%al outb %al,$0x42 movb $0x04,%al outb %al,$0x42 inb $0x61,%al orb $0x3,%al outb %al,$0x61 1: /* Only reset the VBIOS if machdep.acpi_vbios_reset=1 */ cmpb $1,WAKEUP_vbios_reset jne 1f /* Kick the VBIOS. */ lcall $0xc000,$3 /* Reset registers in case the VBIOS changed them. */ movw %cs,%ax movw %ax,%ds movw %ax,%ss /* If we need to restore a VESA VBE mode, do it now */ cmpb $0,WAKEUP_vesa_modenum je 1f movw WAKEUP_vesa_modenum,%bx orw $0x4000,%bx movw $0x4f02,%ax int $0x10 movw %cs,%ax movw %ax,%ds movw %ax,%ss 1: /* Disable beep again if machdep.acpi_beep_on_reset=1 */ cmpb $1,WAKEUP_beep_on_reset jne 1f inb $0x61,%al andb $0xfc,%al outb %al,$0x61 1: /* Load temporary 32bit GDT */ #ifdef __clang__ lgdt tmp_gdt #else data32 addr32 lgdt tmp_gdt #endif /* Enable protected mode without paging */ mov %cr0,%eax orl $(CR0_PE),%eax mov %eax,%cr0 wakeup_sw32: /* * Switch to protected mode by intersegmental jump. * Target and everything else has to compensate for the new origin * as this is using the flat memory model now. */ ljmpl $0x8,$wakeup_32 + ACPI_WAKEUP_ADDR .code32 .align 16 wakeup_32: /* * Switched to protected mode w/o paging */ nop /* Set up segment registers and initial stack for protected mode */ movw $0x10,%ax movw %ax,%ds movw %ax,%ss movl $(ACPI_WAKEUP_ADDR + 4096),%esp /* First, reset the PSL. */ pushl $PSL_MBO popfl /* Enable PAE and potentially PSE */ movl $(CR4_PAE|CR4_OSFXSR|CR4_OSXMMEXCPT|CR4_PSE),%eax movl %eax,%cr4 /* * First switch to Long Mode. Do not restore the original * MSR EFER value directly, as enabling the NX bit without * paging will result in a GPF on AMD CPUs. * * Load the correct MSR EFER value now to not depend on the * data segment register directly after switching to Long Mode. * After this point, no instruction is allowed to clobber %ebx. */ movl WAKEUP_efer + ACPI_WAKEUP_ADDR,%ebx movl $MSR_EFER,%ecx rdmsr orl $EFER_LME,%eax wrmsr /* Load temporary PML4, code will switch to full PML4 later */ movl WAKEUP_r_cr3 + ACPI_WAKEUP_ADDR,%eax movl %eax,%cr3 /* Enable paging */ movl %cr0,%eax orl $(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP|CR0_AM),%eax movl %eax,%cr0 /* Flush the prefetch queue */ jmp 1f 1: /* Switch to temporary 64bit GDT */ lgdt tmp_gdt64 + ACPI_WAKEUP_ADDR /* Switch to long mode using intersegmental jump. */ ljmp $0x8, $wakeup_64 + ACPI_WAKEUP_ADDR .code64 wakeup_64: /* * Load the normal system value of MSR EFER. This includes * enabling the SYSCALL extension and NXE (if supported). */ movl %ebx,%eax movl $MSR_EFER,%ecx wrmsr /* Reload data segment with default value */ movw $GSEL(GDATA_SEL, SEL_KPL),%ax movw %ax,%ds /* Restore registers */ movq WAKEUP_curcpu + ACPI_WAKEUP_ADDR,%r8 movq WAKEUP_restorecpu + ACPI_WAKEUP_ADDR,%rbx /* Continue with wakeup in the high-level wakeup code */ jmp *%rbx .align 8 tmp_gdt: .word 0xffff .long tmp_gdtable + ACPI_WAKEUP_ADDR .align 8, 0 tmp_gdtable: /* null */ .word 0, 0 .byte 0, 0, 0, 0 /* code */ .word 0xffff, 0 .byte 0, 0x9f, 0xcf, 0 /* data */ .word 0xffff, 0 .byte 0, 0x93, 0xcf, 0 tmp_gdt64: .word 0xffff .long tmp_gdtable64 + ACPI_WAKEUP_ADDR tmp_gdtable64: .quad 0x0000000000000000 .quad 0x00af9a000000ffff .quad 0x00cf92000000ffff .align 16, 0 .global WAKEUP_r_cr3 WAKEUP_r_cr3: .quad 0 .global WAKEUP_restorecpu WAKEUP_restorecpu: .quad 0 .global WAKEUP_vbios_reset WAKEUP_vbios_reset: .byte 0 .global WAKEUP_vesa_modenum WAKEUP_vesa_modenum: .word 0 .global WAKEUP_beep_on_reset WAKEUP_beep_on_reset: .byte 0 .global WAKEUP_curcpu WAKEUP_curcpu: .quad 0 .global WAKEUP_efer WAKEUP_efer: .long 0
