123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538 |
- /*
- * 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"
- 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 int32_t
- rmemread(Chan*_, void *a, int32_t n, int64_t off)
- {
- return rmemrw(1, a, n, off);
- }
- static int32_t
- rmemwrite(Chan*_, void *a, int32_t 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(char* spec)
- {
- 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 int
- vgastat(Chan* c, unsigned char* dp, int 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)
- {
- Proc *up = externup();
- 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 int32_t
- vgaread(Chan* c, void* a, int32_t n, int64_t off)
- {
- Proc *up = externup();
- 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 %lu 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%lx v 0x%p size 0x%x\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 int32_t
- vgawrite(Chan* c, void* a, int32_t n, int64_t off)
- {
- Proc *up = externup();
- 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 = {
- .dc = 'v',
- .name = "vga",
- .reset = vgareset,
- .init = devinit,
- .shutdown = devshutdown,
- .attach = vgaattach,
- .walk = vgawalk,
- .stat = vgastat,
- .open = vgaopen,
- .create = devcreate,
- .close = vgaclose,
- .read = vgaread,
- .bread = devbread,
- .write = vgawrite,
- .bwrite = devbwrite,
- .remove = devremove,
- .wstat = devwstat,
- };
|