ref: dab539cd14726de15932b0310532212f8da29bf7
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 */
};