Home | History | Annotate | Line # | Download | only in acpi
acpi_wakecode.S revision 1.9
      1 /*	$NetBSD: acpi_wakecode.S,v 1.9 2007/04/28 14:03:00 joerg Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2002 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Takuya SHIOZAKI.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *	  This product includes software developed by the NetBSD
     21  *	  Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 
     39 
     40 /*
     41  * This code is derived from FreeBSD.  Original copyrights:
     42  *
     43  * Copyright (c) 2001 Takanori Watanabe <takawata (at) jp.freebsd.org>
     44  * Copyright (c) 2001 Mitsuru IWASAKI <iwasaki (at) jp.freebsd.org>
     45  * All rights reserved.
     46  *
     47  * Redistribution and use in source and binary forms, with or without
     48  * modification, are permitted provided that the following conditions
     49  * are met:
     50  * 1. Redistributions of source code must retain the above copyright
     51  *    notice, this list of conditions and the following disclaimer.
     52  * 2. Redistributions in binary form must reproduce the above copyright
     53  *    notice, this list of conditions and the following disclaimer in the
     54  *    documentation and/or other materials provided with the distribution.
     55  *
     56  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     57  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     58  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     59  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     60  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     61  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     62  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     63  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     64  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     65  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     66  * SUCH DAMAGE.
     67  *
     68  *	FreeBSD: src/sys/i386/acpica/acpi_wakecode.S,v 1.1 2001/07/20 06:07:31 takawata Exp
     69  */
     70 
     71 #define _LOCORE
     72 
     73 #include <machine/asm.h>
     74 #include <machine/specialreg.h>
     75 #include <machine/param.h>
     76 #include <machine/segments.h>
     77 
     78 	.code16
     79 	.org 0	/* ACPI spec says: cs==(phys>>8), ip==(phys&0x000F) */
     80 wakeup_16:
     81 	nop
     82 	cli
     83 	cld
     84 
     85 	/* Set up segment registers for real mode */
     86 	movw	%cs,%ax
     87 	movw	%ax,%ds
     88 	movw	%ax,%ss
     89 
     90 	/* Small call stack */
     91 	movw	$0x1000,%sp
     92 
     93 	/* Clear flags */
     94 	pushl	$0
     95 	popfl
     96 
     97 	/* Only beep on reset if machdep.acpi_beep_on_reset=1 */
     98 	cmpb	$1,beep_on_reset
     99 	jne	nobeepon
    100 	call	beepon
    101 nobeepon:
    102 
    103 	/* Only reset the VBIOS if machdep.acpi_vbios_reset=1 */
    104 	cmpb	$1,vbios_reset
    105 	jne	novbiosreset
    106 
    107 	/* Kick the VBIOS. */
    108 	lcall	$0xc000,$3
    109 
    110 	movw	%cs,%ax
    111 	movw	%ax,%ds
    112 	movw	%ax,%ss
    113 novbiosreset:
    114 
    115 	/* Only beep on reset if machdep.acpi_beep_on_reset=1 */
    116 	cmpb	$1,beep_on_reset
    117 	jne	nobeepoff
    118 	call beepoff
    119 nobeepoff:
    120 
    121 	/* Get physical address of the code */
    122 	xorl	%esi,%esi
    123 	movw	%cs,%si
    124 	shll	$4,%esi
    125 
    126 	/* Fill 16->32 address */
    127 	movl	%esi,%eax
    128 	addl	$wakeup_32,%eax
    129 	movl	%eax,wakeup_sw32+2
    130 	jmp	1f			/* flush prefetch queue */
    131 1:	jmp	1f
    132 1:
    133 
    134 	/* Load GDT while non-paging */
    135 	movl	%esi,%eax
    136 	addl	$tmp_gdtable,%eax
    137 	movl	%eax,tmp_gdt+2
    138 	lgdt	tmp_gdt
    139 
    140 	/* Enable protected mode */
    141 	mov	%cr0,%eax
    142 	orl	$(CR0_PE),%eax
    143 	mov	%eax,%cr0
    144 
    145 wakeup_sw32:
    146 	/* Switch to protected mode by intersegmental jump */
    147 	ljmpl	$0x8,$0x12345678	/* Code location, to be replaced */
    148 
    149 
    150 	.code32
    151 	.align	16
    152 wakeup_32:
    153 	/*
    154 	 * Switched to protected mode w/o paging
    155 	 */
    156 
    157 	nop
    158 	/* Set up segment registers for protected mode */
    159 	movw	$GSEL(GDATA_SEL,SEL_KPL),%ax
    160 	movw	%ax,%ds
    161 	movw	%ax,%es
    162 	movw	%ax,%gs
    163 	movw	%ax,%ss
    164 	movw	%ax,%fs
    165 
    166 	/* Fixup TSS type field; 386 busy TSS (11) -> 386 available TSS (9) */
    167 #define TSS_TYPEFIX_MASK	0xf9
    168 	movl	physical_gdt+2(%esi),%ebx
    169 	movzxw	previous_tr(%esi),%ecx
    170 	leal	(%ebx,%ecx),%eax	/* get TSS segment descriptor */
    171 	andb	$TSS_TYPEFIX_MASK,5(%eax)
    172 
    173 	/* Enable paging (assumes identical mapping) */
    174         movl	previous_cr3(%esi),%eax
    175 	movl	%eax,%cr3
    176 	movl	previous_cr0(%esi),%eax
    177 	movl	%eax,%cr0
    178 
    179 	/* Flush the prefetch queue */
    180 	jmp	1f
    181 1:	jmp	1f
    182 1:
    183 
    184 	nop
    185 
    186         /* Restore registers */
    187 	lgdt	previous_gdt(%esi)
    188 	lidt	previous_idt(%esi)
    189         lldt	previous_ldt(%esi)
    190 #if 0
    191         ltr     previous_tr(%esi)
    192 #endif
    193 
    194 	mov	previous_cr2(%esi),%eax
    195 	mov	%eax,%cr2
    196 	mov	previous_cr4(%esi),%eax
    197 	mov	%eax,%cr4
    198 
    199         movw	previous_es(%esi),%ax
    200         movw	%ax,%es
    201         movw	previous_fs(%esi),%ax
    202         movw	%ax,%fs
    203         movw	previous_gs(%esi),%ax
    204         movw	%ax,%gs
    205         movw	previous_ss(%esi),%ax
    206         movw	%ax,%ss
    207         movl	where_to_recover(%esi),%ebx
    208         movw	previous_ds(%esi),%ax
    209         movw	%ax,%ds
    210         jmp	*%ebx
    211 
    212 beepon:
    213 	movb	$0xc0,%al
    214 	outb	%al,$0x42
    215 	movb	$0x04,%al
    216 	outb	%al,$0x42
    217 	inb	$0x61,%al
    218 	orb	$0x3,%al
    219 	outb	%al,$0x61
    220 	ret
    221 
    222 beepoff:
    223 	inb	$0x61,%al
    224 	andb	$0xfc,%al
    225 	outb	%al,$0x61
    226 	ret
    227 
    228 	.align	8
    229 tmp_gdt:
    230 	.word	0xffff
    231 	.long	0
    232 
    233 	.align	8, 0
    234 tmp_gdtable:
    235 	/* null */
    236 	.word	0, 0
    237 	.byte	0, 0, 0, 0
    238 	/* code */
    239 	.word	0xffff, 0
    240 	.byte	0, 0x9f, 0xcf, 0
    241 	/* data */
    242 	.word	0xffff, 0
    243 	.byte	0, 0x93, 0xcf, 0
    244 
    245 	.align	16, 0
    246 physical_gdt:		.word 0
    247 			.long 0
    248 previous_cr2:		.long 0
    249 previous_cr3:		.long 0
    250 previous_cr4:		.long 0
    251 previous_cr0:		.long 0
    252 previous_tr:		.word 0
    253 previous_gdt:		.word 0
    254 			.long 0
    255 previous_ldt:		.word 0
    256 previous_idt:		.word 0
    257 			.long 0
    258 previous_ds:		.word 0
    259 previous_es:		.word 0
    260 previous_fs:		.word 0
    261 previous_gs:		.word 0
    262 previous_ss:		.word 0
    263 where_to_recover:	.long 0
    264 vbios_reset:		.byte 0
    265 beep_on_reset:		.byte 0
    266