X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?p=dos_sbtest;a=blobdiff_plain;f=src%2Fdpmi.c;fp=src%2Fdpmi.c;h=7d2c2b56788b4e544b9e6851516f7f692286ad14;hp=0000000000000000000000000000000000000000;hb=07c19444f4f2a55abf97d181ab62aeaa51033c62;hpb=01a545fde6dc446fe626382f8bba50b9b7c1a35b

diff --git a/src/dpmi.c b/src/dpmi.c
new file mode 100644
index 0000000..7d2c2b5
--- /dev/null
+++ b/src/dpmi.c
@@ -0,0 +1,55 @@
+#include "dpmi.h"
+
+void dpmi_real_int(int inum, struct dpmi_real_regs *regs)
+{
+	unsigned char int_num = (unsigned char)inum;
+	__asm {
+		mov eax, 0x300
+		mov edi, regs
+		mov bl, int_num
+		mov bh, 0
+		xor ecx, ecx
+		int 0x31
+	}
+}
+
+void *dpmi_mmap(uint32_t phys_addr, unsigned int size)
+{
+	uint16_t mem_high, mem_low;
+	uint16_t phys_high = phys_addr >> 16;
+	uint16_t phys_low = phys_addr & 0xffff;
+	uint16_t size_high = size >> 16;
+	uint16_t size_low = size & 0xffff;
+	unsigned int err, res = 0;
+
+	__asm {
+		mov eax, 0x800
+		mov bx, phys_high
+		mov cx, phys_low
+		mov si, size_high
+		mov di, size_low
+		int 0x31
+		add res, 1
+		mov err, eax
+		mov mem_high, bx
+		mov mem_low, cx
+	}
+
+	if(res == 2) {
+		return 0;
+	}
+	return (void*)(((uint32_t)mem_high << 16) | ((uint32_t)mem_low));
+}
+
+void dpmi_munmap(void *addr)
+{
+	uint16_t mem_high = (uint32_t)addr >> 16;
+	uint16_t mem_low = (uint16_t)addr;
+
+	__asm {
+		mov eax, 0x801
+		mov bx, mem_high
+		mov cx, mem_low
+		int 0x31
+	}
+}