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