1 /* $NetBSD: vga_raster.c,v 1.12.2.1 2007/08/12 19:52:27 bouyer Exp $ */
2
3 /*
4 * Copyright (c) 2001, 2002 Bang Jun-Young
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30 /*
31 * Copyright (c) 1995, 1996 Carnegie-Mellon University.
32 * All rights reserved.
33 *
34 * Author: Chris G. Demetriou
35 *
36 * Permission to use, copy, modify and distribute this software and
37 * its documentation is hereby granted, provided that both the copyright
38 * notice and this permission notice appear in all copies of the
39 * software, derivative works or modified versions, and any portions
40 * thereof, and that both notices appear in supporting documentation.
41 *
42 * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
43 * CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND
44 * FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
45 *
46 * Carnegie Mellon requests users of this software to return to
47 *
48 * Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
49 * School of Computer Science
50 * Carnegie Mellon University
51 * Pittsburgh PA 15213-3890
52 *
53 * any improvements or extensions that they make and grant Carnegie the
54 * rights to redistribute these changes.
55 */
56
57 #include <sys/cdefs.h>
58 __KERNEL_RCSID(0, "$NetBSD: vga_raster.c,v 1.12.2.1 2007/08/12 19:52:27 bouyer Exp $");
59
60 #include <sys/param.h>
61 #include <sys/systm.h>
62 #include <sys/callout.h>
63 #include <sys/kernel.h>
64 #include <sys/device.h>
65 #include <sys/malloc.h>
66 #include <sys/queue.h>
67 #include <machine/bus.h>
68
69 #include <dev/ic/mc6845reg.h>
70 #include <dev/ic/pcdisplayvar.h>
71 #include <dev/ic/vgareg.h>
72 #include <dev/ic/vgavar.h>
73 #include <dev/ic/videomode.h>
74
75 #include <dev/wscons/wsdisplayvar.h>
76 #include <dev/wscons/wsconsio.h>
77 #include <dev/wsfont/wsfont.h>
78
79 #include <dev/ic/pcdisplay.h>
80
81 int vga_no_builtinfont = 0;
82
83 u_int8_t builtinfont_data[256 * 16];
84
85 struct wsdisplay_font builtinfont = {
86 "builtin", /* typeface name */
87 0, /* firstchar */
88 256, /* numchars */
89 WSDISPLAY_FONTENC_IBM, /* encoding */
90 8, /* width */
91 16, /* height */
92 1, /* stride */
93 WSDISPLAY_FONTORDER_L2R, /* bit order */
94 WSDISPLAY_FONTORDER_L2R, /* byte order */
95 builtinfont_data /* data */
96 };
97
98 struct vga_scrmem {
99 u_int16_t ch;
100 u_int8_t attr;
101 u_int8_t second; /* XXXBJY should be u_int8_t len; */
102 u_int8_t enc;
103 };
104
105 #ifdef VGA_CONSOLE_SCREENTYPE
106 #define VGA_SCRMEM_SIZE (80 * 30)
107 #else
108 #define VGA_SCRMEM_SIZE (80 * 25)
109 #endif
110
111 struct vga_scrmem boot_scrmem[VGA_SCRMEM_SIZE];
112
113 struct vga_raster_font {
114 LIST_ENTRY(vga_raster_font) next;
115 struct wsdisplay_font *font;
116 };
117
118 struct vgascreen {
119 LIST_ENTRY(vgascreen) next;
120 struct vga_config *cfg;
121 struct vga_handle *hdl;
122 const struct wsscreen_descr *type;
123
124 int active;
125 struct vga_scrmem *mem;
126 int encoding;
127
128 int dispoffset;
129 int mindispoffset;
130 int maxdispoffset;
131
132 int cursoron; /* Is cursor displayed? */
133 int cursorcol; /* Current cursor column */
134 int cursorrow; /* Current cursor row */
135 struct vga_scrmem cursortmp;
136 int cursorstride;
137
138 LIST_HEAD(, vga_raster_font) fontset;
139 };
140
141 struct vga_moderegs {
142 u_int8_t miscout; /* Misc. output */
143 u_int8_t crtc[MC6845_NREGS]; /* CRTC controller */
144 u_int8_t atc[VGA_ATC_NREGS]; /* Attribute controller */
145 u_int8_t ts[VGA_TS_NREGS]; /* Time sequencer */
146 u_int8_t gdc[VGA_GDC_NREGS]; /* Graphics display controller */
147 };
148
149 static int vgaconsole, vga_console_type, vga_console_attached;
150 static struct vgascreen vga_console_screen;
151 static struct vga_config vga_console_vc;
152 static struct vga_raster_font vga_console_fontset_ascii;
153 static struct videomode vga_console_modes[2] = {
154 /* 640x400 for 80x25, 80x40 and 80x50 modes */
155 {
156 25175, 640, 664, 760, 800, 400, 409, 411, 450, 0
157 },
158 /* 640x480 for 80x30 mode */
159 {
160 25175, 640, 664, 760, 800, 480, 491, 493, 525, 0
161 }
162 };
163
164 static void vga_raster_init(struct vga_config *, bus_space_tag_t,
165 bus_space_tag_t);
166 static void vga_raster_init_screen(struct vga_config *, struct vgascreen *,
167 const struct wsscreen_descr *, int, long *);
168 static void vga_raster_setup_font(struct vga_config *, struct vgascreen *);
169 static void vga_setup_regs(struct videomode *, struct vga_moderegs *);
170 static void vga_set_mode(struct vga_handle *, struct vga_moderegs *);
171 static void vga_restore_screen(struct vgascreen *,
172 const struct wsscreen_descr *, struct vga_scrmem *);
173 static void vga_raster_cursor_init(struct vgascreen *, int);
174 static void _vga_raster_putchar(void *, int, int, u_int, long,
175 struct vga_raster_font *);
176
177 static void vga_raster_cursor(void *, int, int, int);
178 static int vga_raster_mapchar(void *, int, u_int *);
179 static void vga_raster_putchar(void *, int, int, u_int, long);
180 static void vga_raster_copycols(void *, int, int, int, int);
181 static void vga_raster_erasecols(void *, int, int, int, long);
182 static void vga_raster_copyrows(void *, int, int, int);
183 static void vga_raster_eraserows(void *, int, int, long);
184 static int vga_raster_allocattr(void *, int, int, int, long *);
185
186 const struct wsdisplay_emulops vga_raster_emulops = {
187 vga_raster_cursor,
188 vga_raster_mapchar,
189 vga_raster_putchar,
190 vga_raster_copycols,
191 vga_raster_erasecols,
192 vga_raster_copyrows,
193 vga_raster_eraserows,
194 vga_raster_allocattr,
195 };
196
197 /*
198 * translate WS(=ANSI) color codes to standard pc ones
199 */
200 static const unsigned char fgansitopc[] = {
201 #ifdef __alpha__
202 /*
203 * XXX DEC HAS SWITCHED THE CODES FOR BLUE AND RED!!!
204 * XXX We should probably not bother with this
205 * XXX (reinitialize the palette registers).
206 */
207 FG_BLACK, FG_BLUE, FG_GREEN, FG_CYAN, FG_RED,
208 FG_MAGENTA, FG_BROWN, FG_LIGHTGREY
209 #else
210 FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE,
211 FG_MAGENTA, FG_CYAN, FG_LIGHTGREY
212 #endif
213 }, bgansitopc[] = {
214 #ifdef __alpha__
215 BG_BLACK, BG_BLUE, BG_GREEN, BG_CYAN, BG_RED,
216 BG_MAGENTA, BG_BROWN, BG_LIGHTGREY
217 #else
218 BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE,
219 BG_MAGENTA, BG_CYAN, BG_LIGHTGREY
220 #endif
221 };
222
223 const struct wsscreen_descr vga_25lscreen = {
224 "80x25", 80, 25,
225 &vga_raster_emulops,
226 8, 16,
227 WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK,
228 &vga_console_modes[0]
229 }, vga_25lscreen_mono = {
230 "80x25", 80, 25,
231 &vga_raster_emulops,
232 8, 16,
233 WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE,
234 &vga_console_modes[0]
235 }, vga_30lscreen = {
236 "80x30", 80, 30,
237 &vga_raster_emulops,
238 8, 16,
239 WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK,
240 &vga_console_modes[1]
241 }, vga_30lscreen_mono = {
242 "80x30", 80, 30,
243 &vga_raster_emulops,
244 8, 16,
245 WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE,
246 &vga_console_modes[1]
247 }, vga_40lscreen = {
248 "80x40", 80, 40,
249 &vga_raster_emulops,
250 8, 10,
251 WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK,
252 &vga_console_modes[0]
253 }, vga_40lscreen_mono = {
254 "80x40", 80, 40,
255 &vga_raster_emulops,
256 8, 10,
257 WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE,
258 &vga_console_modes[0]
259 }, vga_50lscreen = {
260 "80x50", 80, 50,
261 &vga_raster_emulops,
262 8, 8,
263 WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_BLINK,
264 &vga_console_modes[0]
265 }, vga_50lscreen_mono = {
266 "80x50", 80, 50,
267 &vga_raster_emulops,
268 8, 8,
269 WSSCREEN_HILIT | WSSCREEN_UNDERLINE | WSSCREEN_BLINK | WSSCREEN_REVERSE,
270 &vga_console_modes[0]
271 };
272
273 const struct wsscreen_descr *_vga_scrlist[] = {
274 &vga_25lscreen,
275 &vga_30lscreen,
276 &vga_40lscreen,
277 &vga_50lscreen,
278 }, *_vga_scrlist_mono[] = {
279 &vga_25lscreen_mono,
280 &vga_30lscreen_mono,
281 &vga_40lscreen_mono,
282 &vga_50lscreen_mono,
283 };
284
285 const struct wsscreen_list vga_screenlist = {
286 sizeof(_vga_scrlist) / sizeof(struct wsscreen_descr *),
287 _vga_scrlist
288 }, vga_screenlist_mono = {
289 sizeof(_vga_scrlist_mono) / sizeof(struct wsscreen_descr *),
290 _vga_scrlist_mono
291 };
292
293 static int vga_raster_ioctl(void *, u_long, caddr_t, int, struct proc *);
294 static paddr_t vga_raster_mmap(void *, off_t, int);
295 static int vga_raster_alloc_screen(void *, const struct wsscreen_descr *,
296 void **, int *, int *, long *);
297 static void vga_raster_free_screen(void *, void *);
298 static int vga_raster_show_screen(void *, void *, int,
299 void (*)(void *, int, int), void *);
300 static int vga_raster_load_font(void *, void *, struct wsdisplay_font *);
301
302 static void vga_switch_screen(struct vga_config *);
303 static void vga_raster_setscreentype(struct vga_config *,
304 const struct wsscreen_descr *);
305
306 const struct wsdisplay_accessops vga_raster_accessops = {
307 vga_raster_ioctl,
308 vga_raster_mmap,
309 vga_raster_alloc_screen,
310 vga_raster_free_screen,
311 vga_raster_show_screen,
312 vga_raster_load_font,
313 };
314
315 int
316 vga_cnattach(bus_space_tag_t iot, bus_space_tag_t memt, int type, int check)
317 {
318 long defattr;
319 const struct wsscreen_descr *scr;
320 #ifdef VGA_CONSOLE_SCREENTYPE
321 char *typestr;
322 #endif
323
324 if (check && !vga_common_probe(iot, memt))
325 return (ENXIO);
326
327 /* set up bus-independent VGA configuration */
328 vga_raster_init(&vga_console_vc, iot, memt);
329 #ifdef VGA_CONSOLE_SCREENTYPE
330 scr = wsdisplay_screentype_pick(vga_console_vc.hdl.vh_mono ?
331 &vga_screenlist_mono : &vga_screenlist, VGA_CONSOLE_SCREENTYPE);
332 if (!scr)
333 /* Invalid screen type, continue with the default mode. */
334 typestr = "80x25";
335 else if (scr->nrows > 30)
336 /* Unsupported screen type, try 80x30. */
337 typestr = "80x30";
338 scr = wsdisplay_screentype_pick(vga_console_vc.hdl.vh_mono ?
339 &vga_screenlist_mono : &vga_screenlist, typestr);
340 if (scr != vga_console_vc.currenttype)
341 vga_console_vc.currenttype = scr;
342 #else
343 scr = vga_console_vc.currenttype;
344 #endif
345 vga_raster_init_screen(&vga_console_vc, &vga_console_screen, scr, 1,
346 &defattr);
347
348 vga_console_screen.active = 1;
349 vga_console_vc.active = &vga_console_screen;
350
351 wsdisplay_cnattach(scr, &vga_console_screen,
352 vga_console_screen.cursorcol, vga_console_screen.cursorrow,
353 defattr);
354
355 vgaconsole = 1;
356 vga_console_type = type;
357 return (0);
358 }
359
360 void
361 vga_raster_init(struct vga_config *vc, bus_space_tag_t iot,
362 bus_space_tag_t memt)
363 {
364 struct vga_handle *vh = &vc->hdl;
365 u_int8_t mor;
366 struct vga_raster_font *vf;
367
368 vh->vh_iot = iot;
369 vh->vh_memt = memt;
370
371 if (bus_space_map(vh->vh_iot, 0x3c0, 0x10, 0, &vh->vh_ioh_vga))
372 panic("vga_raster_init: couldn't map vga io");
373
374 /* read "misc output register" */
375 mor = bus_space_read_1(vh->vh_iot, vh->vh_ioh_vga, VGA_MISC_DATAR);
376 vh->vh_mono = !(mor & 1);
377
378 if (bus_space_map(vh->vh_iot, (vh->vh_mono ? 0x3b0 : 0x3d0), 0x10, 0,
379 &vh->vh_ioh_6845))
380 panic("vga_raster_init: couldn't map 6845 io");
381
382 if (bus_space_map(vh->vh_memt, 0xa0000, 0x20000, 0, &vh->vh_allmemh))
383 panic("vga_raster_init: couldn't map memory");
384
385 if (bus_space_subregion(vh->vh_memt, vh->vh_allmemh, 0, 0x10000,
386 &vh->vh_memh))
387 panic("vga_raster_init: mem subrange failed");
388
389 /* should only reserve the space (no need to map - save KVM) */
390 vc->vc_biostag = memt;
391 if (bus_space_map(vc->vc_biostag, 0xc0000, 0x8000, 0, &vc->vc_bioshdl))
392 vc->vc_biosmapped = 0;
393 else
394 vc->vc_biosmapped = 1;
395
396 vc->nscreens = 0;
397 LIST_INIT(&vc->screens);
398 vc->active = NULL;
399 vc->currenttype = vh->vh_mono ? &vga_25lscreen_mono : &vga_25lscreen;
400 callout_init(&vc->vc_switch_callout);
401
402 wsfont_init();
403 vc->nfonts = 1;
404 LIST_INIT(&vc->vc_fontlist);
405 vf = &vga_console_fontset_ascii;
406 if (vga_no_builtinfont) {
407 struct wsdisplay_font *wf;
408 int cookie;
409
410 /* prefer 8x16 pixel font */
411 cookie = wsfont_find(NULL, 8, 16, 0, WSDISPLAY_FONTORDER_L2R,
412 0);
413 if (cookie == -1)
414 cookie = wsfont_find(NULL, 0, 0, 0,
415 WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R);
416 if (cookie == -1 || wsfont_lock(cookie, &wf))
417 panic("vga_raster_init: can't load console font");
418 vf->font = wf;
419 } else {
420 vga_load_builtinfont(vh, builtinfont_data, 0, 256);
421 vf->font = &builtinfont;
422 }
423 LIST_INSERT_HEAD(&vc->vc_fontlist, vf, next);
424 }
425
426 void
427 vga_raster_init_screen(struct vga_config *vc, struct vgascreen *scr,
428 const struct wsscreen_descr *type, int existing, long *attrp)
429 {
430 int cpos;
431 int res;
432 struct vga_handle *vh;
433
434 scr->cfg = vc;
435 scr->hdl = &vc->hdl;
436 scr->type = type;
437 scr->mindispoffset = 0;
438 scr->maxdispoffset = 0x10000;
439 vh = &vc->hdl;
440
441 LIST_INIT(&scr->fontset);
442 vga_raster_setup_font(vc, scr);
443
444 if (existing) {
445 int i;
446
447 cpos = vga_6845_read(vh, cursorh) << 8;
448 cpos |= vga_6845_read(vh, cursorl);
449
450 /* make sure we have a valid cursor position */
451 if (cpos < 0 || cpos >= type->nrows * type->ncols)
452 cpos = 0;
453
454 scr->dispoffset = vga_6845_read(vh, startadrh) << 9;
455 scr->dispoffset |= vga_6845_read(vh, startadrl) << 1;
456
457 /* make sure we have a valid memory offset */
458 if (scr->dispoffset < scr->mindispoffset ||
459 scr->dispoffset > scr->maxdispoffset)
460 scr->dispoffset = scr->mindispoffset;
461
462 scr->mem = boot_scrmem;
463 scr->active = 1;
464
465 /* Save the current screen to memory. XXXBJY assume 80x25 */
466 for (i = 0; i < 80 * 25; i++) {
467 scr->mem[i].ch = bus_space_read_1(vh->vh_memt,
468 vh->vh_allmemh, 0x18000 + i * 2);
469 scr->mem[i].attr = bus_space_read_1(vh->vh_memt,
470 vh->vh_allmemh, 0x18000 + i * 2 + 1);
471 scr->mem[i].enc = scr->encoding;
472 }
473
474 vga_raster_setscreentype(vc, type);
475
476 /* Clear the entire screen. */
477 vga_gdc_write(vh, mode, 0x02);
478 bus_space_set_region_4(vh->vh_memt, vh->vh_allmemh, 0, 0,
479 0x4000);
480
481 vga_restore_screen(scr, type, scr->mem);
482
483 /* Delay to prevent the boot screen from being too
484 fast scrolled up. */
485 delay(1000000);
486 } else {
487 cpos = 0;
488 scr->dispoffset = scr->mindispoffset;
489 scr->mem = NULL;
490 scr->active = 0;
491 }
492
493 scr->cursorrow = cpos / type->ncols;
494 scr->cursorcol = cpos % type->ncols;
495 vga_raster_cursor_init(scr, existing);
496
497 #ifdef __alpha__
498 if (!vc->hdl.vh_mono)
499 /*
500 * DEC firmware uses a blue background.
501 */
502 res = vga_raster_allocattr(scr, WSCOL_WHITE, WSCOL_BLUE,
503 WSATTR_WSCOLORS, attrp);
504 else
505 #endif
506 res = vga_raster_allocattr(scr, 0, 0, 0, attrp);
507 #ifdef DIAGNOSTIC
508 if (res)
509 panic("vga_raster_init_screen: attribute botch");
510 #endif
511
512 vc->nscreens++;
513 LIST_INSERT_HEAD(&vc->screens, scr, next);
514 }
515
516 void
517 vga_common_attach(struct vga_softc *sc, bus_space_tag_t iot,
518 bus_space_tag_t memt, int type, int quirks, const struct vga_funcs *vf)
519 {
520 int console;
521 struct vga_config *vc;
522 struct wsemuldisplaydev_attach_args aa;
523
524 console = vga_is_console(iot, type);
525
526 if (console) {
527 vc = &vga_console_vc;
528 vga_console_attached = 1;
529 } else {
530 vc = malloc(sizeof(struct vga_config), M_DEVBUF, M_WAITOK);
531 vga_raster_init(vc, iot, memt);
532 }
533
534 vc->vc_type = type;
535 vc->vc_funcs = vf;
536
537 sc->sc_vc = vc;
538 vc->softc = sc;
539
540 aa.console = console;
541 aa.scrdata = (vc->hdl.vh_mono ? &vga_screenlist_mono : &vga_screenlist);
542 aa.accessops = &vga_raster_accessops;
543 aa.accesscookie = vc;
544
545 config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
546 }
547
548 int
549 vga_is_console(bus_space_tag_t iot, int type)
550 {
551 if (vgaconsole &&
552 !vga_console_attached &&
553 iot == vga_console_vc.hdl.vh_iot &&
554 (vga_console_type == -1 || (type == vga_console_type)))
555 return (1);
556 return (0);
557 }
558
559 static int
560 vga_get_video(struct vga_config *vc)
561 {
562
563 return (vga_ts_read(&vc->hdl, mode) & VGA_TS_MODE_BLANK) == 0;
564 }
565
566 static void
567 vga_set_video(struct vga_config *vc, int state)
568 {
569 int val;
570
571 vga_ts_write(&vc->hdl, syncreset, 0x01);
572 if (state) { /* unblank screen */
573 val = vga_ts_read(&vc->hdl, mode);
574 vga_ts_write(&vc->hdl, mode, val & ~VGA_TS_MODE_BLANK);
575 #ifndef VGA_NO_VBLANK
576 val = vga_6845_read(&vc->hdl, mode);
577 vga_6845_write(&vc->hdl, mode, val | 0x80);
578 #endif
579 } else { /* blank screen */
580 val = vga_ts_read(&vc->hdl, mode);
581 vga_ts_write(&vc->hdl, mode, val | VGA_TS_MODE_BLANK);
582 #ifndef VGA_NO_VBLANK
583 val = vga_6845_read(&vc->hdl, mode);
584 vga_6845_write(&vc->hdl, mode, val & ~0x80);
585 #endif
586 }
587 vga_ts_write(&vc->hdl, syncreset, 0x03);
588 }
589
590 int
591 vga_raster_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
592 {
593 struct vga_config *vc = v;
594 const struct vga_funcs *vf = vc->vc_funcs;
595
596 switch (cmd) {
597 case WSDISPLAYIO_GTYPE:
598 *(int *)data = vc->vc_type;
599 return 0;
600
601 case WSDISPLAYIO_GINFO:
602 /* XXX should get detailed hardware information here */
603 return EPASSTHROUGH;
604
605 case WSDISPLAYIO_GVIDEO:
606 #if 1
607 *(int *)data = (vga_get_video(vc) ?
608 WSDISPLAYIO_VIDEO_ON : WSDISPLAYIO_VIDEO_OFF);
609 return 0;
610 #endif
611
612 case WSDISPLAYIO_SVIDEO:
613 #if 1
614 vga_set_video(vc, *(int *)data == WSDISPLAYIO_VIDEO_ON);
615 return 0;
616 #endif
617
618 case WSDISPLAYIO_GETCMAP:
619 case WSDISPLAYIO_PUTCMAP:
620 case WSDISPLAYIO_GCURPOS:
621 case WSDISPLAYIO_SCURPOS:
622 case WSDISPLAYIO_GCURMAX:
623 case WSDISPLAYIO_GCURSOR:
624 case WSDISPLAYIO_SCURSOR:
625 /* NONE of these operations are by the generic VGA driver. */
626 return EPASSTHROUGH;
627 }
628
629 if (vc->vc_funcs == NULL)
630 return (EPASSTHROUGH);
631
632 if (vf->vf_ioctl == NULL)
633 return (EPASSTHROUGH);
634
635 return ((*vf->vf_ioctl)(v, cmd, data, flag, p));
636 }
637
638 static paddr_t
639 vga_raster_mmap(void *v, off_t offset, int prot)
640 {
641 struct vga_config *vc = v;
642 const struct vga_funcs *vf = vc->vc_funcs;
643
644 if (vc->vc_funcs == NULL)
645 return (-1);
646
647 if (vf->vf_mmap == NULL)
648 return (-1);
649
650 return ((*vf->vf_mmap)(v, offset, prot));
651 }
652
653 int
654 vga_raster_alloc_screen(void *v, const struct wsscreen_descr *type,
655 void **cookiep, int *curxp, int *curyp, long *defattrp)
656 {
657 struct vga_config *vc = v;
658 struct vgascreen *scr;
659
660 if (vc->nscreens == 1) {
661 vc->screens.lh_first->mem = boot_scrmem;
662 }
663
664 scr = malloc(sizeof(struct vgascreen), M_DEVBUF, M_WAITOK);
665 vga_raster_init_screen(vc, scr, type, vc->nscreens == 0, defattrp);
666
667 if (vc->nscreens == 1) {
668 scr->active = 1;
669 vc->active = scr;
670 vc->currenttype = type;
671 } else {
672 scr->mem = malloc(sizeof(struct vga_scrmem) *
673 type->ncols * type->nrows, M_DEVBUF, M_WAITOK);
674 vga_raster_eraserows(scr, 0, type->nrows, *defattrp);
675 }
676
677 *cookiep = scr;
678 *curxp = scr->cursorcol;
679 *curyp = scr->cursorrow;
680
681 return (0);
682 }
683
684 void
685 vga_raster_free_screen(void *v, void *cookie)
686 {
687 struct vgascreen *vs = cookie;
688 struct vga_config *vc = vs->cfg;
689
690 LIST_REMOVE(vs, next);
691 if (vs != &vga_console_screen)
692 free(vs, M_DEVBUF);
693 else
694 panic("vga_raster_free_screen: console");
695
696 if (vc->active == vs)
697 vc->active = 0;
698 }
699
700 int
701 vga_raster_show_screen(void *v, void *cookie, int waitok,
702 void (*cb)(void *, int, int), void *cbarg)
703 {
704 struct vgascreen *scr = cookie, *oldscr;
705 struct vga_config *vc = scr->cfg;
706
707 oldscr = vc->active; /* can be NULL! */
708 if (scr == oldscr) {
709 return (0);
710 }
711
712 vc->wantedscreen = cookie;
713 vc->switchcb = cb;
714 vc->switchcbarg = cbarg;
715 if (cb) {
716 callout_reset(&vc->vc_switch_callout, 0,
717 (void(*)(void *))vga_switch_screen, vc);
718 return (EAGAIN);
719 }
720
721 vga_switch_screen(vc);
722 return (0);
723 }
724
725 void
726 vga_switch_screen(struct vga_config *vc)
727 {
728 struct vgascreen *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("vga_switch_screen: disappeared\n");
735 (*vc->switchcb)(vc->switchcbarg, EIO, 0);
736 return;
737 }
738 type = scr->type;
739 oldscr = vc->active; /* can be NULL! */
740 #ifdef DIAGNOSTIC
741 if (oldscr) {
742 if (!oldscr->active)
743 panic("vga_raster_show_screen: not active");
744 if (oldscr->type != vc->currenttype)
745 panic("vga_raster_show_screen: bad type");
746 }
747 #endif
748 if (scr == oldscr) {
749 return;
750 }
751 #ifdef DIAGNOSTIC
752 if (scr->active)
753 panic("vga_raster_show_screen: active");
754 #endif
755
756 if (oldscr)
757 oldscr->active = 0;
758
759 if (vc->currenttype != type) {
760 vga_raster_setscreentype(vc, type);
761 vc->currenttype = type;
762 }
763
764 scr->dispoffset = scr->mindispoffset;
765
766 if (!oldscr || (scr->dispoffset != oldscr->dispoffset)) {
767 vga_6845_write(vh, startadrh, scr->dispoffset >> 8);
768 vga_6845_write(vh, startadrl, scr->dispoffset);
769 }
770
771 /* Clear the entire screen. */
772 vga_gdc_write(vh, mode, 0x02);
773 bus_space_set_region_4(vh->vh_memt, vh->vh_allmemh, 0, 0, 0x2000);
774
775 scr->active = 1;
776 vga_restore_screen(scr, type, scr->mem);
777
778 vc->active = scr;
779
780 vga_raster_cursor(scr, scr->cursoron, scr->cursorrow, scr->cursorcol);
781
782 vc->wantedscreen = 0;
783 if (vc->switchcb)
784 (*vc->switchcb)(vc->switchcbarg, 0, 0);
785 }
786
787 static int
788 vga_raster_load_font(void *v, void *id, struct wsdisplay_font *data)
789 {
790 /* XXX */
791 printf("vga_raster_load_font: called\n");
792
793 return (0);
794 }
795
796 void
797 vga_raster_setup_font(struct vga_config *vc, struct vgascreen *scr)
798 {
799 struct vga_raster_font *vf;
800 struct wsdisplay_font *wf;
801 int cookie;
802
803 LIST_FOREACH(vf, &vc->vc_fontlist, next) {
804 if (wsfont_matches(vf->font, 0, 0, scr->type->fontheight, 0)) {
805 scr->encoding = vf->font->encoding;
806 LIST_INSERT_HEAD(&scr->fontset, vf, next);
807 return;
808 }
809 }
810
811 cookie = wsfont_find(NULL, 0, scr->type->fontheight, 0,
812 WSDISPLAY_FONTORDER_L2R, 0);
813 if (cookie == -1)
814 return;
815
816 if (wsfont_lock(cookie, &wf))
817 return;
818
819 vf = malloc(sizeof(struct vga_raster_font), M_DEVBUF, M_NOWAIT);
820 if (!vf) {
821 wsfont_unlock(cookie);
822 return;
823 }
824
825 vf->font = wf;
826 scr->encoding = vf->font->encoding;
827 LIST_INSERT_HEAD(&scr->fontset, vf, next);
828 }
829
830 void
831 vga_setup_regs(struct videomode *mode, struct vga_moderegs *regs)
832 {
833 int i;
834 int depth = 4; /* XXXBJY hardcoded for now */
835 const u_int8_t palette[] = {
836 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07,
837 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f
838 };
839
840 /*
841 * Compute hsync and vsync polarity.
842 */
843 if ((mode->flags & (VID_PHSYNC | VID_NHSYNC))
844 && (mode->flags & (VID_PVSYNC | VID_NVSYNC))) {
845 regs->miscout = 0x23;
846 if (mode->flags & VID_NHSYNC)
847 regs->miscout |= 0x40;
848 if (mode->flags & VID_NVSYNC)
849 regs->miscout |= 0x80;
850 } else {
851 if (mode->flags & VID_DBLSCAN)
852 mode->vdisplay *= 2;
853 if (mode->vdisplay < 400)
854 regs->miscout = 0xa3;
855 else if (mode->vdisplay < 480)
856 regs->miscout = 0x63;
857 else if (mode->vdisplay < 768)
858 regs->miscout = 0xe3;
859 else
860 regs->miscout = 0x23;
861 }
862
863 /*
864 * Time sequencer
865 */
866 if (depth == 4)
867 regs->ts[0] = 0x02;
868 else
869 regs->ts[0] = 0x00;
870 if (mode->flags & VID_CLKDIV2)
871 regs->ts[1] = 0x09;
872 else
873 regs->ts[1] = 0x01;
874 regs->ts[2] = 0x0f;
875 regs->ts[3] = 0x00;
876 if (depth < 8)
877 regs->ts[4] = 0x06;
878 else
879 regs->ts[4] = 0x0e;
880
881 /*
882 * CRTC controller
883 */
884 regs->crtc[0] = (mode->htotal >> 3) - 5;
885 regs->crtc[1] = (mode->hdisplay >> 3) - 1;
886 regs->crtc[2] = (mode->hsync_start >> 3) - 1;
887 regs->crtc[3] = (((mode->hsync_end >> 3) - 1) & 0x1f) | 0x80;
888 regs->crtc[4] = mode->hsync_start >> 3;
889 regs->crtc[5] = ((((mode->hsync_end >> 3) - 1) & 0x20) << 2)
890 | (((mode->hsync_end >> 3)) & 0x1f);
891 regs->crtc[6] = (mode->vtotal - 2) & 0xff;
892 regs->crtc[7] = (((mode->vtotal - 2) & 0x100) >> 8)
893 | (((mode->vdisplay - 1) & 0x100) >> 7)
894 | ((mode->vsync_start & 0x100) >> 6)
895 | (((mode->vsync_start - 1) & 0x100) >> 5)
896 | 0x10
897 | (((mode->vtotal - 2) & 0x200) >> 4)
898 | (((mode->vdisplay - 1) & 0x200) >> 3)
899 | ((mode->vsync_start & 0x200) >> 2);
900 regs->crtc[8] = 0x00;
901 regs->crtc[9] = (((mode->vsync_start - 1) & 0x200) >> 4) | 0x40;
902 if (mode->flags & VID_DBLSCAN)
903 regs->crtc[9] |= 0x80;
904 regs->crtc[10] = 0x00;
905 regs->crtc[11] = 0x00;
906 regs->crtc[12] = 0x00;
907 regs->crtc[13] = 0x00;
908 regs->crtc[14] = 0x00;
909 regs->crtc[15] = 0x00;
910 regs->crtc[16] = mode->vsync_start & 0xff;
911 regs->crtc[17] = (mode->vsync_end & 0x0f) | 0x20;
912 regs->crtc[18] = (mode->vdisplay - 1) & 0xff;
913 regs->crtc[19] = mode->hdisplay >> 4; /* XXXBJY */
914 regs->crtc[20] = 0x00;
915 regs->crtc[21] = (mode->vsync_start - 1) & 0xff;
916 regs->crtc[22] = (mode->vsync_end - 1) & 0xff;
917 if (depth < 8)
918 regs->crtc[23] = 0xe3;
919 else
920 regs->crtc[23] = 0xc3;
921 regs->crtc[24] = 0xff;
922
923 /*
924 * Graphics display controller
925 */
926 regs->gdc[0] = 0x00;
927 regs->gdc[1] = 0x00;
928 regs->gdc[2] = 0x00;
929 regs->gdc[3] = 0x00;
930 regs->gdc[4] = 0x00;
931 if (depth == 4)
932 regs->gdc[5] = 0x02;
933 else
934 regs->gdc[5] = 0x40;
935 regs->gdc[6] = 0x01;
936 regs->gdc[7] = 0x0f;
937 regs->gdc[8] = 0xff;
938
939 /*
940 * Attribute controller
941 */
942 /* Set palette registers. */
943 for (i = 0; i < 16; i++)
944 regs->atc[i] = palette[i];
945 if (depth == 4)
946 regs->atc[16] = 0x01; /* XXXBJY was 0x81 in XFree86 */
947 else
948 regs->atc[16] = 0x41;
949 regs->atc[17] = 0x00; /* XXXBJY just a guess */
950 regs->atc[18] = 0x0f;
951 regs->atc[19] = 0x00;
952 regs->atc[20] = 0x00;
953 }
954
955 void
956 vga_set_mode(struct vga_handle *vh, struct vga_moderegs *regs)
957 {
958 int i;
959
960 /* Disable display. */
961 vga_ts_write(vh, mode, vga_ts_read(vh, mode) | VGA_TS_MODE_BLANK);
962
963 /* Write misc output register. */
964 bus_space_write_1(vh->vh_iot, vh->vh_ioh_vga, VGA_MISC_DATAW,
965 regs->miscout);
966
967 /* Set synchronous reset. */
968 vga_ts_write(vh, syncreset, 0x01);
969 vga_ts_write(vh, mode, regs->ts[1] | VGA_TS_MODE_BLANK);
970 for (i = 2; i < VGA_TS_NREGS; i++)
971 _vga_ts_write(vh, i, regs->ts[i]);
972 /* Clear synchronous reset. */
973 vga_ts_write(vh, syncreset, 0x03);
974
975 /* Unprotect CRTC registers 0-7. */
976 vga_6845_write(vh, vsynce, vga_6845_read(vh, vsynce) & ~0x80);
977 /* Write CRTC registers. */
978 for (i = 0; i < MC6845_NREGS; i++)
979 _vga_6845_write(vh, i, regs->crtc[i]);
980
981 /* Write graphics display registers. */
982 for (i = 0; i < VGA_GDC_NREGS; i++)
983 _vga_gdc_write(vh, i, regs->gdc[i]);
984
985 /* Write attribute controller registers. */
986 for (i = 0; i < VGA_ATC_NREGS; i++)
987 _vga_attr_write(vh, i, regs->atc[i]);
988
989 /* Enable display. */
990 vga_ts_write(vh, mode, vga_ts_read(vh, mode) & ~VGA_TS_MODE_BLANK);
991 }
992
993 void
994 vga_raster_cursor_init(struct vgascreen *scr, int existing)
995 {
996 struct vga_handle *vh = scr->hdl;
997 bus_space_tag_t memt;
998 bus_space_handle_t memh;
999 int off;
1000
1001 if (existing) {
1002 /*
1003 * This is the first screen. At this point, scr->active is
1004 * false, so we can't use vga_raster_cursor() to do this.
1005 */
1006 memt = vh->vh_memt;
1007 memh = vh->vh_memh;
1008 off = (scr->cursorrow * scr->type->ncols + scr->cursorcol) +
1009 scr->dispoffset / 8;
1010
1011 scr->cursortmp = scr->mem[off];
1012 vga_raster_putchar(scr, scr->cursorrow, scr->cursorcol,
1013 scr->cursortmp.ch, scr->cursortmp.attr ^ 0x77);
1014 } else {
1015 scr->cursortmp.ch = 0;
1016 scr->cursortmp.attr = 0;
1017 scr->cursortmp.second = 0;
1018 scr->cursortmp.enc = scr->encoding;
1019 }
1020
1021 scr->cursoron = 1;
1022 }
1023
1024 void
1025 vga_raster_cursor(void *id, int on, int row, int col)
1026 {
1027 struct vgascreen *scr = id;
1028 int off, tmp;
1029
1030 /* Remove old cursor image */
1031 if (scr->cursoron) {
1032 off = scr->cursorrow * scr->type->ncols + scr->cursorcol;
1033 if (scr->active) {
1034 tmp = scr->encoding;
1035 scr->encoding = scr->cursortmp.enc;
1036 if (scr->cursortmp.second)
1037 vga_raster_putchar(id, scr->cursorrow,
1038 scr->cursorcol - 1, scr->cursortmp.ch,
1039 scr->cursortmp.attr);
1040 else
1041 vga_raster_putchar(id, scr->cursorrow,
1042 scr->cursorcol, scr->cursortmp.ch,
1043 scr->cursortmp.attr);
1044 scr->encoding = tmp;
1045 }
1046 }
1047
1048 scr->cursorrow = row;
1049 scr->cursorcol = col;
1050
1051 if ((scr->cursoron = on) == 0)
1052 return;
1053
1054 off = scr->cursorrow * scr->type->ncols + scr->cursorcol;
1055 scr->cursortmp = scr->mem[off];
1056 if (scr->active) {
1057 tmp = scr->encoding;
1058 scr->encoding = scr->cursortmp.enc;
1059 if (scr->cursortmp.second)
1060 vga_raster_putchar(id, scr->cursorrow,
1061 scr->cursorcol - 1, scr->cursortmp.ch,
1062 scr->cursortmp.attr ^ 0x77);
1063 else
1064 vga_raster_putchar(id, scr->cursorrow,
1065 scr->cursorcol, scr->cursortmp.ch,
1066 scr->cursortmp.attr ^ 0x77);
1067 scr->encoding = tmp;
1068 }
1069 }
1070
1071 static int
1072 vga_raster_mapchar(void *id, int uni, u_int *index)
1073 {
1074 struct vgascreen *scr = id;
1075
1076 if (scr->encoding == WSDISPLAY_FONTENC_IBM)
1077 return pcdisplay_mapchar(id, uni, index);
1078 else {
1079 *index = uni;
1080 return 5;
1081 }
1082 }
1083
1084 void
1085 vga_raster_putchar(void *id, int row, int col, u_int c, long attr)
1086 {
1087 struct vgascreen *scr = id;
1088 size_t off;
1089 struct vga_raster_font *fs;
1090 u_int tmp_ch;
1091
1092 off = row * scr->type->ncols + col;
1093
1094 if (__predict_false(off >= (scr->type->ncols * scr->type->nrows)))
1095 return;
1096
1097 LIST_FOREACH(fs, &scr->fontset, next) {
1098 if ((scr->encoding == fs->font->encoding) &&
1099 (c >= fs->font->firstchar) &&
1100 (c < fs->font->firstchar + fs->font->numchars) &&
1101 (scr->type->fontheight == fs->font->fontheight)) {
1102 if (scr->active) {
1103 tmp_ch = c - fs->font->firstchar;
1104 _vga_raster_putchar(scr, row, col, tmp_ch,
1105 attr, fs);
1106 }
1107
1108 scr->mem[off].ch = c;
1109 scr->mem[off].attr = attr;
1110 scr->mem[off].second = 0;
1111 scr->mem[off].enc = fs->font->encoding;
1112
1113 if (fs->font->stride == 2) {
1114 scr->mem[off + 1].ch = c;
1115 scr->mem[off + 1].attr = attr;
1116 scr->mem[off + 1].second = 1;
1117 scr->mem[off + 1].enc = fs->font->encoding;
1118 }
1119
1120 return;
1121 }
1122 }
1123
1124 /*
1125 * No match found.
1126 */
1127 if (scr->active)
1128 /*
1129 * Put a single width space character no matter what the
1130 * actual width of the character is.
1131 */
1132 _vga_raster_putchar(scr, row, col, ' ', attr,
1133 &vga_console_fontset_ascii);
1134 scr->mem[off].ch = c;
1135 scr->mem[off].attr = attr;
1136 scr->mem[off].second = 0;
1137 scr->mem[off].enc = scr->encoding;
1138 }
1139
1140 static void
1141 _vga_raster_putchar(void *id, int row, int col, u_int c, long attr,
1142 struct vga_raster_font *fs)
1143 {
1144 struct vgascreen *scr = id;
1145 struct vga_handle *vh = scr->hdl;
1146 bus_space_tag_t memt = vh->vh_memt;
1147 bus_space_handle_t memh = vh->vh_memh;
1148 int i;
1149 int rasoff, rasoff2;
1150 int fheight = scr->type->fontheight;
1151 volatile u_int8_t dummy, pattern;
1152 u_int8_t fgcolor, bgcolor;
1153
1154 rasoff = scr->dispoffset + row * scr->type->ncols * fheight + col;
1155 rasoff2 = rasoff;
1156
1157 #if 0
1158 bgcolor = bgansitopc[attr >> 4];
1159 fgcolor = fgansitopc[attr & 0x0f];
1160 #else
1161 bgcolor = ((attr >> 4) & 0x0f);
1162 fgcolor = attr & 0x0f;
1163 #endif
1164
1165 if (fs->font->stride == 1) {
1166 /* Paint background. */
1167 vga_gdc_write(vh, mode, 0x02);
1168 for (i = 0; i < fheight; i++) {
1169 bus_space_write_1(memt, memh, rasoff, bgcolor);
1170 rasoff += scr->type->ncols;
1171 }
1172
1173 /* Draw a single width character. */
1174 vga_gdc_write(vh, mode, 0x03);
1175 vga_gdc_write(vh, setres, fgcolor);
1176 for (i = 0; i < fheight; i++) {
1177 pattern = ((u_int8_t *)fs->font->data)[c * fheight + i];
1178 /* When pattern is 0, skip output for speed-up. */
1179 if (pattern != 0) {
1180 dummy = bus_space_read_1(memt, memh, rasoff2);
1181 bus_space_write_1(memt, memh, rasoff2, pattern);
1182 }
1183 rasoff2 += scr->type->ncols;
1184 }
1185 } else if (fs->font->stride == 2) {
1186 /* Paint background. */
1187 vga_gdc_write(vh, mode, 0x02);
1188 for (i = 0; i < fheight; i++) {
1189 bus_space_write_1(memt, memh, rasoff, bgcolor);
1190 bus_space_write_1(memt, memh, rasoff + 1, bgcolor);
1191 rasoff += scr->type->ncols;
1192 }
1193
1194 /* Draw a double width character. */
1195 vga_gdc_write(vh, mode, 0x03);
1196 vga_gdc_write(vh, setres, fgcolor);
1197 for (i = 0; i < fheight; i++) {
1198 pattern = ((u_int8_t *)fs->font->data)
1199 [(c * fheight + i) * 2];
1200 if (pattern != 0) {
1201 dummy = bus_space_read_1(memt, memh, rasoff2);
1202 bus_space_write_1(memt, memh, rasoff2, pattern);
1203 }
1204 pattern = ((u_int8_t *)fs->font->data)
1205 [(c * fheight + i) * 2 + 1];
1206 if (pattern != 0) {
1207 rasoff2++;
1208 dummy = bus_space_read_1(memt, memh, rasoff2);
1209 bus_space_write_1(memt, memh, rasoff2, pattern);
1210 rasoff2--;
1211 }
1212 rasoff2 += scr->type->ncols;
1213 }
1214 }
1215 }
1216
1217 void
1218 vga_raster_copycols(void *id, int row, int srccol, int dstcol, int ncols)
1219 {
1220 struct vgascreen *scr = id;
1221 struct vga_handle *vh = scr->hdl;
1222 bus_space_tag_t memt = vh->vh_memt;
1223 bus_space_handle_t memh = vh->vh_memh;
1224 bus_size_t srcoff, dstoff;
1225 bus_size_t rassrcoff, rasdstoff;
1226 int i;
1227 int fheight = scr->type->fontheight;
1228
1229 srcoff = row * scr->type->ncols + srccol;
1230 dstoff = row * scr->type->ncols + dstcol;
1231 rassrcoff = scr->dispoffset + row * scr->type->ncols * fheight + srccol;
1232 rasdstoff = scr->dispoffset + row * scr->type->ncols * fheight + dstcol;
1233
1234 memcpy(&scr->mem[dstoff], &scr->mem[srcoff],
1235 ncols * sizeof(struct vga_scrmem));
1236
1237 vga_gdc_write(vh, mode, 0x01);
1238 if (scr->active) {
1239 for (i = 0; i < fheight; i++) {
1240 bus_space_copy_region_1(memt, memh,
1241 rassrcoff + i * scr->type->ncols, memh,
1242 rasdstoff + i * scr->type->ncols, ncols);
1243 }
1244 }
1245 }
1246
1247 void
1248 vga_raster_erasecols(void *id, int row, int startcol, int ncols, long fillattr)
1249 {
1250 struct vgascreen *scr = id;
1251 int i;
1252
1253 if (scr->active == 0)
1254 return;
1255
1256 for (i = startcol; i < startcol + ncols; i++)
1257 vga_raster_putchar(id, row, i, ' ', fillattr);
1258 }
1259
1260 void
1261 vga_raster_copyrows(void *id, int srcrow, int dstrow, int nrows)
1262 {
1263 struct vgascreen *scr = id;
1264 struct vga_handle *vh = scr->hdl;
1265 bus_space_tag_t memt = vh->vh_memt;
1266 bus_space_handle_t memh = vh->vh_memh;
1267 int ncols;
1268 bus_size_t srcoff, dstoff;
1269 bus_size_t rassrcoff, rasdstoff;
1270 int fheight;
1271
1272 ncols = scr->type->ncols;
1273 fheight = scr->type->fontheight;
1274
1275 srcoff = srcrow * ncols;
1276 dstoff = dstrow * ncols;
1277 rassrcoff = srcoff * fheight;
1278 rasdstoff = dstoff * fheight;
1279
1280 if (scr->active) {
1281 vga_gdc_write(vh, mode, 0x01);
1282 if (dstrow == 0 && (srcrow + nrows == scr->type->nrows)) {
1283 int cursoron = scr->cursoron;
1284
1285 if (cursoron)
1286 /* Disable cursor. */
1287 vga_raster_cursor(scr, 0,
1288 scr->cursorrow, scr->cursorcol);
1289
1290 /* scroll up whole screen */
1291 if ((scr->dispoffset + srcrow * ncols * fheight)
1292 <= scr->maxdispoffset)
1293 scr->dispoffset += srcrow * ncols * fheight;
1294 else {
1295 bus_space_copy_region_1(memt, memh,
1296 scr->dispoffset + rassrcoff,
1297 memh, scr->mindispoffset,
1298 nrows * ncols * fheight);
1299 scr->dispoffset = scr->mindispoffset;
1300 }
1301 vga_6845_write(vh, startadrh, scr->dispoffset >> 8);
1302 vga_6845_write(vh, startadrl, scr->dispoffset);
1303
1304 if (cursoron)
1305 /* Enable cursor. */
1306 vga_raster_cursor(scr, 1, scr->cursorrow,
1307 scr->cursorcol);
1308 } else
1309 bus_space_copy_region_1(memt, memh,
1310 scr->dispoffset + rassrcoff, memh,
1311 scr->dispoffset + rasdstoff,
1312 nrows * ncols * fheight);
1313 }
1314 memcpy(&scr->mem[dstoff], &scr->mem[srcoff],
1315 nrows * ncols * sizeof(struct vga_scrmem));
1316 }
1317
1318 void
1319 vga_raster_eraserows(void *id, int startrow, int nrows, long fillattr)
1320 {
1321 struct vgascreen *scr = id;
1322 struct vga_handle *vh = scr->hdl;
1323 bus_space_tag_t memt = vh->vh_memt;
1324 bus_space_handle_t memh = vh->vh_memh;
1325 bus_size_t off, count;
1326 bus_size_t rasoff, rascount;
1327 int i;
1328
1329 off = startrow * scr->type->ncols;
1330 count = nrows * scr->type->ncols;
1331 rasoff = off * scr->type->fontheight;
1332 rascount = count * scr->type->fontheight;
1333
1334 if (scr->active) {
1335 /* Paint background. */
1336 vga_gdc_write(vh, mode, 0x02);
1337 if (scr->type->ncols % 4 == 0)
1338 /* We can speed up I/O */
1339 for (i = rasoff; i < rasoff + rascount; i += 4)
1340 bus_space_write_4(memt, memh,
1341 scr->dispoffset + i, fillattr >> 4);
1342 else
1343 for (i = rasoff; i < rasoff + rascount; i += 2)
1344 bus_space_write_2(memt, memh,
1345 scr->dispoffset + i, fillattr >> 4);
1346 }
1347 for (i = 0; i < count; i++) {
1348 scr->mem[off + i].ch = ' ';
1349 scr->mem[off + i].attr = fillattr;
1350 scr->mem[off + i].second = 0;
1351 scr->mem[off + i].enc = scr->encoding;
1352 }
1353 }
1354
1355 static int
1356 vga_raster_allocattr(void *id, int fg, int bg, int flags, long *attrp)
1357 {
1358 struct vgascreen *scr = id;
1359 struct vga_config *vc = scr->cfg;
1360
1361 if (__predict_false((unsigned int)fg >= sizeof(fgansitopc) ||
1362 (unsigned int)bg >= sizeof(bgansitopc)))
1363 return (EINVAL);
1364
1365 if (vc->hdl.vh_mono) {
1366 if (flags & WSATTR_WSCOLORS)
1367 return (EINVAL);
1368 if (flags & WSATTR_REVERSE)
1369 *attrp = 0x70;
1370 else
1371 *attrp = 0x07;
1372 if (flags & WSATTR_UNDERLINE)
1373 *attrp |= FG_UNDERLINE;
1374 if (flags & WSATTR_HILIT)
1375 *attrp |= FG_INTENSE;
1376 } else {
1377 if (flags & (WSATTR_UNDERLINE | WSATTR_REVERSE))
1378 return (EINVAL);
1379 if (flags & WSATTR_WSCOLORS)
1380 *attrp = fgansitopc[fg] | bgansitopc[bg];
1381 else
1382 *attrp = 7;
1383 if (flags & WSATTR_HILIT)
1384 *attrp += 8;
1385 }
1386 if (flags & WSATTR_BLINK)
1387 *attrp |= FG_BLINK;
1388 return (0);
1389 }
1390
1391 void
1392 vga_restore_screen(struct vgascreen *scr,
1393 const struct wsscreen_descr *type, struct vga_scrmem *mem)
1394 {
1395 int i, j, off, tmp;
1396
1397 tmp = scr->encoding;
1398 for (i = 0; i < type->nrows; i++) {
1399 for (j = 0; j < type->ncols; j++) {
1400 off = i * type->ncols + j;
1401 if (mem[off].second != 1) {
1402 scr->encoding = mem[off].enc;
1403 vga_raster_putchar(scr, i, j, mem[off].ch,
1404 mem[off].attr);
1405 }
1406 }
1407 }
1408 scr->encoding = tmp;
1409 }
1410
1411 void
1412 vga_raster_setscreentype(struct vga_config *vc,
1413 const struct wsscreen_descr *type)
1414 {
1415 struct vga_handle *vh = &vc->hdl;
1416 struct vga_moderegs moderegs;
1417
1418 vga_setup_regs((struct videomode *)type->modecookie, &moderegs);
1419 vga_set_mode(vh, &moderegs);
1420 }
Cache object: 33b32d241ab77b623877e4b0a4b71b09
|