vgabios: Add support for vbe get/set line length function.
[seabios.git] / vgasrc / bochsvga.c
index cbd0b41d75002d4d33a796e11352ef16dafc3541..2a4b0d5bb27e48f3d242d6fb601f0c5d683db4bd 100644 (file)
@@ -1,9 +1,9 @@
 #include "vgabios.h" // struct vbe_modeinfo
-#include "vbe.h" // VBE_MODE_VESA_DEFINED
+#include "vbe.h" // VBE_CAPABILITY_8BIT_DAC
 #include "bochsvga.h" // bochsvga_set_mode
 #include "util.h" // dprintf
 #include "config.h" // CONFIG_*
-#include "biosvar.h" // SET_BDA
+#include "biosvar.h" // GET_GLOBAL
 #include "stdvga.h" // VGAREG_SEQU_ADDRESS
 #include "pci.h" // pci_config_readl
 #include "pci_regs.h" // PCI_BASE_ADDRESS_0
@@ -14,70 +14,76 @@ static struct bochsvga_mode
     struct vgamode_s info;
 } bochsvga_modes[] VAR16 = {
     /* standard modes */
-    { 0x100, { MM_PACKED, 640,  400,  8  } },
-    { 0x101, { MM_PACKED, 640,  480,  8  } },
-    { 0x102, { MM_PLANAR, 800,  600,  4  } },
-    { 0x103, { MM_PACKED, 800,  600,  8  } },
-    { 0x104, { MM_PLANAR, 1024, 768,  4  } },
-    { 0x105, { MM_PACKED, 1024, 768,  8  } },
-    { 0x106, { MM_PLANAR, 1280, 1024, 4  } },
-    { 0x107, { MM_PACKED, 1280, 1024, 8  } },
-    { 0x10D, { MM_DIRECT, 320,  200,  15 } },
-    { 0x10E, { MM_DIRECT, 320,  200,  16 } },
-    { 0x10F, { MM_DIRECT, 320,  200,  24 } },
-    { 0x110, { MM_DIRECT, 640,  480,  15 } },
-    { 0x111, { MM_DIRECT, 640,  480,  16 } },
-    { 0x112, { MM_DIRECT, 640,  480,  24 } },
-    { 0x113, { MM_DIRECT, 800,  600,  15 } },
-    { 0x114, { MM_DIRECT, 800,  600,  16 } },
-    { 0x115, { MM_DIRECT, 800,  600,  24 } },
-    { 0x116, { MM_DIRECT, 1024, 768,  15 } },
-    { 0x117, { MM_DIRECT, 1024, 768,  16 } },
-    { 0x118, { MM_DIRECT, 1024, 768,  24 } },
-    { 0x119, { MM_DIRECT, 1280, 1024, 15 } },
-    { 0x11A, { MM_DIRECT, 1280, 1024, 16 } },
-    { 0x11B, { MM_DIRECT, 1280, 1024, 24 } },
-    { 0x11C, { MM_PACKED, 1600, 1200, 8  } },
-    { 0x11D, { MM_DIRECT, 1600, 1200, 15 } },
-    { 0x11E, { MM_DIRECT, 1600, 1200, 16 } },
-    { 0x11F, { MM_DIRECT, 1600, 1200, 24 } },
+    { 0x100, { MM_PACKED, 640,  400,  8,  8, 16, SEG_GRAPH } },
+    { 0x101, { MM_PACKED, 640,  480,  8,  8, 16, SEG_GRAPH } },
+    { 0x102, { MM_PLANAR, 800,  600,  4,  8, 16, SEG_GRAPH } },
+    { 0x103, { MM_PACKED, 800,  600,  8,  8, 16, SEG_GRAPH } },
+    { 0x104, { MM_PLANAR, 1024, 768,  4,  8, 16, SEG_GRAPH } },
+    { 0x105, { MM_PACKED, 1024, 768,  8,  8, 16, SEG_GRAPH } },
+    { 0x106, { MM_PLANAR, 1280, 1024, 4,  8, 16, SEG_GRAPH } },
+    { 0x107, { MM_PACKED, 1280, 1024, 8,  8, 16, SEG_GRAPH } },
+    { 0x10D, { MM_DIRECT, 320,  200,  15, 8, 16, SEG_GRAPH } },
+    { 0x10E, { MM_DIRECT, 320,  200,  16, 8, 16, SEG_GRAPH } },
+    { 0x10F, { MM_DIRECT, 320,  200,  24, 8, 16, SEG_GRAPH } },
+    { 0x110, { MM_DIRECT, 640,  480,  15, 8, 16, SEG_GRAPH } },
+    { 0x111, { MM_DIRECT, 640,  480,  16, 8, 16, SEG_GRAPH } },
+    { 0x112, { MM_DIRECT, 640,  480,  24, 8, 16, SEG_GRAPH } },
+    { 0x113, { MM_DIRECT, 800,  600,  15, 8, 16, SEG_GRAPH } },
+    { 0x114, { MM_DIRECT, 800,  600,  16, 8, 16, SEG_GRAPH } },
+    { 0x115, { MM_DIRECT, 800,  600,  24, 8, 16, SEG_GRAPH } },
+    { 0x116, { MM_DIRECT, 1024, 768,  15, 8, 16, SEG_GRAPH } },
+    { 0x117, { MM_DIRECT, 1024, 768,  16, 8, 16, SEG_GRAPH } },
+    { 0x118, { MM_DIRECT, 1024, 768,  24, 8, 16, SEG_GRAPH } },
+    { 0x119, { MM_DIRECT, 1280, 1024, 15, 8, 16, SEG_GRAPH } },
+    { 0x11A, { MM_DIRECT, 1280, 1024, 16, 8, 16, SEG_GRAPH } },
+    { 0x11B, { MM_DIRECT, 1280, 1024, 24, 8, 16, SEG_GRAPH } },
+    { 0x11C, { MM_PACKED, 1600, 1200, 8,  8, 16, SEG_GRAPH } },
+    { 0x11D, { MM_DIRECT, 1600, 1200, 15, 8, 16, SEG_GRAPH } },
+    { 0x11E, { MM_DIRECT, 1600, 1200, 16, 8, 16, SEG_GRAPH } },
+    { 0x11F, { MM_DIRECT, 1600, 1200, 24, 8, 16, SEG_GRAPH } },
     /* BOCHS modes */
-    { 0x140, { MM_DIRECT, 320,  200,  32 } },
-    { 0x141, { MM_DIRECT, 640,  400,  32 } },
-    { 0x142, { MM_DIRECT, 640,  480,  32 } },
-    { 0x143, { MM_DIRECT, 800,  600,  32 } },
-    { 0x144, { MM_DIRECT, 1024, 768,  32 } },
-    { 0x145, { MM_DIRECT, 1280, 1024, 32 } },
-    { 0x146, { MM_PACKED, 320,  200,  8  } },
-    { 0x147, { MM_DIRECT, 1600, 1200, 32 } },
-    { 0x148, { MM_PACKED, 1152, 864,  8  } },
-    { 0x149, { MM_DIRECT, 1152, 864,  15 } },
-    { 0x14a, { MM_DIRECT, 1152, 864,  16 } },
-    { 0x14b, { MM_DIRECT, 1152, 864,  24 } },
-    { 0x14c, { MM_DIRECT, 1152, 864,  32 } },
-    { 0x178, { MM_DIRECT, 1280, 800,  16 } },
-    { 0x179, { MM_DIRECT, 1280, 800,  24 } },
-    { 0x17a, { MM_DIRECT, 1280, 800,  32 } },
-    { 0x17b, { MM_DIRECT, 1280, 960,  16 } },
-    { 0x17c, { MM_DIRECT, 1280, 960,  24 } },
-    { 0x17d, { MM_DIRECT, 1280, 960,  32 } },
-    { 0x17e, { MM_DIRECT, 1440, 900,  16 } },
-    { 0x17f, { MM_DIRECT, 1440, 900,  24 } },
-    { 0x180, { MM_DIRECT, 1440, 900,  32 } },
-    { 0x181, { MM_DIRECT, 1400, 1050, 16 } },
-    { 0x182, { MM_DIRECT, 1400, 1050, 24 } },
-    { 0x183, { MM_DIRECT, 1400, 1050, 32 } },
-    { 0x184, { MM_DIRECT, 1680, 1050, 16 } },
-    { 0x185, { MM_DIRECT, 1680, 1050, 24 } },
-    { 0x186, { MM_DIRECT, 1680, 1050, 32 } },
-    { 0x187, { MM_DIRECT, 1920, 1200, 16 } },
-    { 0x188, { MM_DIRECT, 1920, 1200, 24 } },
-    { 0x189, { MM_DIRECT, 1920, 1200, 32 } },
-    { 0x18a, { MM_DIRECT, 2560, 1600, 16 } },
-    { 0x18b, { MM_DIRECT, 2560, 1600, 24 } },
-    { 0x18c, { MM_DIRECT, 2560, 1600, 32 } },
+    { 0x140, { MM_DIRECT, 320,  200,  32, 8, 16, SEG_GRAPH } },
+    { 0x141, { MM_DIRECT, 640,  400,  32, 8, 16, SEG_GRAPH } },
+    { 0x142, { MM_DIRECT, 640,  480,  32, 8, 16, SEG_GRAPH } },
+    { 0x143, { MM_DIRECT, 800,  600,  32, 8, 16, SEG_GRAPH } },
+    { 0x144, { MM_DIRECT, 1024, 768,  32, 8, 16, SEG_GRAPH } },
+    { 0x145, { MM_DIRECT, 1280, 1024, 32, 8, 16, SEG_GRAPH } },
+    { 0x146, { MM_PACKED, 320,  200,  8,  8, 16, SEG_GRAPH } },
+    { 0x147, { MM_DIRECT, 1600, 1200, 32, 8, 16, SEG_GRAPH } },
+    { 0x148, { MM_PACKED, 1152, 864,  8,  8, 16, SEG_GRAPH } },
+    { 0x149, { MM_DIRECT, 1152, 864,  15, 8, 16, SEG_GRAPH } },
+    { 0x14a, { MM_DIRECT, 1152, 864,  16, 8, 16, SEG_GRAPH } },
+    { 0x14b, { MM_DIRECT, 1152, 864,  24, 8, 16, SEG_GRAPH } },
+    { 0x14c, { MM_DIRECT, 1152, 864,  32, 8, 16, SEG_GRAPH } },
+    { 0x178, { MM_DIRECT, 1280, 800,  16, 8, 16, SEG_GRAPH } },
+    { 0x179, { MM_DIRECT, 1280, 800,  24, 8, 16, SEG_GRAPH } },
+    { 0x17a, { MM_DIRECT, 1280, 800,  32, 8, 16, SEG_GRAPH } },
+    { 0x17b, { MM_DIRECT, 1280, 960,  16, 8, 16, SEG_GRAPH } },
+    { 0x17c, { MM_DIRECT, 1280, 960,  24, 8, 16, SEG_GRAPH } },
+    { 0x17d, { MM_DIRECT, 1280, 960,  32, 8, 16, SEG_GRAPH } },
+    { 0x17e, { MM_DIRECT, 1440, 900,  16, 8, 16, SEG_GRAPH } },
+    { 0x17f, { MM_DIRECT, 1440, 900,  24, 8, 16, SEG_GRAPH } },
+    { 0x180, { MM_DIRECT, 1440, 900,  32, 8, 16, SEG_GRAPH } },
+    { 0x181, { MM_DIRECT, 1400, 1050, 16, 8, 16, SEG_GRAPH } },
+    { 0x182, { MM_DIRECT, 1400, 1050, 24, 8, 16, SEG_GRAPH } },
+    { 0x183, { MM_DIRECT, 1400, 1050, 32, 8, 16, SEG_GRAPH } },
+    { 0x184, { MM_DIRECT, 1680, 1050, 16, 8, 16, SEG_GRAPH } },
+    { 0x185, { MM_DIRECT, 1680, 1050, 24, 8, 16, SEG_GRAPH } },
+    { 0x186, { MM_DIRECT, 1680, 1050, 32, 8, 16, SEG_GRAPH } },
+    { 0x187, { MM_DIRECT, 1920, 1200, 16, 8, 16, SEG_GRAPH } },
+    { 0x188, { MM_DIRECT, 1920, 1200, 24, 8, 16, SEG_GRAPH } },
+    { 0x189, { MM_DIRECT, 1920, 1200, 32, 8, 16, SEG_GRAPH } },
+    { 0x18a, { MM_DIRECT, 2560, 1600, 16, 8, 16, SEG_GRAPH } },
+    { 0x18b, { MM_DIRECT, 2560, 1600, 24, 8, 16, SEG_GRAPH } },
+    { 0x18c, { MM_DIRECT, 2560, 1600, 32, 8, 16, SEG_GRAPH } },
 };
 
