Home | History | Annotate | Line # | Download | only in rasops
rasops2.c revision 1.15
      1 /* 	$NetBSD: rasops2.c,v 1.15 2010/05/04 04:57:34 macallan Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Andrew Doran.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: rasops2.c,v 1.15 2010/05/04 04:57:34 macallan Exp $");
     34 
     35 #include "opt_rasops.h"
     36 
     37 #include <sys/param.h>
     38 #include <sys/systm.h>
     39 #include <sys/time.h>
     40 #include <machine/endian.h>
     41 
     42 #include <dev/wscons/wsdisplayvar.h>
     43 #include <dev/wscons/wsconsio.h>
     44 #include <dev/rasops/rasops.h>
     45 #include <dev/rasops/rasops_masks.h>
     46 
     47 static void	rasops2_copycols(void *, int, int, int, int);
     48 static void	rasops2_erasecols(void *, int, int, int, long);
     49 static void	rasops2_do_cursor(struct rasops_info *);
     50 static void	rasops2_putchar(void *, int, int col, u_int, long);
     51 #ifndef RASOPS_SMALL
     52 static void	rasops2_putchar8(void *, int, int col, u_int, long);
     53 static void	rasops2_putchar12(void *, int, int col, u_int, long);
     54 static void	rasops2_putchar16(void *, int, int col, u_int, long);
     55 static void	rasops2_makestamp(struct rasops_info *, long);
     56 
     57 /*
     58  * 4x1 stamp for optimized character blitting
     59  */
     60 static int8_t	stamp[16];
     61 static long	stamp_attr;
     62 static int	stamp_mutex;	/* XXX see note in README */
     63 #endif
     64 
     65 /*
     66  * Initialize rasops_info struct for this colordepth.
     67  */
     68 void
     69 rasops2_init(struct rasops_info *ri)
     70 {
     71 
     72 	switch (ri->ri_font->fontwidth) {
     73 #ifndef RASOPS_SMALL
     74 	case 8:
     75 		ri->ri_ops.putchar = rasops2_putchar8;
     76 		break;
     77 	case 12:
     78 		ri->ri_ops.putchar = rasops2_putchar12;
     79 		break;
     80 	case 16:
     81 		ri->ri_ops.putchar = rasops2_putchar16;
     82 		break;
     83 #endif	/* !RASOPS_SMALL */
     84 	default:
     85 		panic("fontwidth not 8/12/16 or RASOPS_SMALL - fixme!");
     86 		ri->ri_ops.putchar = rasops2_putchar;
     87 		break;
     88 	}
     89 
     90 	if ((ri->ri_font->fontwidth & 3) != 0) {
     91 		ri->ri_ops.erasecols = rasops2_erasecols;
     92 		ri->ri_ops.copycols = rasops2_copycols;
     93 		ri->ri_do_cursor = rasops2_do_cursor;
     94 	}
     95 }
     96 
     97 #ifdef notyet
     98 /*
     99  * Paint a single character. This is the generic version, this is ugly.
    100  */
    101 static void
    102 rasops2_putchar(void *cookie, int row, int col, u_int uc, long attr)
    103 {
    104 	int height, width, fs, rs, fb, bg, fg, lmask, rmask;
    105 	struct rasops_info *ri;
    106 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    107 	int32_t *rp;
    108 	u_char *fr;
    109 
    110 	ri = (struct rasops_info *)cookie;
    111 
    112 #ifdef RASOPS_CLIPPING
    113 	/* Catches 'row < 0' case too */
    114 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    115 		return;
    116 
    117 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    118 		return;
    119 #endif
    120 
    121 	width = font->fontwidth << 1;
    122 	height = font->fontheight;
    123 	col *= width;
    124 	rp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale + ((col >> 3) & ~3));
    125 	col = col & 31;
    126 	rs = ri->ri_stride;
    127 
    128 	bg = ri->ri_devcmap[(attr >> 16) & 0xf];
    129 	fg = ri->ri_devcmap[(attr >> 24) & 0xf];
    130 
    131 	/* If fg and bg match this becomes a space character */
    132 	if (fg == bg || uc == ' ') {
    133 		uc = (u_int)-1;
    134 		fr = 0;		/* shutup gcc */
    135 		fs = 0;		/* shutup gcc */
    136 	} else {
    137 		uc -= font->firstchar;
    138 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    139 		fs = font->stride;
    140 	}
    141 
    142 	/* Single word, one mask */
    143 	if ((col + width) <= 32) {
    144 		rmask = rasops_pmask[col][width];
    145 		lmask = ~rmask;
    146 
    147 		if (uc == (u_int)-1) {
    148 			bg &= rmask;
    149 
    150 			while (height--) {
    151 				*rp = (*rp & lmask) | bg;
    152 				DELTA(rp, rs, int32_t *);
    153 			}
    154 		} else {
    155 			while (height--) {
    156 				/* get bits, mask */
    157 				/* compose sl */
    158 				/* mask sl */
    159 				/* put word */
    160 			}
    161 		}
    162 
    163 		/* Do underline */
    164 		if (attr & 1) {
    165 			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
    166 			*rp = (*rp & lmask) | (fg & rmask);
    167 		}
    168 	} else {
    169 		lmask = ~rasops_lmask[col];
    170 		rmask = ~rasops_rmask[(col + width) & 31];
    171 
    172 		if (uc == (u_int)-1) {
    173 			bg = bg & ~lmask;
    174 			width = bg & ~rmask;
    175 
    176 			while (height--) {
    177 				rp[0] = (rp[0] & lmask) | bg;
    178 				rp[1] = (rp[1] & rmask) | width;
    179 				DELTA(rp, rs, int32_t *);
    180 			}
    181 		} else {
    182 			width = 32 - col;
    183 
    184 			/* NOT fontbits if bg is white */
    185 			while (height--) {
    186 				fb = ~(fr[3] | (fr[2] << 8) |
    187 				    (fr[1] << 16) | (fr[0] << 24));
    188 
    189 				rp[0] = (rp[0] & lmask)
    190 				    | MBE((u_int)fb >> col);
    191 
    192 				rp[1] = (rp[1] & rmask)
    193 				   | (MBE((u_int)fb << width) & ~rmask);
    194 
    195 				fr += fs;
    196 				DELTA(rp, rs, int32_t *);
    197 			}
    198 		}
    199 
    200 		/* Do underline */
    201 		if (attr & 1) {
    202 			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
    203 			rp[0] = (rp[0] & lmask) | (fg & ~lmask);
    204 			rp[1] = (rp[1] & rmask) | (fg & ~rmask);
    205 		}
    206 	}
    207 }
    208 #endif
    209 
    210 /*
    211  * Put a single character. This is the generic version.
    212  */
    213 static void
    214 rasops2_putchar(void *cookie, int row, int col, u_int uc, long attr)
    215 {
    216 
    217 	/* XXX punt */
    218 }
    219 
    220 #ifndef RASOPS_SMALL
    221 /*
    222  * Recompute the blitting stamp.
    223  */
    224 static void
    225 rasops2_makestamp(struct rasops_info *ri, long attr)
    226 {
    227 	int i, fg, bg;
    228 
    229 	fg = ri->ri_devcmap[(attr >> 24) & 0xf] & 3;
    230 	bg = ri->ri_devcmap[(attr >> 16) & 0xf] & 3;
    231 	stamp_attr = attr;
    232 
    233 	for (i = 0; i < 16; i++) {
    234 		stamp[i] = (i & 1 ? fg : bg);
    235 		stamp[i] |= (i & 2 ? fg : bg) << 2;
    236 		stamp[i] |= (i & 4 ? fg : bg) << 4;
    237 		stamp[i] |= (i & 8 ? fg : bg) << 6;
    238 	}
    239 }
    240 
    241 /*
    242  * Put a single character. This is for 8-pixel wide fonts.
    243  */
    244 static void
    245 rasops2_putchar8(void *cookie, int row, int col, u_int uc, long attr)
    246 {
    247 	struct rasops_info *ri;
    248 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    249 	int height, fs, rs;
    250 	u_char *fr, *rp;
    251 
    252 	/* Can't risk remaking the stamp if it's already in use */
    253 	if (stamp_mutex++) {
    254 		stamp_mutex--;
    255 		rasops2_putchar(cookie, row, col, uc, attr);
    256 		return;
    257 	}
    258 
    259 	ri = (struct rasops_info *)cookie;
    260 
    261 #ifdef RASOPS_CLIPPING
    262 	/* Catches 'row < 0' case too */
    263 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    264 		stamp_mutex--;
    265 		return;
    266 	}
    267 
    268 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    269 		stamp_mutex--;
    270 		return;
    271 	}
    272 #endif
    273 
    274 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    275 	height = font->fontheight;
    276 	rs = ri->ri_stride;
    277 
    278 	/* Recompute stamp? */
    279 	if (attr != stamp_attr)
    280 		rasops2_makestamp(ri, attr);
    281 
    282 	if (uc == ' ') {
    283 		int8_t c = stamp[0];
    284 		while (height--) {
    285 			*(int16_t *)rp = c;
    286 			rp += rs;
    287 		}
    288 	} else {
    289 		uc -= font->firstchar;
    290 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    291 		fs = font->stride;
    292 
    293 		while (height--) {
    294 			rp[0] = stamp[(*fr >> 4) & 0xf];
    295 			rp[1] = stamp[*fr & 0xf];
    296 			fr += fs;
    297 			rp += rs;
    298 		}
    299 	}
    300 
    301 	/* Do underline */
    302 	if ((attr & 1) != 0)
    303 		*(int16_t *)(rp - (ri->ri_stride << 1)) = stamp[15];
    304 
    305 	stamp_mutex--;
    306 }
    307 
    308 /*
    309  * Put a single character. This is for 12-pixel wide fonts.
    310  */
    311 static void
    312 rasops2_putchar12(void *cookie, int row, int col, u_int uc, long attr)
    313 {
    314 	struct rasops_info *ri;
    315 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    316 	int height, fs, rs;
    317 	u_char *fr, *rp;
    318 
    319 	/* Can't risk remaking the stamp if it's already in use */
    320 	if (stamp_mutex++) {
    321 		stamp_mutex--;
    322 		rasops2_putchar(cookie, row, col, uc, attr);
    323 		return;
    324 	}
    325 
    326 	ri = (struct rasops_info *)cookie;
    327 
    328 #ifdef RASOPS_CLIPPING
    329 	/* Catches 'row < 0' case too */
    330 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    331 		stamp_mutex--;
    332 		return;
    333 	}
    334 
    335 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    336 		stamp_mutex--;
    337 		return;
    338 	}
    339 #endif
    340 
    341 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    342 	height = font->fontheight;
    343 	rs = ri->ri_stride;
    344 
    345 	/* Recompute stamp? */
    346 	if (attr != stamp_attr)
    347 		rasops2_makestamp(ri, attr);
    348 
    349 	if (uc == ' ') {
    350 		int8_t c = stamp[0];
    351 		while (height--) {
    352 			rp[0] = rp[1] = rp[2] = c;
    353 			rp += rs;
    354 		}
    355 	} else {
    356 		uc -= font->firstchar;
    357 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    358 		fs = font->stride;
    359 
    360 		while (height--) {
    361 			rp[0] = stamp[(fr[0] >> 4) & 0xf];
    362 			rp[1] = stamp[fr[0] & 0xf];
    363 			rp[2] = stamp[(fr[1] >> 4) & 0xf];
    364 			fr += fs;
    365 			rp += rs;
    366 		}
    367 	}
    368 
    369 	/* Do underline */
    370 	if ((attr & 1) != 0) {
    371 		rp -= ri->ri_stride << 1;
    372 		rp[0] = rp[1] = rp[2] = stamp[15];
    373 	}
    374 
    375 	stamp_mutex--;
    376 }
    377 
    378 /*
    379  * Put a single character. This is for 16-pixel wide fonts.
    380  */
    381 static void
    382 rasops2_putchar16(void *cookie, int row, int col, u_int uc, long attr)
    383 {
    384 	struct rasops_info *ri;
    385 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    386 	int height, fs, rs;
    387 	u_char *fr, *rp;
    388 
    389 	/* Can't risk remaking the stamp if it's already in use */
    390 	if (stamp_mutex++) {
    391 		stamp_mutex--;
    392 		rasops2_putchar(cookie, row, col, uc, attr);
    393 		return;
    394 	}
    395 
    396 	ri = (struct rasops_info *)cookie;
    397 
    398 #ifdef RASOPS_CLIPPING
    399 	/* Catches 'row < 0' case too */
    400 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    401 		stamp_mutex--;
    402 		return;
    403 	}
    404 
    405 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    406 		stamp_mutex--;
    407 		return;
    408 	}
    409 #endif
    410 
    411 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    412 	height = font->fontheight;
    413 	rs = ri->ri_stride;
    414 
    415 	/* Recompute stamp? */
    416 	if (attr != stamp_attr)
    417 		rasops2_makestamp(ri, attr);
    418 
    419 	if (uc == ' ') {
    420 		int8_t c = stamp[0];
    421 		while (height--) {
    422 			*(int32_t *)rp = c;
    423 			rp += rs;
    424 		}
    425 	} else {
    426 		uc -= font->firstchar;
    427 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    428 		fs = font->stride;
    429 
    430 		while (height--) {
    431 			rp[0] = stamp[(fr[0] >> 4) & 0xf];
    432 			rp[1] = stamp[fr[0] & 0xf];
    433 			rp[2] = stamp[(fr[1] >> 4) & 0xf];
    434 			rp[3] = stamp[fr[1] & 0xf];
    435 			fr += fs;
    436 			rp += rs;
    437 		}
    438 	}
    439 
    440 	/* Do underline */
    441 	if ((attr & 1) != 0)
    442 		*(int32_t *)(rp - (ri->ri_stride << 1)) = stamp[15];
    443 
    444 	stamp_mutex--;
    445 }
    446 #endif	/* !RASOPS_SMALL */
    447 
    448 /*
    449  * Grab routines common to depths where (bpp < 8)
    450  */
    451 #define NAME(ident)	rasops2_##ident
    452 #define PIXEL_SHIFT	1
    453 
    454 #include <dev/rasops/rasops_bitops.h>
    455