|
|
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 GBitmap gscreen;
extern GBitmap vgascreen;
static Lock et4000pagelock;
static ulong storage;
static Point hotpoint;
static void
setet4000page(int page)
{
uchar p;
p = page & 0x0F;
p |= p<<4;
outb(0x3CD, p);
p = (page & 0x30);
p |= p>>4;
outb(0x3CB, p);
}
static void
disable(void)
{
uchar imaF7;
outb(0x217A, 0xF7);
imaF7 = inb(0x217B) & ~0x80;
outb(0x217B, imaF7);
}
static void
enable(void)
{
uchar imaF7;
disable();
/*
* Configure CRTCB for Sprite, 64x64,
* CRTC pixel overlay.
*/
outb(0x217A, 0xEF);
outb(0x217B, 0x02);
/*
* Cursor goes in the top left corner
* of the Sprite area, so the horizontal and
* vertical presets are 0.
*/
outb(0x217A, 0xE2);
outb(0x217B, 0x00);
outb(0x217A, 0xE3);
outb(0x217B, 0x00);
outb(0x217A, 0xE6);
outb(0x217B, 0x00);
outb(0x217A, 0xE7);
outb(0x217B, 0x00);
/*
* Find a place for the cursor data in display memory.
* Must be on a "doubleword" boundary, but put it on a
* 1024-byte boundary so that there's no danger of it
* crossing a page.
*/
storage = (gscreen.width*BY2WD*gscreen.r.max.y+1023)/1024;
storage *= 1024/4;
outb(0x217A, 0xE8);
outb(0x217B, storage & 0xFF);
outb(0x217A, 0xE9);
outb(0x217B, (storage>>8) & 0xFF);
outb(0x217A, 0xEA);
outb(0x217B, (storage>>16) & 0x0F);
storage *= 4;
/*
* Row offset in "quadwords". Must be 2 for Sprite.
* Bag the pixel-panning.
* Colour depth, must be 2 for Sprite.
*/
outb(0x217A, 0xEB);
outb(0x217B, 0x02);
outb(0x217A, 0xEC);
outb(0x217B, 0x00);
outb(0x217A, 0xED);
outb(0x217B, 0x00);
outb(0x217A, 0xEE);
if(vgascreen.ldepth == 3)
outb(0x217B, 0x01);
else
outb(0x217B, 0x00);
/*
* Enable the CRTCB/Sprite.
*/
outb(0x217A, 0xF7);
imaF7 = inb(0x217B);
outb(0x217B, 0x80|imaF7);
}
static void
load(Cursor *c)
{
uchar p0, p1, *mem;
int i, x, y;
ushort p;
uchar clr[2*16], set[2*16];
/*
* Lock the display memory so we can update the
* cursor bitmap if necessary.
*/
lock(&et4000pagelock);
/*
* Disable the cursor.
* Set the display page (do we need to restore
* the current contents when done?) and the
* pointer to the two planes. What if this crosses
* into a new page?
*/
disable();
setet4000page(storage>>16);
mem = ((uchar*)vgascreen.base) + (storage & 0xFFFF);
/*
* 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 mode gives the following truth table:
* p1 p0 colour
* 0 0 Sprite Colour 0 (defined as 0x00)
* 0 1 Sprite Colour 1 (defined as 0xFF)
* 1 0 Transparent (allow CRTC pixel pass through)
* 1 1 Invert (allow CRTC pixel invert through)
* 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 = 0x0000;
for(i = 0; i < 8; i++){
if(p1 & (1<<(7-i)))
;
else if(p0 & (1<<(7-i)))
p |= 0x01<<(2*i);
else
p |= 0x02<<(2*i);
}
*mem++ = p & 0xFF;
*mem++ = (p>>8) & 0xFF;
}
else {
*mem++ = 0xAA;
*mem++ = 0xAA;
}
}
}
/*
* Set the cursor hotpoint and enable the cursor.
*/
hotpoint = c->offset;
outb(0x217A, 0xF7);
p = inb(0x217B)|0x80;
outb(0x217B, p);
unlock(&et4000pagelock);
}
static int
move(Point p)
{
int x, xo, y, yo;
if(canlock(&et4000pagelock) == 0)
return 1;
/*
* Mustn't position the cursor offscreen even partially,
* or it disappears. Therefore, if x or y is -ve, adjust the
* cursor presets instead.
*/
if((x = p.x+hotpoint.x) < 0){
xo = -x;
x = 0;
}
else
xo = 0;
if((y = p.y+hotpoint.y) < 0){
yo = -y;
y = 0;
}
else
yo = 0;
/*
* The cursor image is jerky if we don't do this.
* The cursor information is probably fetched from
* display memory during the horizontal blank active
* time and it doesn't like it if the coordinates
* are changed underneath.
*/
while((vgai(Status1) & 0x08) == 0)
;
outb(0x217A, 0xE2);
outb(0x217B, xo);
outb(0x217A, 0xE6);
outb(0x217B, yo);
outb(0x217A, 0xE1);
outb(0x217B, (x>>8) & 0xFF);
outb(0x217A, 0xE0);
outb(0x217B, x & 0xFF);
outb(0x217A, 0xE5);
outb(0x217B, (y>>8) & 0xFF);
outb(0x217A, 0xE4);
outb(0x217B, y & 0xFF);
unlock(&et4000pagelock);
return 0;
}
static Hwgc et4000hwgc = {
"et4000hwgc",
enable,
load,
move,
disable,
0,
};
static void
et4000page(int page)
{
if(hwgc == &et4000hwgc){
lock(&et4000pagelock);
setet4000page(page);
unlock(&et4000pagelock);
}
else
setet4000page(page);
}
static Vgac et4000 = {
"et4000",
et4000page,
0,
};
void
vgaet4000link(void)
{
addvgaclink(&et4000);
addhwgclink(&et4000hwgc);
}
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.