Home | History | Annotate | Line # | Download | only in acpi
acpi_wakecode.S revision 1.11
      1  1.11       jym /*	$NetBSD: acpi_wakecode.S,v 1.11 2012/04/19 18:00:34 jym 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.11       jym 	orl	$(CR0_PE|CR0_PG|CR0_NE|CR0_TS|CR0_MP|CR0_WP|CR0_AM),%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.10  jmcneill 	.global WAKEUP_vesa_modenum
    269  1.10  jmcneill WAKEUP_vesa_modenum:    .word 0
    270   1.2  jmcneill 	.global WAKEUP_beep_on_reset
    271   1.2  jmcneill WAKEUP_beep_on_reset:	.byte 0
    272   1.3     joerg 
    273   1.3     joerg 	.global WAKEUP_curcpu
    274   1.3     joerg WAKEUP_curcpu:		.quad 0
    275   1.5        ad 	.global WAKEUP_efer
    276   1.5        ad WAKEUP_efer:		.long 0
    277