123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273 |
- #include <u.h>
- #include <libc.h>
- #include <bio.h>
- #include "pci.h"
- #include "vga.h"
- enum
- {
- X= 0x3D6, /* index reg */
- D= 0x3D7, /* data reg */
- };
- static int misc[] = { 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0xE, 0x28, 0x29,
- 0x70, 0x72, 0x73, 0x7D, 0x7F, -1};
- static int map[] = { 0x7, 0x8, 0xB, 0xC, 0x10, 0x11, -1};
- static int flags[] = { 0xF, 0x2B, 0x44, 0x45, -1};
- static int compat[] = { 0x14, 0x15, 0x1F, 0x7E, -1};
- static int clock[] = { 0x30, 0x31, 0x32, 0x33, -1};
- static int mm[] = { 0x3A, 0x3B, 0x3C, 0x3D, 0x3E, 0x3F, -1};
- static int alt[] = { 0x0D, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x1B, 0x1C, 0x1D, 0x1E,
- 0x24, 0x25, 0x26, 0x64, 0x65, 0x66, 0x67, -1};
- static int flat[] = { 0x2C, 0x2D, 0x2E, 0x2F, 0x4F, 0x50, 0x51, 0x52, 0x53, 0x54,
- 0x55, 0x56, 0x57, 0x58, 0x59, 0x5A, 0x5B, 0x5C, 0x5D, 0x5E,
- 0x5F, 0x60, 0x61, 0x62, 0x63, 0x68, 0x6C, 0x6E, 0x6F, -1};
- typedef struct Group Group;
- struct Group {
- char *name;
- int *x;
- };
- static Group group[] =
- {
- { "misc", misc, },
- { "map", map, },
- { "compatability", compat, },
- { "clock", clock, },
- { "multimedia", mm, },
- { "alternate", alt, },
- { "flat-panel", flat, },
- { 0 },
- };
- static uchar greg[256];
- static uchar
- ctxi(uchar index)
- {
- outportb(X, index);
- return inportb(D);
- }
- static void
- ctxo(uchar index, uchar data)
- {
- outportb(X, index);
- outportb(D, data);
- }
- /*
- * ct65540.
- */
- static void
- snarf(Vga*, Ctlr* ctlr)
- {
- Group *g;
- int *xp;
- ctlr->flag |= Fsnarf;
- for(g = group; g->name; g++)
- for(xp = g->x; *xp >= 0; xp++)
- greg[*xp] = ctxi(*xp);
- }
- static void
- options(Vga*, Ctlr* ctlr)
- {
- ctlr->flag |= Hlinear|Foptions;
- }
- /*
- * brute force and ignorance
- */
- static int
- setclock(Vga* vga)
- {
- ulong fvco, t;
- ulong m, n;
- ulong bestm, bestn, diff, bestdiff, lastdiff;
- ulong p;
- if(vga->mode->frequency > 220000000)
- return -1;
- vga->misc &= ~(3<<2);
- vga->feature &= ~3;
- greg[0x33] &= ~0x20; /* set VCLK not MCLK */
- greg[0x33] &= ~0x80; /* clk0 & clk1 are 25.175 & 28.322 MHz */
- vga->misc |= (2<<2);
- vga->feature |= 2;
- fvco = vga->mode->frequency;
- if(fvco == 0)
- return -1;
- p = 0;
- while(fvco < 100000000){
- fvco *= 2;
- p++;
- }
- m = (1<<31)/(4*RefFreq);
- if(m > 127)
- m = 127;
- bestdiff = 1<<31;
- bestm = 3;
- bestn = 3;
- for(; m > 2; m--){
- lastdiff = 1<<31;
- for(n = 3; n < 128; n++){
- t = (RefFreq*4*m)/n;
- diff = abs(fvco-t);
- if(diff < bestdiff){
- bestdiff = diff;
- bestm = m;
- bestn = n;
- } else {
- if(diff > lastdiff)
- break;
- }
- lastdiff = diff;
- }
- }
- greg[0x31] = bestm - 2;
- greg[0x32] = bestn - 2;
- greg[0x30] = (p<<1) | 1;
- return 0;
- }
- static void
- init(Vga* vga, Ctlr* ctlr)
- {
- int x;
- greg[0x15] = 0; /* allow writes to all registers */
- if(vga->mode->z > 8)
- error("depth %d not supported\n", vga->mode->z);
- if(vga->mode->z == 8){
- if(vga->linear && (ctlr->flag & Hlinear))
- ctlr->flag |= Ulinear;
- vga->vmz = 1024*1024;
- vga->vmb = 1024*1024;
-
- /* linear mapping - extension regs*/
- greg[0x04] = (1<<2); /* enable CRTC bits 16 & 17, 32 bit mode */
- greg[0x0b] = 0x15; /* linear addressing, > 256k, sequential addr */
- greg[0x28] = 0x90; /* non-interlaced, 256 colors */
- /* normal regs */
- vga->sequencer[0x04] = 0x0A; /* sequential memory access */
- vga->graphics[0x05] = 0x00; /* sequential access, shift out 8 bits at */
- /* a time */
- vga->attribute[0x10] &= ~(1<<6); /* 1 dot clock per pixel */
- vga->crt[0x14] = 0x00;
- vga->crt[0x17] = 0xe3; /* always byte mode */
- } else {
- /* mapped to 0xa0000 - extension regs*/
- greg[0x04] = (1<<2); /* enable CRTC bits 16 & 17, 32 bit mode */
- greg[0x0b] = 0x01; /* 0xA0000 - 0xAFFFF, planar addressing */
- greg[0x28] = 0x80; /* non-interlaced, 16 colors */
- }
- /* the extension registers have even more overflow bits */
- x = 0;
- if(vga->mode->vt & (1<<10))
- x |= (1<<0);
- if(vga->mode->vrs & (1<<10))
- x |= (1<<2);
- greg[0x16] = x;
- x = 0;
- if(vga->mode->ht & (1<<(8+3)))
- x |= (1<<0);
- if(vga->mode->shb & (1<<(8+3)))
- x |= (1<<4);
- if(vga->mode->ehb & (1<<(6+3)))
- x |= (1<<5);
- greg[0x17] = x;
- if(vga->mode->y > 480)
- vga->misc &= 0x3F;
- setclock(vga);
- ctlr->flag |= Finit;
- }
- static void
- load(Vga* vga, Ctlr* ctlr)
- {
- Group *g;
- int *xp;
- /* must be first */
- ctxo(0x15, greg[0x15]); /* write protect */
- ctxo(0x33, greg[0x33]); /* select clock */
- if(ctlr->flag & Ulinear){
- greg[0x8] = vga->vmb>>20;
- ctxo(0x08, greg[0x08]);
- }
- /* only write what changed */
- for(g = group; g->name; g++)
- for(xp = g->x; *xp >= 0; xp++)
- ctxo(*xp, greg[*xp]);
- ctlr->flag |= Fload;
- }
- static void
- dump(Vga*, Ctlr* ctlr)
- {
- Group *g;
- int *xp;
- char *name;
- int lastx;
- char item[32];
- name = ctlr->name;
- for(g = group; g->name; g++){
- lastx = -2;
- for(xp = g->x; *xp >= 0; xp++){
- if(*xp != lastx+1){
- sprint(item, "%s %2.2ux:", g->name, *xp);
- printitem(name, item);
- }
- lastx = *xp;
- printreg(greg[*xp]);
- }
- }
- }
- Ctlr ct65540 = {
- "ct65540", /* name */
- snarf, /* snarf */
- options, /* options */
- init, /* init */
- load, /* load */
- dump, /* dump */
- };
- Ctlr ct65545 = {
- "ct65545", /* name */
- snarf, /* snarf */
- options, /* options */
- init, /* init */
- load, /* load */
- dump, /* dump */
- };
- Ctlr ct65545hwgc = {
- "ct65545hwgc", /* name */
- 0, /* snarf */
- 0, /* options */
- 0, /* init */
- 0, /* load */
- 0, /* dump */
- };
|