v86_common.c

   1 #include <string.h>
   2 #include "v86.h"
   3
   4 #define addr(t) (((t & 0xffff0000) >> 12) + (t & 0x0000ffff))
   5
   6 #define vbeib_get_string(name)                                  \
   7 {                                                                                               \
   8         int l;                                                                          \
   9         t = addr(ib->name);                                                     \
  10         if (t < bufend) {                                                       \
  11                 ib->name = t - lbuf;                                    \
  12         } else if (t > 0xa0000 && fsize > 0) {          \
  13                 strncpy((char*)buf, vptr(t), fsize);    \
  14                 ib->name = tsk->buf_len - fsize;                \
  15                 l = strlen((char*)buf);                                 \
  16                 fsize -= l;                                                             \
  17                 buf += l;                                                               \
  18                 if (fsize < 0)                                                  \
  19                         fsize = 0;                                                      \
  20         } else {                                                                        \
  21                 ib->name = 0;                                                   \
  22         }                                                                                       \
  23 }
  24
  25 int v86_task(struct uvesafb_task *tsk, u8 *buf)
  26 {
  27         u32 lbuf = 0;
  28
  29         ulog(LOG_DEBUG, "task flags: 0x%.2lx\n", tsk->flags);
  30         ulog(LOG_DEBUG, "EAX=%.8lx EBX=%.8lx ECX=%.8lx EDX=%.8lx\n",
  31                  tsk->regs.eax, tsk->regs.ebx, tsk->regs.ecx, tsk->regs.edx);
  32         ulog(LOG_DEBUG, "ESP=%.8lx EBP=%.8lx ESI=%.8lx EDI=%.8lx\n",
  33                  tsk->regs.esp, tsk->regs.ebp, tsk->regs.esi, tsk->regs.edi);
  34
  35         /* Get the VBE Info Block */
  36         if (tsk->flags & TF_VBEIB) {
  37                 struct vbe_ib *ib;
  38                 int fsize;
  39                 u32 t, bufend;
  40                 u16 *td;
  41
  42                 lbuf = v86_mem_alloc(tsk->buf_len);
  43                 memcpy(vptr(lbuf), buf, tsk->buf_len);
  44                 tsk->regs.es  = lbuf >> 4;
  45                 tsk->regs.edi = 0x0000;
  46
  47                 if (v86_int(0x10, &tsk->regs) || (tsk->regs.eax & 0xffff) != 0x004f)
  48                         goto out_vbeib;
  49
  50                 ib = (struct vbe_ib*)buf;
  51                 bufend = lbuf + sizeof(*ib);
  52                 memcpy(buf, vptr(lbuf), tsk->buf_len);
  53
  54                 /* The original VBE Info Block is 512 bytes long. */
  55                 fsize = tsk->buf_len - 512;
  56
  57                 t = addr(ib->mode_list_ptr);
  58                 /* Mode list is in the buffer, we're good. */
  59                 if (t < bufend) {
  60                         ulog(LOG_DEBUG, "The mode list is in the buffer at %.8x.", t);
  61                         ib->mode_list_ptr = t - lbuf;
  62
  63                 /* Mode list is in the ROM. We copy as much of it as we can
  64                  * to the task buffer. */
  65                 } else if (t > 0xa0000) {
  66                         u16 tmp;
  67
  68                         ulog(LOG_DEBUG, "The mode list is in the Video ROM at %.8x", t);
  69
  70                         td = (u16*) (buf + 512);
  71
  72                         while (fsize > 2 && (tmp = v_rdw(t)) != 0xffff) {
  73                                 fsize -= 2;
  74                                 *td = tmp;
  75                                 t += 2;
  76                                 td++;
  77                         }
  78
  79                         ib->mode_list_ptr = 512;
  80                         *td = 0xffff;
  81
  82                 /* Mode list is somewhere else. We're seriously screwed. */
  83                 } else {
  84                         ulog(LOG_ERR, "Can't retrieve mode list from %x\n", t);
  85                         ib->mode_list_ptr = 0;
  86                 }
  87
  88                 buf += 512;
  89
  90                 vbeib_get_string(oem_string_ptr);
  91                 vbeib_get_string(oem_vendor_name_ptr);
  92                 vbeib_get_string(oem_product_name_ptr);
  93                 vbeib_get_string(oem_product_rev_ptr);
  94 out_vbeib:
  95                 v86_mem_free(lbuf);
  96         } else {
  97                 if (tsk->buf_len) {
  98                         lbuf = v86_mem_alloc(tsk->buf_len);
  99                         memcpy(vptr(lbuf), buf, tsk->buf_len);
 100                 }
 101
 102                 if (tsk->flags & TF_BUF_ESDI) {
 103                         tsk->regs.es = lbuf >> 4;
 104                         tsk->regs.edi = 0x0000;
 105                 }
 106
 107                 if (tsk->flags & TF_BUF_ESBX) {
 108                         tsk->regs.es = lbuf >> 4;
 109                         tsk->regs.ebx = 0x0000;
 110                 }
 111
 112                 if (v86_int(0x10, &tsk->regs) || (tsk->regs.eax & 0xffff) != 0x004f)
 113                         goto out;
 114
 115                 if (tsk->buf_len && tsk->flags & TF_BUF_RET) {
 116                         memcpy(buf, vptr(lbuf), tsk->buf_len);
 117                 }
 118 out:
 119                 if (tsk->buf_len)
 120                         v86_mem_free(lbuf);
 121         }
 122
 123         return 0;
 124 }
 125