Add a FB access layer.

[netwatch.git] / video / tnt2.c

diff --git a/video/tnt2.c b/video/tnt2.c
new file mode 100644 (file)
index 0000000..73a3d0b
--- /dev/null
+++ b/video/tnt2.c
@@ -0,0 +1,61 @@
+#include <minilib.h>
+#include <io.h>
+#include <pci.h>
+#include <output.h>
+#include <fb.h>
+
+static void tnt2_getvmode(void *priv);
+
+static struct fbdevice tnt2_fb = {
+       .getvmode = &tnt2_getvmode,
+};
+
+static unsigned int vgard(unsigned char a)
+{
+       outb(a, 0x3D4);
+       return (unsigned int)inb(0x3D5);
+}
+
+static void tnt2_getvmode(void *priv)
+{
+       tnt2_fb.curmode.xres = (vgard(0x1) + 1) * 8;
+       tnt2_fb.curmode.yres = (vgard(0x12) | (vgard(0x7) & 2) << 7 | (vgard(0x7) & 0x40) << 3) + 1;
+       switch (vgard(0x28))
+       {
+       case 4:
+               tnt2_fb.curmode.format = FB_RGB888;
+               tnt2_fb.curmode.bytestride = 4;
+               tnt2_fb.curmode.text = 0;
+               break;
+       case 0:
+               tnt2_fb.curmode.text = 1;
+               break;
+       default:
+               outputf("Unknown TNT2 format %d", vgard(0x28));
+               break;
+       }
+}
+
+static int tnt2_probe(struct pci_dev *pci, void *data)
+{
+       if (pci->bars[1].type != PCI_BAR_MEMORY32)
+       {
+               output("TNT2 BAR1 is not memory32?");
+               return 0;
+       }
+       tnt2_fb.fbaddr = (void *)pci->bars[1].addr;
+       fb = &tnt2_fb;
+       outputf("Found TNT2 with FB at %08x", tnt2_fb.fbaddr);
+       return 1;
+}
+
+static struct pci_id tnt2_pci[] = {
+       {0x10DE, 0x0028, "TNT2", "RIVA TNT2"}
+};
+
+struct pci_driver tnt2_driver = {
+       .name     = "tnt2",
+       .probe    = tnt2_probe,
+       .ids      = tnt2_pci,
+       .id_count = sizeof(tnt2_pci)/sizeof(tnt2_pci[0]),
+};