|
|
Plan 9 NeXT
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "../port/error.h"
#include <libg.h>
#include <gnot.h>
#include "screen.h"
#include "vga.h"
extern Cursor curcursor;
/*
* TVP3020 Viewpoint Video Interface Pallette.
* Assumes hooked up to an S3 86C928.
*/
enum {
AddrW = 0x00, /* Palette address register - write mode */
Palette = 0x01, /* Color palette holding register */
Pmask = 0x02, /* Pixel read mask */
AddrR = 0x03, /* Palette address register - read mode */
Index = 0x06, /* Index register */
Data = 0x07, /* Data register */
};
/*
* Lower 2-bits of indirect DAC register
* addressing.
*/
static ushort dacxreg[4] = {
PaddrW, Pdata, Pixmask, PaddrR
};
static uchar
tvp3020io(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
tvp3020xo(uchar index, uchar data)
{
uchar crt55;
crt55 = tvp3020io(Index, index);
vgao(dacxreg[Data & 0x03], data);
vgaxo(Crtx, 0x55, crt55);
}
static void
load(Cursor *c)
{
uchar p, p0, p1;
int x, y;
uchar clr[2*16], set[2*16];
/*
* Lock the DAC registers so we can update the
* cursor bitmap if necessary.
* If it's the same as the last cursor we loaded,
* just make sure it's enabled.
*/
lock(&palettelock);
#ifdef notdef
if(memcmp(c, &curcursor, sizeof(Cursor)) == 0){
tvp3020xo(0x06, 0x40|0x10); /* Cursor Control Register */
unlock(&palettelock);
return;
}
memmove(&curcursor, c, sizeof(Cursor));
#endif /* notdef */
/*
* Make sure cursor is off by initialising the cursor
* control to defaults + X-Windows cursor mode.
*/
tvp3020xo(0x06, 0x10); /* Cursor Control Register */
/*
* Initialise the cursor RAM LS and MS address
* (LS must be first).
*/
tvp3020xo(0x08, 0x00); /* Cursor RAM LS Address */
tvp3020xo(0x09, 0x00); /* Cursor RAM MS Address */
/*
* Initialise the 64x64 cursor RAM array. There are 2 planes,
* p0 and p1. Data is written 4 pixels per byte, with p1 the
* MS bit of each pixel.
* The cursor is set in X-Windows mode which gives the following
* truth table:
* p1 p0 colour
* 0 0 underlying pixel colour
* 0 1 underlying pixel colour
* 1 0 cursor colour 1
* 1 1 cursor colour 2
* Put the cursor into the top-left of the 64x64 array.
*/
memmove(clr, c->clr, sizeof(clr));
pixreverse(clr, sizeof(clr), 0);
memmove(set, c->set, sizeof(set));
pixreverse(set, sizeof(set), 0);
for(y = 0; y < 64; y++){
for(x = 0; x < 64/8; x++){
if(x < 16/8 && y < 16){
p0 = clr[x+y*2];
p1 = set[x+y*2];
p = 0x00;
if(p1 & 0x10)
p |= 0x03;
else if(p0 & 0x10)
p |= 0x02;
if(p1 & 0x20)
p |= 0x0C;
else if(p0 & 0x20)
p |= 0x08;
if(p1 & 0x40)
p |= 0x30;
else if(p0 & 0x40)
p |= 0x20;
if(p1 & 0x80)
p |= 0xC0;
else if(p0 & 0x80)
p |= 0x80;
tvp3020xo(0x0A, p); /* Cursor RAM Data */
p = 0x00;
if(p1 & 0x01)
p |= 0x03;
else if(p0 & 0x01)
p |= 0x02;
if(p1 & 0x02)
p |= 0x0C;
else if(p0 & 0x02)
p |= 0x08;
if(p1 & 0x04)
p |= 0x30;
else if(p0 & 0x04)
p |= 0x20;
if(p1 & 0x08)
p |= 0xC0;
else if(p0 & 0x08)
p |= 0x80;
tvp3020xo(0x0A, p); /* Cursor RAM Data */
}
else{
tvp3020xo(0x0A, 0x00); /* Cursor RAM Data */
tvp3020xo(0x0A, 0x00);
}
}
}
/*
* Initialise the cursor hot-point
* and enable the cursor.
*/
tvp3020xo(0x04, -c->offset.x); /* Sprite Origin X */
tvp3020xo(0x05, -c->offset.y); /* Sprite Origin Y */
tvp3020xo(0x06, 0x40|0x10); /* Cursor Control Register */
unlock(&palettelock);
}
static void
enable(void)
{
uchar r;
lock(&palettelock);
/*
* Make sure cursor is off by initialising the cursor
* control to defaults + X-Windows cursor mode.
*/
tvp3020xo(0x06, 0x10); /* Cursor Control Register */
/*
* Overscan colour,
* cursor colour 1 (white),
* cursor colour 2 (black).
*/
tvp3020xo(0x20, 0x00); tvp3020xo(0x21, 0x00); tvp3020xo(0x22, 0x00);
tvp3020xo(0x23, 0x00); tvp3020xo(0x24, 0x00); tvp3020xo(0x25, 0x00);
tvp3020xo(0x26, 0xFF); tvp3020xo(0x27, 0xFF); tvp3020xo(0x28, 0xFF);
unlock(&palettelock);
/*
* Finally, enable
* the hardware cursor external operation mode;
* cursor control enable for Bt485 DAC (!).
*/
r = vgaxi(Crtx, 0x55)|0x20;
vgaxo(Crtx, 0x55, r);
r = vgaxi(Crtx, 0x45)|0x20;
vgaxo(Crtx, 0x45, r);
}
static int
move(Point p)
{
if(canlock(&palettelock) == 0)
return 1;
tvp3020xo(0x00, p.x & 0xFF); /* Cursor Position X LSB */
tvp3020xo(0x01, (p.x>>8) & 0x0F); /* Cursor Position X MSB */
tvp3020xo(0x02, p.y & 0xFF); /* Cursor Position Y LSB */
tvp3020xo(0x03, (p.y>>8) & 0x0F); /* Cursor Position Y MSB */
unlock(&palettelock);
return 0;
}
static void
disable(void)
{
uchar r;
/*
* Disable
* cursor;
* cursor control enable for Bt485 DAC (!);
* the hardware cursor external operation mode.
*/
lock(&palettelock);
tvp3020xo(0x06, 0x10); /* Cursor Control Register */
unlock(&palettelock);
r = vgaxi(Crtx, 0x45) & ~0x20;
vgaxo(Crtx, 0x45, r);
r = vgaxi(Crtx, 0x55) & ~0x20;
vgaxo(Crtx, 0x55, r);
}
static Hwgc tvp3020hwgc = {
"tvp3020hwgc",
enable,
load,
move,
disable,
0,
};
void
vgatvp3020link(void)
{
addhwgclink(&tvp3020hwgc);
}
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.