; Start Paging
mov ecx, gaInitPageDir - KERNEL_BASE
mov cr3, ecx
-
mov ecx, cr0
or ecx, 0x80010000 ; PG and WP
mov cr0, ecx
mov WORD [0xB8002], 0x0763 ; 'c'
- mov WORD [0xB8004], 0x0765 ; 'e'
- lea ecx, [.higherHalf]
- jmp ecx
-.higherHalf:
+ ; Set GDT
+ lgdt [gGDTPtr]
+ mov cx, 0x10 ; PL0 Data
+ mov ss, cx
+ mov ds, cx
+ mov es, cx
+ mov gs, cx
+ mov fs, cx
+ mov WORD [0xB8004], 0x0765 ; 'e'
+ jmp 0x08:.higher_half
+.higher_half:
mov WORD [0xB8006], 0x0773 ; 's'
mov WORD [0xB8008], 0x0773 ; 's'
; Multiprocessing AP Startup Code (Must be within 0 - 0x10FFF0)
;
%if USE_MP
-[extern gGDT]
-[extern gGDTPtr]
[extern gIDTPtr]
[extern gpMP_LocalAPIC]
[extern giMP_TimerCount]
[extern gaCPUs]
[extern giNumInitingCPUs]
[extern MM_NewKStack]
+[extern Proc_InitialiseSSE]
lGDTPtr: ; Local GDT Pointer
dw 3*8-1
.hlt:
;hlt
jmp .hlt
+[extern Proc_Reschedule]
[global APStartup]
APStartup:
;xchg bx, bx ; MAGIC BREAK!
mov ebx, [ebp+0x20] ; Read ID
shr ebx, 24
;xchg bx, bx ; MAGIC BREAK
- ; CL is now local APIC ID
+ ; BL is now local APIC ID
mov cl, BYTE [gaAPIC_to_CPU+ebx]
xor ebx, ebx
mov bl, cl
; BL is now the CPU ID
+ mov dr1, ebx ; Save the CPU number to a debug register
+ ; Mark the CPU as up
mov BYTE [gaCPUs+ebx*8+1], 1
; Decrement the remaining CPU count
dec DWORD [giNumInitingCPUs]
; Set TSS
lea ecx, [ebx*8+0x30]
ltr cx
- ; Save the CPU number to a debug register
- mov dr1, ebx
;xchg bx, bx ; MAGIC_BREAK
; Enable Local APIC
mov DWORD [ebp+0x360], 0x000100D2 ; ##Enable LINT1 on IVT#0xD2
mov DWORD [ebp+0x370], 0x000100E1 ; ##Enable Error on IVT#0xE1
mov DWORD [ebp+0x0B0], 0 ; Send an EOI (just in case)
+
+ ; Initialise SSE support
+ call Proc_InitialiseSSE
; CPU is now marked as initialised
- sti
- ;xchg bx, bx ; MAGIC BREAK
+
.hlt:
+ sti
+ call Proc_Reschedule
hlt
jmp .hlt
%endif
pop ebp
ret
+[section .data]
+; GDT
+GDT_SIZE equ (1+2*2+1+MAX_CPUS)*8
+[global gGDT]
+gGDT:
+ ; PL0 - Kernel
+ ; PL3 - User
+ dd 0x00000000, 0x00000000 ; 00 NULL Entry
+ dd 0x0000FFFF, 0x00CF9A00 ; 08 PL0 Code
+ dd 0x0000FFFF, 0x00CF9200 ; 10 PL0 Data
+ dd 0x0000FFFF, 0x00CFFA00 ; 18 PL3 Code
+ dd 0x0000FFFF, 0x00CFF200 ; 20 PL3 Data
+ dd 26*4-1, 0x00408900 ; 28 Double Fault TSS
+ times MAX_CPUS dd 26*4-1, 0x00408900 ; 30+ TSSes
+[global gGDTPtr]
+gGDTPtr:
+ dw GDT_SIZE-1
+ dd gGDT
+
[section .initpd]
[global gaInitPageDir]
[global gaInitPageTable]
Kernel_Stack_Top:
gInitAPStacks:
times 32*MAX_CPUS dd 0
-
+
+; vim: ft=nasm ts=8