4f85115526
The new pci code is moved to port/pci.[hc] and shared by all ports. Each port has its own PCI controller implementation, providing the pcicfgrw*() functions for low level pci config space access. The locking for pcicfgrw*() is now done by the caller (only port/pci.c). Device drivers now need to include "../port/pci.h" in addition to "io.h". The new code now checks bridge windows and membars, while enumerating the bus, giving the pc driver a chance to re-assign them. This is needed because some UEFI implementations fail to assign the bars for some devices, so we need to do it outselfs. (See pcireservemem()). While working on this, it was discovered that the pci code assimed the smallest I/O bar size is 16 (pcibarsize()), which is wrong. I/O bars can be as small as 4 bytes. Bit 1 in an I/O bar is also reserved and should be masked off, making the port mask: port = bar & ~3;
231 lines
4.6 KiB
C
231 lines
4.6 KiB
C
#include "u.h"
|
|
#include "../port/lib.h"
|
|
#include "mem.h"
|
|
#include "dat.h"
|
|
#include "fns.h"
|
|
#include "io.h"
|
|
#include "../port/pci.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 void
|
|
mga2164wenable(VGAscr* scr)
|
|
{
|
|
Pcidev *p;
|
|
|
|
if(scr->mmio)
|
|
return;
|
|
|
|
p = scr->pci;
|
|
if(p == nil || p->vid != MATROX)
|
|
return;
|
|
|
|
if((p->mem[0].bar & 1) != 0
|
|
|| (p->mem[1].bar & 1) != 0)
|
|
return;
|
|
|
|
if(p->did == MGA2064){
|
|
scr->mmio = vmap(p->mem[0].bar&~0x0F, p->mem[0].size);
|
|
if(scr->mmio == nil)
|
|
return;
|
|
addvgaseg("mga2164wmmio", p->mem[0].bar&~0x0F, p->mem[0].size);
|
|
vgalinearaddr(scr, p->mem[1].bar&~0x0F, 8*MB);
|
|
}else{
|
|
scr->mmio = vmap(p->mem[1].bar&~0x0F, p->mem[1].size);
|
|
if(scr->mmio == nil)
|
|
return;
|
|
addvgaseg("mga2164wmmio", p->mem[1].bar&~0x0F, p->mem[1].size);
|
|
vgalinearaddr(scr, p->mem[0].bar&~0x0F, 16*MB);
|
|
}
|
|
if(scr->paddr)
|
|
addvgaseg("mga2164wscreen", scr->paddr, scr->apsize);
|
|
}
|
|
|
|
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->mmio == 0)
|
|
return;
|
|
tvp3026 = (uchar*)scr->mmio+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->mmio == 0)
|
|
return;
|
|
tvp3026 = (uchar*)scr->mmio+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->mmio == 0)
|
|
return 1;
|
|
tvp3026 = (uchar*)scr->mmio+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->mmio == 0)
|
|
return;
|
|
tvp3026 = (uchar*)scr->mmio+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, &cursor);
|
|
tvp3026move(scr, ZP);
|
|
*(tvp3026+Cctl) = 0x01;
|
|
}
|
|
|
|
VGAdev vgamga2164wdev = {
|
|
"mga2164w",
|
|
|
|
mga2164wenable, /* enable */
|
|
0, /* disable */
|
|
0, /* page */
|
|
0, /* linear */
|
|
};
|
|
|
|
VGAcur vgamga2164wcur = {
|
|
"mga2164whwgc",
|
|
|
|
tvp3026enable,
|
|
tvp3026disable,
|
|
tvp3026load,
|
|
tvp3026move,
|
|
};
|