| | 1 | #include <minilib.h> |
| | 2 | #include <io.h> |
| | 3 | #include <pci.h> |
| | 4 | #include <output.h> |
| | 5 | #include <fb.h> |
| | 6 | |
| | 7 | static void tnt2_getvmode(void *priv); |
| | 8 | |
| | 9 | static struct fbdevice tnt2_fb = { |
| | 10 | .getvmode = &tnt2_getvmode, |
| | 11 | }; |
| | 12 | |
| | 13 | static unsigned int vgard(unsigned char a) |
| | 14 | { |
| | 15 | outb(0x3D4, a); |
| | 16 | return (unsigned int)inb(0x3D5); |
| | 17 | } |
| | 18 | |
| | 19 | static void tnt2_getvmode(void *priv) |
| | 20 | { |
| | 21 | tnt2_fb.curmode.xres = (vgard(0x1) + 1) * 8; |
| | 22 | tnt2_fb.curmode.yres = (vgard(0x12) | (vgard(0x7) & 2) << 7 | (vgard(0x7) & 0x40) << 3) + 1; |
| | 23 | switch (vgard(0x28)) |
| | 24 | { |
| | 25 | case 3: |
| | 26 | tnt2_fb.curmode.format = FB_RGB888; |
| | 27 | tnt2_fb.curmode.bytestride = 4; |
| | 28 | tnt2_fb.curmode.text = 0; |
| | 29 | break; |
| | 30 | case 0: |
| | 31 | tnt2_fb.curmode.text = 1; |
| | 32 | break; |
| | 33 | default: |
| | 34 | tnt2_fb.curmode.text = 1; |
| | 35 | outputf("Unknown TNT2 format %x", vgard(0x28)); |
| | 36 | break; |
| | 37 | } |
| | 38 | } |
| | 39 | |
| | 40 | static int tnt2_probe(struct pci_dev *pci, void *data) |
| | 41 | { |
| | 42 | if (pci->bars[1].type != PCI_BAR_MEMORY32) |
| | 43 | { |
| | 44 | output("TNT2 BAR1 is not memory32?"); |
| | 45 | return 0; |
| | 46 | } |
| | 47 | tnt2_fb.fbaddr = (void *)pci->bars[1].addr; |
| | 48 | fb = &tnt2_fb; |
| | 49 | outputf("Found TNT2 with FB at %08x", tnt2_fb.fbaddr); |
| | 50 | return 1; |
| | 51 | } |
| | 52 | |
| | 53 | static struct pci_id tnt2_pci[] = { |
| | 54 | {0x10DE, 0x0028, "TNT2", "RIVA TNT2"} |
| | 55 | }; |
| | 56 | |
| | 57 | struct pci_driver tnt2_driver = { |
| | 58 | .name = "tnt2", |
| | 59 | .probe = tnt2_probe, |
| | 60 | .ids = tnt2_pci, |
| | 61 | .id_count = sizeof(tnt2_pci)/sizeof(tnt2_pci[0]), |
| | 62 | }; |
git.joshuawise.com / netwatch.git / blame_incremental