+static int is_bochsvga_mode(struct vgamode_s *vmode_g)
+{
+    return (vmode_g >= &bochsvga_modes[0].info
+            && vmode_g <= &bochsvga_modes[ARRAY_SIZE(bochsvga_modes)-1].info);
+}
+
 static u16 dispi_get_max_xres(void)
 {
     u16 en;
@@ -192,6 +198,40 @@ bochsvga_hires_enable(int enable)
     dispi_write(VBE_DISPI_INDEX_ENABLE, flags);
 }
 
+int
+bochsvga_get_window(struct vgamode_s *vmode_g, int window)
+{
+    if (window != 0)
+        return -1;
+    return dispi_read(VBE_DISPI_INDEX_BANK);
+}
+
+int
+bochsvga_set_window(struct vgamode_s *vmode_g, int window, int val)
+{
+    if (window != 0)
+        return -1;
+    dispi_write(VBE_DISPI_INDEX_BANK, val);
+    if (dispi_read(VBE_DISPI_INDEX_BANK) != val)
+        return -1;
+    return 0;
+}
+
+int
+bochsvga_get_linelength(struct vgamode_s *vmode_g)
+{
+    return dispi_read(VBE_DISPI_INDEX_VIRT_WIDTH) * vga_bpp(vmode_g) / 8;
+}
+
+int
+bochsvga_set_linelength(struct vgamode_s *vmode_g, int val)
+{
+    stdvga_set_linelength(vmode_g, val);
+    int pixels = (val * 8) / vga_bpp(vmode_g);
+    dispi_write(VBE_DISPI_INDEX_VIRT_WIDTH, pixels);
+    return 0;
+}
+
 static void
 bochsvga_clear_scr(void)
 {
@@ -203,26 +243,18 @@ bochsvga_clear_scr(void)
 }
 
 int
