Annotation of sys/dev/isa/ega.c, Revision 1.1.1.1
1.1 nbrk 1: /* $OpenBSD: ega.c,v 1.12 2007/02/06 22:03:24 miod Exp $ */
2: /* $NetBSD: ega.c,v 1.4.4.1 2000/06/30 16:27:47 simonb Exp $ */
3:
4: /*
5: * Copyright (c) 1999
6: * Matthias Drochner. All rights reserved.
7: *
8: * Redistribution and use in source and binary forms, with or without
9: * modification, are permitted provided that the following conditions
10: * are met:
11: * 1. Redistributions of source code must retain the above copyright
12: * notice, this list of conditions and the following disclaimer.
13: * 2. Redistributions in binary form must reproduce the above copyright
14: * notice, this list of conditions and the following disclaimer in the
15: * documentation and/or other materials provided with the distribution.
16: *
17: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18: * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19: * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20: * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21: * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22: * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23: * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24: * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25: * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26: * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27: *
28: */
29:
30: #include <sys/param.h>
31: #include <sys/systm.h>
32: #include <sys/kernel.h>
33: #include <sys/device.h>
34: #include <sys/malloc.h>
35: #include <sys/timeout.h>
36: #include <machine/bus.h>
37:
38: #include <dev/isa/isavar.h>
39:
40: #include <dev/ic/mc6845reg.h>
41: #include <dev/ic/pcdisplayvar.h>
42: #include <dev/ic/vgareg.h>
43: #include <dev/ic/vgavar.h>
44: #include <dev/isa/egavar.h>
45:
46: #include <dev/ic/pcdisplay.h>
47:
48: #include <dev/wscons/wsconsio.h>
49: #include <dev/wscons/wsdisplayvar.h>
50:
51: static struct egafont {
52: char name[WSFONT_NAME_SIZE];
53: int height;
54: int encoding;
55: int slot;
56: } ega_builtinfont = {
57: "builtin",
58: 14,
59: WSDISPLAY_FONTENC_IBM,
60: 0
61: };
62:
63: struct egascreen {
64: struct pcdisplayscreen pcs;
65: LIST_ENTRY(egascreen) next;
66: struct ega_config *cfg;
67: struct egafont *fontset1, *fontset2;
68:
69: int mindispoffset, maxdispoffset;
70: };
71:
72: struct ega_config {
73: struct vga_handle hdl;
74:
75: int nscreens;
76: LIST_HEAD(, egascreen) screens;
77: struct egascreen *active; /* current display */
78: const struct wsscreen_descr *currenttype;
79: int currentfontset1, currentfontset2;
80:
81: struct egafont *vc_fonts[4];
82:
83: struct egascreen *wantedscreen;
84: void (*switchcb)(void *, int, int);
85: void *switchcbarg;
86:
87: struct timeout switch_timeout;
88: };
89:
90: struct ega_softc {
91: struct device sc_dev;
92: struct ega_config *sc_dc;
93: int nscreens;
94: };
95:
96: static int egaconsole, ega_console_attached;
97: static struct egascreen ega_console_screen;
98: static struct ega_config ega_console_dc;
99:
100: int ega_match(struct device *, void *, void *);
101: void ega_attach(struct device *, struct device *, void *);
102:
103: static int ega_is_console(bus_space_tag_t);
104: static int ega_probe_col(bus_space_tag_t, bus_space_tag_t);
105: static int ega_probe_mono(bus_space_tag_t, bus_space_tag_t);
106: int ega_selectfont(struct ega_config *, struct egascreen *,
107: char *, char *);
108: void ega_init_screen(struct ega_config *, struct egascreen *,
109: const struct wsscreen_descr *,
110: int, long *);
111: static void ega_init(struct ega_config *,
112: bus_space_tag_t, bus_space_tag_t, int);
113: static void ega_setfont(struct ega_config *, struct egascreen *);
114: static int ega_alloc_attr(void *, int, int, int, long *);
115: static void ega_unpack_attr(void *, long, int *, int *, int *);
116: void ega_copyrows(void *, int, int, int);
117:
118: struct cfattach ega_ca = {
119: sizeof(struct ega_softc), ega_match, ega_attach,
120: };
121:
122: struct cfdriver ega_cd = {
123: NULL, "ega", DV_DULL,
124: };
125:
126: const struct wsdisplay_emulops ega_emulops = {
127: pcdisplay_cursor,
128: pcdisplay_mapchar,
129: pcdisplay_putchar,
130: pcdisplay_copycols,
131: pcdisplay_erasecols,
132: ega_copyrows,
133: pcdisplay_eraserows,
134: ega_alloc_attr,
135: ega_unpack_attr
136: };
137:
138: /*
139: * translate WS(=ANSI) color codes to standard pc ones
140: */
141: static const unsigned char fgansitopc[] = {
142: FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE,
143: FG_MAGENTA, FG_CYAN, FG_LIGHTGREY
144: }, bgansitopc[] = {
145: BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE,
146: BG_MAGENTA, BG_CYAN, BG_LIGHTGREY
147: };
148:
149: /*
150: * translate standard pc color codes to WS(=ANSI) ones
151: */
152: static const u_int8_t pctoansi[] = {
153: #ifdef __alpha__
154: WSCOL_BLACK, WSCOL_RED, WSCOL_GREEN, WSCOL_BROWN,
155: WSCOL_BLUE, WSCOL_MAGENTA, WSCOL_CYAN, WSCOL_WHITE
156: #else
157: WSCOL_BLACK, WSCOL_BLUE, WSCOL_GREEN, WSCOL_CYAN,
158: WSCOL_RED, WSCOL_MAGENTA, WSCOL_BROWN, WSCOL_WHITE
159: #endif
160: };
161: const struct wsscreen_descr ega_stdscreen = {
162: "80x25", 80, 25,
163: &ega_emulops,
164: 8, 14,
165: WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
166: }, ega_stdscreen_mono = {
167: "80x25", 80, 25,
168: &ega_emulops,
169: 8, 14,
170: WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
171: }, ega_stdscreen_bf = {
172: "80x25bf", 80, 25,
173: &ega_emulops,
174: 8, 14,
175: WSSCREEN_WSCOLORS | WSSCREEN_BLINK
176: }, ega_35lscreen = {
177: "80x35", 80, 35,
178: &ega_emulops,
179: 8, 10,
180: WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
181: }, ega_35lscreen_mono = {
182: "80x35", 80, 35,
183: &ega_emulops,
184: 8, 10,
185: WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
186: }, ega_35lscreen_bf = {
187: "80x35bf", 80, 35,
188: &ega_emulops,
189: 8, 10,
190: WSSCREEN_WSCOLORS | WSSCREEN_BLINK
191: }, ega_43lscreen = {
192: "80x43", 80, 43,
193: &ega_emulops,
194: 8, 8,
195: WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK
196: }, ega_43lscreen_mono = {
197: "80x43", 80, 43,
198: &ega_emulops,
199: 8, 8,
200: WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE
201: }, ega_43lscreen_bf = {
202: "80x43bf", 80, 43,
203: &ega_emulops,
204: 8, 8,
205: WSSCREEN_WSCOLORS | WSSCREEN_BLINK
206: };
207:
208: #define VGA_SCREEN_CANTWOFONTS(type) (!((type)->capabilities & WSSCREEN_HILIT))
209:
210: const struct wsscreen_descr *_ega_scrlist[] = {
211: &ega_stdscreen,
212: &ega_stdscreen_bf,
213: &ega_35lscreen,
214: &ega_35lscreen_bf,
215: &ega_43lscreen,
216: &ega_43lscreen_bf,
217: }, *_ega_scrlist_mono[] = {
218: &ega_stdscreen_mono,
219: &ega_35lscreen_mono,
220: &ega_43lscreen_mono,
221: };
222:
223:
224: const struct wsscreen_list ega_screenlist = {
225: sizeof(_ega_scrlist) / sizeof(struct wsscreen_descr *),
226: _ega_scrlist
227: }, ega_screenlist_mono = {
228: sizeof(_ega_scrlist_mono) / sizeof(struct wsscreen_descr *),
229: _ega_scrlist_mono
230: };
231:
232: static int ega_ioctl(void *, u_long, caddr_t, int, struct proc *);
233: static paddr_t ega_mmap(void *, off_t, int);
234: static int ega_alloc_screen(void *, const struct wsscreen_descr *,
235: void **, int *, int *, long *);
236: static void ega_free_screen(void *, void *);
237: static int ega_show_screen(void *, void *, int,
238: void (*) (void *, int, int), void *);
239: static int ega_load_font(void *, void *, struct wsdisplay_font *);
240:
241: void ega_doswitch(struct ega_config *);
242:
243: const struct wsdisplay_accessops ega_accessops = {
244: ega_ioctl,
245: ega_mmap,
246: ega_alloc_screen,
247: ega_free_screen,
248: ega_show_screen,
249: ega_load_font
250: };
251:
252: static int
253: ega_probe_col(iot, memt)
254: bus_space_tag_t iot, memt;
255: {
256: bus_space_handle_t memh, ioh_6845;
257: u_int16_t oldval, val;
258:
259: if (bus_space_map(memt, 0xb8000, 0x8000, 0, &memh))
260: return (0);
261: oldval = bus_space_read_2(memt, memh, 0);
262: bus_space_write_2(memt, memh, 0, 0xa55a);
263: val = bus_space_read_2(memt, memh, 0);
264: bus_space_write_2(memt, memh, 0, oldval);
265: bus_space_unmap(memt, memh, 0x8000);
266: if (val != 0xa55a)
267: return (0);
268:
269: if (bus_space_map(iot, 0x3d0, 0x10, 0, &ioh_6845))
270: return (0);
271: bus_space_unmap(iot, ioh_6845, 0x10);
272:
273: return (1);
274: }
275:
276: static int
277: ega_probe_mono(iot, memt)
278: bus_space_tag_t iot, memt;
279: {
280: bus_space_handle_t memh, ioh_6845;
281: u_int16_t oldval, val;
282:
283: if (bus_space_map(memt, 0xb0000, 0x8000, 0, &memh))
284: return (0);
285: oldval = bus_space_read_2(memt, memh, 0);
286: bus_space_write_2(memt, memh, 0, 0xa55a);
287: val = bus_space_read_2(memt, memh, 0);
288: bus_space_write_2(memt, memh, 0, oldval);
289: bus_space_unmap(memt, memh, 0x8000);
290: if (val != 0xa55a)
291: return (0);
292:
293: if (bus_space_map(iot, 0x3b0, 0x10, 0, &ioh_6845))
294: return (0);
295: bus_space_unmap(iot, ioh_6845, 0x10);
296:
297: return (1);
298: }
299: /*
300: * We want at least ASCII 32..127 be present in the
301: * first font slot.
302: */
303: #define vga_valid_primary_font(f) \
304: (f->encoding == WSDISPLAY_FONTENC_IBM || \
305: f->encoding == WSDISPLAY_FONTENC_ISO)
306:
307: int
308: ega_selectfont(vc, scr, name1, name2)
309: struct ega_config *vc;
310: struct egascreen *scr;
311: char *name1, *name2; /* NULL: take first found */
312: {
313: const struct wsscreen_descr *type = scr->pcs.type;
314: struct egafont *f1, *f2;
315: int i;
316:
317: f1 = f2 = 0;
318:
319: for (i = 0; i < 4; i++) {
320: struct egafont *f = vc->vc_fonts[i];
321: if (!f || f->height != type->fontheight)
322: continue;
323: if (!f1 &&
324: vga_valid_primary_font(f) &&
325: (!name1 || !strcmp(name1, f->name))) {
326: f1 = f;
327: continue;
328: }
329: if (!f2 &&
330: VGA_SCREEN_CANTWOFONTS(type) &&
331: (!name2 || !strcmp(name2, f->name))) {
332: f2 = f;
333: continue;
334: }
335: }
336:
337: /*
338: * The request fails if no primary font was found,
339: * or if a second font was requested but not found.
340: */
341: if (f1 && (!name2 || f2)) {
342: #ifdef EGAFONTDEBUG
343: if (scr != &ega_console_screen || ega_console_attached) {
344: printf("ega (%s): font1=%s (slot %d)", type->name,
345: f1->name, f1->slot);
346: if (f2)
347: printf(", font2=%s (slot %d)",
348: f2->name, f2->slot);
349: printf("\n");
350: }
351: #endif
352: scr->fontset1 = f1;
353: scr->fontset2 = f2;
354: return (0);
355: }
356: return (ENXIO);
357: }
358:
359: void
360: ega_init_screen(vc, scr, type, existing, attrp)
361: struct ega_config *vc;
362: struct egascreen *scr;
363: const struct wsscreen_descr *type;
364: int existing;
365: long *attrp;
366: {
367: int cpos;
368: int res;
369:
370: scr->cfg = vc;
371: scr->pcs.hdl = (struct pcdisplay_handle *)&vc->hdl;
372: scr->pcs.type = type;
373: scr->pcs.active = 0;
374: scr->mindispoffset = 0;
375: scr->maxdispoffset = 0x8000 - type->nrows * type->ncols * 2;
376:
377: if (existing) {
378: cpos = vga_6845_read(&vc->hdl, cursorh) << 8;
379: cpos |= vga_6845_read(&vc->hdl, cursorl);
380:
381: /* make sure we have a valid cursor position */
382: if (cpos < 0 || cpos >= type->nrows * type->ncols)
383: cpos = 0;
384:
385: scr->pcs.dispoffset = vga_6845_read(&vc->hdl, startadrh) << 9;
386: scr->pcs.dispoffset |= vga_6845_read(&vc->hdl, startadrl) << 1;
387:
388: /* make sure we have a valid memory offset */
389: if (scr->pcs.dispoffset < scr->mindispoffset ||
390: scr->pcs.dispoffset > scr->maxdispoffset)
391: scr->pcs.dispoffset = scr->mindispoffset;
392: } else {
393: cpos = 0;
394: scr->pcs.dispoffset = scr->mindispoffset;
395: }
396:
397: scr->pcs.vc_crow = cpos / type->ncols;
398: scr->pcs.vc_ccol = cpos % type->ncols;
399: pcdisplay_cursor_init(&scr->pcs, existing);
400:
401: res = ega_alloc_attr(scr, 0, 0, 0, attrp);
402: #ifdef DIAGNOSTIC
403: if (res)
404: panic("ega_init_screen: attribute botch");
405: #endif
406:
407: scr->pcs.mem = NULL;
408:
409: scr->fontset1 = scr->fontset2 = 0;
410: if (ega_selectfont(vc, scr, 0, 0)) {
411: if (scr == &ega_console_screen)
412: panic("ega_init_screen: no font");
413: else
414: printf("ega_init_screen: no font\n");
415: }
416:
417: vc->nscreens++;
418: LIST_INSERT_HEAD(&vc->screens, scr, next);
419: }
420:
421: static void
422: ega_init(vc, iot, memt, mono)
423: struct ega_config *vc;
424: bus_space_tag_t iot, memt;
425: int mono;
426: {
427: struct vga_handle *vh = &vc->hdl;
428: int i;
429:
430: vh->vh_iot = iot;
431: vh->vh_memt = memt;
432: vh->vh_mono = mono;
433:
434: if (bus_space_map(vh->vh_iot, 0x3c0, 0x10, 0, &vh->vh_ioh_vga))
435: panic("ega_common_setup: couldn't map ega io");
436:
437: if (bus_space_map(vh->vh_iot, (vh->vh_mono ? 0x3b0 : 0x3d0), 0x10, 0,
438: &vh->vh_ioh_6845))
439: panic("ega_common_setup: couldn't map 6845 io");
440:
441: if (bus_space_map(vh->vh_memt, 0xa0000, 0x20000, 0, &vh->vh_allmemh))
442: panic("ega_common_setup: couldn't map memory");
443:
444: if (bus_space_subregion(vh->vh_memt, vh->vh_allmemh,
445: (vh->vh_mono ? 0x10000 : 0x18000), 0x8000,
446: &vh->vh_memh))
447: panic("ega_common_setup: mem subrange failed");
448:
449: vc->nscreens = 0;
450: LIST_INIT(&vc->screens);
451: vc->active = NULL;
452: vc->currenttype = vh->vh_mono ? &ega_stdscreen_mono : &ega_stdscreen;
453:
454: vc->vc_fonts[0] = &ega_builtinfont;
455: for (i = 1; i < 4; i++)
456: vc->vc_fonts[i] = 0;
457:
458: vc->currentfontset1 = vc->currentfontset2 = 0;
459: }
460:
461: int
462: ega_match(parent, match, aux)
463: struct device *parent;
464: void *match;
465: void *aux;
466: {
467: struct isa_attach_args *ia = aux;
468: int mono;
469:
470: /* If values are hardwired to something that they can't be, punt. */
471: if ((ia->ia_iobase != IOBASEUNK &&
472: ia->ia_iobase != 0x3d0 &&
473: ia->ia_iobase != 0x3b0) ||
474: /* ia->ia_iosize != 0 || XXX isa.c */
475: (ia->ia_maddr != MADDRUNK &&
476: ia->ia_maddr != 0xb8000 &&
477: ia->ia_maddr != 0xb0000) ||
478: (ia->ia_msize != 0 && ia->ia_msize != 0x8000) ||
479: ia->ia_irq != IRQUNK || ia->ia_drq != DRQUNK)
480: return (0);
481:
482: if (ega_is_console(ia->ia_iot))
483: mono = ega_console_dc.hdl.vh_mono;
484: else if (ia->ia_iobase != 0x3b0 && ia->ia_maddr != 0xb0000 &&
485: ega_probe_col(ia->ia_iot, ia->ia_memt))
486: mono = 0;
487: else if (ia->ia_iobase != 0x3d0 && ia->ia_maddr != 0xb8000 &&
488: ega_probe_mono(ia->ia_iot, ia->ia_memt))
489: mono = 1;
490: else
491: return (0);
492:
493: ia->ia_iobase = mono ? 0x3b0 : 0x3d0;
494: ia->ia_iosize = 0x10;
495: ia->ia_maddr = mono ? 0xb0000 : 0xb8000;
496: ia->ia_msize = 0x8000;
497: return (2); /* beat pcdisplay */
498: }
499:
500: void
501: ega_attach(parent, self, aux)
502: struct device *parent, *self;
503: void *aux;
504: {
505: struct isa_attach_args *ia = aux;
506: struct ega_softc *sc = (struct ega_softc *)self;
507: int console;
508: struct ega_config *dc;
509: struct wsemuldisplaydev_attach_args aa;
510:
511: printf("\n");
512:
513: console = ega_is_console(ia->ia_iot);
514:
515: if (console) {
516: dc = &ega_console_dc;
517: sc->nscreens = 1;
518: ega_console_attached = 1;
519: } else {
520: dc = malloc(sizeof(struct ega_config),
521: M_DEVBUF, M_WAITOK);
522: if (ia->ia_iobase != 0x3b0 && ia->ia_maddr != 0xb0000 &&
523: ega_probe_col(ia->ia_iot, ia->ia_memt))
524: ega_init(dc, ia->ia_iot, ia->ia_memt, 0);
525: else if (ia->ia_iobase != 0x3d0 && ia->ia_maddr != 0xb8000 &&
526: ega_probe_mono(ia->ia_iot, ia->ia_memt))
527: ega_init(dc, ia->ia_iot, ia->ia_memt, 1);
528: else
529: panic("ega_attach: display disappeared");
530: }
531: sc->sc_dc = dc;
532:
533: aa.console = console;
534: aa.scrdata = &ega_screenlist;
535: aa.accessops = &ega_accessops;
536: aa.accesscookie = dc;
537: aa.defaultscreens = 0;
538:
539: config_found(self, &aa, wsemuldisplaydevprint);
540: }
541:
542:
543: int
544: ega_cnattach(iot, memt)
545: bus_space_tag_t iot, memt;
546: {
547: int mono;
548: long defattr;
549: const struct wsscreen_descr *scr;
550:
551: if (ega_probe_col(iot, memt))
552: mono = 0;
553: else if (ega_probe_mono(iot, memt))
554: mono = 1;
555: else
556: return (ENXIO);
557:
558: ega_init(&ega_console_dc, iot, memt, mono);
559: scr = ega_console_dc.currenttype;
560: ega_init_screen(&ega_console_dc, &ega_console_screen, scr, 1, &defattr);
561:
562: ega_console_screen.pcs.active = 1;
563: ega_console_dc.active = &ega_console_screen;
564:
565: wsdisplay_cnattach(scr, &ega_console_screen,
566: ega_console_screen.pcs.vc_ccol,
567: ega_console_screen.pcs.vc_crow,
568: defattr);
569:
570: egaconsole = 1;
571: return (0);
572: }
573:
574: static int
575: ega_is_console(iot)
576: bus_space_tag_t iot;
577: {
578: if (egaconsole &&
579: !ega_console_attached &&
580: iot == ega_console_dc.hdl.vh_iot)
581: return (1);
582: return (0);
583: }
584:
585: static int
586: ega_ioctl(v, cmd, data, flag, p)
587: void *v;
588: u_long cmd;
589: caddr_t data;
590: int flag;
591: struct proc *p;
592: {
593: /*
594: * XXX "do something!"
595: */
596: return (-1);
597: }
598:
599: static paddr_t
600: ega_mmap(v, offset, prot)
601: void *v;
602: off_t offset;
603: int prot;
604: {
605: return (-1);
606: }
607:
608: static int
609: ega_alloc_screen(v, type, cookiep, curxp, curyp, defattrp)
610: void *v;
611: const struct wsscreen_descr *type;
612: void **cookiep;
613: int *curxp, *curyp;
614: long *defattrp;
615: {
616: struct ega_config *vc = v;
617: struct egascreen *scr;
618:
619: if (vc->nscreens == 1) {
620: /*
621: * When allocating the second screen, get backing store
622: * for the first one too.
623: * XXX We could be more clever and use video RAM.
624: */
625: LIST_FIRST(&vc->screens)->pcs.mem =
626: malloc(type->ncols * type->nrows * 2, M_DEVBUF, M_WAITOK);
627: }
628:
629: scr = malloc(sizeof(struct egascreen), M_DEVBUF, M_WAITOK);
630: ega_init_screen(vc, scr, type, vc->nscreens == 0, defattrp);
631:
632: if (vc->nscreens == 1) {
633: scr->pcs.active = 1;
634: vc->active = scr;
635: vc->currenttype = type;
636: } else {
637: scr->pcs.mem = malloc(type->ncols * type->nrows * 2,
638: M_DEVBUF, M_WAITOK);
639: pcdisplay_eraserows(&scr->pcs, 0, type->nrows, *defattrp);
640: }
641:
642: *cookiep = scr;
643: *curxp = scr->pcs.vc_ccol;
644: *curyp = scr->pcs.vc_crow;
645: return (0);
646: }
647:
648: static void
649: ega_free_screen(v, cookie)
650: void *v;
651: void *cookie;
652: {
653: struct egascreen *vs = cookie;
654: struct ega_config *vc = vs->cfg;
655:
656: LIST_REMOVE(vs, next);
657: if (vs != &ega_console_screen) {
658: /*
659: * deallocating the one but last screen
660: * removes backing store for the last one
661: */
662: if (vc->nscreens == 1)
663: free(LIST_FIRST(&vc->screens)->pcs.mem, M_DEVBUF);
664:
665: /* Last screen has no backing store */
666: if (vc->nscreens != 0)
667: free(vs->pcs.mem, M_DEVBUF);
668:
669: free(vs, M_DEVBUF);
670: } else
671: panic("ega_free_screen: console");
672:
673: if (vc->active == vs)
674: vc->active = NULL;
675: }
676:
677: static void
678: ega_setfont(vc, scr)
679: struct ega_config *vc;
680: struct egascreen *scr;
681: {
682: int fontslot1, fontslot2;
683:
684: fontslot1 = (scr->fontset1 ? scr->fontset1->slot : 0);
685: fontslot2 = (scr->fontset2 ? scr->fontset2->slot : fontslot1);
686: if (vc->currentfontset1 != fontslot1 ||
687: vc->currentfontset2 != fontslot2) {
688: vga_setfontset(&vc->hdl, 2 * fontslot1, 2 * fontslot2);
689: vc->currentfontset1 = fontslot1;
690: vc->currentfontset2 = fontslot2;
691: }
692: }
693:
694: static int
695: ega_show_screen(v, cookie, waitok, cb, cbarg)
696: void *v;
697: void *cookie;
698: int waitok;
699: void (*cb)(void *, int, int);
700: void *cbarg;
701: {
702: struct egascreen *scr = cookie, *oldscr;
703: struct ega_config *vc = scr->cfg;
704:
705: oldscr = vc->active; /* can be NULL! */
706: if (scr == oldscr) {
707: return (0);
708: }
709:
710: vc->wantedscreen = cookie;
711: vc->switchcb = cb;
712: vc->switchcbarg = cbarg;
713: if (cb) {
714: timeout_set(&vc->switch_timeout,
715: (void(*)(void *))ega_doswitch, vc);
716: timeout_add(&vc->switch_timeout, 0);
717: return (EAGAIN);
718: }
719:
720: ega_doswitch(vc);
721: return (0);
722: }
723:
724: void
725: ega_doswitch(vc)
726: struct ega_config *vc;
727: {
728: struct egascreen *scr, *oldscr;
729: struct vga_handle *vh = &vc->hdl;
730: const struct wsscreen_descr *type;
731:
732: scr = vc->wantedscreen;
733: if (!scr) {
734: printf("ega_doswitch: disappeared\n");
735: (*vc->switchcb)(vc->switchcbarg, EIO, 0);
736: return;
737: }
738: type = scr->pcs.type;
739: oldscr = vc->active; /* can be NULL! */
740: #ifdef DIAGNOSTIC
741: if (oldscr) {
742: if (!oldscr->pcs.active)
743: panic("ega_show_screen: not active");
744: if (oldscr->pcs.type != vc->currenttype)
745: panic("ega_show_screen: bad type");
746: }
747: #endif
748: if (scr == oldscr) {
749: return;
750: }
751: #ifdef DIAGNOSTIC
752: if (scr->pcs.active)
753: panic("ega_show_screen: active");
754: #endif
755:
756: if (oldscr) {
757: const struct wsscreen_descr *oldtype = oldscr->pcs.type;
758:
759: oldscr->pcs.active = 0;
760: bus_space_read_region_2(vh->vh_memt, vh->vh_memh,
761: oldscr->pcs.dispoffset, oldscr->pcs.mem,
762: oldtype->ncols * oldtype->nrows);
763: }
764:
765: if (vc->currenttype != type) {
766: vga_setscreentype(vh, type);
767: vc->currenttype = type;
768: }
769:
770: ega_setfont(vc, scr);
771: /* XXX swich colours! */
772:
773: scr->pcs.dispoffset = scr->mindispoffset;
774: if (!oldscr || (scr->pcs.dispoffset != oldscr->pcs.dispoffset)) {
775: vga_6845_write(vh, startadrh, scr->pcs.dispoffset >> 9);
776: vga_6845_write(vh, startadrl, scr->pcs.dispoffset >> 1);
777: }
778:
779: bus_space_write_region_2(vh->vh_memt, vh->vh_memh,
780: scr->pcs.dispoffset, scr->pcs.mem,
781: type->ncols * type->nrows);
782: scr->pcs.active = 1;
783:
784: vc->active = scr;
785:
786: pcdisplay_cursor_reset(&scr->pcs);
787: pcdisplay_cursor(&scr->pcs, scr->pcs.cursoron,
788: scr->pcs.vc_crow, scr->pcs.vc_ccol);
789:
790: vc->wantedscreen = 0;
791: if (vc->switchcb)
792: (*vc->switchcb)(vc->switchcbarg, 0, 0);
793: }
794:
795: static int
796: ega_load_font(v, cookie, data)
797: void *v;
798: void *cookie;
799: struct wsdisplay_font *data;
800: {
801: struct ega_config *vc = v;
802: struct egascreen *scr = cookie;
803: char *name2;
804: int res, slot;
805: struct egafont *f;
806:
807: if (scr) {
808: if ((name2 = data->name) != NULL) {
809: while (*name2 && *name2 != ',')
810: name2++;
811: if (name2)
812: *name2++ = '\0';
813: }
814: res = ega_selectfont(vc, scr, data->name, name2);
815: if (!res)
816: ega_setfont(vc, scr);
817: return (res);
818: }
819:
820: if (data->fontwidth != 8 || data->stride != 1)
821: return (EINVAL); /* XXX 1 byte per line */
822: if (data->firstchar != 0 || data->numchars != 256)
823: return (EINVAL);
824: #ifndef WSCONS_SUPPORT_PCVTFONTS
825: if (data->encoding == WSDISPLAY_FONTENC_PCVT) {
826: printf("vga: pcvt font support not built in, see vga(4)\n");
827: return (EINVAL);
828: }
829: #endif
830:
831: if (data->index < 0) {
832: for (slot = 0; slot < 4; slot++)
833: if (!vc->vc_fonts[slot])
834: break;
835: } else
836: slot = data->index;
837:
838: if (slot >= 4)
839: return (ENOSPC);
840:
841: if (vc->vc_fonts[slot] != NULL)
842: return (EEXIST);
843: f = malloc(sizeof(struct egafont), M_DEVBUF, M_WAITOK);
844: if (f == NULL)
845: return (ENOMEM);
846: strlcpy(f->name, data->name, sizeof(f->name));
847: f->height = data->fontheight;
848: f->encoding = data->encoding;
849: #ifdef notyet
850: f->firstchar = data->firstchar;
851: f->numchars = data->numchars;
852: #endif
853: #ifdef EGAFONTDEBUG
854: printf("ega: load %s (8x%d, enc %d) font to slot %d\n", f->name,
855: f->height, f->encoding, slot);
856: #endif
857: vga_loadchars(&vc->hdl, 2 * slot, 0, 256, f->height, data->data);
858: f->slot = slot;
859: vc->vc_fonts[slot] = f;
860: data->cookie = f;
861: data->index = slot;
862:
863: return (0);
864: }
865:
866: static int
867: ega_alloc_attr(id, fg, bg, flags, attrp)
868: void *id;
869: int fg, bg;
870: int flags;
871: long *attrp;
872: {
873: struct egascreen *scr = id;
874: struct ega_config *vc = scr->cfg;
875:
876: if (vc->hdl.vh_mono) {
877: if (flags & WSATTR_WSCOLORS)
878: return (EINVAL);
879: if (flags & WSATTR_REVERSE)
880: *attrp = 0x70;
881: else
882: *attrp = 0x07;
883: if (flags & WSATTR_UNDERLINE)
884: *attrp |= FG_UNDERLINE;
885: if (flags & WSATTR_HILIT)
886: *attrp |= FG_INTENSE;
887: } else {
888: if (flags & (WSATTR_UNDERLINE | WSATTR_REVERSE))
889: return (EINVAL);
890: if (flags & WSATTR_WSCOLORS)
891: *attrp = fgansitopc[fg & 7] | bgansitopc[bg & 7];
892: else
893: *attrp = 7;
894: if ((flags & WSATTR_HILIT) || (fg & 8) || (bg & 8))
895: *attrp += 8;
896: }
897: if (flags & WSATTR_BLINK)
898: *attrp |= FG_BLINK;
899: return (0);
900: }
901:
902: void
903: ega_unpack_attr(id, attr, fg, bg, ul)
904: void *id;
905: long attr;
906: int *fg, *bg, *ul;
907: {
908: struct egascreen *scr = id;
909: struct ega_config *vc = scr->cfg;
910:
911: if (vc->hdl.vh_mono) {
912: *fg = (attr & 0x07) == 0x07 ? WSCOL_WHITE : WSCOL_BLACK;
913: *bg = attr & 0x70 ? WSCOL_WHITE : WSCOL_BLACK;
914: if (ul != NULL)
915: *ul = *fg != WSCOL_WHITE && (attr & 0x01) ? 1 : 0;
916: } else {
917: *fg = pctoansi[attr & 0x07];
918: *bg = pctoansi[(attr & 0x70) >> 4];
919: if (ul != NULL)
920: *ul = 0;
921: }
922: if (attr & FG_INTENSE)
923: *fg += 8;
924: }
925:
926: void
927: ega_copyrows(id, srcrow, dstrow, nrows)
928: void *id;
929: int srcrow, dstrow, nrows;
930: {
931: struct egascreen *scr = id;
932: bus_space_tag_t memt = scr->pcs.hdl->ph_memt;
933: bus_space_handle_t memh = scr->pcs.hdl->ph_memh;
934: int ncols = scr->pcs.type->ncols;
935: bus_size_t srcoff, dstoff;
936:
937: srcoff = srcrow * ncols + 0;
938: dstoff = dstrow * ncols + 0;
939:
940: if (scr->pcs.active) {
941: if (dstrow == 0 && (srcrow + nrows == scr->pcs.type->nrows)) {
942: #ifdef PCDISPLAY_SOFTCURSOR
943: int cursoron = scr->pcs.cursoron;
944:
945: if (cursoron)
946: pcdisplay_cursor(&scr->pcs, 0,
947: scr->pcs.vc_crow, scr->pcs.vc_ccol);
948: #endif
949: /* scroll up whole screen */
950: if ((scr->pcs.dispoffset + srcrow * ncols * 2)
951: <= scr->maxdispoffset) {
952: scr->pcs.dispoffset += srcrow * ncols * 2;
953: } else {
954: bus_space_copy_2(memt, memh,
955: scr->pcs.dispoffset + srcoff * 2,
956: memh, scr->mindispoffset,
957: nrows * ncols);
958: scr->pcs.dispoffset = scr->mindispoffset;
959: }
960: vga_6845_write(&scr->cfg->hdl, startadrh,
961: scr->pcs.dispoffset >> 9);
962: vga_6845_write(&scr->cfg->hdl, startadrl,
963: scr->pcs.dispoffset >> 1);
964: #ifdef PCDISPLAY_SOFTCURSOR
965: if (cursoron)
966: pcdisplay_cursor(&scr->pcs, 1,
967: scr->pcs.vc_crow, scr->pcs.vc_ccol);
968: #endif
969: } else {
970: bus_space_copy_2(memt, memh,
971: scr->pcs.dispoffset + srcoff * 2,
972: memh, scr->pcs.dispoffset + dstoff * 2,
973: nrows * ncols);
974: }
975: } else
976: bcopy(&scr->pcs.mem[srcoff], &scr->pcs.mem[dstoff],
977: nrows * ncols * 2);
978: }
CVSweb