123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289 |
- #include "u.h"
- #include "../port/lib.h"
- #include "mem.h"
- #include "dat.h"
- #include "fns.h"
- #include "io.h"
- #include "../port/error.h"
- #define Image IMAGE
- #include <draw.h>
- #include <memdraw.h>
- #include <cursor.h>
- #include "screen.h"
- /*
- * Matrox Millennium and Matrox Millennium II.
- * Matrox MGA-2064W, MGA-2164W 3D graphics accelerators.
- * Texas Instruments Tvp3026 RAMDAC.
- */
- enum {
- /* pci chip manufacturer */
- MATROX = 0x102B,
- /* pci chip device ids */
- MGA2064 = 0x0519,
- MGA2164 = 0x051B,
- MGA2164AGP = 0x051F
- };
- static Pcidev*
- mgapcimatch(void)
- {
- Pcidev *p;
- p = pcimatch(nil, MATROX, MGA2164AGP);
- if(p == nil) {
- p = pcimatch(nil, MATROX, MGA2164);
- if(p == nil)
- p = pcimatch(nil, MATROX, MGA2064);
- }
- return p;
- }
- static ulong
- mga2164wlinear(VGAscr* scr, int* size, int* align)
- {
- ulong aperture, oaperture;
- int oapsize, wasupamem;
- Pcidev *p;
- oaperture = scr->aperture;
- oapsize = scr->apsize;
- wasupamem = scr->isupamem;
- if(p = mgapcimatch()){
- aperture = p->mem[p->did==MGA2064? 1 : 0].bar & ~0x0F;
- *size = (p->did==MGA2064? 8 :16)*1024*1024;
- }
- else
- aperture = 0;
- if(wasupamem) {
- if(oaperture == aperture)
- return oaperture;
- upafree(oaperture, oapsize);
- }
- scr->isupamem = 0;
- aperture = upamalloc(aperture, *size, *align);
- if(aperture == 0){
- if(wasupamem && upamalloc(oaperture, oapsize, 0)) {
- aperture = oaperture;
- scr->isupamem = 1;
- }
- else
- scr->isupamem = 0;
- }
- else
- scr->isupamem = 1;
- return aperture;
- }
- static void
- mga2164wenable(VGAscr* scr)
- {
- Pcidev *p;
- int size, align, immio;
- ulong aperture;
- /*
- * Only once, can't be disabled for now.
- * scr->io holds the virtual address of
- * the MMIO registers.
- */
- if(scr->io)
- return;
- p = mgapcimatch();
- if(p == nil)
- return;
- immio = p->did==MGA2064? 0 : 1;
- scr->io = upamalloc(p->mem[immio].bar & ~0x0F, p->mem[immio].size, 0);
- if(scr->io == 0)
- return;
- addvgaseg("mga2164wmmio", scr->io, p->mem[immio].size);
- scr->io = (ulong)KADDR(scr->io);
- /* need to map frame buffer here too, so vga can find memory size */
- size = (p->did==MGA2064? 8 :16)*1024*1024;
- align = 0;
- aperture = mga2164wlinear(scr, &size, &align);
- if(aperture) {
- scr->aperture = aperture;
- scr->apsize = size;
- addvgaseg("mga2164wscreen", aperture, size);
- }
- }
- enum {
- Index = 0x00, /* Index */
- Data = 0x0A, /* Data */
- CaddrW = 0x04, /* Colour Write Address */
- Cdata = 0x05, /* Colour Data */
- Cctl = 0x09, /* Direct Cursor Control */
- Cram = 0x0B, /* Cursor Ram Data */
- Cxlsb = 0x0C, /* Cursor X LSB */
- Cxmsb = 0x0D, /* Cursor X MSB */
- Cylsb = 0x0E, /* Cursor Y LSB */
- Cymsb = 0x0F, /* Cursor Y MSB */
- Icctl = 0x06, /* Indirect Cursor Control */
- };
- static void
- tvp3026disable(VGAscr* scr)
- {
- uchar *tvp3026;
- if(scr->io == 0)
- return;
- tvp3026 = KADDR(scr->io+0x3C00);
- /*
- * Make sure cursor is off
- * and direct control enabled.
- */
- *(tvp3026+Index) = Icctl;
- *(tvp3026+Data) = 0x90;
- *(tvp3026+Cctl) = 0x00;
- }
- static void
- tvp3026load(VGAscr* scr, Cursor* curs)
- {
- int x, y;
- uchar *tvp3026;
- if(scr->io == 0)
- return;
- tvp3026 = KADDR(scr->io+0x3C00);
- /*
- * Make sure cursor is off by initialising the cursor
- * control to defaults.
- * Write to the indirect control register to make sure
- * direct register is enabled and upper 2 bits of cursor
- * RAM address are 0.
- * Put 0 in index register for lower 8 bits of cursor RAM address.
- */
- tvp3026disable(scr);
- *(tvp3026+Index) = 0;
- /*
- * Initialise the 64x64 cursor RAM array. There are 2 planes,
- * p0 and p1. Data is written 8 pixels per byte, with p0 in the
- * first 512 bytes of the array and p1 in the second.
- * The cursor is set in 3-colour mode which gives the following
- * truth table:
- * p1 p0 colour
- * 0 0 transparent
- * 0 1 cursor colour 0
- * 1 0 cursor colour 1
- * 1 1 cursor colour 2
- * Put the cursor into the top-left of the 64x64 array.
- * The 0,0 cursor point is bottom-right, so positioning will
- * have to take that into account.
- */
- for(y = 0; y < 64; y++){
- for(x = 0; x < 64/8; x++){
- if(x < 16/8 && y < 16)
- *(tvp3026+Cram) = curs->clr[x+y*2];
- else
- *(tvp3026+Cram) = 0x00;
- }
- }
- for(y = 0; y < 64; y++){
- for(x = 0; x < 64/8; x++){
- if(x < 16/8 && y < 16)
- *(tvp3026+Cram) = curs->set[x+y*2];
- else
- *(tvp3026+Cram) = 0x00;
- }
- }
- /*
- * Initialise the cursor hotpoint
- * and enable the cursor in 3-colour mode.
- */
- scr->offset.x = 64+curs->offset.x;
- scr->offset.y = 64+curs->offset.y;
- *(tvp3026+Cctl) = 0x01;
- }
- static int
- tvp3026move(VGAscr* scr, Point p)
- {
- int x, y;
- uchar *tvp3026;
- if(scr->io == 0)
- return 1;
- tvp3026 = KADDR(scr->io+0x3C00);
- x = p.x+scr->offset.x;
- y = p.y+scr->offset.y;
- *(tvp3026+Cxlsb) = x & 0xFF;
- *(tvp3026+Cxmsb) = (x>>8) & 0x0F;
- *(tvp3026+Cylsb) = y & 0xFF;
- *(tvp3026+Cymsb) = (y>>8) & 0x0F;
- return 0;
- }
- static void
- tvp3026enable(VGAscr* scr)
- {
- int i;
- uchar *tvp3026;
- if(scr->io == 0)
- return;
- tvp3026 = KADDR(scr->io+0x3C00);
- tvp3026disable(scr);
- /*
- * Overscan colour,
- * cursor colour 1 (white),
- * cursor colour 2, 3 (black).
- */
- *(tvp3026+CaddrW) = 0x00;
- for(i = 0; i < 6; i++)
- *(tvp3026+Cdata) = Pwhite;
- for(i = 0; i < 6; i++)
- *(tvp3026+Cdata) = Pblack;
- /*
- * Load, locate and enable the
- * 64x64 cursor in 3-colour mode.
- */
- tvp3026load(scr, &arrow);
- tvp3026move(scr, ZP);
- *(tvp3026+Cctl) = 0x01;
- }
- VGAdev vgamga2164wdev = {
- "mga2164w",
- mga2164wenable, /* enable */
- 0, /* disable */
- 0, /* page */
- mga2164wlinear, /* linear */
- };
- VGAcur vgamga2164wcur = {
- "mga2164whwgc",
- tvp3026enable,
- tvp3026disable,
- tvp3026load,
- tvp3026move,
- };
|