NetBSD/sys/dev/isa/ega.c

916 lines
22 KiB
C
Raw Normal View History

/* $NetBSD: ega.c,v 1.5 2000/06/26 04:56:20 simonb Exp $ */
/*
* Copyright (c) 1999
* Matthias Drochner. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed for the NetBSD Project
* by Matthias Drochner.
* 4. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <machine/bus.h>
#include <dev/isa/isavar.h>
#include <dev/ic/mc6845reg.h>
#include <dev/ic/pcdisplayvar.h>
#include <dev/ic/vgareg.h>
#include <dev/ic/vgavar.h>
#include <dev/isa/egavar.h>
#include <dev/ic/pcdisplay.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
static struct egafont {
char name[16];
int height;
int encoding;
int slot;
} ega_builtinfont = {
"builtin",
14,
WSDISPLAY_FONTENC_IBM,
0
};
struct egascreen {
struct pcdisplayscreen pcs;
LIST_ENTRY(egascreen) next;
struct ega_config *cfg;
struct egafont *fontset1, *fontset2;
int mindispoffset, maxdispoffset;
};
struct ega_config {
struct vga_handle hdl;
int nscreens;
LIST_HEAD(, egascreen) screens;
struct egascreen *active; /* current display */
const struct wsscreen_descr *currenttype;
int currentfontset1, currentfontset2;
struct egafont *vc_fonts[4];
struct egascreen *wantedscreen;
void (*switchcb) __P((void *, int, int));
void *switchcbarg;
struct callout switch_callout;
};
struct ega_softc {
struct device sc_dev;
struct ega_config *sc_dc;
int nscreens;
};
static int egaconsole, ega_console_attached;
static struct egascreen ega_console_screen;
static struct ega_config ega_console_dc;
int ega_match __P((struct device *, struct cfdata *, void *));
void ega_attach __P((struct device *, struct device *, void *));
static int ega_is_console __P((bus_space_tag_t));
static int ega_probe_col __P((bus_space_tag_t, bus_space_tag_t));
static int ega_probe_mono __P((bus_space_tag_t, bus_space_tag_t));
int ega_selectfont __P((struct ega_config *, struct egascreen *,
char *, char *));
void ega_init_screen __P((struct ega_config *, struct egascreen *,
const struct wsscreen_descr *,
int, long *));
static void ega_init __P((struct ega_config *,
bus_space_tag_t, bus_space_tag_t, int));
static void ega_setfont __P((struct ega_config *, struct egascreen *));
static int ega_alloc_attr __P((void *, int, int, int, long *));
void ega_copyrows __P((void *, int, int, int));
struct cfattach ega_ca = {
sizeof(struct ega_softc), ega_match, ega_attach,
};
const struct wsdisplay_emulops ega_emulops = {
pcdisplay_cursor,
pcdisplay_mapchar,
pcdisplay_putchar,
pcdisplay_copycols,
pcdisplay_erasecols,
ega_copyrows,
pcdisplay_eraserows,
ega_alloc_attr
};
/*
* translate WS(=ANSI) color codes to standard pc ones
*/
static unsigned char fgansitopc[] = {
FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE,
FG_MAGENTA, FG_CYAN, FG_LIGHTGREY
}, bgansitopc[] = {
BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE,
BG_MAGENTA, BG_CYAN, BG_LIGHTGREY
};
const struct wsscreen_descr ega_stdscreen = {
"80x25", 80, 25,
&ega_emulops,
8, 14,
WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
}, ega_stdscreen_mono = {
"80x25", 80, 25,
&ega_emulops,
8, 14,
WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
}, ega_stdscreen_bf = {
"80x25bf", 80, 25,
&ega_emulops,
8, 14,
WSSCREEN_WSCOLORS | WSSCREEN_BLINK
}, ega_35lscreen = {
"80x35", 80, 35,
&ega_emulops,
8, 10,
WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
}, ega_35lscreen_mono = {
"80x35", 80, 35,
&ega_emulops,
8, 10,
WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
}, ega_35lscreen_bf = {
"80x35bf", 80, 35,
&ega_emulops,
8, 10,
WSSCREEN_WSCOLORS | WSSCREEN_BLINK
}, ega_43lscreen = {
"80x43", 80, 43,
&ega_emulops,
8, 8,
WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
}, ega_43lscreen_mono = {
"80x43", 80, 43,
&ega_emulops,
8, 8,
WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
}, ega_43lscreen_bf = {
"80x43bf", 80, 43,
&ega_emulops,
8, 8,
WSSCREEN_WSCOLORS | WSSCREEN_BLINK
};
#define VGA_SCREEN_CANTWOFONTS(type) (!((type)->capabilities & WSSCREEN_HILIT))
const struct wsscreen_descr *_ega_scrlist[] = {
&ega_stdscreen,
&ega_stdscreen_bf,
&ega_35lscreen,
&ega_35lscreen_bf,
&ega_43lscreen,
&ega_43lscreen_bf,
}, *_ega_scrlist_mono[] = {
&ega_stdscreen_mono,
&ega_35lscreen_mono,
&ega_43lscreen_mono,
};
const struct wsscreen_list ega_screenlist = {
sizeof(_ega_scrlist) / sizeof(struct wsscreen_descr *),
_ega_scrlist
}, ega_screenlist_mono = {
sizeof(_ega_scrlist_mono) / sizeof(struct wsscreen_descr *),
_ega_scrlist_mono
};
static int ega_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
static paddr_t ega_mmap __P((void *, off_t, int));
static int ega_alloc_screen __P((void *, const struct wsscreen_descr *,
void **, int *, int *, long *));
static void ega_free_screen __P((void *, void *));
static int ega_show_screen __P((void *, void *, int,
void (*) (void *, int, int), void *));
static int ega_load_font __P((void *, void *, struct wsdisplay_font *));
void ega_doswitch __P((struct ega_config *));
const struct wsdisplay_accessops ega_accessops = {
ega_ioctl,
ega_mmap,
ega_alloc_screen,
ega_free_screen,
ega_show_screen,
ega_load_font
};
static int
ega_probe_col(iot, memt)
bus_space_tag_t iot, memt;
{
bus_space_handle_t memh, ioh_6845;
u_int16_t oldval, val;
if (bus_space_map(memt, 0xb8000, 0x8000, 0, &memh))
return (0);
oldval = bus_space_read_2(memt, memh, 0);
bus_space_write_2(memt, memh, 0, 0xa55a);
val = bus_space_read_2(memt, memh, 0);
bus_space_write_2(memt, memh, 0, oldval);
bus_space_unmap(memt, memh, 0x8000);
if (val != 0xa55a)
return (0);
if (bus_space_map(iot, 0x3d0, 0x10, 0, &ioh_6845))
return (0);
bus_space_unmap(iot, ioh_6845, 0x10);
return (1);
}
static int
ega_probe_mono(iot, memt)
bus_space_tag_t iot, memt;
{
bus_space_handle_t memh, ioh_6845;
u_int16_t oldval, val;
if (bus_space_map(memt, 0xb0000, 0x8000, 0, &memh))
return (0);
oldval = bus_space_read_2(memt, memh, 0);
bus_space_write_2(memt, memh, 0, 0xa55a);
val = bus_space_read_2(memt, memh, 0);
bus_space_write_2(memt, memh, 0, oldval);
bus_space_unmap(memt, memh, 0x8000);
if (val != 0xa55a)
return (0);
if (bus_space_map(iot, 0x3b0, 0x10, 0, &ioh_6845))
return (0);
bus_space_unmap(iot, ioh_6845, 0x10);
return (1);
}
/*
* We want at least ASCII 32..127 be present in the
* first font slot.
*/
#define vga_valid_primary_font(f) \
(f->encoding == WSDISPLAY_FONTENC_IBM || \
f->encoding == WSDISPLAY_FONTENC_ISO)
int
ega_selectfont(vc, scr, name1, name2)
struct ega_config *vc;
struct egascreen *scr;
char *name1, *name2; /* NULL: take first found */
{
const struct wsscreen_descr *type = scr->pcs.type;
struct egafont *f1, *f2;
int i;
f1 = f2 = 0;
for (i = 0; i < 4; i++) {
struct egafont *f = vc->vc_fonts[i];
if (!f || f->height != type->fontheight)
continue;
if (!f1 &&
vga_valid_primary_font(f) &&
(!name1 || !strcmp(name1, f->name))) {
f1 = f;
continue;
}
if (!f2 &&
VGA_SCREEN_CANTWOFONTS(type) &&
(!name2 || !strcmp(name2, f->name))) {
f2 = f;
continue;
}
}
/*
* The request fails if no primary font was found,
* or if a second font was requested but not found.
*/
if (f1 && (!name2 || f2)) {
#ifdef EGAFONTDEBUG
if (scr != &ega_console_screen || ega_console_attached) {
printf("ega (%s): font1=%s (slot %d)", type->name,
f1->name, f1->slot);
if (f2)
printf(", font2=%s (slot %d)",
f2->name, f2->slot);
printf("\n");
}
#endif
scr->fontset1 = f1;
scr->fontset2 = f2;
return (0);
}
return (ENXIO);
}
void
ega_init_screen(vc, scr, type, existing, attrp)
struct ega_config *vc;
struct egascreen *scr;
const struct wsscreen_descr *type;
int existing;
long *attrp;
{
int cpos;
int res;
scr->cfg = vc;
scr->pcs.hdl = (struct pcdisplay_handle *)&vc->hdl;
scr->pcs.type = type;
scr->pcs.active = 0;
scr->mindispoffset = 0;
scr->maxdispoffset = 0x8000 - type->nrows * type->ncols * 2;
if (existing) {
cpos = vga_6845_read(&vc->hdl, cursorh) << 8;
cpos |= vga_6845_read(&vc->hdl, cursorl);
/* make sure we have a valid cursor position */
if (cpos < 0 || cpos >= type->nrows * type->ncols)
cpos = 0;
scr->pcs.dispoffset = vga_6845_read(&vc->hdl, startadrh) << 9;
scr->pcs.dispoffset |= vga_6845_read(&vc->hdl, startadrl) << 1;
/* make sure we have a valid memory offset */
if (scr->pcs.dispoffset < scr->mindispoffset ||
scr->pcs.dispoffset > scr->maxdispoffset)
scr->pcs.dispoffset = scr->mindispoffset;
} else {
cpos = 0;
scr->pcs.dispoffset = scr->mindispoffset;
}
scr->pcs.vc_crow = cpos / type->ncols;
scr->pcs.vc_ccol = cpos % type->ncols;
pcdisplay_cursor_init(&scr->pcs, existing);
res = ega_alloc_attr(scr, 0, 0, 0, attrp);
#ifdef DIAGNOSTIC
if (res)
panic("ega_init_screen: attribute botch");
#endif
scr->pcs.mem = NULL;
scr->fontset1 = scr->fontset2 = 0;
if (ega_selectfont(vc, scr, 0, 0)) {
if (scr == &ega_console_screen)
panic("ega_init_screen: no font");
else
printf("ega_init_screen: no font\n");
}
vc->nscreens++;
LIST_INSERT_HEAD(&vc->screens, scr, next);
}
static void
ega_init(vc, iot, memt, mono)
struct ega_config *vc;
bus_space_tag_t iot, memt;
int mono;
{
struct vga_handle *vh = &vc->hdl;
int i;
vh->vh_iot = iot;
vh->vh_memt = memt;
vh->vh_mono = mono;
if (bus_space_map(vh->vh_iot, 0x3c0, 0x10, 0, &vh->vh_ioh_vga))
panic("ega_common_setup: couldn't map ega io");
if (bus_space_map(vh->vh_iot, (vh->vh_mono ? 0x3b0 : 0x3d0), 0x10, 0,
&vh->vh_ioh_6845))
panic("ega_common_setup: couldn't map 6845 io");
if (bus_space_map(vh->vh_memt, 0xa0000, 0x20000, 0, &vh->vh_allmemh))
panic("ega_common_setup: couldn't map memory");
if (bus_space_subregion(vh->vh_memt, vh->vh_allmemh,
(vh->vh_mono ? 0x10000 : 0x18000), 0x8000,
&vh->vh_memh))
panic("ega_common_setup: mem subrange failed");
vc->nscreens = 0;
LIST_INIT(&vc->screens);
vc->active = NULL;
vc->currenttype = vh->vh_mono ? &ega_stdscreen_mono : &ega_stdscreen;
callout_init(&vc->switch_callout);
vc->vc_fonts[0] = &ega_builtinfont;
for (i = 1; i < 4; i++)
vc->vc_fonts[i] = 0;
vc->currentfontset1 = vc->currentfontset2 = 0;
}
int
ega_match(parent, match, aux)
struct device *parent;
struct cfdata *match;
void *aux;
{
struct isa_attach_args *ia = aux;
int mono;
/* If values are hardwired to something that they can't be, punt. */
if ((ia->ia_iobase != IOBASEUNK &&
ia->ia_iobase != 0x3d0 &&
ia->ia_iobase != 0x3b0) ||
/* ia->ia_iosize != 0 || XXX isa.c */
(ia->ia_maddr != MADDRUNK &&
ia->ia_maddr != 0xb8000 &&
ia->ia_maddr != 0xb0000) ||
(ia->ia_msize != 0 && ia->ia_msize != 0x8000) ||
ia->ia_irq != IRQUNK || ia->ia_drq != DRQUNK)
return (0);
if (ega_is_console(ia->ia_iot))
mono = ega_console_dc.hdl.vh_mono;
else if (ia->ia_iobase != 0x3b0 && ia->ia_maddr != 0xb0000 &&
ega_probe_col(ia->ia_iot, ia->ia_memt))
mono = 0;
else if (ia->ia_iobase != 0x3d0 && ia->ia_maddr != 0xb8000 &&
ega_probe_mono(ia->ia_iot, ia->ia_memt))
mono = 1;
else
return (0);
ia->ia_iobase = mono ? 0x3b0 : 0x3d0;
ia->ia_iosize = 0x10;
ia->ia_maddr = mono ? 0xb0000 : 0xb8000;
ia->ia_msize = 0x8000;
return (2); /* beat pcdisplay */
}
void
ega_attach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct isa_attach_args *ia = aux;
struct ega_softc *sc = (struct ega_softc *)self;
int console;
struct ega_config *dc;
struct wsemuldisplaydev_attach_args aa;
printf("\n");
console = ega_is_console(ia->ia_iot);
if (console) {
dc = &ega_console_dc;
sc->nscreens = 1;
ega_console_attached = 1;
} else {
dc = malloc(sizeof(struct ega_config),
M_DEVBUF, M_WAITOK);
if (ia->ia_iobase != 0x3b0 && ia->ia_maddr != 0xb0000 &&
ega_probe_col(ia->ia_iot, ia->ia_memt))
ega_init(dc, ia->ia_iot, ia->ia_memt, 0);
else if (ia->ia_iobase != 0x3d0 && ia->ia_maddr != 0xb8000 &&
ega_probe_mono(ia->ia_iot, ia->ia_memt))
ega_init(dc, ia->ia_iot, ia->ia_memt, 1);
else
panic("ega_attach: display disappeared");
}
sc->sc_dc = dc;
aa.console = console;
aa.scrdata = &ega_screenlist;
aa.accessops = &ega_accessops;
aa.accesscookie = dc;
config_found(self, &aa, wsemuldisplaydevprint);
}
int
ega_cnattach(iot, memt)
bus_space_tag_t iot, memt;
{
int mono;
long defattr;
const struct wsscreen_descr *scr;
if (ega_probe_col(iot, memt))
mono = 0;
else if (ega_probe_mono(iot, memt))
mono = 1;
else
return (ENXIO);
ega_init(&ega_console_dc, iot, memt, mono);
scr = ega_console_dc.currenttype;
ega_init_screen(&ega_console_dc, &ega_console_screen, scr, 1, &defattr);
ega_console_screen.pcs.active = 1;
ega_console_dc.active = &ega_console_screen;
wsdisplay_cnattach(scr, &ega_console_screen,
ega_console_screen.pcs.vc_ccol,
ega_console_screen.pcs.vc_crow,
defattr);
egaconsole = 1;
return (0);
}
static int
ega_is_console(iot)
bus_space_tag_t iot;
{
if (egaconsole &&
!ega_console_attached &&
iot == ega_console_dc.hdl.vh_iot)
return (1);
return (0);
}
static int
ega_ioctl(v, cmd, data, flag, p)
void *v;
u_long cmd;
caddr_t data;
int flag;
struct proc *p;
{
/*
* XXX "do something!"
*/
return (-1);
}
static paddr_t
ega_mmap(v, offset, prot)
void *v;
off_t offset;
int prot;
{
return (-1);
}
static int
ega_alloc_screen(v, type, cookiep, curxp, curyp, defattrp)
void *v;
const struct wsscreen_descr *type;
void **cookiep;
int *curxp, *curyp;
long *defattrp;
{
struct ega_config *vc = v;
struct egascreen *scr;
if (vc->nscreens == 1) {
/*
* When allocating the second screen, get backing store
* for the first one too.
* XXX We could be more clever and use video RAM.
*/
vc->screens.lh_first->pcs.mem =
malloc(type->ncols * type->nrows * 2, M_DEVBUF, M_WAITOK);
}
scr = malloc(sizeof(struct egascreen), M_DEVBUF, M_WAITOK);
ega_init_screen(vc, scr, type, vc->nscreens == 0, defattrp);
if (vc->nscreens == 1) {
scr->pcs.active = 1;
vc->active = scr;
vc->currenttype = type;
} else {
scr->pcs.mem = malloc(type->ncols * type->nrows * 2,
M_DEVBUF, M_WAITOK);
pcdisplay_eraserows(&scr->pcs, 0, type->nrows, *defattrp);
}
*cookiep = scr;
*curxp = scr->pcs.vc_ccol;
*curyp = scr->pcs.vc_crow;
return (0);
}
static void
ega_free_screen(v, cookie)
void *v;
void *cookie;
{
struct egascreen *vs = cookie;
struct ega_config *vc = vs->cfg;
LIST_REMOVE(vs, next);
if (vs != &ega_console_screen)
free(vs, M_DEVBUF);
else
panic("ega_free_screen: console");
if (vc->active == vs)
vc->active = 0;
}
static void
ega_setfont(vc, scr)
struct ega_config *vc;
struct egascreen *scr;
{
int fontslot1, fontslot2;
fontslot1 = (scr->fontset1 ? scr->fontset1->slot : 0);
fontslot2 = (scr->fontset2 ? scr->fontset2->slot : fontslot1);
if (vc->currentfontset1 != fontslot1 ||
vc->currentfontset2 != fontslot2) {
vga_setfontset(&vc->hdl, 2 * fontslot1, 2 * fontslot2);
vc->currentfontset1 = fontslot1;
vc->currentfontset2 = fontslot2;
}
}
static int
ega_show_screen(v, cookie, waitok, cb, cbarg)
void *v;
void *cookie;
int waitok;
void (*cb) __P((void *, int, int));
void *cbarg;
{
struct egascreen *scr = cookie, *oldscr;
struct ega_config *vc = scr->cfg;
oldscr = vc->active; /* can be NULL! */
if (scr == oldscr) {
return (0);
}
vc->wantedscreen = cookie;
vc->switchcb = cb;
vc->switchcbarg = cbarg;
if (cb) {
callout_reset(&vc->switch_callout, 0,
(void(*)(void *))ega_doswitch);
return (EAGAIN);
}
ega_doswitch(vc);
return (0);
}
void
ega_doswitch(vc)
struct ega_config *vc;
{
struct egascreen *scr, *oldscr;
struct vga_handle *vh = &vc->hdl;
const struct wsscreen_descr *type;
scr = vc->wantedscreen;
if (!scr) {
printf("ega_doswitch: disappeared\n");
(*vc->switchcb)(vc->switchcbarg, EIO, 0);
return;
}
type = scr->pcs.type;
oldscr = vc->active; /* can be NULL! */
#ifdef DIAGNOSTIC
if (oldscr) {
if (!oldscr->pcs.active)
panic("ega_show_screen: not active");
if (oldscr->pcs.type != vc->currenttype)
panic("ega_show_screen: bad type");
}
#endif
if (scr == oldscr) {
return;
}
#ifdef DIAGNOSTIC
if (scr->pcs.active)
panic("ega_show_screen: active");
#endif
if (oldscr) {
const struct wsscreen_descr *oldtype = oldscr->pcs.type;
oldscr->pcs.active = 0;
bus_space_read_region_2(vh->vh_memt, vh->vh_memh,
oldscr->pcs.dispoffset, oldscr->pcs.mem,
oldtype->ncols * oldtype->nrows);
}
if (vc->currenttype != type) {
vga_setscreentype(vh, type);
vc->currenttype = type;
}
ega_setfont(vc, scr);
/* XXX swich colours! */
scr->pcs.dispoffset = scr->mindispoffset;
if (!oldscr || (scr->pcs.dispoffset != oldscr->pcs.dispoffset)) {
vga_6845_write(vh, startadrh, scr->pcs.dispoffset >> 9);
vga_6845_write(vh, startadrl, scr->pcs.dispoffset >> 1);
}
bus_space_write_region_2(vh->vh_memt, vh->vh_memh,
scr->pcs.dispoffset, scr->pcs.mem,
type->ncols * type->nrows);
scr->pcs.active = 1;
vc->active = scr;
pcdisplay_cursor(&scr->pcs, scr->pcs.cursoron,
scr->pcs.vc_crow, scr->pcs.vc_ccol);
vc->wantedscreen = 0;
if (vc->switchcb)
(*vc->switchcb)(vc->switchcbarg, 0, 0);
}
static int
ega_load_font(v, cookie, data)
void *v;
void *cookie;
struct wsdisplay_font *data;
{
struct ega_config *vc = v;
struct egascreen *scr = cookie;
char *name2;
int res, slot;
struct egafont *f;
if (scr) {
name2 = strchr(data->name, ',');
if (name2)
*name2++ = '\0';
res = ega_selectfont(vc, scr, data->name, name2);
if (!res)
ega_setfont(vc, scr);
return (res);
}
if (data->fontwidth != 8 || data->stride != 1)
return (EINVAL); /* XXX 1 byte per line */
if (data->firstchar != 0 || data->numchars != 256)
return (EINVAL);
#ifndef WSCONS_SUPPORT_PCVTFONTS
if (data->encoding == WSDISPLAY_FONTENC_PCVT) {
printf("vga: pcvt font support not built in, see vga(4)\n");
return (EINVAL);
}
#endif
for (slot = 0; slot < 4; slot++)
if (!vc->vc_fonts[slot])
break;
if (slot == 4)
return (ENOSPC);
f = malloc(sizeof(struct egafont), M_DEVBUF, M_WAITOK);
strncpy(f->name, data->name, sizeof(f->name));
f->height = data->fontheight;
f->encoding = data->encoding;
#ifdef notyet
f->firstchar = data->firstchar;
f->numchars = data->numchars;
#endif
#ifdef EGAFONTDEBUG
printf("ega: load %s (8x%d, enc %d) font to slot %d\n", f->name,
f->height, f->encoding, slot);
#endif
vga_loadchars(&vc->hdl, 2 * slot, 0, 256, f->height, data->data);
f->slot = slot;
vc->vc_fonts[slot] = f;
return (0);
}
static int
ega_alloc_attr(id, fg, bg, flags, attrp)
void *id;
int fg, bg;
int flags;
long *attrp;
{
struct egascreen *scr = id;
struct ega_config *vc = scr->cfg;
if (vc->hdl.vh_mono) {
if (flags & WSATTR_WSCOLORS)
return (EINVAL);
if (flags & WSATTR_REVERSE)
*attrp = 0x70;
else
*attrp = 0x07;
if (flags & WSATTR_UNDERLINE)
*attrp |= FG_UNDERLINE;
if (flags & WSATTR_HILIT)
*attrp |= FG_INTENSE;
} else {
if (flags & (WSATTR_UNDERLINE | WSATTR_REVERSE))
return (EINVAL);
if (flags & WSATTR_WSCOLORS)
*attrp = fgansitopc[fg] | bgansitopc[bg];
else
*attrp = 7;
if (flags & WSATTR_HILIT)
*attrp += 8;
}
if (flags & WSATTR_BLINK)
*attrp |= FG_BLINK;
return (0);
}
void
ega_copyrows(id, srcrow, dstrow, nrows)
void *id;
int srcrow, dstrow, nrows;
{
struct egascreen *scr = id;
bus_space_tag_t memt = scr->pcs.hdl->ph_memt;
bus_space_handle_t memh = scr->pcs.hdl->ph_memh;
int ncols = scr->pcs.type->ncols;
bus_size_t srcoff, dstoff;
srcoff = srcrow * ncols + 0;
dstoff = dstrow * ncols + 0;
if (scr->pcs.active) {
if (dstrow == 0 && (srcrow + nrows == scr->pcs.type->nrows)) {
#ifdef PCDISPLAY_SOFTCURSOR
int cursoron = scr->pcs.cursoron;
if (cursoron)
pcdisplay_cursor(&scr->pcs, 0,
scr->pcs.vc_crow, scr->pcs.vc_ccol);
#endif
/* scroll up whole screen */
if ((scr->pcs.dispoffset + srcrow * ncols * 2)
<= scr->maxdispoffset) {
scr->pcs.dispoffset += srcrow * ncols * 2;
} else {
bus_space_copy_region_2(memt, memh,
scr->pcs.dispoffset + srcoff * 2,
memh, scr->mindispoffset,
nrows * ncols);
scr->pcs.dispoffset = scr->mindispoffset;
}
vga_6845_write(&scr->cfg->hdl, startadrh,
scr->pcs.dispoffset >> 9);
vga_6845_write(&scr->cfg->hdl, startadrl,
scr->pcs.dispoffset >> 1);
#ifdef PCDISPLAY_SOFTCURSOR
if (cursoron)
pcdisplay_cursor(&scr->pcs, 1,
scr->pcs.vc_crow, scr->pcs.vc_ccol);
#endif
} else {
bus_space_copy_region_2(memt, memh,
scr->pcs.dispoffset + srcoff * 2,
memh, scr->pcs.dispoffset + dstoff * 2,
nrows * ncols);
}
} else
bcopy(&scr->pcs.mem[srcoff], &scr->pcs.mem[dstoff],
nrows * ncols * 2);
}