539 lines
10 KiB
C
539 lines
10 KiB
C
|
/*
|
||
|
|
* This file is part of the UCB release of Plan 9. It is subject to the license
|
||
|
|
* terms in the LICENSE file found in the top-level directory of this
|
||
|
|
* distribution and at http://akaros.cs.berkeley.edu/files/Plan9License. No
|
||
|
|
* part of the UCB release of Plan 9, including this file, may be copied,
|
||
|
|
* modified, propagated, or distributed except according to the terms contained
|
||
|
|
* in the LICENSE file.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/*
|
||
|
|
* VGA controller
|
||
|
|
*/
|
||
|
|
#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"
|
||
|
|
|
||
|
|
#define RMBUF ((void*)(KZERO + 0x9000)) // see 9/386/vgavesa.c
|
||
|
|
#define LORMBUF (0x9000)
|
||
|
|
|
||
|
|
enum {
|
||
|
|
Qdir,
|
||
|
|
Qvgabios,
|
||
|
|
Qvgactl,
|
||
|
|
Qvgaovl,
|
||
|
|
Qvgaovlctl,
|
||
|
|
};
|
||
|
|
|
||
|
|
static Dirtab vgadir[] = {
|
||
|
|
".", { Qdir, 0, QTDIR }, 0, 0550,
|
||
|
|
"vgabios", { Qvgabios, 0 }, 0x100000, 0440,
|
||
|
|
"vgactl", { Qvgactl, 0 }, 0, 0660,
|
||
|
|
"vgaovl", { Qvgaovl, 0 }, 0, 0660,
|
||
|
|
"vgaovlctl", { Qvgaovlctl, 0 }, 0, 0660,
|
||
|
|
};
|
||
|
|
|
||
|
|
enum {
|
||
|
|
CMactualsize,
|
||
|
|
CMblank,
|
||
|
|
CMblanktime,
|
||
|
|
CMdrawinit,
|
||
|
|
CMhwaccel,
|
||
|
|
CMhwblank,
|
||
|
|
CMhwgc,
|
||
|
|
CMlinear,
|
||
|
|
CMpalettedepth,
|
||
|
|
CMpanning,
|
||
|
|
CMsize,
|
||
|
|
CMtextmode,
|
||
|
|
CMtype,
|
||
|
|
CMunblank,
|
||
|
|
};
|
||
|
|
|
||
|
|
static Cmdtab vgactlmsg[] = {
|
||
|
|
CMactualsize, "actualsize", 2,
|
||
|
|
CMblank, "blank", 1,
|
||
|
|
CMblanktime, "blanktime", 2,
|
||
|
|
CMdrawinit, "drawinit", 1,
|
||
|
|
CMhwaccel, "hwaccel", 2,
|
||
|
|
CMhwblank, "hwblank", 2,
|
||
|
|
CMhwgc, "hwgc", 2,
|
||
|
|
CMlinear, "linear", 0,
|
||
|
|
CMpalettedepth, "palettedepth", 2,
|
||
|
|
CMpanning, "panning", 2,
|
||
|
|
CMsize, "size", 3,
|
||
|
|
CMtextmode, "textmode", 1,
|
||
|
|
CMtype, "type", 2,
|
||
|
|
CMunblank, "unblank", 1,
|
||
|
|
};
|
||
|
|
|
||
|
|
static long
|
||
|
|
rmemrw(int isr, void *a, long n, int64_t off)
|
||
|
|
{
|
||
|
|
if(off < 0 || n < 0)
|
||
|
|
error("bad offset/count");
|
||
|
|
if(isr){
|
||
|
|
if(off >= MB)
|
||
|
|
return 0;
|
||
|
|
if(off+n >= MB)
|
||
|
|
n = MB - off;
|
||
|
|
memmove(a, KADDR((uintptr_t)off), n);
|
||
|
|
}else{
|
||
|
|
/* realmode buf page ok, allow vga framebuf's access */
|
||
|
|
if(off >= MB)
|
||
|
|
error("Offset > MB");
|
||
|
|
if (off+n > MB)
|
||
|
|
error("off+n > MB");
|
||
|
|
if (off < LORMBUF)
|
||
|
|
error("off < LORMBUF");
|
||
|
|
if (off+n > LORMBUF+PGSZ)
|
||
|
|
error("off+n > LORMBUF+BY2PG");
|
||
|
|
if (off < 0xA0000)
|
||
|
|
error("off < 0xa0000");
|
||
|
|
if (off+n > 0xB0000+0x10000)
|
||
|
|
error("off+n > 0xb0000+0x10000");
|
||
|
|
memmove(KADDR((uintptr_t)off), a, n);
|
||
|
|
}
|
||
|
|
return n;
|
||
|
|
}
|
||
|
|
|
||
|
|
static long
|
||
|
|
rmemread(Chan*_, void *a, long n, int64_t off)
|
||
|
|
{
|
||
|
|
return rmemrw(1, a, n, off);
|
||
|
|
}
|
||
|
|
|
||
|
|
static long
|
||
|
|
rmemwrite(Chan*_, void *a, long n, int64_t off)
|
||
|
|
{
|
||
|
|
return rmemrw(0, a, n, off);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void
|
||
|
|
vgareset(void)
|
||
|
|
{
|
||
|
|
/* reserve the 'standard' vga registers */
|
||
|
|
if(ioalloc(0x2b0, 0x2df-0x2b0+1, 0, "vga") < 0)
|
||
|
|
panic("vga ports already allocated");
|
||
|
|
if(ioalloc(0x3c0, 0x3da-0x3c0+1, 0, "vga") < 0)
|
||
|
|
panic("vga ports already allocated");
|
||
|
|
addarchfile("realmodemem", 0660, rmemread, rmemwrite);
|
||
|
|
}
|
||
|
|
|
||
|
|
static Chan*
|
||
|
|
vgaattach(Chan *c, Chan *ac, char *spec, int flags)
|
||
|
|
{
|
||
|
|
if(*spec && strcmp(spec, "0"))
|
||
|
|
error(Eio);
|
||
|
|
return devattach('v', spec);
|
||
|
|
}
|
||
|
|
|
||
|
|
Walkqid*
|
||
|
|
vgawalk(Chan* c, Chan *nc, char** name, int nname)
|
||
|
|
{
|
||
|
|
return devwalk(c, nc, name, nname, vgadir, nelem(vgadir), devgen);
|
||
|
|
}
|
||
|
|
|
||
|
|
static long
|
||
|
|
vgastat(Chan* c, uint8_t* dp, long n)
|
||
|
|
{
|
||
|
|
return devstat(c, dp, n, vgadir, nelem(vgadir), devgen);
|
||
|
|
}
|
||
|
|
|
||
|
|
static Chan*
|
||
|
|
vgaopen(Chan* c, int omode)
|
||
|
|
{
|
||
|
|
VGAscr *scr;
|
||
|
|
static char *openctl = "openctl\n";
|
||
|
|
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
if ((uint32_t)c->qid.path == Qvgaovlctl) {
|
||
|
|
if (scr->dev && scr->dev->ovlctl)
|
||
|
|
scr->dev->ovlctl(scr, c, openctl, strlen(openctl));
|
||
|
|
else
|
||
|
|
error(Enonexist);
|
||
|
|
}
|
||
|
|
return devopen(c, omode, vgadir, nelem(vgadir), devgen);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void
|
||
|
|
vgaclose(Chan* c)
|
||
|
|
{
|
||
|
|
VGAscr *scr;
|
||
|
|
static char *closectl = "closectl\n";
|
||
|
|
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
if((uint32_t)c->qid.path == Qvgaovlctl)
|
||
|
|
if(scr->dev && scr->dev->ovlctl){
|
||
|
|
if(waserror()){
|
||
|
|
print("ovlctl error: %s\n", up->errstr);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
scr->dev->ovlctl(scr, c, closectl, strlen(closectl));
|
||
|
|
poperror();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static long
|
||
|
|
vgaread(Chan* c, void* a, long n, int64_t off)
|
||
|
|
{
|
||
|
|
int len;
|
||
|
|
char *p, *s;
|
||
|
|
VGAscr *scr;
|
||
|
|
uint32_t offset = off;
|
||
|
|
char chbuf[30];
|
||
|
|
|
||
|
|
switch((uint32_t)c->qid.path){
|
||
|
|
|
||
|
|
case Qdir:
|
||
|
|
return devdirread(c, a, n, vgadir, nelem(vgadir), devgen);
|
||
|
|
|
||
|
|
case Qvgabios:
|
||
|
|
if(offset >= 0x100000)
|
||
|
|
return 0;
|
||
|
|
if(offset+n >= 0x100000)
|
||
|
|
n = 0x100000 - offset;
|
||
|
|
memmove(a, (unsigned char*)KADDR(0)+offset, n);
|
||
|
|
return n;
|
||
|
|
|
||
|
|
case Qvgactl:
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
|
||
|
|
p = malloc(READSTR);
|
||
|
|
if(p == nil)
|
||
|
|
error(Enomem);
|
||
|
|
if(waserror()){
|
||
|
|
free(p);
|
||
|
|
nexterror();
|
||
|
|
}
|
||
|
|
|
||
|
|
len = 0;
|
||
|
|
|
||
|
|
if(scr->dev)
|
||
|
|
s = scr->dev->name;
|
||
|
|
else
|
||
|
|
s = "cga";
|
||
|
|
len += snprint(p+len, READSTR-len, "type %s\n", s);
|
||
|
|
|
||
|
|
if(scr->gscreen) {
|
||
|
|
len += snprint(p+len, READSTR-len, "size %dx%dx%d %s\n",
|
||
|
|
scr->gscreen->r.max.x, scr->gscreen->r.max.y,
|
||
|
|
scr->gscreen->depth, chantostr(chbuf, scr->gscreen->chan));
|
||
|
|
|
||
|
|
if(Dx(scr->gscreen->r) != Dx(physgscreenr)
|
||
|
|
|| Dy(scr->gscreen->r) != Dy(physgscreenr))
|
||
|
|
len += snprint(p+len, READSTR-len, "actualsize %dx%d\n",
|
||
|
|
physgscreenr.max.x, physgscreenr.max.y);
|
||
|
|
}
|
||
|
|
|
||
|
|
len += snprint(p+len, READSTR-len, "blank time %lud idle %d state %s\n",
|
||
|
|
blanktime, drawidletime(), scr->isblank ? "off" : "on");
|
||
|
|
len += snprint(p+len, READSTR-len, "hwaccel %s\n", hwaccel ? "on" : "off");
|
||
|
|
len += snprint(p+len, READSTR-len, "hwblank %s\n", hwblank ? "on" : "off");
|
||
|
|
len += snprint(p+len, READSTR-len, "panning %s\n", panning ? "on" : "off");
|
||
|
|
len += snprint(p+len, READSTR-len, "addr p 0x%lux v 0x%p size 0x%ux\n", scr->paddr, scr->vaddr, scr->apsize);
|
||
|
|
USED(len);
|
||
|
|
|
||
|
|
n = readstr(offset, a, n, p);
|
||
|
|
poperror();
|
||
|
|
free(p);
|
||
|
|
|
||
|
|
return n;
|
||
|
|
|
||
|
|
case Qvgaovl:
|
||
|
|
case Qvgaovlctl:
|
||
|
|
error(Ebadusefd);
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
error(Egreg);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void
|
||
|
|
vgactl(Cmdbuf *cb)
|
||
|
|
{
|
||
|
|
int align, i, size, x, y, z;
|
||
|
|
char *chanstr, *p;
|
||
|
|
uint32_t chan;
|
||
|
|
Cmdtab *ct;
|
||
|
|
VGAscr *scr;
|
||
|
|
extern VGAdev *vgadev[];
|
||
|
|
extern VGAcur *vgacur[];
|
||
|
|
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
ct = lookupcmd(cb, vgactlmsg, nelem(vgactlmsg));
|
||
|
|
switch(ct->index){
|
||
|
|
case CMhwgc:
|
||
|
|
if(strcmp(cb->f[1], "off") == 0){
|
||
|
|
lock(&cursor.l);
|
||
|
|
if(scr->cur){
|
||
|
|
if(scr->cur->disable)
|
||
|
|
scr->cur->disable(scr);
|
||
|
|
scr->cur = nil;
|
||
|
|
}
|
||
|
|
unlock(&cursor.l);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
if(strcmp(cb->f[1], "soft") == 0){
|
||
|
|
lock(&cursor.l);
|
||
|
|
swcursorinit();
|
||
|
|
if(scr->cur && scr->cur->disable)
|
||
|
|
scr->cur->disable(scr);
|
||
|
|
scr->cur = &swcursor;
|
||
|
|
if(scr->cur->enable)
|
||
|
|
scr->cur->enable(scr);
|
||
|
|
unlock(&cursor.l);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
for(i = 0; vgacur[i]; i++){
|
||
|
|
if(strcmp(cb->f[1], vgacur[i]->name))
|
||
|
|
continue;
|
||
|
|
lock(&cursor.l);
|
||
|
|
if(scr->cur && scr->cur->disable)
|
||
|
|
scr->cur->disable(scr);
|
||
|
|
scr->cur = vgacur[i];
|
||
|
|
if(scr->cur->enable)
|
||
|
|
scr->cur->enable(scr);
|
||
|
|
unlock(&cursor.l);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case CMtype:
|
||
|
|
for(i = 0; vgadev[i]; i++){
|
||
|
|
if(strcmp(cb->f[1], vgadev[i]->name))
|
||
|
|
continue;
|
||
|
|
if(scr->dev && scr->dev->disable)
|
||
|
|
scr->dev->disable(scr);
|
||
|
|
scr->dev = vgadev[i];
|
||
|
|
if(scr->dev->enable)
|
||
|
|
scr->dev->enable(scr);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case CMtextmode:
|
||
|
|
cgainit();
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMsize:
|
||
|
|
x = strtoul(cb->f[1], &p, 0);
|
||
|
|
if(x == 0 || x > 10240)
|
||
|
|
error(Ebadarg);
|
||
|
|
if(*p)
|
||
|
|
p++;
|
||
|
|
|
||
|
|
y = strtoul(p, &p, 0);
|
||
|
|
if(y == 0 || y > 10240)
|
||
|
|
error(Ebadarg);
|
||
|
|
if(*p)
|
||
|
|
p++;
|
||
|
|
|
||
|
|
z = strtoul(p, &p, 0);
|
||
|
|
|
||
|
|
chanstr = cb->f[2];
|
||
|
|
if((chan = strtochan(chanstr)) == 0)
|
||
|
|
error("bad channel");
|
||
|
|
|
||
|
|
if(chantodepth(chan) != z)
|
||
|
|
error("depth, channel do not match");
|
||
|
|
|
||
|
|
cursoroff(1);
|
||
|
|
deletescreenimage();
|
||
|
|
if(screensize(x, y, z, chan))
|
||
|
|
error(Egreg);
|
||
|
|
vgascreenwin(scr);
|
||
|
|
resetscreenimage();
|
||
|
|
cursoron(1);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMactualsize:
|
||
|
|
if(scr->gscreen == nil)
|
||
|
|
error("set the screen size first");
|
||
|
|
|
||
|
|
x = strtoul(cb->f[1], &p, 0);
|
||
|
|
if(x == 0 || x > 2048)
|
||
|
|
error(Ebadarg);
|
||
|
|
if(*p)
|
||
|
|
p++;
|
||
|
|
|
||
|
|
y = strtoul(p, nil, 0);
|
||
|
|
if(y == 0 || y > 2048)
|
||
|
|
error(Ebadarg);
|
||
|
|
|
||
|
|
if(x > scr->gscreen->r.max.x || y > scr->gscreen->r.max.y)
|
||
|
|
error("physical screen bigger than virtual");
|
||
|
|
|
||
|
|
physgscreenr = Rect(0,0,x,y);
|
||
|
|
scr->gscreen->clipr = physgscreenr;
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMpalettedepth:
|
||
|
|
x = strtoul(cb->f[1], &p, 0);
|
||
|
|
if(x != 8 && x != 6)
|
||
|
|
error(Ebadarg);
|
||
|
|
|
||
|
|
scr->palettedepth = x;
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMdrawinit:
|
||
|
|
if(scr->gscreen == nil)
|
||
|
|
error("drawinit: no gscreen");
|
||
|
|
if(scr->dev && scr->dev->drawinit)
|
||
|
|
scr->dev->drawinit(scr);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMlinear:
|
||
|
|
if(cb->nf!=2 && cb->nf!=3)
|
||
|
|
error(Ebadarg);
|
||
|
|
size = strtoul(cb->f[1], 0, 0);
|
||
|
|
if(cb->nf == 2)
|
||
|
|
align = 0;
|
||
|
|
else
|
||
|
|
align = strtoul(cb->f[2], 0, 0);
|
||
|
|
if(screenaperture(size, align) < 0)
|
||
|
|
error("not enough free address space");
|
||
|
|
return;
|
||
|
|
/*
|
||
|
|
case CMmemset:
|
||
|
|
memset((void*)strtoul(cb->f[1], 0, 0), atoi(cb->f[2]), atoi(cb->f[3]));
|
||
|
|
return;
|
||
|
|
*/
|
||
|
|
|
||
|
|
case CMblank:
|
||
|
|
drawblankscreen(1);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMunblank:
|
||
|
|
drawblankscreen(0);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMblanktime:
|
||
|
|
blanktime = strtoul(cb->f[1], 0, 0);
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMpanning:
|
||
|
|
if(strcmp(cb->f[1], "on") == 0){
|
||
|
|
if(scr == nil || scr->cur == nil)
|
||
|
|
error("set screen first");
|
||
|
|
if(!scr->cur->doespanning)
|
||
|
|
error("panning not supported");
|
||
|
|
scr->gscreen->clipr = scr->gscreen->r;
|
||
|
|
panning = 1;
|
||
|
|
}
|
||
|
|
else if(strcmp(cb->f[1], "off") == 0){
|
||
|
|
scr->gscreen->clipr = physgscreenr;
|
||
|
|
panning = 0;
|
||
|
|
}else
|
||
|
|
break;
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMhwaccel:
|
||
|
|
if(strcmp(cb->f[1], "on") == 0)
|
||
|
|
hwaccel = 1;
|
||
|
|
else if(strcmp(cb->f[1], "off") == 0)
|
||
|
|
hwaccel = 0;
|
||
|
|
else
|
||
|
|
break;
|
||
|
|
return;
|
||
|
|
|
||
|
|
case CMhwblank:
|
||
|
|
if(strcmp(cb->f[1], "on") == 0)
|
||
|
|
hwblank = 1;
|
||
|
|
else if(strcmp(cb->f[1], "off") == 0)
|
||
|
|
hwblank = 0;
|
||
|
|
else
|
||
|
|
break;
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
cmderror(cb, "bad VGA control message");
|
||
|
|
}
|
||
|
|
|
||
|
|
char Enooverlay[] = "No overlay support";
|
||
|
|
|
||
|
|
static long
|
||
|
|
vgawrite(Chan* c, void* a, long n, int64_t off)
|
||
|
|
{
|
||
|
|
uint32_t offset = off;
|
||
|
|
Cmdbuf *cb;
|
||
|
|
VGAscr *scr;
|
||
|
|
|
||
|
|
switch((uint32_t)c->qid.path){
|
||
|
|
|
||
|
|
case Qdir:
|
||
|
|
error(Eperm);
|
||
|
|
|
||
|
|
case Qvgactl:
|
||
|
|
if(offset || n >= READSTR)
|
||
|
|
error(Ebadarg);
|
||
|
|
cb = parsecmd(a, n);
|
||
|
|
if(waserror()){
|
||
|
|
free(cb);
|
||
|
|
nexterror();
|
||
|
|
}
|
||
|
|
vgactl(cb);
|
||
|
|
poperror();
|
||
|
|
free(cb);
|
||
|
|
return n;
|
||
|
|
|
||
|
|
case Qvgaovl:
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
if (scr->dev == nil || scr->dev->ovlwrite == nil) {
|
||
|
|
error(Enooverlay);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return scr->dev->ovlwrite(scr, a, n, off);
|
||
|
|
|
||
|
|
case Qvgaovlctl:
|
||
|
|
scr = &vgascreen[0];
|
||
|
|
if (scr->dev == nil || scr->dev->ovlctl == nil) {
|
||
|
|
error(Enooverlay);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
scr->dev->ovlctl(scr, c, a, n);
|
||
|
|
return n;
|
||
|
|
|
||
|
|
default:
|
||
|
|
error(Egreg);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
Dev vgadevtab = {
|
||
|
|
'v',
|
||
|
|
"vga",
|
||
|
|
|
||
|
|
vgareset,
|
||
|
|
devinit,
|
||
|
|
devshutdown,
|
||
|
|
vgaattach,
|
||
|
|
vgawalk,
|
||
|
|
vgastat,
|
||
|
|
vgaopen,
|
||
|
|
devcreate,
|
||
|
|
vgaclose,
|
||
|
|
vgaread,
|
||
|
|
devbread,
|
||
|
|
vgawrite,
|
||
|
|
devbwrite,
|
||
|
|
devremove,
|
||
|
|
devwstat,
|
||
|
|
};
|