/* $NetBSD: ega.c,v 1.4.4.1 2000/06/30 16:27:47 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); }