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
|
.section .apinit, "a"
.SET stack_top, 0x3008000
.SET stack_off, 0x8000
.SET bspdone, 0x3000100
.SET aprunning, 0x3000200
.code16
ap_trampoline:
cli
cld
ljmp $0, $_start16
.align 16
gdt32:
.long 0, 0
.long 0x0000FFFF, 0x00CF9A00 # flat code
.long 0x0000FFFF, 0x008F9200 # flat data
.long 0x00000068, 0x00CF8900 # tss
gdt32p:
.word gdt32p - gdt32 - 1
.long 0x8010
.long 0, 0
.align 64
_start16:
xorw %ax, %ax
movw %ax, %ds
lgdtl gdt32p
movl %cr0, %eax
orl $1, %eax
movl %eax, %cr0
ljmp $8, $_start32
.align 32
.code32
_start32:
movw $16, %ax
movw %ax, %ds
movw %ax, %ss
# get our Local APIC ID
mov $1, %eax
cpuid
shrl $24, %ebx
movl %ebx, %edi
# set up 32k stack, one for each core. It is important that all core must have its own stack
movl $stack_top, %esp
movl %ebx, %ecx
22:
addl $stack_off, %esp
decl %ecx
cmp $0, %ecx
jne 22b
# spinlock, wait for the BSP to finish
11:
pause
cmpb $0, bspdone
jz 11b
call enable_paging
lgdt gdtp
# jump into C code (should never return)
ljmp $8, $_start64
.set KERNEL_VMA, 0xffffffff80000000
.align 64
.code64
_start64:
mov $0x10, %ax
mov %ax, %ds
mov %ax, %es
mov %ax, %ss
mov %ax, %fs
mov %ax, %gs
add $KERNEL_VMA, %rsp
movabs $_higher_half, %rax
jmp *%rax
.section .text
_higher_half:
lock incb aprunning
call ap_startup
|
