1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
|
/////////////////////////////////////////////////////////////////////////
// $Id: rombios32start.S,v 1.3 2006/10/02 06:29:38 vruppert Exp $
/////////////////////////////////////////////////////////////////////////
//
// 32 bit Bochs BIOS init code
// Copyright (C) 2006 Fabrice Bellard
//
// This library is free software; you can redistribute it and/or
// modify it under the terms of the GNU Lesser General Public
// License as published by the Free Software Foundation; either
// version 2 of the License, or (at your option) any later version.
//
// This library is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
// Lesser General Public License for more details.
//
// You should have received a copy of the GNU Lesser General Public
// License along with this library; if not, write to the Free Software
// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
#include "rombios.h"
.globl _start
.globl smp_ap_boot_code_start
.globl smp_ap_boot_code_end
.global smm_relocation_start
.global smm_relocation_end
.global smm_code_start
.global smm_code_end
_start:
/* clear bss section */
xor %eax, %eax
mov $__bss_start, %edi
mov $_end, %ecx
sub %edi, %ecx
rep stosb
jmp rombios32_init
.code16
smp_ap_boot_code_start:
cli
xor %ax, %ax
mov %ax, %ds
xor %eax, %eax
xor %edx, %edx
mov $0x10, %ecx
wrmsr
mov $SMP_MSR_ADDR, %ebx
11:
mov 0(%ebx), %ecx
test %ecx, %ecx
jz 12f
mov 4(%ebx), %eax
mov 8(%ebx), %edx
wrmsr
add $12, %ebx
jmp 11b
12:
incw CPU_COUNT_ADDR
ljmp $0xe000, $(1f-_start)
1:
hlt
jmp 1b
smp_ap_boot_code_end:
/* code to relocate SMBASE to 0xa0000 */
smm_relocation_start:
mov $0x38000 + 0x7efc, %ebx
addr32 mov (%ebx), %al /* revision ID to see if x86_64 or x86 */
cmp $0x64, %al
je 1f
mov $0x38000 + 0x7ef8, %ebx
jmp 2f
1:
mov $0x38000 + 0x7f00, %ebx
2:
movl $0xa0000, %eax
addr32 movl %eax, (%ebx)
/* indicate to the BIOS that the SMM code was executed */
mov $0x00, %al
movw $0xb3, %dx
outb %al, %dx
rsm
smm_relocation_end:
/* minimal SMM code to enable or disable ACPI */
smm_code_start:
movw $0xb2, %dx
inb %dx, %al
cmp $0xf0, %al
jne 1f
/* ACPI disable */
mov $PM_IO_BASE + 0x04, %dx /* PMCNTRL */
inw %dx, %ax
andw $~1, %ax
outw %ax, %dx
jmp 2f
1:
cmp $0xf1, %al
jne 2f
/* ACPI enable */
mov $PM_IO_BASE + 0x04, %dx /* PMCNTRL */
inw %dx, %ax
orw $1, %ax
outw %ax, %dx
2:
rsm
smm_code_end:
|
