X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Kernel%2Farch%2Fx86%2Fproc.asm;h=9c1cabd90f7426bc39b62c9304e1e2adaa810648;hb=b68b764267d33a45539b4c910db13fbdae48f193;hp=fd863a42e93c04f21167bcb38bb0571de4f96116;hpb=e7fb36caedf6cd739359e98a163041b6e058ce7a;p=tpg%2Facess2.git

diff --git a/Kernel/arch/x86/proc.asm b/Kernel/arch/x86/proc.asm
index fd863a42..9c1cabd9 100644
--- a/Kernel/arch/x86/proc.asm
+++ b/Kernel/arch/x86/proc.asm
@@ -8,6 +8,74 @@ KERNEL_BASE	equ 0xC0000000
 KSTACK_USERSTATE_SIZE	equ	(4+8+1+5)*4	; SRegs, GPRegs, CPU, IRET
 
 [section .text]
+
+[global NewTaskHeader]
+NewTaskHeader:
+	mov eax, [esp]
+	mov dr0, eax
+
+	mov eax, [esp+4]
+	add esp, 12	; Thread, Function, Arg Count
+	call eax
+	
+	push eax	; Ret val
+	push 0  	; 0 = This Thread
+	call Threads_Exit
+
+[extern MM_Clone]
+[global Proc_CloneInt]
+Proc_CloneInt:
+	pusha
+	; Save RSP
+	mov eax, [esp+0x20+4]
+	mov [eax], esp
+	call MM_Clone
+	; Save CR3
+	mov esi, [esp+0x20+8]
+	mov [esi], eax
+	; Undo the pusha
+	add esp, 0x20
+	mov eax, .newTask
+	ret
+.newTask:
+	popa
+	xor eax, eax
+	ret
+
+[global SwitchTasks]
+; + 4 = New RSP
+; + 8 = Old RSP save loc
+; +12 = New RIP
+; +16 = Old RIP save loc
+; +20 = CR3
+SwitchTasks:
+	pusha
+	
+	; Old IP
+	mov eax, [esp+0x20+16]
+	mov DWORD [eax], .restore
+	; Old SP
+	mov eax, [esp+0x20+8]
+	mov [eax], esp
+
+	mov ecx, [esp+0x20+12]	; New IP
+	mov eax, [esp+0x20+20]	; New CR3
+	mov esp, [esp+0x20+ 4]	; New SP
+	test eax, eax
+	jz .setState
+	mov cr3, eax
+	invlpg [esp]
+	invlpg [esp+0x1000]
+.setState:
+;	xchg bx, bx
+	jmp ecx
+
+.restore:
+	popa
+	xor eax, eax
+	ret
+
+
 %if USE_MP
 [extern giMP_TimerCount]
 [extern gpMP_LocalAPIC]
@@ -74,6 +142,13 @@ SchedulerBase:
 	push fs
 	push gs
 	
+	pushf
+	and BYTE [esp+1], 0xFE	; Clear Trap Flag
+	popf
+	
+	mov eax, dr0
+	push eax	; Debug Register 0, Current Thread
+	
 	mov ax, 0x10
 	mov ds, ax
 	mov es, ax
@@ -89,8 +164,10 @@ SchedulerBase:
 	%endif
 	
 	call Proc_Scheduler
+[global scheduler_return]
+scheduler_return:	; Used by some hackery in Proc_DumpThreadCPUState
 	
-	add esp, 4	; Remove Argument
+	add esp, 4	; Remove CPU Number (thread is poped later)
 
 	%if USE_MP
 	test ebx, ebx
@@ -107,13 +184,16 @@ SchedulerBase:
 	mov DWORD [eax+0x0B0], 0
 	%endif
 .ret:
+	pop eax	; Debug Register 0, Current Thread
+	mov dr0, eax
+
 	pop gs
 	pop fs
 	pop es
 	pop ds
 	
 	popa
-	add esp, 4	; CPU ID
+	add esp, 4*2	; CPU ID + Dummy error code
 	; No Error code / int num
 	iret
 
@@ -123,7 +203,7 @@ SchedulerBase:
 SpawnTask:
 	; Call Proc_Clone with Flags=0
 	xor eax, eax
-	push eax
+;	push eax
 	push eax
 	call Proc_Clone
 	add esp, 8	; Remove arguments from stack
@@ -134,9 +214,10 @@ SpawnTask:
 	; In child, so now set up stack frame
 	mov ebx, [esp+4]	; Child Function
 	mov edx, [esp+8]	; Argument
