Avoid suffering from wrong CS_SEGSEL syndrome.

[netwatch.git] / video / tnt2.c

diff --git a/video/tnt2.c b/video/tnt2.c
index 73a3d0b6eafd484a61f5a68a9a0a4d7febc8ca97..382739370db83a4bfc607aad4b11f1c88096d104 100644 (file)
--- a/video/tnt2.c
+++ b/video/tnt2.c
@@ -3,6 +3,10 @@
 #include <pci.h>
 #include <output.h>
 #include <fb.h>
+#include <paging.h>
+#include <text.h>
+
+#include "generic.h"
 
 static void tnt2_getvmode(void *priv);
 
@@ -12,7 +16,7 @@ static struct fbdevice tnt2_fb = {
 
 static unsigned int vgard(unsigned char a)
 {
-       outb(a, 0x3D4);
+       outb(0x3D4, a);
        return (unsigned int)inb(0x3D5);
 }
 
@@ -22,30 +26,44 @@ static void tnt2_getvmode(void *priv)
        tnt2_fb.curmode.yres = (vgard(0x12) | (vgard(0x7) & 2) << 7 | (vgard(0x7) & 0x40) << 3) + 1;
        switch (vgard(0x28))
        {
-       case 4:
+       case 3:
                tnt2_fb.curmode.format = FB_RGB888;
                tnt2_fb.curmode.bytestride = 4;
                tnt2_fb.curmode.text = 0;
+               tnt2_fb.checksum_rect = checksum_rect_generic32;
+               tnt2_fb.copy_pixels = copy_pixels_generic32;
                break;
        case 0:
                tnt2_fb.curmode.text = 1;
+               tnt2_fb.checksum_rect = text_checksum;
+               tnt2_fb.copy_pixels = text_render;
                break;
        default:
-               outputf("Unknown TNT2 format %d", vgard(0x28));
+               tnt2_fb.curmode.text = 1;
+               tnt2_fb.checksum_rect = text_checksum;
+               tnt2_fb.copy_pixels = text_render;
+               outputf("Unknown TNT2 format %x", vgard(0x28));
                break;
        }
 }
 
 static int tnt2_probe(struct pci_dev *pci, void *data)
 {
+       unsigned int p;
+
        if (pci->bars[1].type != PCI_BAR_MEMORY32)
        {
                output("TNT2 BAR1 is not memory32?");
                return 0;
        }
-       tnt2_fb.fbaddr = (void *)pci->bars[1].addr;
+       
+       /* Map 32M of memory. */
+       for (p = 0; p < 32; p += 4)
+               addmap_4m(0x40000000 + p*1024*1024, pci->bars[1].addr + p*1024*1024);
+       tnt2_fb.fbaddr = (void *)0x40000000;
+       
        fb = &tnt2_fb;
-       outputf("Found TNT2 with FB at %08x", tnt2_fb.fbaddr);
+       outputf("Found TNT2 with FB at %08x, mapped to %08x", pci->bars[1].addr, tnt2_fb.fbaddr);
        return 1;
 }