vgasrc/vbe.c

   1 // Video Bios Extensions handlers
   2 //
   3 // Copyright (C) 2009  Kevin O'Connor <kevin@koconnor.net>
   4 // Copyright (C) 2001-2008 the LGPL VGABios developers Team
   5 //
   6 // This file may be distributed under the terms of the GNU LGPLv3 license.
   7
   8 #include "vgabios.h" // handle_104f
   9 #include "config.h" // CONFIG_*
  10 #include "bregs.h" // struct bregs
  11 #include "vbe.h" // struct vbe_info
  12 #include "util.h" // dprintf
  13 #include "biosvar.h" // get_global_set
  14 #include "bochsvga.h" // bochsvga_set_mode
  15 #include "stdvga.h" // stdvga_set_mode
  16
  17 static void
  18 vbe_104f00(struct bregs *regs)
  19 {
  20     u16 seg = regs->es;
  21     struct vbe_info *info = (void*)(regs->di+0);
  22
  23     if (GET_FARVAR(seg, info->signature) == VBE2_SIGNATURE) {
  24         dprintf(4, "Get VBE Controller: VBE2 Signature found\n");
  25     } else if (GET_FARVAR(seg, info->signature) == VESA_SIGNATURE) {
  26         dprintf(4, "Get VBE Controller: VESA Signature found\n");
  27     } else {
  28         dprintf(4, "Get VBE Controller: Invalid Signature\n");
  29     }
  30
  31     memset_far(seg, info, 0, sizeof(*info));
  32
  33     SET_FARVAR(seg, info->signature, VESA_SIGNATURE);
  34
  35     SET_FARVAR(seg, info->version, 0x0200);
  36
  37     SET_FARVAR(seg, info->oem_string,
  38             SEGOFF(get_global_seg(), (u32)VBE_OEM_STRING));
  39     SET_FARVAR(seg, info->capabilities, 0x1); /* 8BIT DAC */
  40
  41     /* We generate our mode list in the reserved field of the info block */
  42     SET_FARVAR(seg, info->video_mode, SEGOFF(seg, regs->di + 34));
  43
  44     /* Total memory (in 64 blocks) */
  45     SET_FARVAR(seg, info->total_memory, bochsvga_total_mem());
  46
  47     SET_FARVAR(seg, info->oem_vendor_string,
  48             SEGOFF(get_global_seg(), (u32)VBE_VENDOR_STRING));
  49     SET_FARVAR(seg, info->oem_product_string,
  50             SEGOFF(get_global_seg(), (u32)VBE_PRODUCT_STRING));
  51     SET_FARVAR(seg, info->oem_revision_string,
  52             SEGOFF(get_global_seg(), (u32)VBE_REVISION_STRING));
  53
  54     /* Fill list of modes */
  55     bochsvga_list_modes(seg, regs->di + 32);
  56
  57     regs->al = regs->ah; /* 0x4F, Function supported */
  58     regs->ah = 0x0; /* 0x0, Function call successful */
  59 }
  60
  61 static void
  62 vbe_104f01(struct bregs *regs)
  63 {
  64     u16 seg = regs->es;
  65     struct vbe_mode_info *info = (void*)(regs->di+0);
  66     u16 mode = regs->cx;
  67     struct vbe_modeinfo modeinfo;
  68     int rc;
  69
  70     dprintf(1, "VBE mode info request: %x\n", mode);
  71
  72     rc = bochsvga_mode_info(mode, &modeinfo);
  73     if (rc) {
  74         dprintf(1, "VBE mode %x not found\n", mode);
  75         regs->ax = 0x100;
  76         return;
  77     }
  78
  79     u16 mode_attr = VBE_MODE_ATTRIBUTE_SUPPORTED |
  80                     VBE_MODE_ATTRIBUTE_EXTENDED_INFORMATION_AVAILABLE |
  81                     VBE_MODE_ATTRIBUTE_COLOR_MODE |
  82                     VBE_MODE_ATTRIBUTE_GRAPHICS_MODE;
  83     if (modeinfo.depth == 4)
  84         mode_attr |= VBE_MODE_ATTRIBUTE_TTY_BIOS_SUPPORT;
  85     else
  86         mode_attr |= VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE;
  87     SET_FARVAR(seg, info->mode_attributes, mode_attr);
  88     SET_FARVAR(seg, info->winA_attributes,
  89                VBE_WINDOW_ATTRIBUTE_RELOCATABLE |
  90                VBE_WINDOW_ATTRIBUTE_READABLE |
  91                VBE_WINDOW_ATTRIBUTE_WRITEABLE);
  92     SET_FARVAR(seg, info->winB_attributes, 0);
  93     SET_FARVAR(seg, info->win_granularity, 64); /* Bank size 64K */
  94     SET_FARVAR(seg, info->win_size, 64); /* Bank size 64K */
  95     SET_FARVAR(seg, info->winA_seg, 0xA000);
  96     SET_FARVAR(seg, info->winB_seg, 0x0);
  97     SET_FARVAR(seg, info->win_func_ptr.segoff, 0x0);
  98     SET_FARVAR(seg, info->bytes_per_scanline, modeinfo.linesize);
  99     SET_FARVAR(seg, info->xres, modeinfo.width);
 100     SET_FARVAR(seg, info->yres, modeinfo.height);
 101     SET_FARVAR(seg, info->xcharsize, 8);
 102     SET_FARVAR(seg, info->ycharsize, 16);
 103     if (modeinfo.depth == 4)
 104         SET_FARVAR(seg, info->planes, 4);
 105     else
 106         SET_FARVAR(seg, info->planes, 1);
 107     SET_FARVAR(seg, info->bits_per_pixel, modeinfo.depth);
 108     SET_FARVAR(seg, info->banks,
 109             (modeinfo.linesize * modeinfo.height + 65535) / 65536);
 110     if (modeinfo.depth == 4)
 111         SET_FARVAR(seg, info->mem_model, VBE_MEMORYMODEL_PLANAR);
 112     else if (modeinfo.depth == 8)
 113         SET_FARVAR(seg, info->mem_model, VBE_MEMORYMODEL_PACKED_PIXEL);
 114     else
 115         SET_FARVAR(seg, info->mem_model, VBE_MEMORYMODEL_DIRECT_COLOR);
 116     SET_FARVAR(seg, info->bank_size, 0);
 117     u32 pages = modeinfo.vram_size / (modeinfo.height * modeinfo.linesize);
 118     if (modeinfo.depth == 4)
 119         SET_FARVAR(seg, info->pages, (pages / 4) - 1);
 120     else
 121         SET_FARVAR(seg, info->pages, pages - 1);
 122     SET_FARVAR(seg, info->reserved0, 1);
 123
 124     u8 r_size, r_pos, g_size, g_pos, b_size, b_pos, a_size, a_pos;
 125
 126     switch (modeinfo.depth) {
 127     case 15: r_size = 5; r_pos = 10; g_size = 5; g_pos = 5;
 128              b_size = 5; b_pos = 0; a_size = 1; a_pos = 15; break;
 129     case 16: r_size = 5; r_pos = 11; g_size = 6; g_pos = 5;
 130              b_size = 5; b_pos = 0; a_size = 0; a_pos = 0; break;
 131     case 24: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
 132              b_size = 8; b_pos = 0; a_size = 0; a_pos = 0; break;
 133     case 32: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
 134              b_size = 8; b_pos = 0; a_size = 8; a_pos = 24; break;
 135     default: r_size = 0; r_pos = 0; g_size = 0; g_pos = 0;
 136              b_size = 0; b_pos = 0; a_size = 0; a_pos = 0; break;
 137     }
 138
 139     SET_FARVAR(seg, info->red_size, r_size);
 140     SET_FARVAR(seg, info->red_pos, r_pos);
 141     SET_FARVAR(seg, info->green_size, g_size);
 142     SET_FARVAR(seg, info->green_pos, g_pos);
 143     SET_FARVAR(seg, info->blue_size, b_size);
 144     SET_FARVAR(seg, info->blue_pos, b_pos);
 145     SET_FARVAR(seg, info->alpha_size, a_size);
 146     SET_FARVAR(seg, info->alpha_pos, a_pos);
 147
 148     if (modeinfo.depth == 32)
 149         SET_FARVAR(seg, info->directcolor_info,
 150                    VBE_DIRECTCOLOR_RESERVED_BITS_AVAILABLE);
 151     else
 152         SET_FARVAR(seg, info->directcolor_info, 0);
 153
 154     if (modeinfo.depth > 4)
 155         SET_FARVAR(seg, info->phys_base, modeinfo.phys_base);
 156     else
 157         SET_FARVAR(seg, info->phys_base, 0);
 158
 159     SET_FARVAR(seg, info->reserved1, 0);
 160     SET_FARVAR(seg, info->reserved2, 0);
 161     SET_FARVAR(seg, info->linear_bytes_per_scanline, modeinfo.linesize);
 162     SET_FARVAR(seg, info->bank_pages, 0);
 163     SET_FARVAR(seg, info->linear_pages, 0);
 164     SET_FARVAR(seg, info->linear_red_size, r_size);
 165     SET_FARVAR(seg, info->linear_red_pos, r_pos);
 166     SET_FARVAR(seg, info->linear_green_size, g_size);
 167     SET_FARVAR(seg, info->linear_green_pos, g_pos);
 168     SET_FARVAR(seg, info->linear_blue_size, b_size);
 169     SET_FARVAR(seg, info->linear_blue_pos, b_pos);
 170     SET_FARVAR(seg, info->linear_alpha_size, a_size);
 171     SET_FARVAR(seg, info->linear_alpha_pos, a_pos);
 172     SET_FARVAR(seg, info->pixclock_max, 0);
 173
 174     regs->al = regs->ah; /* 0x4F, Function supported */
 175     regs->ah = 0x0; /* 0x0, Function call successful */
 176 }
 177
 178 static void
 179 vbe_104f02(struct bregs *regs)
 180 {
 181     //u16 seg = regs->es;
 182     //struct vbe_crtc_info *crtc_info = (void*)(regs->di+0);
 183     u16 mode = regs->bx;
 184     struct vbe_modeinfo modeinfo;
 185     int rc;
 186
 187     dprintf(1, "VBE mode set: %x\n", mode);
 188
 189     if (mode < 0x100) { /* VGA */
 190         dprintf(1, "set VGA mode %x\n", mode);
 191
 192         bochsvga_hires_enable(0);
 193         stdvga_set_mode(mode, 0);
 194     } else { /* VBE */
 195         rc = bochsvga_mode_info(mode & 0x1ff, &modeinfo);
 196         if (rc) {
 197             dprintf(1, "VBE mode %x not found\n", mode & 0x1ff);
 198             regs->ax = 0x100;
 199             return;
 200         }
 201         bochsvga_hires_enable(1);
 202         bochsvga_set_mode(mode & 0x1ff, &modeinfo);
 203
 204         if (mode & 0x4000) {
 205             /* Linear frame buffer */
 206             /* XXX: ??? */
 207         }
 208         if (!(mode & 0x8000)) {
 209             bochsvga_clear_scr();
 210         }
 211     }
 212
 213     regs->al = regs->ah; /* 0x4F, Function supported */
 214     regs->ah = 0x0; /* 0x0, Function call successful */
 215 }
 216
 217 static void
 218 vbe_104f03(struct bregs *regs)
 219 {
 220     if (!bochsvga_hires_enabled()) {
 221         regs->bx = GET_BDA(video_mode);
 222     } else {
 223         regs->bx = bochsvga_curr_mode();
 224     }
 225
 226     dprintf(1, "VBE current mode=%x\n", regs->bx);
 227
 228     regs->al = regs->ah; /* 0x4F, Function supported */
 229     regs->ah = 0x0; /* 0x0, Function call successful */
 230 }
 231
 232 static void
 233 vbe_104f04(struct bregs *regs)
 234 {
 235     debug_stub(regs);
 236     regs->ax = 0x0100;
 237 }
 238
 239 static void
 240 vbe_104f05(struct bregs *regs)
 241 {
 242     debug_stub(regs);
 243     regs->ax = 0x0100;
 244 }
 245
 246 static void
 247 vbe_104f06(struct bregs *regs)
 248 {
 249     debug_stub(regs);
 250     regs->ax = 0x0100;
 251 }
 252
 253 static void
 254 vbe_104f07(struct bregs *regs)
 255 {
 256     debug_stub(regs);
 257     regs->ax = 0x0100;
 258 }
 259
 260 static void
 261 vbe_104f08(struct bregs *regs)
 262 {
 263     debug_stub(regs);
 264     regs->ax = 0x0100;
 265 }
 266
 267 static void
 268 vbe_104f0a(struct bregs *regs)
 269 {
 270     debug_stub(regs);
 271     regs->ax = 0x0100;
 272 }
 273
 274 static void
 275 vbe_104fXX(struct bregs *regs)
 276 {
 277     debug_stub(regs);
 278     regs->ax = 0x0100;
 279 }
 280
 281 void
 282 handle_104f(struct bregs *regs)
 283 {
 284     if (!bochsvga_enabled()) {
 285         vbe_104fXX(regs);
 286         return;
 287     }
 288
 289     switch (regs->al) {
 290     case 0x00: vbe_104f00(regs); break;
 291     case 0x01: vbe_104f01(regs); break;
 292     case 0x02: vbe_104f02(regs); break;
 293     case 0x03: vbe_104f03(regs); break;
 294     case 0x04: vbe_104f04(regs); break;
 295     case 0x05: vbe_104f05(regs); break;
 296     case 0x06: vbe_104f06(regs); break;
 297     case 0x07: vbe_104f07(regs); break;
 298     case 0x08: vbe_104f08(regs); break;
 299     case 0x0a: vbe_104f0a(regs); break;
 300     default:   vbe_104fXX(regs); break;
 301     }
 302 }