X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Kernel%2Farch%2Fx86_64%2Fstart64.asm;h=33c77d6277330dd39eac664662595542802c6c27;hb=e6d539f85a06fb3d25b985d1a27d8648d23736f0;hp=c1f1e58be0e474e6308e5676083555b6e8585d44;hpb=9f407c493c33928e0f19b834699d9694036ca42e;p=tpg%2Facess2.git

diff --git a/Kernel/arch/x86_64/start64.asm b/Kernel/arch/x86_64/start64.asm
index c1f1e58b..33c77d62 100644
--- a/Kernel/arch/x86_64/start64.asm
+++ b/Kernel/arch/x86_64/start64.asm
@@ -2,20 +2,61 @@
 ; Acess2 x86_64 Port
 ;
 [bits 64]
+KERNEL_BASE	equ	0xFFFF800000000000
+
+[extern kmain]
+
+[extern gMultibootPtr]
+[extern gMultibootMagic]
 
 [section .text]
 [global start64]
 start64:
+	; Load Registers
+	mov ax, 0x10
+	mov ds, ax
+	mov es, ax
+	mov fs, ax
+	mov gs, ax
+	
+	; Go to high memory
+	mov rax, start64.himem
+	jmp rax
+.himem:
+	
+	; Clear the screen
+	mov rax, 0x1F201F201F201F20	; Set the screen to White on blue, space (4 characters)
+	mov edi, 0xB8000
+	mov ecx, 80*25*2/8
+	rep stosq
+	
 	; Set kernel stack
+	mov rsp, gInitialKernelStack
+	
 	; Call main
-	jmp $
+	mov edi, [gMultibootMagic - KERNEL_BASE]
+	mov esi, [gMultibootPtr - KERNEL_BASE]
+	call kmain
+	
+	cli
+.hlt:
+	hlt
+	jmp .hlt
 
 [global GetRIP]
 GetRIP:
 	mov rax, [rsp]
 	ret
 
-KSTACK_USERSTATE_SIZE	equ	(4+8+1+5)*4	; SRegs, GPRegs, CPU, IRET
+[global GetCPUNum]
+GetCPUNum:
+	xor rax, rax
+	str ax
+	sub ax, 0x38	; TSS Base
+	shr ax, 4	; One 16-byte TSS per CPU
+	ret
+
+KSTACK_USERSTATE_SIZE	equ	(16+1+5)*8	; GPRegs, CPU, IRET
 [global Proc_ReturnToUser]
 [extern Proc_GetCurThread]
 Proc_ReturnToUser:
@@ -38,7 +79,8 @@ Proc_ReturnToUser:
 	mov rcx, [rax+KSTACK_USERSTATE_SIZE-3*8]
 	mov rdx, [rbx+60]	; Get Signal Number
 	mov [rcx-8], rdx
-	mov QWORD [rcx-16], User_Syscall_RetAndExit
+	mov rax, User_Syscall_RetAndExit
+	mov [rcx-16], rax
 	sub rcx, 16
 	
 	; Restore Segment Registers
@@ -54,6 +96,26 @@ Proc_ReturnToUser:
 	
 	iret
 
+; int CallWithArgArray(void *Ptr, int NArgs, Uint *Args)
+; Call a function passing the array as arguments
+[global CallWithArgArray]
+CallWithArgArray:
+	push rbp
+	mov rbp, rsp
+	mov rcx, [rbp+3*8]	; Get NArgs
+	mov rdx, [rbp+4*8]
+
+.top:
+	mov rax, [rdx+rcx*8-8]
+	push rax
+	loop .top
+	
+	mov rax, [rbp+2*8]
+	call rax
+	lea rsp, [rbp]
+	pop rbp
+	ret
+
 [section .usertext]
 User_Syscall_RetAndExit:
 	mov rdi, rax
@@ -65,6 +127,6 @@ User_Syscall_Exit:
 
 [section .bss]
 [global gInitialKernelStack]
-	resd	1024*1	; 1 Page
+	resd	1024*4	; 4 Pages
 gInitialKernelStack: