Home | History | Annotate | Line # | Download | only in rasops
rasops.c revision 1.67
      1  1.67  macallan /*	 $NetBSD: rasops.c,v 1.67 2011/12/22 04:52:45 macallan Exp $	*/
      2   1.1        ad 
      3   1.9        ad /*-
      4   1.9        ad  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5   1.1        ad  * All rights reserved.
      6   1.1        ad  *
      7   1.9        ad  * This code is derived from software contributed to The NetBSD Foundation
      8  1.32        ad  * by Andrew Doran.
      9   1.9        ad  *
     10   1.1        ad  * Redistribution and use in source and binary forms, with or without
     11   1.1        ad  * modification, are permitted provided that the following conditions
     12   1.1        ad  * are met:
     13   1.1        ad  * 1. Redistributions of source code must retain the above copyright
     14   1.1        ad  *    notice, this list of conditions and the following disclaimer.
     15   1.1        ad  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1        ad  *    notice, this list of conditions and the following disclaimer in the
     17   1.1        ad  *    documentation and/or other materials provided with the distribution.
     18   1.1        ad  *
     19   1.9        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.9        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.9        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.9        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.9        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.9        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.9        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.9        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.9        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.9        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.9        ad  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1        ad  */
     31   1.2        ad 
     32   1.1        ad #include <sys/cdefs.h>
     33  1.67  macallan __KERNEL_RCSID(0, "$NetBSD: rasops.c,v 1.67 2011/12/22 04:52:45 macallan Exp $");
     34   1.1        ad 
     35  1.18        ad #include "opt_rasops.h"
     36   1.4        ad #include "rasops_glue.h"
     37  1.47  macallan #include "opt_wsmsgattrs.h"
     38   1.1        ad 
     39   1.1        ad #include <sys/param.h>
     40   1.1        ad #include <sys/systm.h>
     41   1.1        ad #include <sys/time.h>
     42  1.63  macallan #include <sys/kmem.h>
     43   1.1        ad 
     44  1.50       dsl #include <sys/bswap.h>
     45   1.4        ad #include <machine/endian.h>
     46   1.3        ad 
     47   1.1        ad #include <dev/wscons/wsdisplayvar.h>
     48   1.1        ad #include <dev/wscons/wsconsio.h>
     49   1.1        ad #include <dev/wsfont/wsfont.h>
     50   1.1        ad #include <dev/rasops/rasops.h>
     51   1.1        ad 
     52  1.11        ad #ifndef _KERNEL
     53  1.11        ad #include <errno.h>
     54  1.11        ad #endif
     55  1.11        ad 
     56   1.1        ad /* ANSI colormap (R,G,B). Upper 8 are high-intensity */
     57  1.23  drochner const u_char rasops_cmap[256*3] = {
     58   1.1        ad 	0x00, 0x00, 0x00, /* black */
     59   1.1        ad 	0x7f, 0x00, 0x00, /* red */
     60   1.1        ad 	0x00, 0x7f, 0x00, /* green */
     61   1.1        ad 	0x7f, 0x7f, 0x00, /* brown */
     62   1.1        ad 	0x00, 0x00, 0x7f, /* blue */
     63   1.1        ad 	0x7f, 0x00, 0x7f, /* magenta */
     64   1.1        ad 	0x00, 0x7f, 0x7f, /* cyan */
     65   1.1        ad 	0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
     66   1.1        ad 
     67   1.1        ad 	0x7f, 0x7f, 0x7f, /* black */
     68   1.1        ad 	0xff, 0x00, 0x00, /* red */
     69   1.1        ad 	0x00, 0xff, 0x00, /* green */
     70   1.1        ad 	0xff, 0xff, 0x00, /* brown */
     71   1.1        ad 	0x00, 0x00, 0xff, /* blue */
     72   1.1        ad 	0xff, 0x00, 0xff, /* magenta */
     73   1.1        ad 	0x00, 0xff, 0xff, /* cyan */
     74   1.1        ad 	0xff, 0xff, 0xff, /* white */
     75  1.23  drochner 
     76  1.23  drochner 	/*
     77  1.23  drochner 	 * For the cursor, we need at least the last (255th)
     78  1.23  drochner 	 * color to be white. Fill up white completely for
     79  1.23  drochner 	 * simplicity.
     80  1.23  drochner 	 */
     81  1.23  drochner #define _CMWHITE 0xff, 0xff, 0xff,
     82  1.23  drochner #define _CMWHITE16	_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     83  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     84  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     85  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE
     86  1.23  drochner 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
     87  1.23  drochner 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
     88  1.44       uwe 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 /* but not the last one */
     89  1.23  drochner #undef _CMWHITE16
     90  1.23  drochner #undef _CMWHITE
     91  1.44       uwe 
     92  1.44       uwe 	/*
     93  1.44       uwe 	 * For the cursor the fg/bg indices are bit inverted, so
     94  1.44       uwe 	 * provide complimentary colors in the upper 16 entries.
     95  1.44       uwe 	 */
     96  1.44       uwe 	0x7f, 0x7f, 0x7f, /* black */
     97  1.44       uwe 	0xff, 0x00, 0x00, /* red */
     98  1.44       uwe 	0x00, 0xff, 0x00, /* green */
     99  1.44       uwe 	0xff, 0xff, 0x00, /* brown */
    100  1.44       uwe 	0x00, 0x00, 0xff, /* blue */
    101  1.44       uwe 	0xff, 0x00, 0xff, /* magenta */
    102  1.44       uwe 	0x00, 0xff, 0xff, /* cyan */
    103  1.44       uwe 	0xff, 0xff, 0xff, /* white */
    104  1.44       uwe 
    105  1.44       uwe 	0x00, 0x00, 0x00, /* black */
    106  1.44       uwe 	0x7f, 0x00, 0x00, /* red */
    107  1.44       uwe 	0x00, 0x7f, 0x00, /* green */
    108  1.44       uwe 	0x7f, 0x7f, 0x00, /* brown */
    109  1.44       uwe 	0x00, 0x00, 0x7f, /* blue */
    110  1.44       uwe 	0x7f, 0x00, 0x7f, /* magenta */
    111  1.44       uwe 	0x00, 0x7f, 0x7f, /* cyan */
    112  1.44       uwe 	0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
    113   1.1        ad };
    114   1.1        ad 
    115   1.1        ad /* True if color is gray */
    116  1.30        pk const u_char rasops_isgray[16] = {
    117  1.30        pk 	1, 0, 0, 0,
    118   1.1        ad 	0, 0, 0, 1,
    119   1.1        ad 	1, 0, 0, 0,
    120   1.1        ad 	0, 0, 0, 1
    121   1.1        ad };
    122   1.1        ad 
    123   1.4        ad /* Generic functions */
    124  1.45     perry static void	rasops_copyrows(void *, int, int, int);
    125  1.45     perry static int	rasops_mapchar(void *, int, u_int *);
    126  1.45     perry static void	rasops_cursor(void *, int, int, int);
    127  1.45     perry static int	rasops_allocattr_color(void *, int, int, int, long *);
    128  1.45     perry static int	rasops_allocattr_mono(void *, int, int, int, long *);
    129  1.45     perry static void	rasops_do_cursor(struct rasops_info *);
    130  1.45     perry static void	rasops_init_devcmap(struct rasops_info *);
    131   1.1        ad 
    132  1.55      ober #if NRASOPS_ROTATION > 0
    133  1.62    nonaka static void	rasops_rotate_font(int *, int);
    134  1.55      ober static void	rasops_copychar(void *, int, int, int, int);
    135  1.62    nonaka 
    136  1.62    nonaka /* rotate clockwise */
    137  1.62    nonaka static void	rasops_copycols_rotated_cw(void *, int, int, int, int);
    138  1.62    nonaka static void	rasops_copyrows_rotated_cw(void *, int, int, int);
    139  1.62    nonaka static void	rasops_erasecols_rotated_cw(void *, int, int, int, long);
    140  1.62    nonaka static void	rasops_eraserows_rotated_cw(void *, int, int, long);
    141  1.62    nonaka static void	rasops_putchar_rotated_cw(void *, int, int, u_int, long);
    142  1.62    nonaka 
    143  1.62    nonaka /* rotate counter-clockwise */
    144  1.62    nonaka static void	rasops_copychar_ccw(void *, int, int, int, int);
    145  1.62    nonaka static void	rasops_copycols_rotated_ccw(void *, int, int, int, int);
    146  1.62    nonaka static void	rasops_copyrows_rotated_ccw(void *, int, int, int);
    147  1.62    nonaka #define rasops_erasecols_rotated_ccw rasops_erasecols_rotated_cw
    148  1.62    nonaka #define rasops_eraserows_rotated_ccw rasops_eraserows_rotated_cw
    149  1.62    nonaka static void	rasops_putchar_rotated_ccw(void *, int, int, u_int, long);
    150  1.55      ober 
    151  1.55      ober /*
    152  1.55      ober  * List of all rotated fonts
    153  1.55      ober  */
    154  1.55      ober SLIST_HEAD(, rotatedfont) rotatedfonts = SLIST_HEAD_INITIALIZER(rotatedfonts);
    155  1.55      ober struct rotatedfont {
    156  1.55      ober 	SLIST_ENTRY(rotatedfont) rf_next;
    157  1.55      ober 	int rf_cookie;
    158  1.55      ober 	int rf_rotated;
    159  1.55      ober };
    160  1.55      ober #endif	/* NRASOPS_ROTATION > 0 */
    161  1.55      ober 
    162  1.63  macallan void	rasops_make_box_chars_8(struct rasops_info *);
    163  1.63  macallan void	rasops_make_box_chars_16(struct rasops_info *);
    164  1.63  macallan void	rasops_make_box_chars_32(struct rasops_info *);
    165  1.67  macallan void	rasops_make_box_chars_alpha(struct rasops_info *);
    166  1.63  macallan 
    167  1.64  macallan extern int cold;
    168  1.64  macallan 
    169   1.1        ad /*
    170  1.37       wiz  * Initialize a 'rasops_info' descriptor.
    171   1.1        ad  */
    172   1.1        ad int
    173  1.60       dsl rasops_init(struct rasops_info *ri, int wantrows, int wantcols)
    174   1.1        ad {
    175  1.20        ad 
    176  1.63  macallan 	memset (&ri->ri_optfont, 0, sizeof(ri->ri_optfont));
    177  1.30        pk #ifdef _KERNEL
    178   1.1        ad 	/* Select a font if the caller doesn't care */
    179   1.1        ad 	if (ri->ri_font == NULL) {
    180  1.67  macallan 		int cookie = -1;
    181  1.30        pk 
    182   1.1        ad 		wsfont_init();
    183   1.1        ad 
    184  1.67  macallan 		if (ri->ri_flg & RI_ENABLE_ALPHA) {
    185  1.67  macallan 			/* try finding an AA font first */
    186  1.67  macallan 			cookie = wsfont_find_aa(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_L2R,
    187  1.67  macallan 			    WSDISPLAY_FONTORDER_L2R);
    188  1.67  macallan 		}
    189  1.67  macallan 		if (cookie == -1) {
    190  1.67  macallan 			/* Want 8 pixel wide, don't care about aesthetics */
    191  1.67  macallan 			cookie = wsfont_find(NULL, 8, 0, 0, WSDISPLAY_FONTORDER_L2R,
    192  1.67  macallan 			    WSDISPLAY_FONTORDER_L2R);
    193  1.67  macallan 		}
    194  1.39        ad 		if (cookie <= 0)
    195  1.39        ad 			cookie = wsfont_find(NULL, 0, 0, 0,
    196  1.39        ad 			    WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R);
    197   1.1        ad 
    198   1.7        ad 		if (cookie <= 0) {
    199   1.1        ad 			printf("rasops_init: font table is empty\n");
    200   1.1        ad 			return (-1);
    201   1.1        ad 		}
    202  1.30        pk 
    203  1.55      ober #if NRASOPS_ROTATION > 0
    204  1.55      ober 		/*
    205  1.55      ober 		 * Pick the rotated version of this font. This will create it
    206  1.55      ober 		 * if necessary.
    207  1.55      ober 		 */
    208  1.62    nonaka 		if (ri->ri_flg & RI_ROTATE_MASK) {
    209  1.62    nonaka 			if (ri->ri_flg & RI_ROTATE_CW)
    210  1.62    nonaka 				rasops_rotate_font(&cookie, WSFONT_ROTATE_CW);
    211  1.62    nonaka 			else if (ri->ri_flg & RI_ROTATE_CCW)
    212  1.62    nonaka 				rasops_rotate_font(&cookie, WSFONT_ROTATE_CCW);
    213  1.62    nonaka 		}
    214  1.55      ober #endif
    215  1.55      ober 
    216  1.39        ad 		if (wsfont_lock(cookie, &ri->ri_font)) {
    217   1.1        ad 			printf("rasops_init: couldn't lock font\n");
    218   1.1        ad 			return (-1);
    219   1.1        ad 		}
    220   1.8        ad 
    221   1.5        ad 		ri->ri_wsfcookie = cookie;
    222   1.1        ad 	}
    223   1.4        ad #endif
    224  1.30        pk 
    225   1.1        ad 	/* This should never happen in reality... */
    226   1.1        ad #ifdef DEBUG
    227  1.31  sommerfe 	if ((long)ri->ri_bits & 3) {
    228   1.1        ad 		printf("rasops_init: bits not aligned on 32-bit boundary\n");
    229   1.1        ad 		return (-1);
    230   1.1        ad 	}
    231   1.1        ad 
    232   1.1        ad 	if ((int)ri->ri_stride & 3) {
    233   1.1        ad 		printf("rasops_init: stride not aligned on 32-bit boundary\n");
    234   1.1        ad 		return (-1);
    235   1.1        ad 	}
    236   1.1        ad #endif
    237   1.4        ad 
    238  1.13        ad 	if (rasops_reconfig(ri, wantrows, wantcols))
    239   1.4        ad 		return (-1);
    240  1.46     perry 
    241   1.4        ad 	rasops_init_devcmap(ri);
    242   1.4        ad 	return (0);
    243   1.4        ad }
    244   1.4        ad 
    245   1.4        ad /*
    246  1.13        ad  * Reconfigure (because parameters have changed in some way).
    247   1.4        ad  */
    248   1.4        ad int
    249  1.60       dsl rasops_reconfig(struct rasops_info *ri, int wantrows, int wantcols)
    250   1.4        ad {
    251  1.63  macallan 	int bpp, s, len;
    252  1.30        pk 
    253  1.13        ad 	s = splhigh();
    254  1.30        pk 
    255  1.63  macallan 	/* throw away old line drawing character bitmaps, if we have any */
    256  1.63  macallan 	if (ri->ri_optfont.data != NULL) {
    257  1.63  macallan 		kmem_free(ri->ri_optfont.data, ri->ri_optfont.stride *
    258  1.63  macallan 		    ri->ri_optfont.fontheight * ri->ri_optfont.numchars);
    259  1.63  macallan 		ri->ri_optfont.data = NULL;
    260  1.63  macallan 	}
    261  1.63  macallan 
    262  1.63  macallan 	/* autogenerate box drawing characters */
    263  1.64  macallan 	ri->ri_optfont.firstchar = WSFONT_FLAG_OPT;
    264  1.64  macallan 	ri->ri_optfont.numchars = 16;
    265  1.63  macallan 	ri->ri_optfont.fontwidth = ri->ri_font->fontwidth;
    266  1.63  macallan 	ri->ri_optfont.fontheight = ri->ri_font->fontheight;
    267  1.63  macallan 	ri->ri_optfont.stride = ri->ri_font->stride;
    268  1.64  macallan 	len = ri->ri_optfont.fontheight * ri->ri_optfont.stride *
    269  1.64  macallan 		      ri->ri_optfont.numchars;
    270  1.64  macallan 
    271  1.64  macallan 	if (((ri->ri_flg & RI_NO_AUTO) == 0) &&
    272  1.64  macallan 	  ((ri->ri_optfont.data = kmem_zalloc(len, KM_SLEEP)) != NULL)) {
    273  1.64  macallan 
    274  1.67  macallan 		if (ri->ri_optfont.stride < ri->ri_optfont.fontwidth) {
    275  1.67  macallan 			switch (ri->ri_optfont.stride) {
    276  1.67  macallan 			case 1:
    277  1.67  macallan 				rasops_make_box_chars_8(ri);
    278  1.67  macallan 				break;
    279  1.67  macallan 			case 2:
    280  1.67  macallan 				rasops_make_box_chars_16(ri);
    281  1.67  macallan 				break;
    282  1.67  macallan 			case 4:
    283  1.67  macallan 				rasops_make_box_chars_32(ri);
    284  1.67  macallan 				break;
    285  1.67  macallan 			}
    286  1.67  macallan 		} else {
    287  1.67  macallan 			rasops_make_box_chars_alpha(ri);
    288  1.63  macallan 		}
    289  1.64  macallan 	} else
    290  1.64  macallan 		memset(&ri->ri_optfont, 0, sizeof(ri->ri_optfont));
    291  1.63  macallan 
    292   1.4        ad 	if (ri->ri_font->fontwidth > 32 || ri->ri_font->fontwidth < 4)
    293  1.42    provos 		panic("rasops_init: fontwidth assumptions botched!");
    294  1.30        pk 
    295   1.4        ad 	/* Need this to frob the setup below */
    296   1.4        ad 	bpp = (ri->ri_depth == 15 ? 16 : ri->ri_depth);
    297   1.4        ad 
    298  1.13        ad 	if ((ri->ri_flg & RI_CFGDONE) != 0)
    299   1.4        ad 		ri->ri_bits = ri->ri_origbits;
    300  1.30        pk 
    301   1.1        ad 	/* Don't care if the caller wants a hideously small console */
    302   1.1        ad 	if (wantrows < 10)
    303  1.13        ad 		wantrows = 10;
    304  1.30        pk 
    305   1.1        ad 	if (wantcols < 20)
    306  1.13        ad 		wantcols = 20;
    307  1.30        pk 
    308   1.1        ad 	/* Now constrain what they get */
    309   1.1        ad 	ri->ri_emuwidth = ri->ri_font->fontwidth * wantcols;
    310   1.1        ad 	ri->ri_emuheight = ri->ri_font->fontheight * wantrows;
    311  1.30        pk 
    312   1.1        ad 	if (ri->ri_emuwidth > ri->ri_width)
    313   1.1        ad 		ri->ri_emuwidth = ri->ri_width;
    314  1.30        pk 
    315   1.1        ad 	if (ri->ri_emuheight > ri->ri_height)
    316   1.1        ad 		ri->ri_emuheight = ri->ri_height;
    317  1.30        pk 
    318   1.1        ad 	/* Reduce width until aligned on a 32-bit boundary */
    319  1.20        ad 	while ((ri->ri_emuwidth * bpp & 31) != 0)
    320   1.1        ad 		ri->ri_emuwidth--;
    321  1.30        pk 
    322  1.55      ober #if NRASOPS_ROTATION > 0
    323  1.62    nonaka 	if (ri->ri_flg & (RI_ROTATE_CW|RI_ROTATE_CCW)) {
    324  1.55      ober 		ri->ri_rows = ri->ri_emuwidth / ri->ri_font->fontwidth;
    325  1.55      ober 		ri->ri_cols = ri->ri_emuheight / ri->ri_font->fontheight;
    326  1.55      ober 	} else
    327  1.55      ober #endif
    328  1.55      ober 	{
    329  1.55      ober 
    330  1.55      ober 		ri->ri_cols = ri->ri_emuwidth / ri->ri_font->fontwidth;
    331  1.55      ober 		ri->ri_rows = ri->ri_emuheight / ri->ri_font->fontheight;
    332  1.55      ober 	}
    333   1.4        ad 	ri->ri_emustride = ri->ri_emuwidth * bpp >> 3;
    334   1.1        ad 	ri->ri_delta = ri->ri_stride - ri->ri_emustride;
    335   1.1        ad 	ri->ri_ccol = 0;
    336   1.1        ad 	ri->ri_crow = 0;
    337   1.4        ad 	ri->ri_pelbytes = bpp >> 3;
    338  1.30        pk 
    339   1.4        ad 	ri->ri_xscale = (ri->ri_font->fontwidth * bpp) >> 3;
    340   1.1        ad 	ri->ri_yscale = ri->ri_font->fontheight * ri->ri_stride;
    341   1.1        ad 	ri->ri_fontscale = ri->ri_font->fontheight * ri->ri_font->stride;
    342   1.1        ad 
    343  1.30        pk #ifdef DEBUG
    344  1.18        ad 	if ((ri->ri_delta & 3) != 0)
    345  1.13        ad 		panic("rasops_init: ri_delta not aligned on 32-bit boundary");
    346  1.30        pk #endif
    347   1.1        ad 	/* Clear the entire display */
    348  1.13        ad 	if ((ri->ri_flg & RI_CLEAR) != 0)
    349  1.13        ad 		memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    350  1.30        pk 
    351  1.30        pk 	/* Now centre our window if needs be */
    352   1.1        ad 	ri->ri_origbits = ri->ri_bits;
    353  1.61  macallan 	ri->ri_hworigbits = ri->ri_hwbits;
    354  1.30        pk 
    355  1.13        ad 	if ((ri->ri_flg & RI_CENTER) != 0) {
    356  1.46     perry 		ri->ri_bits += (((ri->ri_width * bpp >> 3) -
    357  1.36   nathanw 		    ri->ri_emustride) >> 1) & ~3;
    358  1.30        pk 		ri->ri_bits += ((ri->ri_height - ri->ri_emuheight) >> 1) *
    359   1.1        ad 		    ri->ri_stride;
    360  1.61  macallan 		if (ri->ri_hwbits != NULL) {
    361  1.61  macallan 			ri->ri_hwbits += (((ri->ri_width * bpp >> 3) -
    362  1.61  macallan 			    ri->ri_emustride) >> 1) & ~3;
    363  1.61  macallan 			ri->ri_hwbits += ((ri->ri_height - ri->ri_emuheight) >> 1) *
    364  1.61  macallan 			    ri->ri_stride;
    365  1.61  macallan 		}
    366  1.30        pk 		ri->ri_yorigin = (int)(ri->ri_bits - ri->ri_origbits)
    367   1.5        ad 		   / ri->ri_stride;
    368  1.30        pk 		ri->ri_xorigin = (((int)(ri->ri_bits - ri->ri_origbits)
    369  1.28   nathanw 		   % ri->ri_stride) * 8 / bpp);
    370   1.5        ad 	} else
    371   1.5        ad 		ri->ri_xorigin = ri->ri_yorigin = 0;
    372   1.4        ad 
    373  1.30        pk 	/*
    374   1.4        ad 	 * Fill in defaults for operations set.  XXX this nukes private
    375   1.4        ad 	 * routines used by accelerated fb drivers.
    376   1.4        ad 	 */
    377   1.1        ad 	ri->ri_ops.mapchar = rasops_mapchar;
    378   1.1        ad 	ri->ri_ops.copyrows = rasops_copyrows;
    379   1.1        ad 	ri->ri_ops.copycols = rasops_copycols;
    380   1.4        ad 	ri->ri_ops.erasecols = rasops_erasecols;
    381   1.4        ad 	ri->ri_ops.eraserows = rasops_eraserows;
    382   1.1        ad 	ri->ri_ops.cursor = rasops_cursor;
    383   1.4        ad 	ri->ri_do_cursor = rasops_do_cursor;
    384  1.30        pk 
    385  1.13        ad 	if (ri->ri_depth < 8 || (ri->ri_flg & RI_FORCEMONO) != 0) {
    386  1.41  junyoung 		ri->ri_ops.allocattr = rasops_allocattr_mono;
    387  1.24  drochner 		ri->ri_caps = WSSCREEN_UNDERLINE | WSSCREEN_REVERSE;
    388   1.4        ad 	} else {
    389  1.41  junyoung 		ri->ri_ops.allocattr = rasops_allocattr_color;
    390  1.30        pk 		ri->ri_caps = WSSCREEN_UNDERLINE | WSSCREEN_HILIT |
    391  1.24  drochner 		    WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
    392   1.4        ad 	}
    393   1.4        ad 
    394   1.1        ad 	switch (ri->ri_depth) {
    395  1.20        ad #if NRASOPS1 > 0
    396   1.1        ad 	case 1:
    397   1.1        ad 		rasops1_init(ri);
    398   1.1        ad 		break;
    399   1.1        ad #endif
    400  1.20        ad #if NRASOPS2 > 0
    401   1.4        ad 	case 2:
    402   1.4        ad 		rasops2_init(ri);
    403  1.34  takemura 		break;
    404  1.34  takemura #endif
    405  1.34  takemura #if NRASOPS4 > 0
    406  1.34  takemura 	case 4:
    407  1.34  takemura 		rasops4_init(ri);
    408   1.4        ad 		break;
    409   1.4        ad #endif
    410  1.20        ad #if NRASOPS8 > 0
    411   1.1        ad 	case 8:
    412   1.1        ad 		rasops8_init(ri);
    413   1.1        ad 		break;
    414   1.1        ad #endif
    415  1.20        ad #if NRASOPS15 > 0 || NRASOPS16 > 0
    416   1.1        ad 	case 15:
    417   1.1        ad 	case 16:
    418   1.1        ad 		rasops15_init(ri);
    419   1.1        ad 		break;
    420   1.1        ad #endif
    421  1.20        ad #if NRASOPS24 > 0
    422   1.1        ad 	case 24:
    423   1.1        ad 		rasops24_init(ri);
    424   1.1        ad 		break;
    425   1.1        ad #endif
    426  1.20        ad #if NRASOPS32 > 0
    427   1.1        ad 	case 32:
    428   1.1        ad 		rasops32_init(ri);
    429   1.1        ad 		break;
    430   1.1        ad #endif
    431   1.1        ad 	default:
    432  1.13        ad 		ri->ri_flg &= ~RI_CFGDONE;
    433  1.13        ad 		splx(s);
    434   1.1        ad 		return (-1);
    435   1.1        ad 	}
    436  1.30        pk 
    437  1.55      ober #if NRASOPS_ROTATION > 0
    438  1.62    nonaka 	if (ri->ri_flg & RI_ROTATE_MASK) {
    439  1.62    nonaka 		if (ri->ri_flg & RI_ROTATE_CW) {
    440  1.62    nonaka 			ri->ri_real_ops = ri->ri_ops;
    441  1.62    nonaka 			ri->ri_ops.copycols = rasops_copycols_rotated_cw;
    442  1.62    nonaka 			ri->ri_ops.copyrows = rasops_copyrows_rotated_cw;
    443  1.62    nonaka 			ri->ri_ops.erasecols = rasops_erasecols_rotated_cw;
    444  1.62    nonaka 			ri->ri_ops.eraserows = rasops_eraserows_rotated_cw;
    445  1.62    nonaka 			ri->ri_ops.putchar = rasops_putchar_rotated_cw;
    446  1.62    nonaka 		} else if (ri->ri_flg & RI_ROTATE_CCW) {
    447  1.62    nonaka 			ri->ri_real_ops = ri->ri_ops;
    448  1.62    nonaka 			ri->ri_ops.copycols = rasops_copycols_rotated_ccw;
    449  1.62    nonaka 			ri->ri_ops.copyrows = rasops_copyrows_rotated_ccw;
    450  1.62    nonaka 			ri->ri_ops.erasecols = rasops_erasecols_rotated_ccw;
    451  1.62    nonaka 			ri->ri_ops.eraserows = rasops_eraserows_rotated_ccw;
    452  1.62    nonaka 			ri->ri_ops.putchar = rasops_putchar_rotated_ccw;
    453  1.62    nonaka 		}
    454  1.55      ober 	}
    455  1.55      ober #endif
    456  1.55      ober 
    457  1.13        ad 	ri->ri_flg |= RI_CFGDONE;
    458  1.13        ad 	splx(s);
    459   1.1        ad 	return (0);
    460   1.1        ad }
    461   1.1        ad 
    462   1.1        ad /*
    463   1.1        ad  * Map a character.
    464   1.1        ad  */
    465   1.1        ad static int
    466  1.59       dsl rasops_mapchar(void *cookie, int c, u_int *cp)
    467   1.1        ad {
    468   1.1        ad 	struct rasops_info *ri;
    469  1.30        pk 
    470   1.1        ad 	ri = (struct rasops_info *)cookie;
    471   1.8        ad 
    472  1.30        pk #ifdef DIAGNOSTIC
    473   1.8        ad 	if (ri->ri_font == NULL)
    474  1.42    provos 		panic("rasops_mapchar: no font selected");
    475  1.30        pk #endif
    476  1.39        ad 
    477  1.63  macallan 	if ( (c = wsfont_map_unichar(ri->ri_font, c)) < 0) {
    478  1.63  macallan 		*cp = ' ';
    479  1.63  macallan 		return (0);
    480  1.35    marcus 	}
    481  1.30        pk 
    482   1.1        ad 	if (c < ri->ri_font->firstchar) {
    483   1.1        ad 		*cp = ' ';
    484   1.1        ad 		return (0);
    485   1.1        ad 	}
    486  1.30        pk 
    487  1.63  macallan #if 0
    488   1.1        ad 	if (c - ri->ri_font->firstchar >= ri->ri_font->numchars) {
    489   1.1        ad 		*cp = ' ';
    490   1.1        ad 		return (0);
    491   1.1        ad 	}
    492  1.63  macallan #endif
    493   1.1        ad 	*cp = c;
    494   1.1        ad 	return (5);
    495   1.1        ad }
    496   1.1        ad 
    497   1.1        ad /*
    498   1.1        ad  * Allocate a color attribute.
    499   1.1        ad  */
    500   1.1        ad static int
    501  1.54  christos rasops_allocattr_color(void *cookie, int fg, int bg, int flg,
    502  1.53  christos     long *attr)
    503   1.1        ad {
    504   1.1        ad 	int swap;
    505   1.1        ad 
    506  1.56       mjf 	if (__predict_false((unsigned int)fg >= sizeof(rasops_isgray) ||
    507  1.56       mjf 	    (unsigned int)bg >= sizeof(rasops_isgray)))
    508  1.56       mjf 		return (EINVAL);
    509  1.56       mjf 
    510   1.1        ad #ifdef RASOPS_CLIPPING
    511   1.1        ad 	fg &= 7;
    512   1.1        ad 	bg &= 7;
    513   1.1        ad #endif
    514  1.17        ad 	if ((flg & WSATTR_BLINK) != 0)
    515   1.1        ad 		return (EINVAL);
    516  1.23  drochner 
    517  1.23  drochner 	if ((flg & WSATTR_WSCOLORS) == 0) {
    518  1.48  macallan #ifdef WS_DEFAULT_FG
    519  1.48  macallan 		fg = WS_DEFAULT_FG;
    520  1.48  macallan #else
    521  1.48  macallan 		fg = WSCOL_WHITE;
    522  1.48  macallan #endif
    523  1.48  macallan #ifdef WS_DEFAULT_BG
    524  1.48  macallan 		bg = WS_DEFAULT_BG;
    525  1.48  macallan #else
    526  1.48  macallan 		bg = WSCOL_BLACK;
    527  1.48  macallan #endif
    528  1.23  drochner 	}
    529  1.23  drochner 
    530  1.17        ad 	if ((flg & WSATTR_REVERSE) != 0) {
    531   1.1        ad 		swap = fg;
    532   1.1        ad 		fg = bg;
    533   1.1        ad 		bg = swap;
    534   1.1        ad 	}
    535   1.1        ad 
    536  1.17        ad 	if ((flg & WSATTR_HILIT) != 0)
    537   1.1        ad 		fg += 8;
    538  1.30        pk 
    539   1.1        ad 	flg = ((flg & WSATTR_UNDERLINE) ? 1 : 0);
    540  1.30        pk 
    541   1.1        ad 	if (rasops_isgray[fg])
    542   1.1        ad 		flg |= 2;
    543   1.1        ad 
    544   1.1        ad 	if (rasops_isgray[bg])
    545   1.1        ad 		flg |= 4;
    546   1.1        ad 
    547   1.1        ad 	*attr = (bg << 16) | (fg << 24) | flg;
    548  1.17        ad 	return (0);
    549   1.1        ad }
    550   1.1        ad 
    551   1.1        ad /*
    552   1.1        ad  * Allocate a mono attribute.
    553   1.1        ad  */
    554   1.1        ad static int
    555  1.54  christos rasops_allocattr_mono(void *cookie, int fg, int bg, int flg,
    556  1.53  christos     long *attr)
    557   1.1        ad {
    558   1.1        ad 	int swap;
    559   1.1        ad 
    560  1.23  drochner 	if ((flg & (WSATTR_BLINK | WSATTR_HILIT | WSATTR_WSCOLORS)) != 0)
    561   1.1        ad 		return (EINVAL);
    562  1.23  drochner 
    563  1.23  drochner 	fg = 1;
    564  1.23  drochner 	bg = 0;
    565  1.23  drochner 
    566  1.17        ad 	if ((flg & WSATTR_REVERSE) != 0) {
    567   1.1        ad 		swap = fg;
    568   1.1        ad 		fg = bg;
    569   1.1        ad 		bg = swap;
    570   1.1        ad 	}
    571   1.1        ad 
    572   1.1        ad 	*attr = (bg << 16) | (fg << 24) | ((flg & WSATTR_UNDERLINE) ? 7 : 6);
    573  1.17        ad 	return (0);
    574   1.1        ad }
    575   1.1        ad 
    576   1.1        ad /*
    577   1.1        ad  * Copy rows.
    578   1.1        ad  */
    579   1.1        ad static void
    580  1.60       dsl rasops_copyrows(void *cookie, int src, int dst, int num)
    581   1.1        ad {
    582  1.51  jmcneill 	int32_t *sp, *dp, *hp, *srp, *drp, *hrp;
    583   1.1        ad 	struct rasops_info *ri;
    584  1.18        ad 	int n8, n1, cnt, delta;
    585  1.30        pk 
    586   1.1        ad 	ri = (struct rasops_info *)cookie;
    587  1.51  jmcneill 	hp = hrp = NULL;
    588   1.1        ad 
    589   1.1        ad #ifdef RASOPS_CLIPPING
    590   1.1        ad 	if (dst == src)
    591   1.1        ad 		return;
    592  1.30        pk 
    593   1.1        ad 	if (src < 0) {
    594   1.1        ad 		num += src;
    595   1.1        ad 		src = 0;
    596   1.1        ad 	}
    597   1.1        ad 
    598   1.1        ad 	if ((src + num) > ri->ri_rows)
    599   1.1        ad 		num = ri->ri_rows - src;
    600   1.1        ad 
    601   1.1        ad 	if (dst < 0) {
    602   1.1        ad 		num += dst;
    603   1.1        ad 		dst = 0;
    604   1.1        ad 	}
    605   1.1        ad 
    606   1.1        ad 	if ((dst + num) > ri->ri_rows)
    607   1.1        ad 		num = ri->ri_rows - dst;
    608  1.30        pk 
    609   1.1        ad 	if (num <= 0)
    610   1.1        ad 		return;
    611   1.1        ad #endif
    612   1.1        ad 
    613   1.1        ad 	num *= ri->ri_font->fontheight;
    614   1.1        ad 	n8 = ri->ri_emustride >> 5;
    615   1.1        ad 	n1 = (ri->ri_emustride >> 2) & 7;
    616  1.30        pk 
    617   1.1        ad 	if (dst < src) {
    618  1.18        ad 		srp = (int32_t *)(ri->ri_bits + src * ri->ri_yscale);
    619  1.18        ad 		drp = (int32_t *)(ri->ri_bits + dst * ri->ri_yscale);
    620  1.51  jmcneill 		if (ri->ri_hwbits)
    621  1.51  jmcneill 			hrp = (int32_t *)(ri->ri_hwbits + dst *
    622  1.51  jmcneill 			    ri->ri_yscale);
    623  1.18        ad 		delta = ri->ri_stride;
    624   1.1        ad 	} else {
    625   1.1        ad 		src = ri->ri_font->fontheight * src + num - 1;
    626   1.1        ad 		dst = ri->ri_font->fontheight * dst + num - 1;
    627   1.1        ad 		srp = (int32_t *)(ri->ri_bits + src * ri->ri_stride);
    628   1.1        ad 		drp = (int32_t *)(ri->ri_bits + dst * ri->ri_stride);
    629  1.51  jmcneill 		if (ri->ri_hwbits)
    630  1.51  jmcneill 			hrp = (int32_t *)(ri->ri_hwbits + dst *
    631  1.51  jmcneill 			    ri->ri_stride);
    632  1.51  jmcneill 
    633  1.18        ad 		delta = -ri->ri_stride;
    634  1.18        ad 	}
    635  1.30        pk 
    636  1.18        ad 	while (num--) {
    637  1.18        ad 		dp = drp;
    638  1.18        ad 		sp = srp;
    639  1.51  jmcneill 		if (ri->ri_hwbits)
    640  1.51  jmcneill 			hp = hrp;
    641  1.51  jmcneill 
    642  1.18        ad 		DELTA(drp, delta, int32_t *);
    643  1.18        ad 		DELTA(srp, delta, int32_t *);
    644  1.51  jmcneill 		if (ri->ri_hwbits)
    645  1.51  jmcneill 			DELTA(hrp, delta, int32_t *);
    646  1.18        ad 
    647  1.18        ad 		for (cnt = n8; cnt; cnt--) {
    648  1.52  jmcneill 			dp[0] = sp[0];
    649  1.52  jmcneill 			dp[1] = sp[1];
    650  1.52  jmcneill 			dp[2] = sp[2];
    651  1.52  jmcneill 			dp[3] = sp[3];
    652  1.52  jmcneill 			dp[4] = sp[4];
    653  1.52  jmcneill 			dp[5] = sp[5];
    654  1.52  jmcneill 			dp[6] = sp[6];
    655  1.52  jmcneill 			dp[7] = sp[7];
    656  1.18        ad 			dp += 8;
    657  1.18        ad 			sp += 8;
    658  1.52  jmcneill 		}
    659  1.52  jmcneill 		if (ri->ri_hwbits) {
    660  1.52  jmcneill 			sp -= (8 * n8);
    661  1.52  jmcneill 			for (cnt = n8; cnt; cnt--) {
    662  1.52  jmcneill 				hp[0] = sp[0];
    663  1.52  jmcneill 				hp[1] = sp[1];
    664  1.52  jmcneill 				hp[2] = sp[2];
    665  1.52  jmcneill 				hp[3] = sp[3];
    666  1.52  jmcneill 				hp[4] = sp[4];
    667  1.52  jmcneill 				hp[5] = sp[5];
    668  1.52  jmcneill 				hp[6] = sp[6];
    669  1.52  jmcneill 				hp[7] = sp[7];
    670  1.51  jmcneill 				hp += 8;
    671  1.52  jmcneill 				sp += 8;
    672  1.52  jmcneill 			}
    673  1.18        ad 		}
    674  1.30        pk 
    675  1.51  jmcneill 		for (cnt = n1; cnt; cnt--) {
    676  1.18        ad 			*dp++ = *sp++;
    677  1.51  jmcneill 			if (ri->ri_hwbits)
    678  1.51  jmcneill 				*hp++ = *(sp - 1);
    679  1.51  jmcneill 		}
    680   1.1        ad 	}
    681   1.1        ad }
    682   1.1        ad 
    683   1.1        ad /*
    684   1.1        ad  * Copy columns. This is slow, and hard to optimize due to alignment,
    685   1.1        ad  * and the fact that we have to copy both left->right and right->left.
    686  1.43       uwe  * We simply cop-out here and use memmove(), since it handles all of
    687   1.1        ad  * these cases anyway.
    688   1.1        ad  */
    689   1.4        ad void
    690  1.60       dsl rasops_copycols(void *cookie, int row, int src, int dst, int num)
    691   1.1        ad {
    692   1.1        ad 	struct rasops_info *ri;
    693  1.51  jmcneill 	u_char *sp, *dp, *hp;
    694   1.1        ad 	int height;
    695  1.30        pk 
    696   1.1        ad 	ri = (struct rasops_info *)cookie;
    697  1.51  jmcneill 	hp = NULL;
    698   1.1        ad 
    699   1.1        ad #ifdef RASOPS_CLIPPING
    700   1.1        ad 	if (dst == src)
    701   1.1        ad 		return;
    702  1.30        pk 
    703   1.3        ad 	/* Catches < 0 case too */
    704   1.3        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    705   1.1        ad 		return;
    706  1.30        pk 
    707   1.1        ad 	if (src < 0) {
    708   1.1        ad 		num += src;
    709   1.1        ad 		src = 0;
    710   1.1        ad 	}
    711   1.1        ad 
    712   1.1        ad 	if ((src + num) > ri->ri_cols)
    713   1.1        ad 		num = ri->ri_cols - src;
    714   1.1        ad 
    715   1.1        ad 	if (dst < 0) {
    716   1.1        ad 		num += dst;
    717   1.1        ad 		dst = 0;
    718   1.1        ad 	}
    719   1.1        ad 
    720   1.1        ad 	if ((dst + num) > ri->ri_cols)
    721   1.1        ad 		num = ri->ri_cols - dst;
    722  1.30        pk 
    723   1.1        ad 	if (num <= 0)
    724   1.1        ad 		return;
    725   1.1        ad #endif
    726  1.30        pk 
    727   1.1        ad 	num *= ri->ri_xscale;
    728   1.1        ad 	row *= ri->ri_yscale;
    729   1.1        ad 	height = ri->ri_font->fontheight;
    730  1.30        pk 
    731   1.1        ad 	sp = ri->ri_bits + row + src * ri->ri_xscale;
    732   1.1        ad 	dp = ri->ri_bits + row + dst * ri->ri_xscale;
    733  1.51  jmcneill 	if (ri->ri_hwbits)
    734  1.51  jmcneill 		hp = ri->ri_hwbits + row + dst * ri->ri_xscale;
    735  1.30        pk 
    736   1.1        ad 	while (height--) {
    737  1.43       uwe 		memmove(dp, sp, num);
    738  1.51  jmcneill 		if (ri->ri_hwbits) {
    739  1.51  jmcneill 			memcpy(hp, sp, num);
    740  1.51  jmcneill 			hp += ri->ri_stride;
    741  1.51  jmcneill 		}
    742   1.1        ad 		dp += ri->ri_stride;
    743   1.1        ad 		sp += ri->ri_stride;
    744   1.1        ad 	}
    745   1.1        ad }
    746   1.1        ad 
    747   1.1        ad /*
    748   1.1        ad  * Turn cursor off/on.
    749   1.1        ad  */
    750   1.1        ad static void
    751  1.60       dsl rasops_cursor(void *cookie, int on, int row, int col)
    752   1.1        ad {
    753   1.1        ad 	struct rasops_info *ri;
    754  1.30        pk 
    755   1.1        ad 	ri = (struct rasops_info *)cookie;
    756  1.30        pk 
    757   1.1        ad 	/* Turn old cursor off */
    758  1.13        ad 	if ((ri->ri_flg & RI_CURSOR) != 0)
    759  1.30        pk #ifdef RASOPS_CLIPPING
    760  1.13        ad 		if ((ri->ri_flg & RI_CURSORCLIP) == 0)
    761   1.1        ad #endif
    762   1.1        ad 			ri->ri_do_cursor(ri);
    763   1.1        ad 
    764   1.1        ad 	/* Select new cursor */
    765   1.1        ad #ifdef RASOPS_CLIPPING
    766  1.13        ad 	ri->ri_flg &= ~RI_CURSORCLIP;
    767  1.30        pk 
    768   1.1        ad 	if (row < 0 || row >= ri->ri_rows)
    769  1.13        ad 		ri->ri_flg |= RI_CURSORCLIP;
    770   1.1        ad 	else if (col < 0 || col >= ri->ri_cols)
    771  1.13        ad 		ri->ri_flg |= RI_CURSORCLIP;
    772   1.1        ad #endif
    773   1.1        ad 	ri->ri_crow = row;
    774   1.1        ad 	ri->ri_ccol = col;
    775   1.1        ad 
    776   1.1        ad 	if (on) {
    777  1.13        ad 		ri->ri_flg |= RI_CURSOR;
    778  1.30        pk #ifdef RASOPS_CLIPPING
    779  1.13        ad 		if ((ri->ri_flg & RI_CURSORCLIP) == 0)
    780   1.1        ad #endif
    781   1.1        ad 			ri->ri_do_cursor(ri);
    782  1.30        pk 	} else
    783  1.13        ad 		ri->ri_flg &= ~RI_CURSOR;
    784   1.1        ad }
    785   1.1        ad 
    786   1.1        ad /*
    787   1.1        ad  * Make the device colormap
    788   1.1        ad  */
    789   1.4        ad static void
    790  1.59       dsl rasops_init_devcmap(struct rasops_info *ri)
    791   1.1        ad {
    792  1.23  drochner 	const u_char *p;
    793   1.1        ad 	int i, c;
    794  1.30        pk 
    795   1.4        ad 	switch (ri->ri_depth) {
    796   1.4        ad 	case 1:
    797   1.4        ad 		ri->ri_devcmap[0] = 0;
    798   1.4        ad 		for (i = 1; i < 16; i++)
    799   1.4        ad 			ri->ri_devcmap[i] = -1;
    800   1.4        ad 		return;
    801   1.4        ad 
    802   1.4        ad 	case 2:
    803   1.4        ad 		for (i = 1; i < 15; i++)
    804   1.4        ad 			ri->ri_devcmap[i] = 0xaaaaaaaa;
    805  1.30        pk 
    806   1.4        ad 		ri->ri_devcmap[0] = 0;
    807   1.4        ad 		ri->ri_devcmap[8] = 0x55555555;
    808   1.4        ad 		ri->ri_devcmap[15] = -1;
    809   1.4        ad 		return;
    810   1.4        ad 
    811   1.4        ad 	case 8:
    812   1.4        ad 		for (i = 0; i < 16; i++)
    813   1.4        ad 			ri->ri_devcmap[i] = i | (i<<8) | (i<<16) | (i<<24);
    814   1.4        ad 		return;
    815   1.4        ad 	}
    816  1.30        pk 
    817   1.1        ad 	p = rasops_cmap;
    818  1.30        pk 
    819  1.29   nathanw 	for (i = 0; i < 16; i++) {
    820   1.1        ad 		if (ri->ri_rnum <= 8)
    821  1.12        ad 			c = (*p >> (8 - ri->ri_rnum)) << ri->ri_rpos;
    822  1.30        pk 		else
    823  1.12        ad 			c = (*p << (ri->ri_rnum - 8)) << ri->ri_rpos;
    824  1.29   nathanw 		p++;
    825   1.1        ad 
    826   1.1        ad 		if (ri->ri_gnum <= 8)
    827  1.12        ad 			c |= (*p >> (8 - ri->ri_gnum)) << ri->ri_gpos;
    828  1.30        pk 		else
    829  1.12        ad 			c |= (*p << (ri->ri_gnum - 8)) << ri->ri_gpos;
    830  1.29   nathanw 		p++;
    831   1.1        ad 
    832   1.1        ad 		if (ri->ri_bnum <= 8)
    833  1.12        ad 			c |= (*p >> (8 - ri->ri_bnum)) << ri->ri_bpos;
    834  1.30        pk 		else
    835  1.12        ad 			c |= (*p << (ri->ri_bnum - 8)) << ri->ri_bpos;
    836  1.29   nathanw 		p++;
    837   1.4        ad 
    838   1.4        ad 		/* Fill the word for generic routines, which want this */
    839   1.4        ad 		if (ri->ri_depth == 24)
    840   1.4        ad 			c = c | ((c & 0xff) << 24);
    841   1.4        ad 		else if (ri->ri_depth <= 16)
    842   1.4        ad 			c = c | (c << 16);
    843   1.1        ad 
    844   1.4        ad 		/* 24bpp does bswap on the fly. {32,16,15}bpp do it here. */
    845  1.13        ad 		if ((ri->ri_flg & RI_BSWAP) == 0)
    846   1.3        ad 			ri->ri_devcmap[i] = c;
    847   1.4        ad 		else if (ri->ri_depth == 32)
    848   1.3        ad 			ri->ri_devcmap[i] = bswap32(c);
    849   1.4        ad 		else if (ri->ri_depth == 16 || ri->ri_depth == 15)
    850   1.3        ad 			ri->ri_devcmap[i] = bswap16(c);
    851   1.4        ad 		else
    852   1.4        ad 			ri->ri_devcmap[i] = c;
    853   1.1        ad 	}
    854   1.1        ad }
    855   1.1        ad 
    856   1.1        ad /*
    857   1.1        ad  * Unpack a rasops attribute
    858   1.1        ad  */
    859   1.1        ad void
    860  1.60       dsl rasops_unpack_attr(long attr, int *fg, int *bg, int *underline)
    861   1.1        ad {
    862  1.30        pk 
    863  1.30        pk 	*fg = ((u_int)attr >> 24) & 0xf;
    864  1.30        pk 	*bg = ((u_int)attr >> 16) & 0xf;
    865  1.25        ad 	if (underline != NULL)
    866  1.24  drochner 		*underline = (u_int)attr & 1;
    867   1.4        ad }
    868   1.4        ad 
    869   1.4        ad /*
    870   1.4        ad  * Erase rows. This isn't static, since 24-bpp uses it in special cases.
    871   1.4        ad  */
    872   1.4        ad void
    873  1.60       dsl rasops_eraserows(void *cookie, int row, int num, long attr)
    874   1.4        ad {
    875   1.4        ad 	struct rasops_info *ri;
    876  1.14        ad 	int np, nw, cnt, delta;
    877  1.51  jmcneill 	int32_t *dp, *hp, clr;
    878  1.51  jmcneill 	int i;
    879  1.30        pk 
    880   1.4        ad 	ri = (struct rasops_info *)cookie;
    881  1.51  jmcneill 	hp = NULL;
    882   1.4        ad 
    883   1.4        ad #ifdef RASOPS_CLIPPING
    884   1.4        ad 	if (row < 0) {
    885   1.4        ad 		num += row;
    886   1.4        ad 		row = 0;
    887   1.4        ad 	}
    888   1.4        ad 
    889   1.4        ad 	if ((row + num) > ri->ri_rows)
    890   1.4        ad 		num = ri->ri_rows - row;
    891  1.30        pk 
    892   1.4        ad 	if (num <= 0)
    893   1.4        ad 		return;
    894   1.4        ad #endif
    895   1.4        ad 
    896  1.30        pk 	clr = ri->ri_devcmap[(attr >> 16) & 0xf];
    897   1.4        ad 
    898  1.30        pk 	/*
    899  1.20        ad 	 * XXX The wsdisplay_emulops interface seems a little deficient in
    900  1.30        pk 	 * that there is no way to clear the *entire* screen. We provide a
    901  1.30        pk 	 * workaround here: if the entire console area is being cleared, and
    902  1.13        ad 	 * the RI_FULLCLEAR flag is set, clear the entire display.
    903  1.30        pk 	 */
    904  1.13        ad 	if (num == ri->ri_rows && (ri->ri_flg & RI_FULLCLEAR) != 0) {
    905  1.13        ad 		np = ri->ri_stride >> 5;
    906  1.13        ad 		nw = (ri->ri_stride >> 2) & 7;
    907  1.13        ad 		num = ri->ri_height;
    908  1.14        ad 		dp = (int32_t *)ri->ri_origbits;
    909  1.51  jmcneill 		if (ri->ri_hwbits)
    910  1.61  macallan 			hp = (int32_t *)ri->ri_hworigbits;
    911  1.14        ad 		delta = 0;
    912  1.13        ad 	} else {
    913  1.13        ad 		np = ri->ri_emustride >> 5;
    914  1.13        ad 		nw = (ri->ri_emustride >> 2) & 7;
    915  1.13        ad 		num *= ri->ri_font->fontheight;
    916  1.14        ad 		dp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale);
    917  1.51  jmcneill 		if (ri->ri_hwbits)
    918  1.51  jmcneill 			hp = (int32_t *)(ri->ri_hwbits + row *
    919  1.51  jmcneill 			    ri->ri_yscale);
    920  1.14        ad 		delta = ri->ri_delta;
    921  1.13        ad 	}
    922  1.30        pk 
    923   1.4        ad 	while (num--) {
    924   1.4        ad 		for (cnt = np; cnt; cnt--) {
    925  1.51  jmcneill 			for (i = 0; i < 8; i++) {
    926  1.51  jmcneill 				dp[i] = clr;
    927  1.51  jmcneill 				if (ri->ri_hwbits)
    928  1.51  jmcneill 					hp[i] = clr;
    929  1.51  jmcneill 			}
    930   1.4        ad 			dp += 8;
    931  1.51  jmcneill 			if (ri->ri_hwbits)
    932  1.51  jmcneill 				hp += 8;
    933   1.4        ad 		}
    934  1.30        pk 
    935   1.4        ad 		for (cnt = nw; cnt; cnt--) {
    936   1.4        ad 			*(int32_t *)dp = clr;
    937   1.4        ad 			DELTA(dp, 4, int32_t *);
    938  1.51  jmcneill 			if (ri->ri_hwbits) {
    939  1.51  jmcneill 				*(int32_t *)hp = clr;
    940  1.51  jmcneill 				DELTA(hp, 4, int32_t *);
    941  1.51  jmcneill 			}
    942  1.30        pk 		}
    943  1.30        pk 
    944  1.14        ad 		DELTA(dp, delta, int32_t *);
    945  1.51  jmcneill 		if (ri->ri_hwbits)
    946  1.51  jmcneill 			DELTA(hp, delta, int32_t *);
    947   1.4        ad 	}
    948   1.4        ad }
    949   1.4        ad 
    950   1.4        ad /*
    951   1.4        ad  * Actually turn the cursor on or off. This does the dirty work for
    952   1.4        ad  * rasops_cursor().
    953   1.4        ad  */
    954   1.4        ad static void
    955  1.59       dsl rasops_do_cursor(struct rasops_info *ri)
    956   1.4        ad {
    957  1.21        ad 	int full1, height, cnt, slop1, slop2, row, col;
    958  1.63  macallan 	u_char *dp, *rp, *hrp, *hp, tmp = 0;
    959  1.51  jmcneill 
    960  1.51  jmcneill 	hrp = hp = NULL;
    961  1.30        pk 
    962  1.55      ober #if NRASOPS_ROTATION > 0
    963  1.62    nonaka 	if (ri->ri_flg & RI_ROTATE_MASK) {
    964  1.62    nonaka 		if (ri->ri_flg & RI_ROTATE_CW) {
    965  1.62    nonaka 			/* Rotate rows/columns */
    966  1.62    nonaka 			row = ri->ri_ccol;
    967  1.62    nonaka 			col = ri->ri_rows - ri->ri_crow - 1;
    968  1.62    nonaka 		} else if (ri->ri_flg & RI_ROTATE_CCW) {
    969  1.62    nonaka 			/* Rotate rows/columns */
    970  1.62    nonaka 			row = ri->ri_cols - ri->ri_ccol - 1;
    971  1.62    nonaka 			col = ri->ri_crow;
    972  1.62    nonaka 		} else {	/* upside-down */
    973  1.62    nonaka 			row = ri->ri_crow;
    974  1.62    nonaka 			col = ri->ri_ccol;
    975  1.62    nonaka 		}
    976  1.55      ober 	} else
    977  1.55      ober #endif
    978  1.55      ober 	{
    979  1.55      ober 		row = ri->ri_crow;
    980  1.55      ober 		col = ri->ri_ccol;
    981  1.55      ober 	}
    982  1.30        pk 
    983   1.4        ad 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    984  1.51  jmcneill 	if (ri->ri_hwbits)
    985  1.51  jmcneill 		hrp = ri->ri_hwbits + row * ri->ri_yscale + col
    986  1.51  jmcneill 		    * ri->ri_xscale;
    987   1.4        ad 	height = ri->ri_font->fontheight;
    988  1.27  nisimura 	slop1 = (4 - ((long)rp & 3)) & 3;
    989  1.30        pk 
    990   1.4        ad 	if (slop1 > ri->ri_xscale)
    991   1.4        ad 		slop1 = ri->ri_xscale;
    992  1.30        pk 
    993   1.4        ad 	slop2 = (ri->ri_xscale - slop1) & 3;
    994   1.4        ad 	full1 = (ri->ri_xscale - slop1 - slop2) >> 2;
    995  1.30        pk 
    996   1.4        ad 	if ((slop1 | slop2) == 0) {
    997  1.63  macallan 		uint32_t tmp32;
    998   1.4        ad 		/* A common case */
    999   1.4        ad 		while (height--) {
   1000   1.4        ad 			dp = rp;
   1001   1.4        ad 			rp += ri->ri_stride;
   1002  1.51  jmcneill 			if (ri->ri_hwbits) {
   1003  1.51  jmcneill 				hp = hrp;
   1004  1.51  jmcneill 				hrp += ri->ri_stride;
   1005  1.51  jmcneill 			}
   1006  1.30        pk 
   1007   1.4        ad 			for (cnt = full1; cnt; cnt--) {
   1008  1.63  macallan 				tmp32 = *(int32_t *)dp ^ ~0;
   1009  1.63  macallan 				*(int32_t *)dp = tmp32;
   1010   1.4        ad 				dp += 4;
   1011  1.51  jmcneill 				if (ri->ri_hwbits) {
   1012  1.63  macallan 					*(int32_t *)hp = tmp32;
   1013  1.51  jmcneill 					hp += 4;
   1014  1.51  jmcneill 				}
   1015   1.4        ad 			}
   1016   1.4        ad 		}
   1017   1.4        ad 	} else {
   1018  1.63  macallan 		uint16_t tmp16;
   1019  1.63  macallan 		uint32_t tmp32;
   1020   1.4        ad 		/* XXX this is stupid.. use masks instead */
   1021   1.4        ad 		while (height--) {
   1022   1.4        ad 			dp = rp;
   1023   1.4        ad 			rp += ri->ri_stride;
   1024  1.51  jmcneill 			if (ri->ri_hwbits) {
   1025  1.51  jmcneill 				hp = hrp;
   1026  1.51  jmcneill 				hrp += ri->ri_stride;
   1027  1.51  jmcneill 			}
   1028  1.30        pk 
   1029  1.51  jmcneill 			if (slop1 & 1) {
   1030  1.63  macallan 				tmp = *dp ^ ~0;
   1031  1.63  macallan 				*dp = tmp;
   1032  1.63  macallan 				dp++;
   1033  1.57  jmcneill 				if (ri->ri_hwbits) {
   1034  1.63  macallan 					*hp++ = tmp;
   1035  1.57  jmcneill 				}
   1036  1.51  jmcneill 			}
   1037   1.4        ad 
   1038   1.4        ad 			if (slop1 & 2) {
   1039  1.63  macallan 				tmp16 = *(int16_t *)dp ^ ~0;
   1040  1.63  macallan 				*(uint16_t *)dp = tmp16;
   1041   1.4        ad 				dp += 2;
   1042  1.51  jmcneill 				if (ri->ri_hwbits) {
   1043  1.63  macallan 					*(int16_t *)hp = tmp16;
   1044  1.51  jmcneill 					hp += 2;
   1045  1.51  jmcneill 				}
   1046   1.4        ad 			}
   1047  1.30        pk 
   1048   1.4        ad 			for (cnt = full1; cnt; cnt--) {
   1049  1.63  macallan 				tmp32 = *(int32_t *)dp ^ ~0;
   1050  1.63  macallan 				*(uint32_t *)dp = tmp32;
   1051   1.4        ad 				dp += 4;
   1052  1.51  jmcneill 				if (ri->ri_hwbits) {
   1053  1.63  macallan 					*(int32_t *)hp = tmp32;
   1054  1.51  jmcneill 					hp += 4;
   1055  1.51  jmcneill 				}
   1056   1.4        ad 			}
   1057   1.4        ad 
   1058  1.51  jmcneill 			if (slop2 & 1) {
   1059  1.63  macallan 				tmp = *dp ^ ~0;
   1060  1.63  macallan 				*dp = tmp;
   1061  1.63  macallan 				dp++;
   1062  1.51  jmcneill 				if (ri->ri_hwbits)
   1063  1.63  macallan 					*hp++ = tmp;
   1064  1.51  jmcneill 			}
   1065   1.4        ad 
   1066  1.51  jmcneill 			if (slop2 & 2) {
   1067  1.63  macallan 				tmp16 = *(int16_t *)dp ^ ~0;
   1068  1.63  macallan 				*(uint16_t *)dp = tmp16;
   1069  1.51  jmcneill 				if (ri->ri_hwbits)
   1070  1.63  macallan 					*(int16_t *)hp = tmp16;
   1071  1.51  jmcneill 			}
   1072   1.4        ad 		}
   1073   1.4        ad 	}
   1074   1.4        ad }
   1075   1.4        ad 
   1076   1.4        ad /*
   1077   1.4        ad  * Erase columns.
   1078   1.4        ad  */
   1079   1.4        ad void
   1080  1.60       dsl rasops_erasecols(void *cookie, int row, int col, int num, long attr)
   1081   1.4        ad {
   1082   1.4        ad 	int n8, height, cnt, slop1, slop2, clr;
   1083   1.4        ad 	struct rasops_info *ri;
   1084  1.51  jmcneill 	int32_t *rp, *dp, *hrp, *hp;
   1085  1.51  jmcneill 	int i;
   1086  1.30        pk 
   1087   1.4        ad 	ri = (struct rasops_info *)cookie;
   1088  1.51  jmcneill 	hrp = hp = NULL;
   1089  1.30        pk 
   1090  1.30        pk #ifdef RASOPS_CLIPPING
   1091   1.4        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
   1092   1.4        ad 		return;
   1093   1.4        ad 
   1094   1.4        ad 	if (col < 0) {
   1095   1.4        ad 		num += col;
   1096   1.4        ad 		col = 0;
   1097   1.4        ad 	}
   1098   1.4        ad 
   1099   1.4        ad 	if ((col + num) > ri->ri_cols)
   1100   1.4        ad 		num = ri->ri_cols - col;
   1101  1.30        pk 
   1102   1.4        ad 	if (num <= 0)
   1103   1.4        ad 		return;
   1104   1.4        ad #endif
   1105  1.30        pk 
   1106   1.4        ad 	num = num * ri->ri_xscale;
   1107   1.4        ad 	rp = (int32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
   1108  1.51  jmcneill 	if (ri->ri_hwbits)
   1109  1.51  jmcneill 		hrp = (int32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
   1110  1.51  jmcneill 		    col*ri->ri_xscale);
   1111   1.4        ad 	height = ri->ri_font->fontheight;
   1112  1.30        pk 	clr = ri->ri_devcmap[(attr >> 16) & 0xf];
   1113  1.30        pk 
   1114   1.4        ad 	/* Don't bother using the full loop for <= 32 pels */
   1115   1.4        ad 	if (num <= 32) {
   1116   1.6        ad 		if (((num | ri->ri_xscale) & 3) == 0) {
   1117   1.6        ad 			/* Word aligned blt */
   1118   1.6        ad 			num >>= 2;
   1119   1.6        ad 
   1120   1.6        ad 			while (height--) {
   1121   1.6        ad 				dp = rp;
   1122   1.6        ad 				DELTA(rp, ri->ri_stride, int32_t *);
   1123  1.51  jmcneill 				if (ri->ri_hwbits) {
   1124  1.51  jmcneill 					hp = hrp;
   1125  1.51  jmcneill 					DELTA(hrp, ri->ri_stride, int32_t *);
   1126  1.51  jmcneill 				}
   1127  1.30        pk 
   1128  1.51  jmcneill 				for (cnt = num; cnt; cnt--) {
   1129   1.6        ad 					*dp++ = clr;
   1130  1.51  jmcneill 					if (ri->ri_hwbits)
   1131  1.51  jmcneill 						*hp++ = clr;
   1132  1.51  jmcneill 				}
   1133   1.6        ad 			}
   1134   1.6        ad 		} else if (((num | ri->ri_xscale) & 1) == 0) {
   1135  1.30        pk 			/*
   1136   1.4        ad 			 * Halfword aligned blt. This is needed so the
   1137  1.30        pk 			 * 15/16 bit ops can use this function.
   1138   1.4        ad 			 */
   1139   1.4        ad 			num >>= 1;
   1140   1.4        ad 
   1141   1.4        ad 			while (height--) {
   1142   1.4        ad 				dp = rp;
   1143   1.4        ad 				DELTA(rp, ri->ri_stride, int32_t *);
   1144  1.51  jmcneill 				if (ri->ri_hwbits) {
   1145  1.51  jmcneill 					hp = hrp;
   1146  1.51  jmcneill 					DELTA(hrp, ri->ri_stride, int32_t *);
   1147  1.51  jmcneill 				}
   1148   1.4        ad 
   1149   1.4        ad 				for (cnt = num; cnt; cnt--) {
   1150   1.4        ad 					*(int16_t *)dp = clr;
   1151   1.4        ad 					DELTA(dp, 2, int32_t *);
   1152  1.51  jmcneill 					if (ri->ri_hwbits) {
   1153  1.51  jmcneill 						*(int16_t *)hp = clr;
   1154  1.51  jmcneill 						DELTA(hp, 2, int32_t *);
   1155  1.51  jmcneill 					}
   1156   1.4        ad 				}
   1157   1.4        ad 			}
   1158   1.4        ad 		} else {
   1159   1.4        ad 			while (height--) {
   1160   1.4        ad 				dp = rp;
   1161   1.4        ad 				DELTA(rp, ri->ri_stride, int32_t *);
   1162  1.51  jmcneill 				if (ri->ri_hwbits) {
   1163  1.51  jmcneill 					hp = hrp;
   1164  1.51  jmcneill 					DELTA(hrp, ri->ri_stride, int32_t *);
   1165  1.51  jmcneill 				}
   1166   1.4        ad 
   1167   1.4        ad 				for (cnt = num; cnt; cnt--) {
   1168   1.4        ad 					*(u_char *)dp = clr;
   1169   1.4        ad 					DELTA(dp, 1, int32_t *);
   1170  1.51  jmcneill 					if (ri->ri_hwbits) {
   1171  1.51  jmcneill 						*(u_char *)hp = clr;
   1172  1.51  jmcneill 						DELTA(hp, 1, int32_t *);
   1173  1.51  jmcneill 					}
   1174   1.4        ad 				}
   1175   1.4        ad 			}
   1176   1.4        ad 		}
   1177  1.30        pk 
   1178   1.4        ad 		return;
   1179   1.4        ad 	}
   1180  1.30        pk 
   1181  1.27  nisimura 	slop1 = (4 - ((long)rp & 3)) & 3;
   1182   1.4        ad 	slop2 = (num - slop1) & 3;
   1183   1.4        ad 	num -= slop1 + slop2;
   1184   1.4        ad 	n8 = num >> 5;
   1185   1.4        ad 	num = (num >> 2) & 7;
   1186   1.4        ad 
   1187   1.4        ad 	while (height--) {
   1188   1.4        ad 		dp = rp;
   1189   1.4        ad 		DELTA(rp, ri->ri_stride, int32_t *);
   1190  1.51  jmcneill 		if (ri->ri_hwbits) {
   1191  1.51  jmcneill 			hp = hrp;
   1192  1.51  jmcneill 			DELTA(hrp, ri->ri_stride, int32_t *);
   1193  1.51  jmcneill 		}
   1194  1.30        pk 
   1195   1.4        ad 		/* Align span to 4 bytes */
   1196   1.4        ad 		if (slop1 & 1) {
   1197   1.4        ad 			*(u_char *)dp = clr;
   1198   1.4        ad 			DELTA(dp, 1, int32_t *);
   1199  1.51  jmcneill 			if (ri->ri_hwbits) {
   1200  1.51  jmcneill 				*(u_char *)hp = clr;
   1201  1.51  jmcneill 				DELTA(hp, 1, int32_t *);
   1202  1.51  jmcneill 			}
   1203   1.4        ad 		}
   1204   1.4        ad 
   1205   1.4        ad 		if (slop1 & 2) {
   1206   1.4        ad 			*(int16_t *)dp = clr;
   1207   1.4        ad 			DELTA(dp, 2, int32_t *);
   1208  1.51  jmcneill 			if (ri->ri_hwbits) {
   1209  1.51  jmcneill 				*(int16_t *)hp = clr;
   1210  1.51  jmcneill 				DELTA(hp, 2, int32_t *);
   1211  1.51  jmcneill 			}
   1212   1.4        ad 		}
   1213  1.30        pk 
   1214   1.4        ad 		/* Write 32 bytes per loop */
   1215   1.4        ad 		for (cnt = n8; cnt; cnt--) {
   1216  1.51  jmcneill 			for (i = 0; i < 8; i++) {
   1217  1.51  jmcneill 				dp[i] = clr;
   1218  1.51  jmcneill 				if (ri->ri_hwbits)
   1219  1.51  jmcneill 					hp[i] = clr;
   1220  1.51  jmcneill 			}
   1221   1.4        ad 			dp += 8;
   1222  1.51  jmcneill 			if (ri->ri_hwbits)
   1223  1.51  jmcneill 				hp += 8;
   1224   1.4        ad 		}
   1225  1.30        pk 
   1226  1.30        pk 		/* Write 4 bytes per loop */
   1227  1.51  jmcneill 		for (cnt = num; cnt; cnt--) {
   1228   1.4        ad 			*dp++ = clr;
   1229  1.51  jmcneill 			if (ri->ri_hwbits)
   1230  1.51  jmcneill 				*hp++ = clr;
   1231  1.51  jmcneill 		}
   1232  1.30        pk 
   1233  1.30        pk 		/* Write unaligned trailing slop */
   1234   1.4        ad 		if (slop2 & 1) {
   1235   1.4        ad 			*(u_char *)dp = clr;
   1236   1.4        ad 			DELTA(dp, 1, int32_t *);
   1237  1.51  jmcneill 			if (ri->ri_hwbits) {
   1238  1.51  jmcneill 				*(u_char *)hp = clr;
   1239  1.51  jmcneill 				DELTA(hp, 1, int32_t *);
   1240  1.51  jmcneill 			}
   1241   1.4        ad 		}
   1242   1.4        ad 
   1243  1.51  jmcneill 		if (slop2 & 2) {
   1244   1.4        ad 			*(int16_t *)dp = clr;
   1245  1.51  jmcneill 			if (ri->ri_hwbits)
   1246  1.51  jmcneill 				*(int16_t *)hp = clr;
   1247  1.51  jmcneill 		}
   1248   1.4        ad 	}
   1249   1.1        ad }
   1250  1.55      ober 
   1251  1.55      ober #if NRASOPS_ROTATION > 0
   1252  1.55      ober /*
   1253  1.55      ober  * Quarter clockwise rotation routines (originally intended for the
   1254  1.55      ober  * built-in Zaurus C3x00 display in 16bpp).
   1255  1.55      ober  */
   1256  1.55      ober 
   1257  1.55      ober #include <sys/malloc.h>
   1258  1.55      ober 
   1259  1.55      ober static void
   1260  1.62    nonaka rasops_rotate_font(int *cookie, int rotate)
   1261  1.55      ober {
   1262  1.55      ober 	struct rotatedfont *f;
   1263  1.55      ober 	int ncookie;
   1264  1.55      ober 
   1265  1.55      ober 	SLIST_FOREACH(f, &rotatedfonts, rf_next) {
   1266  1.55      ober 		if (f->rf_cookie == *cookie) {
   1267  1.55      ober 			*cookie = f->rf_rotated;
   1268  1.55      ober 			return;
   1269  1.55      ober 		}
   1270  1.55      ober 	}
   1271  1.55      ober 
   1272  1.55      ober 	/*
   1273  1.55      ober 	 * We did not find a rotated version of this font. Ask the wsfont
   1274  1.55      ober 	 * code to compute one for us.
   1275  1.55      ober 	 */
   1276  1.55      ober 
   1277  1.55      ober 	f = malloc(sizeof(struct rotatedfont), M_DEVBUF, M_WAITOK);
   1278  1.55      ober 	if (f == NULL)
   1279  1.55      ober 		return;
   1280  1.55      ober 
   1281  1.62    nonaka 	if ((ncookie = wsfont_rotate(*cookie, rotate)) == -1)
   1282  1.55      ober 		return;
   1283  1.55      ober 
   1284  1.55      ober 	f->rf_cookie = *cookie;
   1285  1.55      ober 	f->rf_rotated = ncookie;
   1286  1.55      ober 	SLIST_INSERT_HEAD(&rotatedfonts, f, rf_next);
   1287  1.55      ober 
   1288  1.55      ober 	*cookie = ncookie;
   1289  1.55      ober }
   1290  1.55      ober 
   1291  1.55      ober static void
   1292  1.60       dsl rasops_copychar(void *cookie, int srcrow, int dstrow, int srccol, int dstcol)
   1293  1.55      ober {
   1294  1.55      ober 	struct rasops_info *ri;
   1295  1.55      ober 	u_char *sp, *dp;
   1296  1.55      ober 	int height;
   1297  1.55      ober 	int r_srcrow, r_dstrow, r_srccol, r_dstcol;
   1298  1.55      ober 
   1299  1.55      ober 	ri = (struct rasops_info *)cookie;
   1300  1.55      ober 
   1301  1.55      ober 	r_srcrow = srccol;
   1302  1.55      ober 	r_dstrow = dstcol;
   1303  1.55      ober 	r_srccol = ri->ri_rows - srcrow - 1;
   1304  1.55      ober 	r_dstcol = ri->ri_rows - dstrow - 1;
   1305  1.55      ober 
   1306  1.55      ober 	r_srcrow *= ri->ri_yscale;
   1307  1.55      ober 	r_dstrow *= ri->ri_yscale;
   1308  1.55      ober 	height = ri->ri_font->fontheight;
   1309  1.55      ober 
   1310  1.55      ober 	sp = ri->ri_bits + r_srcrow + r_srccol * ri->ri_xscale;
   1311  1.55      ober 	dp = ri->ri_bits + r_dstrow + r_dstcol * ri->ri_xscale;
   1312  1.55      ober 
   1313  1.55      ober 	while (height--) {
   1314  1.55      ober 		memmove(dp, sp, ri->ri_xscale);
   1315  1.55      ober 		dp += ri->ri_stride;
   1316  1.55      ober 		sp += ri->ri_stride;
   1317  1.55      ober 	}
   1318  1.55      ober }
   1319  1.55      ober 
   1320  1.55      ober static void
   1321  1.62    nonaka rasops_putchar_rotated_cw(void *cookie, int row, int col, u_int uc, long attr)
   1322  1.55      ober {
   1323  1.55      ober 	struct rasops_info *ri;
   1324  1.55      ober 	u_char *rp;
   1325  1.55      ober 	int height;
   1326  1.55      ober 
   1327  1.55      ober 	ri = (struct rasops_info *)cookie;
   1328  1.55      ober 
   1329  1.56       mjf 	if (__predict_false((unsigned int)row > ri->ri_rows ||
   1330  1.56       mjf 	    (unsigned int)col > ri->ri_cols))
   1331  1.56       mjf 		return;
   1332  1.56       mjf 
   1333  1.56       mjf 	/* Avoid underflow */
   1334  1.56       mjf 	if ((ri->ri_rows - row - 1) < 0)
   1335  1.56       mjf 		return;
   1336  1.56       mjf 
   1337  1.55      ober 	/* Do rotated char sans (side)underline */
   1338  1.55      ober 	ri->ri_real_ops.putchar(cookie, col, ri->ri_rows - row - 1, uc,
   1339  1.55      ober 	    attr & ~1);
   1340  1.55      ober 
   1341  1.55      ober 	/* Do rotated underline */
   1342  1.55      ober 	rp = ri->ri_bits + col * ri->ri_yscale + (ri->ri_rows - row - 1) *
   1343  1.55      ober 	    ri->ri_xscale;
   1344  1.55      ober 	height = ri->ri_font->fontheight;
   1345  1.55      ober 
   1346  1.55      ober 	/* XXX this assumes 16-bit color depth */
   1347  1.55      ober 	if ((attr & 1) != 0) {
   1348  1.55      ober 		int16_t c = (int16_t)ri->ri_devcmap[((u_int)attr >> 24) & 0xf];
   1349  1.55      ober 
   1350  1.55      ober 		while (height--) {
   1351  1.55      ober 			*(int16_t *)rp = c;
   1352  1.55      ober 			rp += ri->ri_stride;
   1353  1.55      ober 		}
   1354  1.55      ober 	}
   1355  1.55      ober }
   1356  1.55      ober 
   1357  1.55      ober static void
   1358  1.62    nonaka rasops_erasecols_rotated_cw(void *cookie, int row, int col, int num, long attr)
   1359  1.55      ober {
   1360  1.55      ober 	struct rasops_info *ri;
   1361  1.55      ober 	int i;
   1362  1.55      ober 
   1363  1.55      ober 	ri = (struct rasops_info *)cookie;
   1364  1.55      ober 
   1365  1.55      ober 	for (i = col; i < col + num; i++)
   1366  1.55      ober 		ri->ri_ops.putchar(cookie, row, i, ' ', attr);
   1367  1.55      ober }
   1368  1.55      ober 
   1369  1.55      ober /* XXX: these could likely be optimised somewhat. */
   1370  1.55      ober static void
   1371  1.62    nonaka rasops_copyrows_rotated_cw(void *cookie, int src, int dst, int num)
   1372  1.55      ober {
   1373  1.55      ober 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1374  1.55      ober 	int col, roff;
   1375  1.55      ober 
   1376  1.55      ober 	if (src > dst)
   1377  1.55      ober 		for (roff = 0; roff < num; roff++)
   1378  1.55      ober 			for (col = 0; col < ri->ri_cols; col++)
   1379  1.55      ober 				rasops_copychar(cookie, src + roff, dst + roff,
   1380  1.55      ober 				    col, col);
   1381  1.55      ober 	else
   1382  1.55      ober 		for (roff = num - 1; roff >= 0; roff--)
   1383  1.55      ober 			for (col = 0; col < ri->ri_cols; col++)
   1384  1.55      ober 				rasops_copychar(cookie, src + roff, dst + roff,
   1385  1.55      ober 				    col, col);
   1386  1.55      ober }
   1387  1.55      ober 
   1388  1.55      ober static void
   1389  1.62    nonaka rasops_copycols_rotated_cw(void *cookie, int row, int src, int dst, int num)
   1390  1.55      ober {
   1391  1.55      ober 	int coff;
   1392  1.55      ober 
   1393  1.55      ober 	if (src > dst)
   1394  1.55      ober 		for (coff = 0; coff < num; coff++)
   1395  1.55      ober 			rasops_copychar(cookie, row, row, src + coff, dst + coff);
   1396  1.55      ober 	else
   1397  1.55      ober 		for (coff = num - 1; coff >= 0; coff--)
   1398  1.55      ober 			rasops_copychar(cookie, row, row, src + coff, dst + coff);
   1399  1.55      ober }
   1400  1.55      ober 
   1401  1.55      ober static void
   1402  1.62    nonaka rasops_eraserows_rotated_cw(void *cookie, int row, int num, long attr)
   1403  1.55      ober {
   1404  1.55      ober 	struct rasops_info *ri;
   1405  1.55      ober 	int col, rn;
   1406  1.55      ober 
   1407  1.55      ober 	ri = (struct rasops_info *)cookie;
   1408  1.55      ober 
   1409  1.55      ober 	for (rn = row; rn < row + num; rn++)
   1410  1.55      ober 		for (col = 0; col < ri->ri_cols; col++)
   1411  1.55      ober 			ri->ri_ops.putchar(cookie, rn, col, ' ', attr);
   1412  1.55      ober }
   1413  1.62    nonaka 
   1414  1.62    nonaka /*
   1415  1.62    nonaka  * Quarter counter-clockwise rotation routines (originally intended for the
   1416  1.62    nonaka  * built-in Sharp W-ZERO3 display in 16bpp).
   1417  1.62    nonaka  */
   1418  1.62    nonaka static void
   1419  1.62    nonaka rasops_copychar_ccw(void *cookie, int srcrow, int dstrow, int srccol, int dstcol)
   1420  1.62    nonaka {
   1421  1.62    nonaka 	struct rasops_info *ri;
   1422  1.62    nonaka 	u_char *sp, *dp;
   1423  1.62    nonaka 	int height;
   1424  1.62    nonaka 	int r_srcrow, r_dstrow, r_srccol, r_dstcol;
   1425  1.62    nonaka 
   1426  1.62    nonaka 	ri = (struct rasops_info *)cookie;
   1427  1.62    nonaka 
   1428  1.62    nonaka 	r_srcrow = ri->ri_cols - srccol - 1;
   1429  1.62    nonaka 	r_dstrow = ri->ri_cols - dstcol - 1;
   1430  1.62    nonaka 	r_srccol = srcrow;
   1431  1.62    nonaka 	r_dstcol = dstrow;
   1432  1.62    nonaka 
   1433  1.62    nonaka 	r_srcrow *= ri->ri_yscale;
   1434  1.62    nonaka 	r_dstrow *= ri->ri_yscale;
   1435  1.62    nonaka 	height = ri->ri_font->fontheight;
   1436  1.62    nonaka 
   1437  1.62    nonaka 	sp = ri->ri_bits + r_srcrow + r_srccol * ri->ri_xscale;
   1438  1.62    nonaka 	dp = ri->ri_bits + r_dstrow + r_dstcol * ri->ri_xscale;
   1439  1.62    nonaka 
   1440  1.62    nonaka 	while (height--) {
   1441  1.62    nonaka 		memmove(dp, sp, ri->ri_xscale);
   1442  1.62    nonaka 		dp += ri->ri_stride;
   1443  1.62    nonaka 		sp += ri->ri_stride;
   1444  1.62    nonaka 	}
   1445  1.62    nonaka }
   1446  1.62    nonaka 
   1447  1.62    nonaka static void
   1448  1.62    nonaka rasops_putchar_rotated_ccw(void *cookie, int row, int col, u_int uc, long attr)
   1449  1.62    nonaka {
   1450  1.62    nonaka 	struct rasops_info *ri;
   1451  1.62    nonaka 	u_char *rp;
   1452  1.62    nonaka 	int height;
   1453  1.62    nonaka 
   1454  1.62    nonaka 	ri = (struct rasops_info *)cookie;
   1455  1.62    nonaka 
   1456  1.62    nonaka 	if (__predict_false((unsigned int)row > ri->ri_rows ||
   1457  1.62    nonaka 	    (unsigned int)col > ri->ri_cols))
   1458  1.62    nonaka 		return;
   1459  1.62    nonaka 
   1460  1.62    nonaka 	/* Avoid underflow */
   1461  1.62    nonaka 	if ((ri->ri_cols - col - 1) < 0)
   1462  1.62    nonaka 		return;
   1463  1.62    nonaka 
   1464  1.62    nonaka 	/* Do rotated char sans (side)underline */
   1465  1.62    nonaka 	ri->ri_real_ops.putchar(cookie, ri->ri_cols - col - 1, row, uc,
   1466  1.62    nonaka 	    attr & ~1);
   1467  1.62    nonaka 
   1468  1.62    nonaka 	/* Do rotated underline */
   1469  1.62    nonaka 	rp = ri->ri_bits + (ri->ri_cols - col - 1) * ri->ri_yscale +
   1470  1.65   tsutsui 	    row * ri->ri_xscale +
   1471  1.65   tsutsui 	    (ri->ri_font->fontwidth - 1) * ri->ri_pelbytes;
   1472  1.62    nonaka 	height = ri->ri_font->fontheight;
   1473  1.62    nonaka 
   1474  1.62    nonaka 	/* XXX this assumes 16-bit color depth */
   1475  1.62    nonaka 	if ((attr & 1) != 0) {
   1476  1.62    nonaka 		int16_t c = (int16_t)ri->ri_devcmap[((u_int)attr >> 24) & 0xf];
   1477  1.62    nonaka 
   1478  1.62    nonaka 		while (height--) {
   1479  1.62    nonaka 			*(int16_t *)rp = c;
   1480  1.62    nonaka 			rp += ri->ri_stride;
   1481  1.62    nonaka 		}
   1482  1.62    nonaka 	}
   1483  1.62    nonaka }
   1484  1.62    nonaka 
   1485  1.62    nonaka /* XXX: these could likely be optimised somewhat. */
   1486  1.62    nonaka static void
   1487  1.62    nonaka rasops_copyrows_rotated_ccw(void *cookie, int src, int dst, int num)
   1488  1.62    nonaka {
   1489  1.62    nonaka 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1490  1.62    nonaka 	int col, roff;
   1491  1.62    nonaka 
   1492  1.62    nonaka 	if (src > dst)
   1493  1.62    nonaka 		for (roff = 0; roff < num; roff++)
   1494  1.62    nonaka 			for (col = 0; col < ri->ri_cols; col++)
   1495  1.62    nonaka 				rasops_copychar_ccw(cookie,
   1496  1.62    nonaka 				    src + roff, dst + roff, col, col);
   1497  1.62    nonaka 	else
   1498  1.62    nonaka 		for (roff = num - 1; roff >= 0; roff--)
   1499  1.62    nonaka 			for (col = 0; col < ri->ri_cols; col++)
   1500  1.62    nonaka 				rasops_copychar_ccw(cookie,
   1501  1.62    nonaka 				    src + roff, dst + roff, col, col);
   1502  1.62    nonaka }
   1503  1.62    nonaka 
   1504  1.62    nonaka static void
   1505  1.62    nonaka rasops_copycols_rotated_ccw(void *cookie, int row, int src, int dst, int num)
   1506  1.62    nonaka {
   1507  1.62    nonaka 	int coff;
   1508  1.62    nonaka 
   1509  1.62    nonaka 	if (src > dst)
   1510  1.62    nonaka 		for (coff = 0; coff < num; coff++)
   1511  1.62    nonaka 			rasops_copychar_ccw(cookie, row, row,
   1512  1.62    nonaka 			    src + coff, dst + coff);
   1513  1.62    nonaka 	else
   1514  1.62    nonaka 		for (coff = num - 1; coff >= 0; coff--)
   1515  1.62    nonaka 			rasops_copychar_ccw(cookie, row, row,
   1516  1.62    nonaka 			    src + coff, dst + coff);
   1517  1.62    nonaka }
   1518  1.55      ober #endif	/* NRASOPS_ROTATION */
   1519  1.63  macallan 
   1520  1.63  macallan void
   1521  1.63  macallan rasops_make_box_chars_16(struct rasops_info *ri)
   1522  1.63  macallan {
   1523  1.63  macallan 	uint16_t vert_mask, hmask_left, hmask_right;
   1524  1.63  macallan 	uint16_t *data = (uint16_t *)ri->ri_optfont.data;
   1525  1.63  macallan 	int c, i, mid;
   1526  1.63  macallan 
   1527  1.63  macallan 	vert_mask = 0xc000 >> ((ri->ri_font->fontwidth >> 1) - 1);
   1528  1.63  macallan 	hmask_left = 0xff00 << (8 - (ri->ri_font->fontwidth >> 1));
   1529  1.63  macallan 	hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1)>> 1);
   1530  1.63  macallan 	mid = (ri->ri_font->fontheight + 1) >> 1;
   1531  1.63  macallan 
   1532  1.63  macallan 	/* 0x00 would be empty anyway so don't bother */
   1533  1.63  macallan 	for (c = 1; c < 16; c++) {
   1534  1.63  macallan 		data += ri->ri_font->fontheight;
   1535  1.63  macallan 		if (c & 1) {
   1536  1.63  macallan 			/* upper segment */
   1537  1.63  macallan 			for (i = 0; i < mid; i++)
   1538  1.63  macallan 				data[i] = vert_mask;
   1539  1.63  macallan 		}
   1540  1.63  macallan 		if (c & 4) {
   1541  1.63  macallan 			/* lower segment */
   1542  1.63  macallan 			for (i = mid; i < ri->ri_font->fontheight; i++)
   1543  1.63  macallan 				data[i] = vert_mask;
   1544  1.63  macallan 		}
   1545  1.63  macallan 		if (c & 2) {
   1546  1.63  macallan 			/* right segment */
   1547  1.63  macallan 			i = ri->ri_font->fontheight >> 1;
   1548  1.63  macallan 			data[mid - 1] |= hmask_right;
   1549  1.63  macallan 			data[mid] |= hmask_right;
   1550  1.63  macallan 		}
   1551  1.63  macallan 		if (c & 8) {
   1552  1.63  macallan 			/* left segment */
   1553  1.63  macallan 			data[mid - 1] |= hmask_left;
   1554  1.63  macallan 			data[mid] |= hmask_left;
   1555  1.63  macallan 		}
   1556  1.63  macallan 	}
   1557  1.63  macallan }
   1558  1.63  macallan 
   1559  1.63  macallan void
   1560  1.63  macallan rasops_make_box_chars_8(struct rasops_info *ri)
   1561  1.63  macallan {
   1562  1.63  macallan 	uint8_t vert_mask, hmask_left, hmask_right;
   1563  1.63  macallan 	uint8_t *data = (uint8_t *)ri->ri_optfont.data;
   1564  1.63  macallan 	int c, i, mid;
   1565  1.63  macallan 
   1566  1.63  macallan 	vert_mask = 0xc0 >> ((ri->ri_font->fontwidth >> 1) - 1);
   1567  1.63  macallan 	hmask_left = 0xf0 << (4 - (ri->ri_font->fontwidth >> 1));
   1568  1.63  macallan 	hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1)>> 1);
   1569  1.63  macallan 	mid = (ri->ri_font->fontheight + 1) >> 1;
   1570  1.63  macallan 
   1571  1.63  macallan 	/* 0x00 would be empty anyway so don't bother */
   1572  1.63  macallan 	for (c = 1; c < 16; c++) {
   1573  1.63  macallan 		data += ri->ri_font->fontheight;
   1574  1.63  macallan 		if (c & 1) {
   1575  1.63  macallan 			/* upper segment */
   1576  1.63  macallan 			for (i = 0; i < mid; i++)
   1577  1.63  macallan 				data[i] = vert_mask;
   1578  1.63  macallan 		}
   1579  1.63  macallan 		if (c & 4) {
   1580  1.63  macallan 			/* lower segment */
   1581  1.63  macallan 			for (i = mid; i < ri->ri_font->fontheight; i++)
   1582  1.63  macallan 				data[i] = vert_mask;
   1583  1.63  macallan 		}
   1584  1.63  macallan 		if (c & 2) {
   1585  1.63  macallan 			/* right segment */
   1586  1.63  macallan 			i = ri->ri_font->fontheight >> 1;
   1587  1.63  macallan 			data[mid - 1] |= hmask_right;
   1588  1.63  macallan 			data[mid] |= hmask_right;
   1589  1.63  macallan 		}
   1590  1.63  macallan 		if (c & 8) {
   1591  1.63  macallan 			/* left segment */
   1592  1.63  macallan 			data[mid - 1] |= hmask_left;
   1593  1.63  macallan 			data[mid] |= hmask_left;
   1594  1.63  macallan 		}
   1595  1.63  macallan 	}
   1596  1.63  macallan }
   1597  1.63  macallan 
   1598  1.63  macallan void
   1599  1.63  macallan rasops_make_box_chars_32(struct rasops_info *ri)
   1600  1.63  macallan {
   1601  1.63  macallan 	uint32_t vert_mask, hmask_left, hmask_right;
   1602  1.63  macallan 	uint32_t *data = (uint32_t *)ri->ri_optfont.data;
   1603  1.63  macallan 	int c, i, mid;
   1604  1.63  macallan 
   1605  1.63  macallan 	vert_mask = 0xc0000000 >> ((ri->ri_font->fontwidth >> 1) - 1);
   1606  1.63  macallan 	hmask_left = 0xffff0000 << (16 - (ri->ri_font->fontwidth >> 1));
   1607  1.63  macallan 	hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1)>> 1);
   1608  1.63  macallan 	mid = (ri->ri_font->fontheight + 1) >> 1;
   1609  1.63  macallan 
   1610  1.63  macallan 	/* 0x00 would be empty anyway so don't bother */
   1611  1.63  macallan 	for (c = 1; c < 16; c++) {
   1612  1.63  macallan 		data += ri->ri_font->fontheight;
   1613  1.63  macallan 		if (c & 1) {
   1614  1.63  macallan 			/* upper segment */
   1615  1.63  macallan 			for (i = 0; i < mid; i++)
   1616  1.63  macallan 				data[i] = vert_mask;
   1617  1.63  macallan 		}
   1618  1.63  macallan 		if (c & 4) {
   1619  1.63  macallan 			/* lower segment */
   1620  1.63  macallan 			for (i = mid; i < ri->ri_font->fontheight; i++)
   1621  1.63  macallan 				data[i] = vert_mask;
   1622  1.63  macallan 		}
   1623  1.63  macallan 		if (c & 2) {
   1624  1.63  macallan 			/* right segment */
   1625  1.63  macallan 			i = ri->ri_font->fontheight >> 1;
   1626  1.63  macallan 			data[mid - 1] |= hmask_right;
   1627  1.63  macallan 			data[mid] |= hmask_right;
   1628  1.63  macallan 		}
   1629  1.63  macallan 		if (c & 8) {
   1630  1.63  macallan 			/* left segment */
   1631  1.63  macallan 			data[mid - 1] |= hmask_left;
   1632  1.63  macallan 			data[mid] |= hmask_left;
   1633  1.63  macallan 		}
   1634  1.63  macallan 	}
   1635  1.63  macallan }
   1636  1.67  macallan 
   1637  1.67  macallan void
   1638  1.67  macallan rasops_make_box_chars_alpha(struct rasops_info *ri)
   1639  1.67  macallan {
   1640  1.67  macallan 	uint8_t *data = (uint8_t *)ri->ri_optfont.data;
   1641  1.67  macallan 	uint8_t *ddata;
   1642  1.67  macallan 	int c, i, hmid, vmid, wi, he;
   1643  1.67  macallan 
   1644  1.67  macallan 	wi = ri->ri_font->fontwidth;
   1645  1.67  macallan 	he = ri->ri_font->fontheight;
   1646  1.67  macallan 
   1647  1.67  macallan 	vmid = (he + 1) >> 1;
   1648  1.67  macallan 	hmid = (wi + 1) >> 1;
   1649  1.67  macallan 
   1650  1.67  macallan 	/* 0x00 would be empty anyway so don't bother */
   1651  1.67  macallan 	for (c = 1; c < 16; c++) {
   1652  1.67  macallan 		data += ri->ri_fontscale;
   1653  1.67  macallan 		if (c & 1) {
   1654  1.67  macallan 			/* upper segment */
   1655  1.67  macallan 			ddata = data + hmid;
   1656  1.67  macallan 			for (i = 0; i <= vmid; i++) {
   1657  1.67  macallan 				*ddata = 0xff;
   1658  1.67  macallan 				ddata += wi;
   1659  1.67  macallan 			}
   1660  1.67  macallan 		}
   1661  1.67  macallan 		if (c & 4) {
   1662  1.67  macallan 			/* lower segment */
   1663  1.67  macallan 			ddata = data + wi * vmid + hmid;
   1664  1.67  macallan 			for (i = vmid; i < he; i++) {
   1665  1.67  macallan 				*ddata = 0xff;
   1666  1.67  macallan 				ddata += wi;
   1667  1.67  macallan 			}
   1668  1.67  macallan 		}
   1669  1.67  macallan 		if (c & 2) {
   1670  1.67  macallan 			/* right segment */
   1671  1.67  macallan 			ddata = data + wi * vmid + hmid;
   1672  1.67  macallan 			for (i = hmid; i < wi; i++) {
   1673  1.67  macallan 				*ddata = 0xff;
   1674  1.67  macallan 				ddata++;
   1675  1.67  macallan 			}
   1676  1.67  macallan 		}
   1677  1.67  macallan 		if (c & 8) {
   1678  1.67  macallan 			/* left segment */
   1679  1.67  macallan 			ddata = data + wi * vmid;
   1680  1.67  macallan 			for (i = 0; i <= hmid; i++) {
   1681  1.67  macallan 				*ddata = 0xff;
   1682  1.67  macallan 				ddata++;
   1683  1.67  macallan 			}
   1684  1.67  macallan 		}
   1685  1.67  macallan 	}
   1686  1.67  macallan }
   1687