Modified the way of calling V86 procedures, and calling BIOS ints

5 files changed, 136 insertions, 94 deletions

diff --git a/Source/Kernel/TaskManager/V86/V86.ns.cpp b/Source/Kernel/TaskManager/V86/V86.ns.cpp
index 93d51f2..f70728c 100644
--- a/Source/Kernel/TaskManager/V86/V86.ns.cpp
+++ b/Source/Kernel/TaskManager/V86/V86.ns.cpp
@@ -5,10 +5,17 @@ namespace V86 {
 
 u16int seg = V86_ALLOC_START;
 
-void run(v86_function_t& entry, registers_t &regs, u32int data) {
+void run(v86_function_t& entry, v86_regs_t &regs) {
 	v86_retval_t ret;
 	ret.regs = &regs;
-	new V86Thread(&entry, &ret, data);
+	new V86Thread(&entry, &ret);
+	while (!ret.finished) Task::currThread()->sleep(10);
+}
+
+void biosInt(u8int int_no, v86_regs_t &regs) {
+	v86_retval_t ret;
+	ret.regs = &regs;
+	new V86Thread(int_no, &ret);
 	while (!ret.finished) Task::currThread()->sleep(10);
 }
 
@@ -19,8 +26,7 @@ void map(Process* p) {
 	}
 }
 
-u16int allocSeg(u16int length, Process* p) {
-	if (p == 0) p = Task::currProcess();
+u16int allocSeg(u16int length) {
 	if (length & 0xF) length = (length & 0xFFFF0) + 0x10;
 	u16int segments = length / 16;
 	if (seg < V86_ALLOC_START) seg = V86_ALLOC_START;
@@ -28,16 +34,11 @@ u16int allocSeg(u16int length, Process* p) {
 	u16int ret = seg;
 	seg += segments;
 
-	void* ptr = FP_TO_LINEAR(ret, 0);
-	for (u32int i = (u32int)ptr & 0xFFFFF000; i < (u32int)ptr + length; i += 0x1000) {
-		p->getPagedir()->allocFrame(i, true, true);
-	}
-
 	return ret;
 }
 
-void* alloc(u16int length, Process* p) {
-	return FP_TO_LINEAR(allocSeg(length, p), 0);
+void* alloc(u16int length) {
+	return FP_TO_LINEAR(allocSeg(length), 0);
 }
 
 }
diff --git a/Source/Kernel/TaskManager/V86/V86.ns.h b/Source/Kernel/TaskManager/V86/V86.ns.h
index 9fa132b..ec8e928 100644
--- a/Source/Kernel/TaskManager/V86/V86.ns.h
+++ b/Source/Kernel/TaskManager/V86/V86.ns.h
@@ -23,11 +23,12 @@ inline FARPTR LINEAR_TO_FP(void* ptr) {
 #define V86_ALLOC_END 0x9000
 
 namespace V86 {
-	void run(v86_function_t& entry, registers_t &regs, u32int data);
+	void run(v86_function_t& entry, v86_regs_t &regs);
+	void biosInt(u8int int_no, v86_regs_t &regs);
 
 	void map(Process* p = 0);	//Maps lower 1MB of virtual memory to physical memory (lower 1MB as well)
-	u16int allocSeg(u16int size, Process* p = 0);
-	void* alloc(u16int size, Process* p = 0);
+	u16int allocSeg(u16int size);
+	void* alloc(u16int size);
 }
 
 #endif
diff --git a/Source/Kernel/TaskManager/V86/V86Thread.class.cpp b/Source/Kernel/TaskManager/V86/V86Thread.class.cpp
index 26fca63..5002225 100644
--- a/Source/Kernel/TaskManager/V86/V86Thread.class.cpp
+++ b/Source/Kernel/TaskManager/V86/V86Thread.class.cpp
@@ -3,85 +3,75 @@
 
 #include <TaskManager/V86/V86.ns.h>
 
-void V86Thread::runV86(V86Thread* thread, u32int data, u32int ss, u32int cs) {
-	thread->m_process->getPagedir()->switchTo();
-	//Setup values on user stack
-	u32int *stack = (u32int*)(FP_TO_LINEAR(ss, V86_STACKSIZE));
-	stack--; *stack = data;
-
-	u32int sp = V86_STACKSIZE - 4;
-
-	//Setup a false iret structure on the kernel stack, containing (first pushed first) :
-	// - gs = cs
-	// - fs = cs
-	// - ds = cs
-	// - es = cs
-	// - stack segment = ss (temporarily in ecx)
-	// - stack pointer = sp (temp in ebx)
-	// - flags (OR'ed with EFLAGS.VM)
-	// - code segment = cs (temp in eax)
-	// - instruction pointer = ip (is 0)
-	asm volatile("			\
-			pushl %%eax;	\
-			pushl %%eax;	\
-			pushl %%eax;	\
-			pushl %%eax;	\
-			pushl %%ecx;	\
-			pushl %%ebx;	\
-			pushf;			\
-			pop %%ebx;		\
-			or $0x200, %%ebx;	\
-			or $0x20000, %%ebx;	\
-			push %%ebx;		\
-			pushl %%eax;	\
-			pushl $0;		\
-			iret;			\
-			" : : "a"(cs), "c"(ss), "b"(sp));
-}
+//in v86.wtf.asm
+extern "C" void v86_run(u32int pd_phys,	//A page directory's physical address
+	v86_regs_t* regs);
 
 /*
  *	Set up a V86 task :
  *	Allocate space for the kernel stack
- *	Map frames in lower 1MB : IVT (first page), BDA (0xA0000 to 0xFFFFF)
+ *	Map frames in lower 1MB
  *  Find somewhere to put the stack and the code, still in lower 1MB
- *  Map that space, and copy the 16bit code to that place
+ *  Copy the 16bit code to that place
  *  Setup values on the kernel stack for starting the thread (V86Thread::runV86),
  *  giving it entry point and stack location
  */
 
-V86Thread::V86Thread(v86_function_t* entry, v86_retval_t* ret, u32int data) : Thread() {
-	m_ret = ret; m_ret->finished = false;
-	m_xchgspace = 0;
-	m_isKernel = true;
-	m_if = true;
+V86Thread::V86Thread(v86_function_t* entry, v86_retval_t* ret) : Thread() {
+	m_ret = ret;
+	setup();
+	m_continueOnIret = true;
+
+	m_ret->regs->cs = V86::allocSeg(entry->size);	//Alocate segments for the code to run in
+	u8int* codeptr = (u8int*)(FP_TO_LINEAR(m_ret->regs->cs, 0));
+	memcpy(codeptr, entry->data, entry->size);	//Copy the code there
+	
+	m_ret->regs->ip = 0;
+
+	m_state = T_RUNNING;
+	m_process->registerThread(this);
+	Task::registerThread(this);
+}
+
+V86Thread::V86Thread(u8int int_no, v86_retval_t* ret) : Thread() {
+	m_ret = ret;
+	setup();
+	m_continueOnIret = false;
+
+	//setup CS:IP for running interrupt
+	u16int* ivt = 0;
+
+	m_ret->regs->cs = ivt[int_no * 2 + 1];
+	m_ret->regs->ip = ivt[int_no * 2];
+
+	m_state = T_RUNNING;
+	m_process->registerThread(this);
+	Task::registerThread(this);
+}
+
+void V86Thread::setup() {
+	m_ret->finished = false; m_xchgspace = 0; m_isKernel = true;
 	m_process = Task::currProcess();
-	m_kernelStack.addr = Mem::alloc(STACKSIZE);
-	m_kernelStack.size = STACKSIZE;	
+	m_if = true;	//Set virtual interrupt flag
+	m_kernelStack.addr = Mem::alloc(STACKSIZE); m_kernelStack.size = STACKSIZE; //Setup kernel stack
 
 	m_process->getPagedir()->switchTo();
 
 	//Map all lower memory
 	V86::map();
 
-	u16int cs = V86::allocSeg(entry->size);	//Alocate segments for the code to run in
-	u8int* codeptr = (u8int*)(FP_TO_LINEAR(cs, 0));
-	memcpy(codeptr, entry->data, entry->size);	//Copy the code there
-
-	u16int ss = V86::allocSeg(V86_STACKSIZE);
+	//Allocate space for v86 stack
+	m_ret->regs->ss = V86::allocSeg(V86_STACKSIZE);
+	m_ret->regs->sp = V86_STACKSIZE - 4;
 
+	//Setup kernel stack for running v86_run (entry procedure)
 	u32int* stack = (u32int*)((u32int)m_kernelStack.addr + m_kernelStack.size);
-	stack--; *stack = cs;	//Pass code segment (ip = 0)
-	stack--; *stack = ss;	//Pass stack segment (sp = V86_STACKSIZE)
-	stack--; *stack = data;	//Pass data for thread
-	stack--; *stack = (u32int)this;	//Pass thread pointer
+	stack--; *stack = (u32int)m_ret->regs;
+	stack--; *stack = m_process->getPagedir()->physicalAddr;
 	stack--; *stack = 0;
 	m_esp = (u32int)stack;
-	m_ebp = m_esp + 8;
-	m_eip = (u32int)runV86;
-
-	m_state = T_RUNNING;
-	m_process->registerThread(this);
-	Task::registerThread(this);
+	m_ebp = m_esp + 4;
+	m_eip = (u32int)v86_run;
 }
 
 bool V86Thread::handleV86GPF(registers_t *regs) {
@@ -135,16 +125,6 @@ bool V86Thread::handleV86GPF(registers_t *regs) {
 				return true;
 			case 0xCD:		// INT N
 				if (ip[1] == 3) return false;	//Breakpoint exception, here used for telling that thread has ended
-				if (ip[1] == 60) {		//INT 60 is used so that the real mode code can retrieve some regs from caller
-					regs->eax = m_ret->regs->eax;
-					regs->ebx = m_ret->regs->ebx;
-					regs->ecx = m_ret->regs->ecx;
-					regs->edx = m_ret->regs->edx;
-					regs->edi = m_ret->regs->edi;
-					regs->esi = m_ret->regs->esi;
-					regs->eip = (u16int)(regs->eip + 2);
-					return true;
-				}
 
 				stack -= 3;
 				regs->useresp = ((regs->useresp & 0xFFFF) - 6) & 0xFFFF;
@@ -162,7 +142,7 @@ bool V86Thread::handleV86GPF(registers_t *regs) {
 				regs->eflags = EFLAGS_IF | EFLAGS_VM | stack[2];
 				m_if = (stack[2] & EFLAGS_IF) != 0;
 				regs->useresp = ((regs->useresp & 0xFFFF) + 6) & 0xFFFF;
-				return false;
+				return m_continueOnIret;
 			case 0xFA:		// CLI
 				m_if = false;
 				regs->eip = (u16int)(regs->eip + 1);
@@ -181,7 +161,12 @@ void V86Thread::handleException(registers_t *regs, int no) {
 	if (no == 13) {			//General protection fault
 		if (!handleV86GPF(regs)) {
 			m_ret->finished = true;
-			*(m_ret->regs) = *regs;
+			m_ret->regs->ax = (u16int)regs->eax;
+			m_ret->regs->bx = (u16int)regs->ebx;
+			m_ret->regs->cx = (u16int)regs->ecx;
+			m_ret->regs->dx = (u16int)regs->edx;
+			m_ret->regs->di = (u16int)regs->edi;
+			m_ret->regs->si = (u16int)regs->esi;
 			Task::currentThreadExits(0);
 			return;
 		}
diff --git a/Source/Kernel/TaskManager/V86/V86Thread.class.h b/Source/Kernel/TaskManager/V86/V86Thread.class.h
index 591bea6..7ca55b1 100644
--- a/Source/Kernel/TaskManager/V86/V86Thread.class.h
+++ b/Source/Kernel/TaskManager/V86/V86Thread.class.h
@@ -3,16 +3,22 @@
 
 #include <TaskManager/Thread.class.h>
 
-struct v86_retval_t {
-	registers_t *regs;
-	bool finished;
-};
-
 struct v86_function_t {
 	u16int size;
 	u8int data[];
 };
 
+struct v86_regs_t {
+	u16int ax, bx, cx, dx, di, si;
+	u16int cs, ds, es, fs, gs, ss;
+	u16int ip, sp;
+} __attribute__((packed));
+
+struct v86_retval_t {
+	v86_regs_t *regs;
+	bool finished;
+};
+
 #define V86_STACKSIZE 1024
 
 #define EFLAGS_IF 0x200
@@ -26,12 +32,13 @@ class V86Thread : public Thread {
 
 	v86_retval_t* m_ret;
 
-	bool m_if;	//V86 IF flag
+	bool m_if, m_continueOnIret;	//V86 IF flag
+
+	void setup();
 
-	static void runV86(V86Thread* t, u32int data, u32int ss, u32int cs);
-	
 	public:
-	V86Thread(v86_function_t* entry, v86_retval_t* ret, u32int data);
+	V86Thread(v86_function_t* entry, v86_retval_t* ret);
+	V86Thread(u8int int_no, v86_retval_t* ret);
 
 	bool handleV86GPF(registers_t *regs);
 	void handleException(registers_t *regs, int no);	
diff --git a/Source/Kernel/TaskManager/V86/v86.wtf.asm b/Source/Kernel/TaskManager/V86/v86.wtf.asm
new file mode 100644
index 0000000..09b08a2
--- /dev/null
+++ b/Source/Kernel/TaskManager/V86/v86.wtf.asm
@@ -0,0 +1,48 @@
+; This is the procedure that is first run when starting a V86 thread
+; Parameters : esp+4 = page directory to switch to, esp+8 = v86_regs_t pointer
+; Algorithm :
+; - Switch page directory
+; - Create a false IRET structure, with : (first pushed first)
+;   GS, FS, DS, ES, SS, SP, EFLAGS (with eflags.if and eflags.vm), CS, IP
+; - Set general purpose regisers : ax bx cx dx di si
+; - Call iret, switch to V86 mode.
+
+[BITS 32]
+
+[GLOBAL v86_run]
+v86_run:
+	mov eax, [esp + 4]
+	mov cr3, eax
+	mov eax, [esp + 8]
+
+	xor ebx, ebx
+	mov bx, [eax + 20]		; get GS
+	push ebx
+	mov bx, [eax + 18]		; get FS
+	push ebx
+	mov bx, [eax + 14]		; get DS
+	push ebx
+	mov bx, [eax + 16]		; get ES
+	push ebx
+	mov bx, [eax + 22]		; get SS
+	push ebx
+	mov bx, [eax + 26]		; get SP
+	push ebx
+	pushf
+	pop ebx
+	or ebx, 20200h
+	push ebx
+	xor ebx, ebx
+	mov bx, [eax + 12]		; get CS
+	push ebx
+	mov bx, [eax + 24]		; get IP
+	push ebx
+
+	mov bx, [eax + 2]
+	mov cx, [eax + 4]
+	mov dx, [eax + 6]
+	mov di, [eax + 8]
+	mov si, [eax + 10]
+	mov ax, [eax]
+
+	iret