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