plan9fox/sys/src/9/pc/vgatvp3026.c
2011-03-30 19:35:09 +03:00

191 lines
3.9 KiB
C

#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"
/*
* TVP3026 Viewpoint Video Interface Pallette.
* Assumes hooked up to an S3 Vision968.
*/
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 */
};
/*
* Lower 2-bits of indirect DAC register
* addressing.
*/
static ushort dacxreg[4] = {
PaddrW, Pdata, Pixmask, PaddrR
};
static uchar
tvp3026io(uchar reg, uchar data)
{
uchar crt55;
crt55 = vgaxi(Crtx, 0x55) & 0xFC;
vgaxo(Crtx, 0x55, crt55|((reg>>2) & 0x03));
vgao(dacxreg[reg & 0x03], data);
return crt55;
}
static void
tvp3026o(uchar reg, uchar data)
{
uchar crt55;
crt55 = tvp3026io(reg, data);
vgaxo(Crtx, 0x55, crt55);
}
void
tvp3026xo(uchar index, uchar data)
{
uchar crt55;
crt55 = tvp3026io(Index, index);
vgaxo(Crtx, 0x55, crt55|((Data>>2) & 0x03));
vgao(dacxreg[Data & 0x03], data);
vgaxo(Crtx, 0x55, crt55);
}
static void
tvp3026disable(VGAscr*)
{
tvp3026xo(Icctl, 0x90);
tvp3026o(Cctl, 0x00);
}
static void
tvp3026enable(VGAscr*)
{
/*
* Make sure cursor is off and direct control enabled.
*/
tvp3026xo(Icctl, 0x90);
tvp3026o(Cctl, 0x00);
/*
* Overscan colour,
* cursor colour 1 (white),
* cursor colour 2, 3 (black).
*/
tvp3026o(CaddrW, 0x00);
tvp3026o(Cdata, Pwhite); tvp3026o(Cdata, Pwhite); tvp3026o(Cdata, Pwhite);
tvp3026o(Cdata, Pwhite); tvp3026o(Cdata, Pwhite); tvp3026o(Cdata, Pwhite);
tvp3026o(Cdata, Pblack); tvp3026o(Cdata, Pblack); tvp3026o(Cdata, Pblack);
tvp3026o(Cdata, Pblack); tvp3026o(Cdata, Pblack); tvp3026o(Cdata, Pblack);
/*
* Enable the cursor in 3-colour mode.
*/
tvp3026o(Cctl, 0x01);
}
static void
tvp3026load(VGAscr* scr, Cursor* curs)
{
int x, y;
/*
* 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.
* The LSBs of the cursor RAM address are in PaddrW.
*/
tvp3026xo(Icctl, 0x90);
tvp3026o(Cctl, 0x00);
vgao(PaddrW, 0x00);
/*
* 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)
tvp3026o(Cram, curs->clr[x+y*2]);
else
tvp3026o(Cram, 0x00);
}
}
for(y = 0; y < 64; y++){
for(x = 0; x < 64/8; x++){
if(x < 16/8 && y < 16)
tvp3026o(Cram, curs->set[x+y*2]);
else
tvp3026o(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;
tvp3026o(Cctl, 0x01);
}
static int
tvp3026move(VGAscr* scr, Point p)
{
int x, y;
x = p.x+scr->offset.x;
y = p.y+scr->offset.y;
tvp3026o(Cxlsb, x & 0xFF);
tvp3026o(Cxmsb, (x>>8) & 0x0F);
tvp3026o(Cylsb, y & 0xFF);
tvp3026o(Cymsb, (y>>8) & 0x0F);
return 0;
}
VGAcur vgatvp3026cur = {
"tvp3026hwgc",
tvp3026enable,
tvp3026disable,
tvp3026load,
tvp3026move,
};