-	; Child
+	; Child Function
 	push edx	; Argument
 	call ebx	; Function
+	; Kill thread once done
 	push eax	; Exit Code
 	push   0	; Kill this thread
 	call Threads_Exit	; Kill Thread
@@ -144,19 +225,24 @@ SpawnTask:
 .parent:
 	ret
 
-;
+; void Proc_ReturnToUser(void *Method, Uint Parameter)
 ; Calls a user fault handler
 ;
 [global Proc_ReturnToUser]
 [extern Proc_GetCurThread]
 Proc_ReturnToUser:
-	; EBP is the handler to use
+	push ebp
+	mov ebp, esp
+	; [EBP+8]: handler to use
+	; [EBP+12]: parameter
+	; [EBP+16]: kernel stack top
 	
-	call Proc_GetCurThread
+	;call Proc_GetCurThread
 	
 	; EAX is the current thread
-	mov ebx, eax
-	mov eax, [ebx+40]	; Get Kernel Stack
+	;mov ebx, eax
+	;mov eax, [ebx+12*4]	; Get Kernel Stack
+	mov eax, [ebp+16]	; Get Kernel Stack
 	sub eax, KSTACK_USERSTATE_SIZE
 	
 	;
@@ -168,14 +254,10 @@ Proc_ReturnToUser:
 	; Validate user ESP
 	; - Page Table
 	mov edx, [eax+KSTACK_USERSTATE_SIZE-12]	; User ESP is at top of kstack - 3*4
-	%if USE_PAE
-	%error PAE Support
-	%else
 	mov ecx, edx
 	shr ecx, 22
 	test BYTE [0xFC3F0000+ecx*4], 1
 	jnz .justKillIt
-	%endif
 	; - Page
 	mov ecx, edx
 	shr ecx, 12
@@ -184,13 +266,10 @@ Proc_ReturnToUser:
 	; Adjust
 	sub edx, 8
 	; - Page Table
-	%if USE_PAE
-	%else
 	mov ecx, edx
 	shr ecx, 22
 	test BYTE [0xFC3F0000+ecx*4], 1
 	jnz .justKillIt
-	%endif
 	; - Page
 	mov ecx, edx
 	shr ecx, 12
@@ -198,10 +277,10 @@ Proc_ReturnToUser:
 	jnz .justKillIt
 	
 	; Get and alter User SP
-	mov ecx, edx
-	mov edx, [ebx+60]	; Get Signal Number from TCB
-	mov [ecx+4], edx	; Parameter (Signal/Error Number)
-	mov [ecx], DWORD User_Syscall_RetAndExit	; Return Address
+	mov edi, edx
+	mov edx, [ebp+12]	; Get parameter
+	mov [edi+4], edx	; save to user stack
+	mov [edi], DWORD User_Syscall_RetAndExit	; Return Address
 	
 	; Restore Segment Registers
 	mov ax, 0x23
@@ -211,10 +290,11 @@ Proc_ReturnToUser:
 	mov gs, ax
 	
 	push 0x23	; SS
-	push ecx	; ESP
+	push edi	; ESP
 	push 0x202	; EFLAGS (IP and Rsvd)
 	push 0x1B	; CS
-	push ebp	; EIP
+	mov eax, [ebp+8]	; Method to call
+	push eax	; EIP
 	
 	iret
 	
@@ -223,15 +303,25 @@ Proc_ReturnToUser:
 .justKillIt:
 	xor eax, eax
 	xor ebx, ebx
-	dec ebx
+	dec ebx	; EBX = -1
 	int 0xAC
 
 [global GetCPUNum]
-GetCPUNum:
-	xor eax, eax
-	str ax
-	sub ax, 0x30
-	shr ax, 3	; ax /= 8
+GetCPUNum:	; TODO: Store in debug registers
+;	xor eax, eax
+;	str ax
+;	sub ax, 0x30
+;	shr ax, 3	; ax /= 8
+	mov eax, dr1
+	ret
+
+[extern GetEIP]
+[global GetEIP_Sched]
+[global GetEIP_Sched_ret]
+GetEIP_Sched_ret equ GetEIP_Sched.ret
+GetEIP_Sched:
+	call GetEIP
+GetEIP_Sched.ret:
 	ret
 
 ; Usermode code exported by the kernel
@@ -239,6 +329,7 @@ GetCPUNum:
 ; Export a place for the user to jump to to call a syscall
 ; - Allows the kernel to change the method easily
 User_Syscall:
+	xchg bx, bx	; MAGIC BREAKPOINT
 	int 0xAC
 
 ; A place to return to and exit