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