-bochsvga_set_mode(int mode, int flags)
+bochsvga_set_mode(struct vgamode_s *vmode_g, int flags)
 {
-    if (!(mode & VBE_MODE_VESA_DEFINED)) {
-        dprintf(1, "set VGA mode %x\n", mode);
-
-        SET_BDA(vbe_mode, 0);
+    if (! is_bochsvga_mode(vmode_g)) {
         bochsvga_hires_enable(0);
-        return stdvga_set_mode(mode, flags);
+        return stdvga_set_mode(vmode_g, flags);
     }
 
-    struct vgamode_s *vmode_g = bochsvga_find_mode(mode);
-    if (!vmode_g) {
-        dprintf(1, "VBE mode %x not found\n", mode);
-        return VBE_RETURN_STATUS_FAILED;
-    }
     bochsvga_hires_enable(1);
 
     u8 depth = GET_GLOBAL(vmode_g->depth);
     if (depth == 4)
-        stdvga_set_mode(0x6a, 0);
+        stdvga_set_mode(stdvga_find_mode(0x6a), 0);
     if (depth == 8)
         // XXX load_dac_palette(3);
         ;
@@ -260,13 +292,11 @@ bochsvga_set_mode(int mode, int flags)
         stdvga_grdc_mask(0x05, 0x20, 0x40);
     }
 
-    SET_BDA(vbe_mode, mode | flags);
-
     if (flags & MF_LINEARFB) {
         /* Linear frame buffer */
         /* XXX: ??? */
     }
-    if (!(mode & MF_NOCLEARMEM)) {
+    if (!(flags & MF_NOCLEARMEM)) {
         bochsvga_clear_scr();
     }