ref: 2aec1f8a09ae0bc9fb269d84ef53defebc47eede
dir: /sys/src/cmd/aux/vga/hiqvideo.c/
#include <u.h> #include <libc.h> #include <bio.h> #include "pci.h" #include "vga.h" /* * Chips and Technologies HiQVideo. * Extensions in the 69000 over the 65550 are not fully taken into account. * Depths other than 8 are too slow. */ enum { Frx = 0x3D0, /* Flat Panel Extensions Index */ Mrx = 0x3D2, /* Multimedia Extensions Index */ Xrx = 0x3D6, /* Configuration Extensions Index */ }; typedef struct { Pcidev* pci; uchar fr[256]; uchar mr[256]; uchar xr[256]; } HiQVideo; static uchar hiqvideoxi(long port, uchar index) { uchar data; outportb(port, index); data = inportb(port+1); return data; } static void hiqvideoxo(long port, uchar index, uchar data) { outportb(port, index); outportb(port+1, data); } static void snarf(Vga* vga, Ctlr* ctlr) { int i; Pcidev *p; HiQVideo *hqv; if(vga->private == nil){ vga->private = alloc(sizeof(HiQVideo)); hqv = vga->private; p = vga->pci; if(p == nil) p = pcimatch(nil, 0x102C, 0); if(p == nil || p->vid != 0x102C) error("%s: not found\n", ctlr->name); switch(p->did){ case 0x00C0: /* 69000 HiQVideo */ vga->f[1] = 135000000; vga->vmz = 2048*1024; break; case 0x00E0: /* 65550 HiQV32 */ case 0x00E4: /* 65554 HiQV32 */ case 0x00E5: /* 65555 HiQV32 */ vga->f[1] = 90000000; vga->vmz = 2048*1024; break; default: error("%s: DID %4.4uX unsupported\n", ctlr->name, p->did); } hqv->pci = p; } hqv = vga->private; for(i = 0; i < 0x50; i++) hqv->fr[i] = hiqvideoxi(Frx, i); for(i = 0; i < 0x60; i++) hqv->mr[i] = hiqvideoxi(Mrx, i); for(i = 0x30; i < 0x80; i++) vga->crt[i] = vgaxi(Crtx, i); for(i = 0; i < 0x100; i++) hqv->xr[i] = hiqvideoxi(Xrx, i); switch(hqv->pci->did){ case 0x00C0: /* 69000 HiQVideo */ vga->f[1] = 135000000; vga->vmz = 2048*1024; break; case 0x00E0: /* 65550 HiQV32 */ case 0x00E4: /* 65554 HiQV32 */ case 0x00E5: /* 65555 HiQV32 */ /* * Check VCC to determine max clock. * 5V allows a higher rate. */ if(hqv->fr[0x0A] & 0x02) vga->f[1] = 110000000; else vga->f[1] = 80000000; switch((hqv->xr[0x43]>>1) & 0x03){ case 0: vga->vmz = 1*1024*1024; break; case 1: vga->vmz = 2*1024*1024; break; default: vga->vmz = 16*1024*1024; break; } break; } ctlr->flag |= Fsnarf; } static void options(Vga*, Ctlr* ctlr) { ctlr->flag |= Hlinear|Foptions; } static void clock(Vga* vga, Ctlr* ctlr) { double f, fmin, fvco, m; ulong n, nmin, nmax, pd, rd; /* * Constraints: * 1. 1MHz <= Fref <= 60MHz * 2. 150KHz <= Fref/(RD*N) <= 2MHz * 3. 48MHz < Fvco <= 220MHz * 4. 3 <= M <= 1023 * 5. 3 <= N <= 1023 */ f = vga->f[0]; /* * Although pd = 0 is valid, things seems more stable * starting at 1. */ for(pd = 1; pd < 6; pd++){ f = vga->f[0]*(1<<pd); if(f > 48000000 && f <= 220000000) break; } if(pd >= 6) error("%s: dclk %lud out of range\n", ctlr->name, vga->f[0]); vga->p[0] = pd; /* * The reference divisor has only two possible values, 1 and 4. */ fmin = f; for(rd = 1; rd <= 4; rd += 3){ /* * Find the range for n (constraint 2). */ for(nmin = 3; nmin <= 1023; nmin++){ if(RefFreq/(rd*nmin) <= 2000000) break; } for(nmax = 1023; nmax >= 3; nmax--){ if(RefFreq/(rd*nmax) >= 150000) break; } /* * Now find the closest match for M and N. */ for(n = nmin; n < nmax; n++){ for(m = 3; m <= vga->m[1]; m++){ fvco = (RefFreq*4*m)/(rd*n); if(fvco < 48000000 || fvco > 220000000) continue; fvco -= f; if(fvco < 0) fvco = -fvco; if(fvco < fmin){ fmin = fvco; vga->m[0] = m; vga->n[0] = n; vga->p[0] = pd; vga->r[0] = rd; } } } } } static void init(Vga* vga, Ctlr* ctlr) { HiQVideo *hqv; hqv = vga->private; if(vga->f[0] == 0) vga->f[0] = vga->mode->frequency; vga->misc &= ~0x0C; hqv->fr[0x03] &= ~0x0C; switch(vga->mode->z){ case 8: case 16: case 32: break; default: error("depth %d not supported\n", vga->mode->z); } /* * FR[0x01] == 1 for CRT, 2 for LCD. * Don't programme the clock if it's an LCD. */ if((hqv->fr[0x01] & 0x03) == 0x02){ vga->misc |= 0x08; hqv->fr[0x03] |= 0x08; } else{ /* * Clock bits. If the desired video clock is * one of the two standard VGA clocks it can just be * set using bits <3:2> of vga->misc or Fr03, * otherwise the DCLK PLL needs to be programmed. */ if(vga->f[0] == VgaFreq0){ /* nothing to do */; } else if(vga->f[0] == VgaFreq1){ vga->misc |= 0x04; hqv->fr[0x03] |= 0x04; } else{ if(vga->f[0] > vga->f[1]) error("%s: invalid dclk - %lud\n", ctlr->name, vga->f[0]); if((hqv->fr[0x01] & 0x03) != 0x02){ vga->m[1] = 1023; clock(vga, ctlr); hqv->xr[0xC8] = (vga->m[0]-2) & 0xFF; hqv->xr[0xCA] = ((vga->m[0]-2) & 0x300)>>8; hqv->xr[0xC9] = (vga->n[0]-2) & 0xFF; hqv->xr[0xCA] |= ((vga->n[0]-2) & 0x300)>>4; hqv->xr[0xCB] = (vga->p[0]<<4)|(vga->r[0] == 1); } vga->misc |= 0x08; hqv->fr[0x03] |= 0x08; } } if(vga->mode->y >= 480) vga->misc &= ~0xC0; /* * 10 bits should be enough, but set the extended mode anyway. */ hqv->xr[0x09] |= 0x01; vga->crt[0x30] = ((vga->mode->vt-2)>>8) & 0x0F; vga->crt[0x31] = ((vga->mode->y-1)>>8) & 0x0F; vga->crt[0x32] = (vga->mode->vrs>>8) & 0x0F; vga->crt[0x33] = (vga->mode->vrs>>8) & 0x0F; vga->crt[0x38] = (((vga->mode->ht>>3)-5)>>8) & 0x01; vga->crt[0x3C] = (vga->mode->ehb>>3) & 0xC0; vga->crt[0x41] = (vga->crt[0x13]>>8) & 0x0F; vga->crt[0x40] = 0x80; hqv->xr[0x40] |= 0x03; hqv->xr[0x80] |= 0x10; hqv->xr[0x81] &= ~0x0F; switch(vga->mode->z){ case 8: hqv->xr[0x81] |= 0x12; break; case 16: hqv->xr[0x81] |= 0x15; break; case 32: hqv->xr[0x81] |= 0x16; break; } hqv->xr[0x0A] = 0x01; if(vga->linear && (ctlr->flag & Hlinear)) ctlr->flag |= Ulinear; vga->attribute[0x11] = 0; ctlr->flag |= Finit; } static void load(Vga* vga, Ctlr* ctlr) { HiQVideo *hqv; hqv = vga->private; hiqvideoxo(Xrx, 0x0E, 0x00); while((vgai(Status1) & 0x08) == 0x08) ; while((vgai(Status1) & 0x08) == 0) ; vgaxo(Seqx, 0x07, 0x00); /* * Set the clock if necessary. */ if((vga->misc & 0x0C) == 0x08 && (hqv->fr[0x01] & 0x03) != 0x02){ vgao(MiscW, vga->misc & ~0x0C); hiqvideoxo(Frx, 0x03, hqv->fr[0x03] & ~0x0C); hiqvideoxo(Xrx, 0xC8, hqv->xr[0xC8]); hiqvideoxo(Xrx, 0xC9, hqv->xr[0xC9]); hiqvideoxo(Xrx, 0xCA, hqv->xr[0xCA]); hiqvideoxo(Xrx, 0xCB, hqv->xr[0xCB]); } hiqvideoxo(Frx, 0x03, hqv->fr[0x03]); vgao(MiscW, vga->misc); hiqvideoxo(Xrx, 0x09, hqv->xr[0x09]); vgaxo(Crtx, 0x30, vga->crt[0x30]); vgaxo(Crtx, 0x31, vga->crt[0x31]); vgaxo(Crtx, 0x32, vga->crt[0x32]); vgaxo(Crtx, 0x33, vga->crt[0x33]); vgaxo(Crtx, 0x38, vga->crt[0x38]); vgaxo(Crtx, 0x3C, vga->crt[0x3C]); vgaxo(Crtx, 0x41, vga->crt[0x41]); vgaxo(Crtx, 0x40, vga->crt[0x40]); hiqvideoxo(Xrx, 0x40, hqv->xr[0x40]); hiqvideoxo(Xrx, 0x80, hqv->xr[0x80]); hiqvideoxo(Xrx, 0x81, hqv->xr[0x81]); if(ctlr->flag & Ulinear){ hqv->xr[0x05] = vga->vmb>>16; hqv->xr[0x06] = vga->vmb>>24; hiqvideoxo(Xrx, 0x05, hqv->xr[0x05]); hiqvideoxo(Xrx, 0x06, hqv->xr[0x06]); hqv->xr[0x0A] = 0x02; } hiqvideoxo(Xrx, 0x0A, hqv->xr[0x0A]); ctlr->flag |= Fload; } static ulong dumpmclk(uchar data[4]) { double f, m, n; int pds, rds; m = data[0] & 0x7F; n = data[1] & 0x7F; pds = 1<<((data[2] & 0x70)>>4); if(data[2] & 0x01) rds = 1; else rds = 4; f = (RefFreq*4*(m+2))/(rds*(n+2)); f /= pds; return f; } static ulong dumpvclk(uchar data[4]) { double f, m, n; int pds, rds; m = ((data[2] & 0x03)<<8)|data[0]; n = (((data[2] & 0x30)>>4)<<8)|data[1]; pds = 1<<((data[3] & 0x70)>>4); if(data[3] & 0x01) rds = 1; else rds = 4; f = (RefFreq*4*(m+2))/(rds*(n+2)); f /= pds; return f; } static void dump(Vga* vga, Ctlr* ctlr) { int i; char *name; HiQVideo *hqv; name = ctlr->name; hqv = vga->private; printitem(name, "Fr00"); for(i = 0; i < 0x50; i++) printreg(hqv->fr[i]); printitem(name, "Mr00"); for(i = 0; i < 0x60; i++) printreg(hqv->mr[i]); printitem(name, "Crt30"); for(i = 0x30; i < 0x80; i++) printreg(vga->crt[i]); printitem(name, "Xr00"); for(i = 0; i < 0x100; i++) printreg(hqv->xr[i]); printitem(ctlr->name, "CLK0"); for(i = 0; i < 4; i++) printreg(hqv->xr[0xC0+i]); Bprint(&stdout, "%23ld", dumpvclk(&hqv->xr[0xC0])); printitem(ctlr->name, "CLK1"); for(i = 0; i < 4; i++) printreg(hqv->xr[0xC4+i]); Bprint(&stdout, "%23ld", dumpvclk(&hqv->xr[0xC4])); printitem(ctlr->name, "CLK2"); for(i = 0; i < 4; i++) printreg(hqv->xr[0xC8+i]); Bprint(&stdout, "%23ld", dumpvclk(&hqv->xr[0xC8])); printitem(ctlr->name, "MCLK"); for(i = 0; i < 4; i++) printreg(hqv->xr[0xCC+i]); Bprint(&stdout, "%23ld", dumpmclk(&hqv->xr[0xCC])); printitem(ctlr->name, "m n pd rd"); Bprint(&stdout, "%9ld %8ld - %8ld %8ld\n", vga->m[0], vga->n[0], vga->p[0], vga->r[0]); } Ctlr hiqvideo = { "hiqvideo", /* name */ snarf, /* snarf */ options, /* options */ init, /* init */ load, /* load */ dump, /* dump */ }; Ctlr hiqvideohwgc = { "hiqvideohwgc", /* name */ 0, /* snarf */ 0, /* options */ 0, /* init */ 0, /* load */ 0, /* dump */ };