video/tnt2.c

   1 #include <minilib.h>
   2 #include <io.h>
   3 #include <pci.h>
   4 #include <output.h>
   5 #include <fb.h>
   6 #include <paging.h>
   7 #include <text.h>
   8
   9 #include "generic.h"
  10
  11 static void tnt2_getvmode(void *priv);
  12
  13 static struct fbdevice tnt2_fb = {
  14         .getvmode = &tnt2_getvmode,
  15 };
  16
  17 static unsigned int vgard(unsigned char a)
  18 {
  19         outb(0x3D4, a);
  20         return (unsigned int)inb(0x3D5);
  21 }
  22
  23 static void tnt2_getvmode(void *priv)
  24 {
  25         tnt2_fb.curmode.xres = (vgard(0x1) + 1) * 8;
  26         tnt2_fb.curmode.yres = (vgard(0x12) | (vgard(0x7) & 2) << 7 | (vgard(0x7) & 0x40) << 3) + 1;
  27         switch (vgard(0x28))
  28         {
  29         case 3:
  30                 tnt2_fb.curmode.format = FB_RGB888;
  31                 tnt2_fb.curmode.bytestride = 4;
  32                 tnt2_fb.curmode.text = 0;
  33                 tnt2_fb.checksum_rect = checksum_rect_generic32;
  34                 tnt2_fb.copy_pixels = copy_pixels_generic32;
  35                 break;
  36         case 0:
  37                 tnt2_fb.curmode.text = 1;
  38                 tnt2_fb.checksum_rect = text_checksum;
  39                 tnt2_fb.copy_pixels = text_render;
  40                 break;
  41         default:
  42                 tnt2_fb.curmode.text = 1;
  43                 tnt2_fb.checksum_rect = text_checksum;
  44                 tnt2_fb.copy_pixels = text_render;
  45                 outputf("Unknown TNT2 format %x", vgard(0x28));
  46                 break;
  47         }
  48 }
  49
  50 static int tnt2_probe(struct pci_dev *pci, void *data)
  51 {
  52         unsigned int p;
  53
  54         if (pci->bars[1].type != PCI_BAR_MEMORY32)
  55         {
  56                 output("TNT2 BAR1 is not memory32?");
  57                 return 0;
  58         }
  59
  60         /* Map 32M of memory. */
  61         for (p = 0; p < 32; p += 4)
  62                 addmap_4m(0x40000000 + p*1024*1024, pci->bars[1].addr + p*1024*1024);
  63         tnt2_fb.fbaddr = (void *)0x40000000;
  64
  65         fb = &tnt2_fb;
  66         outputf("Found TNT2 with FB at %08x, mapped to %08x", pci->bars[1].addr, tnt2_fb.fbaddr);
  67         return 1;
  68 }
  69
  70 static struct pci_id tnt2_pci[] = {
  71         {0x10DE, 0x0028, "TNT2", "RIVA TNT2"}
  72 };
  73
  74 struct pci_driver tnt2_driver = {
  75         .name     = "tnt2",
  76         .probe    = tnt2_probe,
  77         .ids      = tnt2_pci,
  78         .id_count = sizeof(tnt2_pci)/sizeof(tnt2_pci[0]),
  79 };