Home | History | Annotate | Line # | Download | only in wscons
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