video/tnt2.c

   1 /* tnt2.c
   2  * NVidia TNT2 driver.
   3  * NetWatch system management mode administration console
   4  *
   5  * Copyright (c) 2008 Jacob Potter and Joshua Wise.  All rights reserved.
   6  * This program is free software; you can redistribute and/or modify it under
   7  * the terms found in the file LICENSE in the root of this source tree.
   8  *
   9  */
  10
  11 #include <minilib.h>
  12 #include <io.h>
  13 #include <pci.h>
  14 #include <output.h>
  15 #include <fb.h>
  16 #include <paging.h>
  17 #include <text.h>
  18
  19 #include "generic.h"
  20
  21 static void tnt2_getvmode(void *priv);
  22
  23 static struct fbdevice tnt2_fb = {
  24         .getvmode = &tnt2_getvmode,
  25 };
  26
  27 static unsigned int vgard(unsigned char a)
  28 {
  29         outb(0x3D4, a);
  30         return (unsigned int)inb(0x3D5);
  31 }
  32
  33 static void tnt2_getvmode(void *priv)
  34 {
  35         tnt2_fb.curmode.xres = (vgard(0x1) + 1) * 8;
  36         tnt2_fb.curmode.yres = (vgard(0x12) | (vgard(0x7) & 2) << 7 | (vgard(0x7) & 0x40) << 3) + 1;
  37         switch (vgard(0x28))
  38         {
  39         case 3:
  40                 tnt2_fb.curmode.format = FB_RGB888;
  41                 tnt2_fb.curmode.bytestride = 4;
  42                 tnt2_fb.curmode.text = 0;
  43                 tnt2_fb.checksum_rect = checksum_rect_generic32;
  44                 tnt2_fb.copy_pixels = copy_pixels_generic32;
  45                 break;
  46         case 0:
  47                 tnt2_fb.curmode.text = 1;
  48                 tnt2_fb.checksum_rect = text_checksum;
  49                 tnt2_fb.copy_pixels = text_render;
  50                 break;
  51         default:
  52                 tnt2_fb.curmode.text = 1;
  53                 tnt2_fb.checksum_rect = text_checksum;
  54                 tnt2_fb.copy_pixels = text_render;
  55                 outputf("Unknown TNT2 format %x", vgard(0x28));
  56                 break;
  57         }
  58 }
  59
  60 static int tnt2_probe(struct pci_dev *pci, void *data)
  61 {
  62         unsigned int p;
  63
  64         if (pci->bars[1].type != PCI_BAR_MEMORY32)
  65         {
  66                 output("TNT2 BAR1 is not memory32?");
  67                 return 0;
  68         }
  69
  70         /* Map 32M of memory. */
  71         for (p = 0; p < 32; p += 4)
  72                 addmap_4m(0x40000000 + p*1024*1024, pci->bars[1].addr + p*1024*1024);
  73         tnt2_fb.fbaddr = (void *)0x40000000;
  74
  75         fb = &tnt2_fb;
  76         outputf("Found TNT2 with FB at %08x, mapped to %08x", pci->bars[1].addr, tnt2_fb.fbaddr);
  77         return 1;
  78 }
  79
  80 static struct pci_id tnt2_pci[] = {
  81         {0x10DE, 0x0028, "TNT2", "RIVA TNT2"}
  82 };
  83
  84 struct pci_driver tnt2_driver = {
  85         .name     = "tnt2",
  86         .probe    = tnt2_probe,
  87         .ids      = tnt2_pci,
  88         .id_count = sizeof(tnt2_pci)/sizeof(tnt2_pci[0]),
  89 };