wsdisplay_vcons.c revision 1.3 1 1.3 macallan /* $NetBSD: wsdisplay_vcons.c,v 1.3 2006/02/14 16:02:00 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (c) 2005, 2006 Michael Lorenz
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * Redistribution and use in source and binary forms, with or without
8 1.1 macallan * modification, are permitted provided that the following conditions
9 1.1 macallan * are met:
10 1.1 macallan * 1. Redistributions of source code must retain the above copyright
11 1.1 macallan * notice, this list of conditions and the following disclaimer.
12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 macallan * notice, this list of conditions and the following disclaimer in the
14 1.1 macallan * documentation and/or other materials provided with the distribution.
15 1.1 macallan * 3. All advertising materials mentioning features or use of this software
16 1.1 macallan * must display the following acknowledgement:
17 1.1 macallan * This product includes software developed by the NetBSD
18 1.1 macallan * Foundation, Inc. and its contributors.
19 1.1 macallan * 4. Neither the name of The NetBSD Foundation nor the names of its
20 1.1 macallan * contributors may be used to endorse or promote products derived
21 1.1 macallan * from this software without specific prior written permission.
22 1.1 macallan *
23 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
24 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
25 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
27 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
34 1.1 macallan */
35 1.1 macallan
36 1.1 macallan #include <sys/cdefs.h>
37 1.3 macallan __KERNEL_RCSID(0, "$NetBSD: wsdisplay_vcons.c,v 1.3 2006/02/14 16:02:00 macallan Exp $");
38 1.1 macallan
39 1.1 macallan #include <sys/param.h>
40 1.1 macallan #include <sys/systm.h>
41 1.1 macallan #include <sys/kernel.h>
42 1.1 macallan #include <sys/buf.h>
43 1.1 macallan #include <sys/device.h>
44 1.1 macallan #include <sys/ioctl.h>
45 1.1 macallan #include <sys/malloc.h>
46 1.1 macallan #include <sys/mman.h>
47 1.1 macallan #include <sys/tty.h>
48 1.1 macallan #include <sys/conf.h>
49 1.1 macallan #include <sys/proc.h>
50 1.1 macallan #include <sys/kthread.h>
51 1.1 macallan #include <sys/tprintf.h>
52 1.1 macallan
53 1.1 macallan #include <dev/wscons/wsdisplayvar.h>
54 1.1 macallan #include <dev/wscons/wsconsio.h>
55 1.1 macallan #include <dev/wsfont/wsfont.h>
56 1.1 macallan #include <dev/rasops/rasops.h>
57 1.1 macallan
58 1.1 macallan #include <dev/wscons/wsdisplay_vconsvar.h>
59 1.1 macallan
60 1.1 macallan static void vcons_dummy_init_screen(void *, struct vcons_screen *, int,
61 1.1 macallan long *);
62 1.1 macallan
63 1.1 macallan static int vcons_alloc_screen(void *, const struct wsscreen_descr *, void **,
64 1.1 macallan int *, int *, long *);
65 1.1 macallan static void vcons_free_screen(void *, void *);
66 1.1 macallan static int vcons_show_screen(void *, void *, int, void (*)(void *, int, int),
67 1.1 macallan void *);
68 1.1 macallan
69 1.1 macallan static void vcons_do_switch(struct vcons_data *);
70 1.1 macallan
71 1.1 macallan /* methods that work only on text buffers */
72 1.1 macallan static void vcons_copycols_buffer(void *, int, int, int, int);
73 1.1 macallan static void vcons_erasecols_buffer(void *, int, int, int, long);
74 1.1 macallan static void vcons_copyrows_buffer(void *, int, int, int);
75 1.1 macallan static void vcons_eraserows_buffer(void *, int, int, long);
76 1.1 macallan static void vcons_putchar_buffer(void *, int, int, u_int, long);
77 1.1 macallan
78 1.1 macallan /*
79 1.1 macallan * actual wrapper methods which call both the _buffer ones above and the
80 1.1 macallan * driver supplied ones to do the drawing
81 1.1 macallan */
82 1.1 macallan static void vcons_copycols(void *, int, int, int, int);
83 1.1 macallan static void vcons_erasecols(void *, int, int, int, long);
84 1.1 macallan static void vcons_copyrows(void *, int, int, int);
85 1.1 macallan static void vcons_eraserows(void *, int, int, long);
86 1.1 macallan static void vcons_putchar(void *, int, int, u_int, long);
87 1.1 macallan static void vcons_cursor(void *, int, int, int);
88 1.1 macallan
89 1.1 macallan /* support for readin/writing text buffers. For wsmoused */
90 1.1 macallan static int vcons_putwschar(void *, struct wsdisplay_char *);
91 1.1 macallan static int vcons_getwschar(void *, struct wsdisplay_char *);
92 1.1 macallan
93 1.1 macallan static void vcons_lock(struct vcons_screen *);
94 1.1 macallan static void vcons_unlock(struct vcons_screen *);
95 1.1 macallan
96 1.1 macallan
97 1.1 macallan int
98 1.1 macallan vcons_init(struct vcons_data *vd, void *cookie, struct wsscreen_descr *def,
99 1.1 macallan struct wsdisplay_accessops *ao)
100 1.1 macallan {
101 1.2 macallan
102 1.2 macallan /* zero out everything so we can rely on untouched fields being 0 */
103 1.3 macallan memset(vd, 0, sizeof(struct vcons_data));
104 1.2 macallan
105 1.1 macallan vd->cookie = cookie;
106 1.1 macallan
107 1.1 macallan vd->init_screen = vcons_dummy_init_screen;
108 1.1 macallan vd->show_screen_cb = NULL;
109 1.1 macallan
110 1.1 macallan ao->alloc_screen = vcons_alloc_screen;
111 1.1 macallan ao->free_screen = vcons_free_screen;
112 1.1 macallan ao->show_screen = vcons_show_screen;
113 1.1 macallan ao->getwschar = vcons_getwschar;
114 1.1 macallan ao->putwschar = vcons_putwschar;
115 1.1 macallan
116 1.1 macallan LIST_INIT(&vd->screens);
117 1.1 macallan vd->active = NULL;
118 1.1 macallan vd->wanted = NULL;
119 1.1 macallan vd->currenttype = def;
120 1.1 macallan callout_init(&vd->switch_callout);
121 1.1 macallan
122 1.1 macallan /*
123 1.1 macallan * a lock to serialize access to the framebuffer.
124 1.1 macallan * when switching screens we need to make sure there's no rasops
125 1.1 macallan * operation in progress
126 1.1 macallan */
127 1.1 macallan #ifdef DIAGNOSTIC
128 1.1 macallan vd->switch_poll_count = 0;
129 1.1 macallan #endif
130 1.1 macallan return 0;
131 1.1 macallan }
132 1.1 macallan
133 1.1 macallan static void
134 1.1 macallan vcons_lock(struct vcons_screen *scr)
135 1.1 macallan {
136 1.1 macallan #ifdef VCONS_PARANOIA
137 1.1 macallan int s;
138 1.1 macallan
139 1.1 macallan s = splhigh();
140 1.1 macallan #endif
141 1.1 macallan SCREEN_BUSY(scr);
142 1.1 macallan #ifdef VCONS_PARANOIA
143 1.1 macallan splx(s);
144 1.1 macallan #endif
145 1.1 macallan }
146 1.1 macallan
147 1.1 macallan static void
148 1.1 macallan vcons_unlock(struct vcons_screen *scr)
149 1.1 macallan {
150 1.1 macallan #ifdef VCONS_PARANOIA
151 1.1 macallan int s;
152 1.1 macallan
153 1.1 macallan s = splhigh();
154 1.1 macallan #endif
155 1.1 macallan SCREEN_IDLE(scr);
156 1.1 macallan #ifdef VCONS_PARANOIA
157 1.1 macallan splx(s);
158 1.1 macallan #endif
159 1.1 macallan }
160 1.1 macallan
161 1.1 macallan static void
162 1.1 macallan vcons_dummy_init_screen(void *cookie, struct vcons_screen *scr, int exists,
163 1.1 macallan long *defattr)
164 1.1 macallan {
165 1.1 macallan
166 1.1 macallan /*
167 1.1 macallan * default init_screen() method.
168 1.1 macallan * Needs to be overwritten so we bitch and whine in case anyone ends
169 1.1 macallan * up in here.
170 1.1 macallan */
171 1.1 macallan printf("vcons_init_screen: dummy function called. Your driver is "
172 1.1 macallan "supposed to supply a replacement for proper operation\n");
173 1.1 macallan }
174 1.1 macallan
175 1.1 macallan int
176 1.1 macallan vcons_init_screen(struct vcons_data *vd, struct vcons_screen *scr,
177 1.1 macallan int existing, long *defattr)
178 1.1 macallan {
179 1.1 macallan struct rasops_info *ri = &scr->scr_ri;
180 1.1 macallan int cnt, i;
181 1.1 macallan
182 1.1 macallan scr->scr_cookie = vd->cookie;
183 1.1 macallan scr->scr_vd = vd;
184 1.2 macallan SCREEN_IDLE(scr);
185 1.2 macallan
186 1.1 macallan /*
187 1.1 macallan * call the driver-supplied init_screen function which is expected
188 1.1 macallan * to set up rasops_info, override cursor() and probably others
189 1.1 macallan */
190 1.1 macallan vd->init_screen(vd->cookie, scr, existing, defattr);
191 1.1 macallan
192 1.1 macallan /*
193 1.1 macallan * save the non virtual console aware rasops and replace them with
194 1.1 macallan * our wrappers
195 1.1 macallan */
196 1.1 macallan vd->eraserows = ri->ri_ops.eraserows;
197 1.1 macallan vd->copyrows = ri->ri_ops.copyrows;
198 1.1 macallan vd->erasecols = ri->ri_ops.erasecols;
199 1.1 macallan vd->copycols = ri->ri_ops.copycols;
200 1.1 macallan vd->putchar = ri->ri_ops.putchar;
201 1.1 macallan vd->cursor = ri->ri_ops.cursor;
202 1.1 macallan
203 1.1 macallan ri->ri_ops.eraserows = vcons_eraserows;
204 1.1 macallan ri->ri_ops.copyrows = vcons_copyrows;
205 1.1 macallan ri->ri_ops.erasecols = vcons_erasecols;
206 1.1 macallan ri->ri_ops.copycols = vcons_copycols;
207 1.1 macallan ri->ri_ops.putchar = vcons_putchar;
208 1.1 macallan ri->ri_ops.cursor = vcons_cursor;
209 1.1 macallan ri->ri_hw = scr;
210 1.1 macallan
211 1.1 macallan /*
212 1.1 macallan * we allocate both chars and attributes in one chunk, attributes first
213 1.1 macallan * because they have the (potentially) bigger alignment
214 1.1 macallan */
215 1.1 macallan cnt = ri->ri_rows * ri->ri_cols;
216 1.1 macallan scr->scr_attrs = (long *)malloc(cnt * (sizeof(long) +
217 1.1 macallan sizeof(uint16_t)), M_DEVBUF, M_WAITOK);
218 1.1 macallan if (scr->scr_attrs == NULL)
219 1.1 macallan return ENOMEM;
220 1.1 macallan
221 1.1 macallan scr->scr_chars = (uint16_t *)&scr->scr_attrs[cnt];
222 1.1 macallan
223 1.1 macallan ri->ri_ops.allocattr(ri, WS_DEFAULT_FG, WS_DEFAULT_BG, 0, defattr);
224 1.1 macallan scr->scr_defattr = *defattr;
225 1.1 macallan
226 1.1 macallan /*
227 1.1 macallan * fill the attribute buffer with *defattr, chars with 0x20
228 1.1 macallan * since we don't know if the driver tries to mimic firmware output or
229 1.1 macallan * reset everything we do nothing to VRAM here, any driver that feels
230 1.1 macallan * the need to clear screen or something will have to do it on its own
231 1.1 macallan * Additional screens will start out in the background anyway so
232 1.1 macallan * cleaning or not only really affects the initial console screen
233 1.1 macallan */
234 1.1 macallan for (i = 0; i < cnt; i++) {
235 1.1 macallan scr->scr_attrs[i] = *defattr;
236 1.1 macallan scr->scr_chars[i] = 0x20;
237 1.1 macallan }
238 1.1 macallan
239 1.2 macallan if(vd->active == NULL) {
240 1.2 macallan vd->active = scr;
241 1.2 macallan SCREEN_VISIBLE(scr);
242 1.2 macallan }
243 1.2 macallan
244 1.1 macallan if (existing) {
245 1.2 macallan SCREEN_VISIBLE(scr);
246 1.2 macallan vd->active = scr;
247 1.1 macallan } else {
248 1.2 macallan SCREEN_INVISIBLE(scr);
249 1.1 macallan }
250 1.1 macallan
251 1.1 macallan LIST_INSERT_HEAD(&vd->screens, scr, next);
252 1.1 macallan return 0;
253 1.1 macallan }
254 1.1 macallan
255 1.1 macallan static void
256 1.1 macallan vcons_do_switch(struct vcons_data *vd)
257 1.1 macallan {
258 1.1 macallan struct vcons_screen *scr, *oldscr;
259 1.1 macallan
260 1.1 macallan scr = vd->wanted;
261 1.1 macallan if (!scr) {
262 1.1 macallan printf("vcons_switch_screen: disappeared\n");
263 1.1 macallan vd->switch_cb(vd->switch_cb_arg, EIO, 0);
264 1.1 macallan return;
265 1.1 macallan }
266 1.1 macallan oldscr = vd->active; /* can be NULL! */
267 1.1 macallan
268 1.1 macallan /*
269 1.1 macallan * if there's an old, visible screen we mark it invisible and wait
270 1.1 macallan * until it's not busy so we can safely switch
271 1.1 macallan */
272 1.1 macallan if (oldscr != NULL) {
273 1.1 macallan SCREEN_INVISIBLE(oldscr);
274 1.1 macallan if (SCREEN_IS_BUSY(oldscr)) {
275 1.1 macallan callout_reset(&vd->switch_callout, 1,
276 1.1 macallan (void(*)(void *))vcons_do_switch, vd);
277 1.1 macallan #ifdef DIAGNOSTIC
278 1.1 macallan /* bitch if we wait too long */
279 1.1 macallan vd->switch_poll_count++;
280 1.1 macallan if (vd->switch_poll_count > 100) {
281 1.1 macallan panic("vcons: screen still busy");
282 1.1 macallan }
283 1.1 macallan #endif
284 1.1 macallan return;
285 1.1 macallan }
286 1.1 macallan /* invisible screen -> no visible cursor image */
287 1.1 macallan oldscr->scr_ri.ri_flg &= ~RI_CURSOR;
288 1.1 macallan #ifdef DIAGNOSTIC
289 1.1 macallan vd->switch_poll_count = 0;
290 1.1 macallan #endif
291 1.1 macallan }
292 1.1 macallan
293 1.1 macallan if (scr == oldscr)
294 1.1 macallan return;
295 1.1 macallan
296 1.1 macallan #ifdef DIAGNOSTIC
297 1.1 macallan if (SCREEN_IS_VISIBLE(scr))
298 1.1 macallan panic("vcons_switch_screen: already active");
299 1.1 macallan #endif
300 1.1 macallan
301 1.1 macallan #ifdef notyet
302 1.1 macallan if (vd->currenttype != type) {
303 1.1 macallan vcons_set_screentype(vd, type);
304 1.1 macallan vd->currenttype = type;
305 1.1 macallan }
306 1.1 macallan #endif
307 1.1 macallan
308 1.1 macallan SCREEN_VISIBLE(scr);
309 1.1 macallan vd->active = scr;
310 1.1 macallan vd->wanted = NULL;
311 1.1 macallan
312 1.1 macallan if (vd->show_screen_cb != NULL)
313 1.1 macallan vd->show_screen_cb(scr);
314 1.1 macallan
315 1.1 macallan if ((scr->scr_flags & VCONS_NO_REDRAW) == 0)
316 1.1 macallan vcons_redraw_screen(scr);
317 1.1 macallan
318 1.1 macallan if (vd->switch_cb)
319 1.1 macallan vd->switch_cb(vd->switch_cb_arg, 0, 0);
320 1.1 macallan }
321 1.1 macallan
322 1.1 macallan void
323 1.1 macallan vcons_redraw_screen(struct vcons_screen *scr)
324 1.1 macallan {
325 1.1 macallan uint16_t *charptr = scr->scr_chars;
326 1.1 macallan long *attrptr = scr->scr_attrs;
327 1.1 macallan struct rasops_info *ri = &scr->scr_ri;
328 1.1 macallan int i, j, offset;
329 1.1 macallan
330 1.1 macallan vcons_lock(scr);
331 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
332 1.1 macallan
333 1.1 macallan /*
334 1.1 macallan * only clear the screen when RI_FULLCLEAR is set since we're
335 1.1 macallan * going to overwrite every single character cell anyway
336 1.1 macallan */
337 1.1 macallan if (ri->ri_flg & RI_FULLCLEAR) {
338 1.1 macallan scr->scr_vd->eraserows(ri, 0, ri->ri_rows,
339 1.1 macallan scr->scr_defattr);
340 1.1 macallan }
341 1.1 macallan
342 1.1 macallan /* redraw the screen */
343 1.1 macallan offset = 0;
344 1.1 macallan for (i = 0; i < ri->ri_rows; i++) {
345 1.1 macallan for (j = 0; j < ri->ri_cols; j++) {
346 1.1 macallan /*
347 1.1 macallan * no need to use the wrapper function - we
348 1.1 macallan * don't change any characters or attributes
349 1.1 macallan * and we already made sure the screen we're
350 1.1 macallan * working on is visible
351 1.1 macallan */
352 1.1 macallan scr->scr_vd->putchar(ri, i, j,
353 1.1 macallan charptr[offset], attrptr[offset]);
354 1.1 macallan offset++;
355 1.1 macallan }
356 1.1 macallan }
357 1.1 macallan ri->ri_flg &= ~RI_CURSOR;
358 1.1 macallan scr->scr_vd->cursor(ri, 1, ri->ri_crow, ri->ri_ccol);
359 1.1 macallan }
360 1.1 macallan vcons_unlock(scr);
361 1.1 macallan }
362 1.1 macallan
363 1.1 macallan static int
364 1.1 macallan vcons_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
365 1.1 macallan int *curxp, int *curyp, long *defattrp)
366 1.1 macallan {
367 1.1 macallan struct vcons_data *vd = v;
368 1.1 macallan struct vcons_screen *scr;
369 1.1 macallan int ret;
370 1.1 macallan
371 1.1 macallan scr = malloc(sizeof(struct vcons_screen), M_DEVBUF, M_WAITOK | M_ZERO);
372 1.1 macallan if (scr == NULL)
373 1.1 macallan return ENOMEM;
374 1.1 macallan
375 1.1 macallan scr->scr_flags = 0;
376 1.2 macallan scr->scr_status = 0;
377 1.2 macallan scr->scr_busy = 0;
378 1.1 macallan scr->scr_type = type;
379 1.1 macallan
380 1.1 macallan ret = vcons_init_screen(vd, scr, 0, defattrp);
381 1.1 macallan if (ret != 0) {
382 1.1 macallan free(scr, M_DEVBUF);
383 1.1 macallan return ret;
384 1.1 macallan }
385 1.1 macallan
386 1.1 macallan if (vd->active == NULL) {
387 1.1 macallan SCREEN_VISIBLE(scr);
388 1.1 macallan vd->active = scr;
389 1.1 macallan vd->currenttype = type;
390 1.1 macallan }
391 1.1 macallan
392 1.1 macallan *cookiep = scr;
393 1.1 macallan *curxp = scr->scr_ri.ri_ccol;
394 1.1 macallan *curyp = scr->scr_ri.ri_crow;
395 1.1 macallan return 0;
396 1.1 macallan }
397 1.1 macallan
398 1.1 macallan static void
399 1.1 macallan vcons_free_screen(void *v, void *cookie)
400 1.1 macallan {
401 1.1 macallan struct vcons_data *vd = v;
402 1.1 macallan struct vcons_screen *scr = cookie;
403 1.1 macallan
404 1.1 macallan vcons_lock(scr);
405 1.1 macallan /* there should be no rasops activity here */
406 1.1 macallan
407 1.1 macallan LIST_REMOVE(scr, next);
408 1.1 macallan
409 1.1 macallan if ((scr->scr_flags & VCONS_SCREEN_IS_STATIC) == 0) {
410 1.1 macallan free(scr->scr_attrs, M_DEVBUF);
411 1.1 macallan free(scr, M_DEVBUF);
412 1.1 macallan } else {
413 1.1 macallan /*
414 1.1 macallan * maybe we should just restore the old rasops_info methods
415 1.1 macallan * and free the character/attribute buffer here?
416 1.1 macallan */
417 1.1 macallan #ifdef VCONS_DEBUG
418 1.1 macallan panic("vcons_free_screen: console");
419 1.1 macallan #else
420 1.1 macallan printf("vcons_free_screen: console\n");
421 1.1 macallan #endif
422 1.1 macallan }
423 1.1 macallan
424 1.1 macallan if (vd->active == scr)
425 1.1 macallan vd->active = NULL;
426 1.1 macallan }
427 1.1 macallan
428 1.1 macallan static int
429 1.1 macallan vcons_show_screen(void *v, void *cookie, int waitok,
430 1.1 macallan void (*cb)(void *, int, int), void *cb_arg)
431 1.1 macallan {
432 1.1 macallan struct vcons_data *vd = v;
433 1.1 macallan struct vcons_screen *scr;
434 1.1 macallan
435 1.1 macallan scr = cookie;
436 1.1 macallan if (scr == vd->active)
437 1.1 macallan return 0;
438 1.1 macallan
439 1.1 macallan vd->wanted = scr;
440 1.1 macallan vd->switch_cb = cb;
441 1.1 macallan vd->switch_cb_arg = cb_arg;
442 1.1 macallan if (cb) {
443 1.1 macallan callout_reset(&vd->switch_callout, 0,
444 1.1 macallan (void(*)(void *))vcons_do_switch, vd);
445 1.1 macallan return EAGAIN;
446 1.1 macallan }
447 1.1 macallan
448 1.1 macallan vcons_do_switch(vd);
449 1.1 macallan return 0;
450 1.1 macallan }
451 1.1 macallan
452 1.1 macallan /* wrappers for rasops_info methods */
453 1.1 macallan
454 1.1 macallan static void
455 1.1 macallan vcons_copycols_buffer(void *cookie, int row, int srccol, int dstcol, int ncols)
456 1.1 macallan {
457 1.1 macallan struct rasops_info *ri = cookie;
458 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
459 1.1 macallan int from = srccol + row * ri->ri_cols;
460 1.1 macallan int to = dstcol + row * ri->ri_cols;
461 1.1 macallan
462 1.1 macallan memmove(&scr->scr_attrs[to], &scr->scr_attrs[from],
463 1.1 macallan ncols * sizeof(long));
464 1.1 macallan memmove(&scr->scr_chars[to], &scr->scr_chars[from],
465 1.1 macallan ncols * sizeof(uint16_t));
466 1.1 macallan }
467 1.1 macallan
468 1.1 macallan static void
469 1.1 macallan vcons_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
470 1.1 macallan {
471 1.1 macallan struct rasops_info *ri = cookie;
472 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
473 1.1 macallan
474 1.1 macallan vcons_copycols_buffer(cookie, row, srccol, dstcol, ncols);
475 1.1 macallan
476 1.1 macallan vcons_lock(scr);
477 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
478 1.1 macallan scr->scr_vd->copycols(cookie, row, srccol, dstcol, ncols);
479 1.1 macallan }
480 1.1 macallan vcons_unlock(scr);
481 1.1 macallan }
482 1.1 macallan
483 1.1 macallan static void
484 1.1 macallan vcons_erasecols_buffer(void *cookie, int row, int startcol, int ncols, long fillattr)
485 1.1 macallan {
486 1.1 macallan struct rasops_info *ri = cookie;
487 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
488 1.1 macallan int start = startcol + row * ri->ri_cols;
489 1.1 macallan int end = start + ncols, i;
490 1.1 macallan
491 1.1 macallan for (i = start; i < end; i++) {
492 1.1 macallan scr->scr_attrs[i] = fillattr;
493 1.1 macallan scr->scr_chars[i] = 0x20;
494 1.1 macallan }
495 1.1 macallan }
496 1.1 macallan
497 1.1 macallan static void
498 1.1 macallan vcons_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
499 1.1 macallan {
500 1.1 macallan struct rasops_info *ri = cookie;
501 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
502 1.1 macallan
503 1.1 macallan vcons_erasecols_buffer(cookie, row, startcol, ncols, fillattr);
504 1.1 macallan
505 1.1 macallan vcons_lock(scr);
506 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
507 1.1 macallan scr->scr_vd->erasecols(cookie, row, startcol, ncols,
508 1.1 macallan fillattr);
509 1.1 macallan }
510 1.1 macallan vcons_unlock(scr);
511 1.1 macallan }
512 1.1 macallan
513 1.1 macallan static void
514 1.1 macallan vcons_copyrows_buffer(void *cookie, int srcrow, int dstrow, int nrows)
515 1.1 macallan {
516 1.1 macallan struct rasops_info *ri = cookie;
517 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
518 1.1 macallan int from, to, len;
519 1.1 macallan
520 1.1 macallan from = ri->ri_cols * srcrow;
521 1.1 macallan to = ri->ri_cols * dstrow;
522 1.1 macallan len = ri->ri_cols * nrows;
523 1.1 macallan
524 1.1 macallan memmove(&scr->scr_attrs[to], &scr->scr_attrs[from],
525 1.1 macallan len * sizeof(long));
526 1.1 macallan memmove(&scr->scr_chars[to], &scr->scr_chars[from],
527 1.1 macallan len * sizeof(uint16_t));
528 1.1 macallan }
529 1.1 macallan
530 1.1 macallan static void
531 1.1 macallan vcons_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
532 1.1 macallan {
533 1.1 macallan struct rasops_info *ri = cookie;
534 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
535 1.1 macallan
536 1.1 macallan vcons_copyrows_buffer(cookie, srcrow, dstrow, nrows);
537 1.1 macallan
538 1.1 macallan vcons_lock(scr);
539 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
540 1.1 macallan scr->scr_vd->copyrows(cookie, srcrow, dstrow, nrows);
541 1.1 macallan }
542 1.1 macallan vcons_unlock(scr);
543 1.1 macallan }
544 1.1 macallan
545 1.1 macallan static void
546 1.1 macallan vcons_eraserows_buffer(void *cookie, int row, int nrows, long fillattr)
547 1.1 macallan {
548 1.1 macallan struct rasops_info *ri = cookie;
549 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
550 1.1 macallan int start, end, i;
551 1.1 macallan
552 1.1 macallan start = ri->ri_cols * row;
553 1.1 macallan end = ri->ri_cols * (row + nrows);
554 1.1 macallan
555 1.1 macallan for (i = start; i < end; i++) {
556 1.1 macallan scr->scr_attrs[i] = fillattr;
557 1.1 macallan scr->scr_chars[i] = 0x20;
558 1.1 macallan }
559 1.1 macallan }
560 1.1 macallan
561 1.1 macallan static void
562 1.1 macallan vcons_eraserows(void *cookie, int row, int nrows, long fillattr)
563 1.1 macallan {
564 1.1 macallan struct rasops_info *ri = cookie;
565 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
566 1.1 macallan
567 1.1 macallan vcons_eraserows_buffer(cookie, row, nrows, fillattr);
568 1.1 macallan
569 1.1 macallan vcons_lock(scr);
570 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
571 1.1 macallan scr->scr_vd->eraserows(cookie, row, nrows, fillattr);
572 1.1 macallan }
573 1.1 macallan vcons_unlock(scr);
574 1.1 macallan }
575 1.1 macallan
576 1.1 macallan static void
577 1.1 macallan vcons_putchar_buffer(void *cookie, int row, int col, u_int c, long attr)
578 1.1 macallan {
579 1.1 macallan struct rasops_info *ri = cookie;
580 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
581 1.1 macallan int pos;
582 1.1 macallan
583 1.1 macallan if ((row >= 0) && (row < ri->ri_rows) && (col >= 0) &&
584 1.1 macallan (col < ri->ri_cols)) {
585 1.1 macallan pos = col + row * ri->ri_cols;
586 1.1 macallan scr->scr_attrs[pos] = attr;
587 1.1 macallan scr->scr_chars[pos] = c;
588 1.1 macallan }
589 1.1 macallan }
590 1.1 macallan
591 1.1 macallan static void
592 1.1 macallan vcons_putchar(void *cookie, int row, int col, u_int c, long attr)
593 1.1 macallan {
594 1.1 macallan struct rasops_info *ri = cookie;
595 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
596 1.1 macallan
597 1.1 macallan vcons_putchar_buffer(cookie, row, col, c, attr);
598 1.1 macallan
599 1.1 macallan vcons_lock(scr);
600 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
601 1.1 macallan scr->scr_vd->putchar(cookie, row, col, c, attr);
602 1.1 macallan }
603 1.1 macallan vcons_unlock(scr);
604 1.1 macallan }
605 1.1 macallan
606 1.1 macallan static void
607 1.1 macallan vcons_cursor(void *cookie, int on, int row, int col)
608 1.1 macallan {
609 1.1 macallan struct rasops_info *ri = cookie;
610 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
611 1.1 macallan
612 1.1 macallan vcons_lock(scr);
613 1.1 macallan if (SCREEN_IS_VISIBLE(scr)) {
614 1.1 macallan scr->scr_vd->cursor(cookie, on, row, col);
615 1.1 macallan } else {
616 1.1 macallan scr->scr_ri.ri_crow = row;
617 1.1 macallan scr->scr_ri.ri_ccol = col;
618 1.1 macallan }
619 1.1 macallan vcons_unlock(scr);
620 1.1 macallan }
621 1.1 macallan
622 1.1 macallan /* methods to read/write characters via ioctl() */
623 1.1 macallan
624 1.1 macallan static int
625 1.1 macallan vcons_putwschar(void *cookie, struct wsdisplay_char *wsc)
626 1.1 macallan {
627 1.1 macallan struct rasops_info *ri = cookie;
628 1.1 macallan long attr;
629 1.1 macallan
630 1.1 macallan ri->ri_ops.allocattr(ri, wsc->foreground, wsc->background,
631 1.1 macallan wsc->flags, &attr);
632 1.1 macallan vcons_putchar(ri, wsc->row, wsc->col, wsc->letter, attr);
633 1.1 macallan return 0;
634 1.1 macallan }
635 1.1 macallan
636 1.1 macallan static int
637 1.1 macallan vcons_getwschar(void *cookie, struct wsdisplay_char *wsc)
638 1.1 macallan {
639 1.1 macallan struct rasops_info *ri = cookie;
640 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
641 1.1 macallan long attr;
642 1.1 macallan int offset = ri->ri_cols * wsc->row + wsc->col;
643 1.1 macallan
644 1.1 macallan wsc->letter = scr->scr_chars[offset];
645 1.1 macallan attr = scr->scr_attrs[offset];
646 1.1 macallan
647 1.1 macallan /*
648 1.1 macallan * this is ugly. We need to break up an attribute into colours and
649 1.1 macallan * flags but there's no rasops method to do that so we must rely on
650 1.1 macallan * the 'canonical' encoding.
651 1.1 macallan */
652 1.1 macallan wsc->foreground = (attr & 0xff000000) >> 24;
653 1.1 macallan wsc->background = (attr & 0x00ff0000) >> 16;
654 1.1 macallan wsc->flags = (attr & 0x0000ff00) >> 8;
655 1.1 macallan return 0;
656 1.1 macallan }
657