+++ /dev/null
-#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]),
-};