ref: 88ccea37f65b87312292b2b1a107c39927c6a2c3
dir: /sys/src/cmd/aux/vga/clgd546x.c/
#include <u.h> #include <libc.h> #include <bio.h> #include "pci.h" #include "vga.h" /* * Laguna Visual Media Accelerators Family CL-GD546x. */ typedef struct { Pcidev* pci; uchar* mmio; int mem; int format; /* graphics and video format */ int threshold; /* display threshold */ int tilectrl; /* tiling control */ int vsc; /* vendor specific control */ int control; /* control */ int tilectrl2D3D; /* tiling control 2D3D */ } Laguna; enum { Format = 0xC0, /* graphics and video format */ Threshold = 0xEA, /* Display Threshold */ TileCtrl = 0x2C4, Vsc = 0x3FC, /* Vendor Specific Control (32-bits) */ Control = 0x402, /* 2D Control */ TileCtrl2D3D = 0x407, /* (8-bits) */ }; static int mmio8r(Laguna* laguna, int offset) { return *(laguna->mmio+offset) & 0xFF; } static void mmio8w(Laguna* laguna, int offset, int data) { *(laguna->mmio+offset) = data; } static int mmio16r(Laguna* laguna, int offset) { return *((ushort*)(laguna->mmio+offset)) & 0xFFFF; } static void mmio16w(Laguna* laguna, int offset, int data) { *((ushort*)(laguna->mmio+offset)) = data; } static int mmio32r(Laguna* laguna, int offset) { return *((ulong*)(laguna->mmio+offset)); } static void mmio32w(Laguna* laguna, int offset, int data) { *((ulong*)(laguna->mmio+offset)) = data; } static void snarf(Vga* vga, Ctlr* ctlr) { int i; uchar *mmio; Pcidev *p; Laguna *laguna; /* * Save all the registers, even though we'll only * change a handful. */ for(i = 0x06; i < 0x20; i++) vga->sequencer[i] = vgaxi(Seqx, i); for(i = 0x09; i < 0x0C; i++) vga->graphics[i] = vgaxi(Grx, i); for(i = 0x19; i < 0x20; i++) vga->crt[i] = vgaxi(Crtx, i); if(vga->private == nil){ vga->private = alloc(sizeof(Laguna)); p = vga->pci; if(p == nil) p = pcimatch(0, 0x1013, 0); if(p == nil || p->vid != 0x1013) error("%s: not found\n", ctlr->name); switch(p->did){ case 0xD0: /* CL-GD5462 */ vga->f[1] = 170000000; break; case 0xD4: /* CL-GD5464 */ case 0xD6: /* CL-GD5465 */ vga->f[1] = 230000000; break; default: error("%s: DID %4.4uX unsupported\n", ctlr->name, p->did); } vgactlpci(p); vgactlw("type", "clgd546x"); mmio = segattach(0, "clgd546xmmio", 0, p->mem[1].size); if(mmio == (void*)-1) error("%s: can't attach mmio segment\n", ctlr->name); laguna = vga->private; laguna->pci = p; laguna->mmio = mmio; } laguna = vga->private; laguna->mem = (vga->sequencer[0x14] & 0x07)+1; laguna->format = mmio16r(laguna, Format); laguna->threshold = mmio16r(laguna, Threshold); laguna->tilectrl = mmio16r(laguna, TileCtrl); laguna->vsc = mmio32r(laguna, Vsc); laguna->control = mmio16r(laguna, Control); laguna->tilectrl2D3D = mmio8r(laguna, TileCtrl2D3D); vga->vma = vga->vmz = laguna->pci->mem[0].size; ctlr->flag |= Hlinear; ctlr->flag |= Fsnarf; } static void init(Vga* vga, Ctlr* ctlr) { Mode *mode; ushort x; int format, interleave, fetches, nointerleave, notile, pagesize, tiles; Laguna *laguna; nointerleave = 1; notile = 1; pagesize = 0; mode = vga->mode; if(vga->f[0] == 0) vga->f[0] = vga->mode->frequency; if(vga->f[0] > vga->f[1]) error("%s: invalid pclk - %lud\n", ctlr->name, vga->f[0]); if(mode->z > 8) error("%s: depth %d not supported\n", ctlr->name, mode->z); /* * VCLK3 */ clgd54xxclock(vga, ctlr); vga->misc |= 0x0C; vga->sequencer[0x1E] = vga->n[0]; vga->sequencer[0x0E] = (vga->d[0]<<1)|vga->p[0]; vga->sequencer[0x07] = 0x00; if(mode->z == 8) vga->sequencer[0x07] |= 0x01; vga->crt[0x14] = 0; vga->crt[0x17] = 0xC3; /* * Overflow bits. */ vga->crt[0x1A] = 0x00; x = mode->ehb>>3; if(x & 0x40) vga->crt[0x1A] |= 0x10; if(x & 0x80) vga->crt[0x1A] |= 0x20; if(vga->crt[0x16] & 0x100) vga->crt[0x1A] |= 0x40; if(vga->crt[0x16] & 0x200) vga->crt[0x1A] |= 0x80; vga->crt[0x1B] = 0x22; if(vga->crt[0x13] & 0x100) vga->crt[0x1B] |= 0x10; vga->crt[0x1D] = 0x00; if(vga->crt[0x13] & 0x200) vga->crt[0x1D] |= 0x01; vga->crt[0x1E] = 0x00; if(vga->crt[0x10] & 0x400) vga->crt[0x1E] |= 0x01; if(vga->crt[0x15] & 0x400) vga->crt[0x1E] |= 0x02; if(vga->crt[0x12] & 0x400) vga->crt[0x1E] |= 0x04; if(vga->crt[0x06] & 0x400) vga->crt[0x1E] |= 0x08; if(vga->crt[0x04] & 0x100) vga->crt[0x1E] |= 0x10; if(vga->crt[0x02] & 0x100) vga->crt[0x1E] |= 0x20; if(vga->crt[0x01] & 0x100) vga->crt[0x1E] |= 0x40; if(vga->crt[0x00] & 0x100) vga->crt[0x1E] |= 0x80; vga->graphics[0x0B] = 0x00; if(vga->vmz > 1024*1024) vga->graphics[0x0B] |= 0x20; if(mode->interlace == 'v'){ vga->crt[0x19] = vga->crt[0x00]/2; vga->crt[0x1A] |= 0x01; } if(vga->linear && (ctlr->flag & Hlinear)) ctlr->flag |= Ulinear; laguna = vga->private; /* * Ignore wide tiles for now, this simplifies things. */ if(mode->x <= 640) tiles = 5; else if(mode->x <= 1024) tiles = 8; else if(mode->x <= 1280) tiles = 10; else if(mode->x <= 1664) tiles = 13; else if(mode->x <= 2048) tiles = 16; else if(mode->x <= 2560) tiles = 20; else if(mode->x <= 3228) tiles = 26; else tiles = 32; fetches = tiles; /* -1? */ if(nointerleave) interleave = 0; else switch(laguna->mem){ default: interleave = 0; break; case 2: interleave = 1; break; case 4: case 8: interleave = 2; break; } if(mode->z == 8) format = 0; else if(mode->z == 16) format = (1<<12)|(2<<9); else if(mode->z == 24) format = (2<<12)|(2<<9); else format = (2<<12)|(2<<9); //if(ctlr->flag & Ulinear) // laguna->vsc |= 0x10000000; //else laguna->vsc &= ~0x10000000; laguna->format = format; laguna->threshold = (interleave<<14)|(fetches<<8)|0x14; laguna->tilectrl &= 0x3F; laguna->tilectrl |= (interleave<<14)|(tiles<<8); if(!notile) laguna->tilectrl |= 0x80; if(pagesize == 1) laguna->tilectrl |= 0x10; laguna->tilectrl2D3D = (interleave<<6)|tiles; laguna->control = 0; if(notile) laguna->control |= 0x1000; if(pagesize == 1) laguna->control |= 0x0200; } static void load(Vga* vga, Ctlr*) { Laguna *laguna; vgaxo(Seqx, 0x0E, vga->sequencer[0x0E]); vgaxo(Seqx, 0x1E, vga->sequencer[0x1E]); vgaxo(Seqx, 0x07, vga->sequencer[0x07]); if(vga->mode->interlace == 'v') vgaxo(Crtx, 0x19, vga->crt[0x19]); vgaxo(Crtx, 0x1A, vga->crt[0x1A]); vgaxo(Crtx, 0x1B, vga->crt[0x1B]); vgaxo(Crtx, 0x1D, vga->crt[0x1D]); vgaxo(Crtx, 0x1E, vga->crt[0x1E]); vgaxo(Grx, 0x0B, vga->graphics[0x0B]); laguna = vga->private; mmio16w(laguna, Format, laguna->format); mmio32w(laguna, Vsc, laguna->vsc); mmio16w(laguna, Threshold, laguna->threshold); mmio16w(laguna, TileCtrl, laguna->tilectrl); mmio8w(laguna, TileCtrl2D3D, laguna->tilectrl2D3D); mmio16w(laguna, Control, laguna->control); } static void dump(Vga* vga, Ctlr* ctlr) { int i; char *name; Laguna *laguna; name = ctlr->name; printitem(name, "Seq06"); for(i = 0x06; i < 0x20; i++) printreg(vga->sequencer[i]); printitem(name, "Crt19"); for(i = 0x19; i < 0x20; i++) printreg(vga->crt[i]); printitem(name, "Gr09"); for(i = 0x09; i < 0x0C; i++) printreg(vga->graphics[i]); laguna = vga->private; Bprint(&stdout, "\n"); Bprint(&stdout, "%s mem\t\t%d\n", ctlr->name, laguna->mem*1024*1024); Bprint(&stdout, "%s Format\t\t%uX\n", ctlr->name, laguna->format); Bprint(&stdout, "%s Threshold\t\t\t%uX\n", ctlr->name, laguna->threshold); Bprint(&stdout, "%s TileCtrl\t\t\t%uX\n", ctlr->name, laguna->tilectrl); Bprint(&stdout, "%s Vsc\t\t%uX\n", ctlr->name, laguna->vsc); Bprint(&stdout, "%s Control\t\t%uX\n", ctlr->name, laguna->control); Bprint(&stdout, "%s TileCtrlC2D3D\t\t%uX\n", ctlr->name, laguna->tilectrl2D3D); } Ctlr clgd546x = { "clgd546x", /* name */ snarf, /* snarf */ 0, /* options */ init, /* init */ load, /* load */ dump, /* dump */ }; Ctlr clgd546xhwgc = { "clgd546xhwgc", /* name */ 0, /* snarf */ 0, /* options */ 0, /* init */ 0, /* load */ 0, /* dump */ };