v86_lrmi.c

   1 #include <string.h>
   2 #include <lrmi.h>
   3 #include "v86.h"
   4
   5 #define addr(t) (((t & 0xffff0000) >> 12) + (t & 0x0000ffff))
   6
   7 void rconv_vm86_to_LRMI(struct vm86_regs *rs, struct LRMI_regs *rd)
   8 {
   9         memset(rd, 0, sizeof(*rd));
  10
  11         rd->eax = rs->eax;
  12         rd->ebx = rs->ebx;
  13         rd->ecx = rs->ecx;
  14         rd->edx = rs->edx;
  15         rd->edi = rs->edi;
  16         rd->esi = rs->esi;
  17         rd->ebp = rs->ebp;
  18         rd->sp  = rs->esp;
  19         rd->flags = rs->eflags;
  20         rd->ip  = rs->eip;
  21         rd->cs  = rs->cs;
  22         rd->ds  = rs->ds;
  23         rd->es  = rs->es;
  24         rd->fs  = rs->fs;
  25         rd->gs  = rs->gs;
  26 }
  27
  28 void rconv_LRMI_to_vm86(struct LRMI_regs *rs, struct vm86_regs *rd)
  29 {
  30         rd->eax = rs->eax;
  31         rd->ebx = rs->ebx;
  32         rd->ecx = rs->ecx;
  33         rd->edx = rs->edx;
  34         rd->edi = rs->edi;
  35         rd->esi = rs->esi;
  36         rd->ebp = rs->ebp;
  37         rd->esp = rs->sp;
  38         rd->eflags = rs->flags;
  39         rd->eip = rs->ip;
  40         rd->cs  = rs->cs;
  41         rd->ds  = rs->ds;
  42         rd->es  = rs->es;
  43         rd->fs  = rs->fs;
  44         rd->gs  = rs->gs;
  45 }
  46
  47 int v86_init() {
  48         int err = LRMI_init();
  49
  50         ioperm(0, 1024, 1);
  51         iopl(3);
  52
  53         return (err == 1) ? 0 : 1;
  54 }
  55
  56 /*
  57  * Perform a simulated interrupt call.
  58  */
  59 int v86_int(int num, struct vm86_regs *regs)
  60 {
  61         struct LRMI_regs r;
  62         int err;
  63
  64         rconv_vm86_to_LRMI(regs, &r);
  65         err = LRMI_int(num, &r);
  66         rconv_LRMI_to_vm86(&r, regs);
  67
  68         return (err == 1) ? 0 : 1;
  69 }
  70
  71 #define vbeib_get_string(name)                  \
  72 {                                                                               \
  73         t = addr(ib->name);                                     \
  74         ulog("%x %x\n", t, bufend);                     \
  75         if (t < bufend) {                                       \
  76                 ib->name = t - (u32)lbuf;               \
  77         } else {                                                        \
  78                 ib->name = 0;                                   \
  79         }                                                                       \
  80 }
  81
  82 int v86_task(struct uvesafb_task *tsk, u8 *buf)
  83 {
  84         u8 *lbuf;
  85
  86         /* Get the VBE Info Block */
  87         if (tsk->flags & TF_VBEIB) {
  88                 struct vbe_ib *ib;
  89                 u32 t, bufend;
  90
  91                 lbuf = LRMI_alloc_real(tsk->buf_len);
  92                 memcpy(lbuf, buf, tsk->buf_len);
  93                 tsk->regs.es  = (u32)lbuf >> 4;
  94                 tsk->regs.edi = 0x0000;
  95
  96                 if (v86_int(0x10, &tsk->regs) || (tsk->regs.eax & 0xffff) != 0x004f)
  97                         goto out_vbeib;
  98
  99                 ib = (struct vbe_ib*)buf;
 100                 bufend = (u32)(lbuf + sizeof(struct vbe_ib));
 101                 memcpy(buf, lbuf, tsk->buf_len);
 102
 103                 vbeib_get_string(oem_string_ptr);
 104                 vbeib_get_string(oem_vendor_name_ptr);
 105                 vbeib_get_string(oem_product_name_ptr);
 106                 vbeib_get_string(oem_product_rev_ptr);
 107                 vbeib_get_string(mode_list_ptr);
 108 out_vbeib:
 109                 LRMI_free_real(lbuf);
 110         } else {
 111                 if (tsk->buf_len) {
 112                         lbuf = LRMI_alloc_real(tsk->buf_len);
 113                         memcpy(lbuf, buf, tsk->buf_len);
 114                 }
 115
 116                 if (tsk->flags & TF_BUF_ESDI) {
 117                         tsk->regs.es = (u32)lbuf >> 4;
 118                         tsk->regs.edi = 0x0000;
 119                 }
 120
 121                 if (v86_int(0x10, &tsk->regs) || (tsk->regs.eax & 0xffff) != 0x004f)
 122                         goto out;
 123
 124                 if (tsk->buf_len && tsk->flags & TF_BUF_RET) {
 125                         memcpy(buf, lbuf, tsk->buf_len);
 126                 }
 127 out:
 128                 if (tsk->buf_len)
 129                         LRMI_free_real(lbuf);
 130         }
 131
 132         return 0;
 133 }
 134