git.mutantstargoat.com Git - dosdemo/blob - src/dos/watdpmi.c

   1 #ifdef __WATCOMC__
   2 #include "cdpmi.h"
   3
   4 void dpmi_real_int(int inum, struct dpmi_real_regs *regs)
   5 {
   6         unsigned char int_num = (unsigned char)inum;
   7         __asm {
   8                 mov eax, 0x300
   9                 mov edi, regs
  10                 mov bl, int_num
  11                 mov bh, 0
  12                 xor ecx, ecx
  13                 int 0x31
  14         }
  15 }
  16
  17 void *dpmi_mmap(uint32_t phys_addr, unsigned int size)
  18 {
  19         uint16_t mem_high, mem_low;
  20         uint16_t phys_high = phys_addr >> 16;
  21         uint16_t phys_low = phys_addr & 0xffff;
  22         uint16_t size_high = size >> 16;
  23         uint16_t size_low = size & 0xffff;
  24         unsigned int err, res = 0;
  25
  26         __asm {
  27                 mov eax, 0x800
  28                 mov bx, phys_high
  29                 mov cx, phys_low
  30                 mov si, size_high
  31                 mov di, size_low
  32                 int 0x31
  33                 add res, 1
  34                 mov err, eax
  35                 mov mem_high, bx
  36                 mov mem_low, cx
  37         }
  38
  39         if(res == 2) {
  40                 return 0;
  41         }
  42         return (void*)(((uint32_t)mem_high << 16) | ((uint32_t)mem_low));
  43 }
  44
  45 void dpmi_munmap(void *addr)
  46 {
  47         uint16_t mem_high = (uint32_t)addr >> 16;
  48         uint16_t mem_low = (uint16_t)addr;
  49
  50         __asm {
  51                 mov eax, 0x801
  52                 mov bx, mem_high
  53                 mov cx, mem_low
  54                 int 0x31
  55         }
  56 }
  57 #endif  /* __WATCOM__ */