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;
214 lines
3.6 KiB
C
214 lines
3.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"
|
|
|
|
typedef struct Cursor546x Cursor546x;
|
|
struct Cursor546x {
|
|
ushort x;
|
|
ushort y;
|
|
ushort preset;
|
|
ushort enable;
|
|
ushort addr;
|
|
};
|
|
|
|
enum {
|
|
PaletteState = 0xB0,
|
|
CursorMMIO = 0xE0,
|
|
};
|
|
|
|
static void
|
|
clgd546xlinear(VGAscr* scr, int, int)
|
|
{
|
|
vgalinearpci(scr);
|
|
}
|
|
|
|
static void
|
|
clgd546xenable(VGAscr* scr)
|
|
{
|
|
Pcidev *p;
|
|
|
|
if(scr->mmio)
|
|
return;
|
|
p = scr->pci;
|
|
if(p == nil)
|
|
return;
|
|
if(p->mem[1].bar & 1)
|
|
return;
|
|
scr->mmio = vmap(p->mem[1].bar&~0x0F, p->mem[1].size);
|
|
if(scr->mmio == nil)
|
|
return;
|
|
addvgaseg("clgd546xmmio", p->mem[1].bar&~0x0F, p->mem[1].size);
|
|
}
|
|
|
|
static void
|
|
clgd546xcurdisable(VGAscr* scr)
|
|
{
|
|
Cursor546x *cursor546x;
|
|
|
|
if(scr->mmio == nil)
|
|
return;
|
|
cursor546x = (Cursor546x*)((uchar*)scr->mmio+CursorMMIO);
|
|
cursor546x->enable = 0;
|
|
}
|
|
|
|
static void
|
|
clgd546xcurload(VGAscr* scr, Cursor* curs)
|
|
{
|
|
int c, i, m, y;
|
|
uchar *p;
|
|
Cursor546x *cursor546x;
|
|
|
|
if(scr->mmio == 0)
|
|
return;
|
|
cursor546x = (Cursor546x*)((uchar*)scr->mmio+CursorMMIO);
|
|
|
|
/*
|
|
* Disable the cursor then change only the bits
|
|
* that need it.
|
|
*/
|
|
cursor546x->enable = 0;
|
|
p = (uchar*)scr->vaddr + scr->storage;
|
|
for(y = 0; y < 16; y++){
|
|
c = curs->set[2*y];
|
|
m = 0;
|
|
for(i = 0; i < 8; i++){
|
|
if(c & (1<<(7-i)))
|
|
m |= 1<<i;
|
|
}
|
|
*p++ = m;
|
|
c = curs->set[2*y + 1];
|
|
m = 0;
|
|
for(i = 0; i < 8; i++){
|
|
if(c & (1<<(7-i)))
|
|
m |= 1<<i;
|
|
}
|
|
*p++ = m;
|
|
p += 6;
|
|
c = curs->set[2*y]|curs->clr[2*y];
|
|
m = 0;
|
|
for(i = 0; i < 8; i++){
|
|
if(c & (1<<(7-i)))
|
|
m |= 1<<i;
|
|
}
|
|
*p++ = m;
|
|
c = curs->set[2*y + 1]|curs->clr[2*y + 1];
|
|
m = 0;
|
|
for(i = 0; i < 8; i++){
|
|
if(c & (1<<(7-i)))
|
|
m |= 1<<i;
|
|
}
|
|
*p++ = m;
|
|
p += 6;
|
|
}
|
|
|
|
/*
|
|
* Save the cursor hotpoint and enable the cursor.
|
|
*/
|
|
scr->offset = curs->offset;
|
|
cursor546x->enable = 1;
|
|
}
|
|
|
|
static int
|
|
clgd546xcurmove(VGAscr* scr, Point p)
|
|
{
|
|
int x, xo, y, yo;
|
|
Cursor546x *cursor546x;
|
|
|
|
if(scr->mmio == 0)
|
|
return 1;
|
|
cursor546x = (Cursor546x*)((uchar*)scr->mmio+CursorMMIO);
|
|
|
|
if((x = p.x+scr->offset.x) < 0){
|
|
xo = -x;
|
|
x = 0;
|
|
}
|
|
else
|
|
xo = 0;
|
|
if((y = p.y+scr->offset.y) < 0){
|
|
yo = -y;
|
|
y = 0;
|
|
}
|
|
else
|
|
yo = 0;
|
|
|
|
cursor546x->preset = (xo<<8)|yo;
|
|
cursor546x->x = x;
|
|
cursor546x->y = y;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
clgd546xcurenable(VGAscr* scr)
|
|
{
|
|
uchar *p;
|
|
Cursor546x *cursor546x;
|
|
|
|
clgd546xenable(scr);
|
|
if(scr->mmio == 0)
|
|
return;
|
|
cursor546x = (Cursor546x*)((uchar*)scr->mmio+CursorMMIO);
|
|
|
|
/*
|
|
* Cursor colours.
|
|
* Can't call setcolor here as cursor is already locked.
|
|
*/
|
|
p = (uchar*)scr->mmio+PaletteState;
|
|
*p |= 0x08;
|
|
vgao(PaddrW, 0x00);
|
|
vgao(Pdata, Pwhite);
|
|
vgao(Pdata, Pwhite);
|
|
vgao(Pdata, Pwhite);
|
|
vgao(PaddrW, 0x0F);
|
|
vgao(Pdata, Pblack);
|
|
vgao(Pdata, Pblack);
|
|
vgao(Pdata, Pblack);
|
|
*p &= ~0x08;
|
|
|
|
/*
|
|
* Find a place for the cursor data in display memory.
|
|
* 2 cursor images might be needed, 1KB each so use the last
|
|
* 2KB of the framebuffer and initialise them to be
|
|
* transparent.
|
|
*/
|
|
scr->storage = ((vgaxi(Seqx, 0x14) & 0x07)+1)*1024*1022;
|
|
cursor546x->addr = (scr->storage>>10)<<2;
|
|
memset((uchar*)scr->vaddr + scr->storage, 0, 2*64*16);
|
|
|
|
/*
|
|
* Load, locate and enable the 64x64 cursor.
|
|
*/
|
|
clgd546xcurload(scr, &cursor);
|
|
clgd546xcurmove(scr, ZP);
|
|
cursor546x->enable = 1;
|
|
}
|
|
|
|
VGAdev vgaclgd546xdev = {
|
|
"clgd546x",
|
|
|
|
clgd546xenable,
|
|
nil,
|
|
nil,
|
|
clgd546xlinear,
|
|
};
|
|
|
|
VGAcur vgaclgd546xcur = {
|
|
"clgd546xhwgc",
|
|
|
|
clgd546xcurenable,
|
|
clgd546xcurdisable,
|
|
clgd546xcurload,
|
|
clgd546xcurmove,
|
|
};
|