Home | History | Annotate | Line # | Download | only in rasops
rasops1.c revision 1.23 
      1 /* 	$NetBSD: rasops1.c,v 1.23 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: rasops1.c,v 1.23 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	rasops1_copycols(void *, int, int, int, int);
     48 static void	rasops1_erasecols(void *, int, int, int, long);
     49 static void	rasops1_do_cursor(struct rasops_info *);
     50 static void	rasops1_putchar(void *, int, int col, u_int, long);
     51 #ifndef RASOPS_SMALL
     52 static void	rasops1_putchar8(void *, int, int col, u_int, long);
     53 static void	rasops1_putchar16(void *, int, int col, u_int, long);
     54 #endif
     55 
     56 /*
     57  * Initialize rasops_info struct for this colordepth.
     58  */
     59 void
     60 rasops1_init(struct rasops_info *ri)
     61 {
     62 
     63 	switch (ri->ri_font->fontwidth) {
     64 #ifndef RASOPS_SMALL
     65 	case 8:
     66 		ri->ri_ops.putchar = rasops1_putchar8;
     67 		break;
     68 	case 16:
     69 		ri->ri_ops.putchar = rasops1_putchar16;
     70 		break;
     71 #endif
     72 	default:
     73 		ri->ri_ops.putchar = rasops1_putchar;
     74 		break;
     75 	}
     76 
     77 	if ((ri->ri_font->fontwidth & 7) != 0) {
     78 		ri->ri_ops.erasecols = rasops1_erasecols;
     79 		ri->ri_ops.copycols = rasops1_copycols;
     80 		ri->ri_do_cursor = rasops1_do_cursor;
     81 	}
     82 }
     83 
     84 /*
     85  * Paint a single character. This is the generic version, this is ugly.
     86  */
     87 static void
     88 rasops1_putchar(void *cookie, int row, int col, u_int uc, long attr)
     89 {
     90 	u_int fs, rs, fb, bg, fg, lmask, rmask;
     91 	u_int32_t height, width;
     92 	struct rasops_info *ri = (struct rasops_info *)cookie;
     93 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
     94 	int32_t *rp, *hrp = NULL, tmp, tmp2;
     95 	u_char *fr;
     96 
     97 #ifdef RASOPS_CLIPPING
     98 	/* Catches 'row < 0' case too */
     99 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    100 		return;
    101 
    102 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    103 		return;
    104 #endif
    105 
    106 	col *= ri->ri_font->fontwidth;
    107 	rp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale + ((col >> 3) & ~3));
    108 	if (ri->ri_hwbits)
    109 		hrp = (int32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
    110 		    ((col >> 3) & ~3));
    111 	height = font->fontheight;
    112 	width = font->fontwidth;
    113 	col = col & 31;
    114 	rs = ri->ri_stride;
    115 
    116 	bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    117 	fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    118 
    119 	/* If fg and bg match this becomes a space character */
    120 	if (fg == bg || uc == ' ') {
    121 		uc = (u_int)-1;
    122 		fr = 0;		/* shutup gcc */
    123 		fs = 0;		/* shutup gcc */
    124 	} else {
    125 		uc -= font->firstchar;
    126 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    127 		fs = font->stride;
    128 	}
    129 
    130 	/* Single word, one mask */
    131 	if ((col + width) <= 32) {
    132 		rmask = rasops_pmask[col][width];
    133 		lmask = ~rmask;
    134 
    135 		if (uc == (u_int)-1) {
    136 			bg &= rmask;
    137 
    138 			while (height--) {
    139 				tmp = (*rp & lmask) | bg;
    140 				*rp = tmp;
    141 				DELTA(rp, rs, int32_t *);
    142 				if (ri->ri_hwbits) {
    143 					*hrp = tmp;
    144 					DELTA(hrp, rs, int32_t *);
    145 				}
    146 			}
    147 		} else {
    148 			/* NOT fontbits if bg is white */
    149 			if (bg) {
    150 				while (height--) {
    151 					fb = ~(fr[3] | (fr[2] << 8) |
    152 					    (fr[1] << 16) | (fr[0] << 24));
    153 					tmp = (*rp & lmask)
    154 					    | (MBE(fb >> col) & rmask);
    155 					*rp = tmp;
    156 
    157 					fr += fs;
    158 					DELTA(rp, rs, int32_t *);
    159 					if (ri->ri_hwbits) {
    160 						*hrp = tmp;
    161 						DELTA(hrp, rs, int32_t *);
    162 					}
    163 				}
    164 			} else {
    165 				while (height--) {
    166 					fb = (fr[3] | (fr[2] << 8) |
    167 					    (fr[1] << 16) | (fr[0] << 24));
    168 					tmp = (*rp & lmask)
    169 					    | (MBE(fb >> col) & rmask);
    170 					*rp = tmp;
    171 
    172 					fr += fs;
    173 					DELTA(rp, rs, int32_t *);
    174 					if (ri->ri_hwbits) {
    175 						*hrp = tmp;
    176 						DELTA(hrp, rs, int32_t *);
    177 					}
    178 				}
    179 			}
    180 		}
    181 
    182 		/* Do underline */
    183 		if ((attr & 1) != 0) {
    184 			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
    185 			tmp = (*rp & lmask) | (fg & rmask);
    186 			*rp = tmp;
    187 			if (ri->ri_hwbits) {
    188 				DELTA(hrp, -(ri->ri_stride << 1), int32_t *);
    189 				*hrp = tmp;
    190 			}
    191 		}
    192 	} else {
    193 		lmask = ~rasops_lmask[col];
    194 		rmask = ~rasops_rmask[(col + width) & 31];
    195 
    196 		if (uc == (u_int)-1) {
    197 			width = bg & ~rmask;
    198 			bg = bg & ~lmask;
    199 
    200 			while (height--) {
    201 				tmp = (rp[0] & lmask) | bg;
    202 				tmp2 = (rp[1] & rmask) | width;
    203 				rp[0] = tmp;
    204 				rp[1] = tmp2;
    205 				DELTA(rp, rs, int32_t *);
    206 				if (ri->ri_hwbits) {
    207 					hrp[0] = tmp;
    208 					hrp[1] = tmp2;
    209 					DELTA(hrp, rs, int32_t *);
    210 				}
    211 			}
    212 		} else {
    213 			width = 32 - col;
    214 
    215 			/* NOT fontbits if bg is white */
    216 			if (bg) {
    217 				while (height--) {
    218 					fb = ~(fr[3] | (fr[2] << 8) |
    219 					    (fr[1] << 16) | (fr[0] << 24));
    220 
    221 					tmp = (rp[0] & lmask)
    222 					    | MBE((u_int)fb >> col);
    223 
    224 					tmp2 = (rp[1] & rmask)
    225 					    | (MBE((u_int)fb << width) & ~rmask);
    226 					rp[0] = tmp;
    227 					rp[1] = tmp2;
    228 					fr += fs;
    229 					DELTA(rp, rs, int32_t *);
    230 					if (ri->ri_hwbits) {
    231 						hrp[0] = tmp;
    232 						hrp[1] = tmp2;
    233 						DELTA(hrp, rs, int32_t *);
    234 					}
    235 				}
    236 			} else {
    237 				while (height--) {
    238 					fb = (fr[3] | (fr[2] << 8) |
    239 					    (fr[1] << 16) | (fr[0] << 24));
    240 
    241 					tmp = (rp[0] & lmask)
    242 					    | MBE(fb >> col);
    243 
    244 					tmp2 = (rp[1] & rmask)
    245 					    | (MBE(fb << width) & ~rmask);
    246 					rp[0] = tmp;
    247 					rp[1] = tmp2;
    248 					fr += fs;
    249 					DELTA(rp, rs, int32_t *);
    250 					if (ri->ri_hwbits) {
    251 						hrp[0] = tmp;
    252 						hrp[1] = tmp2;
    253 						DELTA(hrp, rs, int32_t *);
    254 					}
    255 				}
    256 			}
    257 		}
    258 
    259 		/* Do underline */
    260 		if ((attr & 1) != 0) {
    261 			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
    262 			tmp = (rp[0] & lmask) | (fg & ~lmask);
    263 			tmp2 = (rp[1] & rmask) | (fg & ~rmask);
    264 			rp[0] = tmp;
    265 			rp[1] = tmp2;
    266 			if (ri->ri_hwbits) {
    267 				DELTA(hrp, -(ri->ri_stride << 1), int32_t *);
    268 				hrp[0] = tmp;
    269 				hrp[1] = tmp2;
    270 			}
    271 		}
    272 	}
    273 }
    274 
    275 #ifndef RASOPS_SMALL
    276 /*
    277  * Paint a single character. This is for 8-pixel wide fonts.
    278  */
    279 static void
    280 rasops1_putchar8(void *cookie, int row, int col, u_int uc, long attr)
    281 {
    282 	int height, fs, rs, bg, fg;
    283 	struct rasops_info *ri = (struct rasops_info *)cookie;
    284 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    285 	u_char *fr, *rp, *hrp = NULL;
    286 
    287 #ifdef RASOPS_CLIPPING
    288 	/* Catches 'row < 0' case too */
    289 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    290 		return;
    291 
    292 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    293 		return;
    294 #endif
    295 
    296 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    297 	if (ri->ri_hwbits)
    298 		hrp = ri->ri_hwbits + row * ri->ri_yscale + col * ri->ri_xscale;
    299 	height = font->fontheight;
    300 	rs = ri->ri_stride;
    301 
    302 	bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    303 	fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    304 
    305 	/* If fg and bg match this becomes a space character */
    306 	if (fg == bg || uc == ' ') {
    307 		while (height--) {
    308 			*rp = bg;
    309 			rp += rs;
    310 			if (ri->ri_hwbits) {
    311 				*hrp = bg;
    312 				hrp += rs;
    313 			}
    314 		}
    315 	} else {
    316 		uc -= font->firstchar;
    317 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    318 		fs = font->stride;
    319 
    320 		/* NOT fontbits if bg is white */
    321 		if (bg) {
    322 			while (height--) {
    323 				*rp = ~*fr;
    324 				rp += rs;
    325 				if (ri->ri_hwbits) {
    326 					*hrp = ~*fr;
    327 					hrp += rs;
    328 				}
    329 				fr += fs;
    330 
    331 			}
    332 		} else {
    333 			while (height--) {
    334 				*rp = *fr;
    335 				rp += rs;
    336 				if (ri->ri_hwbits) {
    337 					*hrp = *fr;
    338 					hrp += rs;
    339 				}
    340 				fr += fs;
    341 			}
    342 		}
    343 
    344 	}
    345 
    346 	/* Do underline */
    347 	if ((attr & 1) != 0) {
    348 		rp[-(ri->ri_stride << 1)] = fg;
    349 		if (ri->ri_hwbits) {
    350 			hrp[-(ri->ri_stride << 1)] = fg;
    351 		}
    352 	}
    353 }
    354 
    355 /*
    356  * Paint a single character. This is for 16-pixel wide fonts.
    357  */
    358 static void
    359 rasops1_putchar16(void *cookie, int row, int col, u_int uc, long attr)
    360 {
    361 	int height, fs, rs, bg, fg;
    362 	struct rasops_info *ri = (struct rasops_info *)cookie;
    363 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    364 	u_char *fr, *rp, *hrp = NULL;
    365 
    366 #ifdef RASOPS_CLIPPING
    367 	/* Catches 'row < 0' case too */
    368 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    369 		return;
    370 
    371 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    372 		return;
    373 #endif
    374 
    375 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    376 	if (ri->ri_hwbits)
    377 		hrp = ri->ri_hwbits + row * ri->ri_yscale + col * ri->ri_xscale;
    378 	height = font->fontheight;
    379 	rs = ri->ri_stride;
    380 
    381 	bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    382 	fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0];
    383 
    384 	/* If fg and bg match this becomes a space character */
    385 	if (fg == bg || uc == ' ') {
    386 		while (height--) {
    387 			/* XXX alignment?! */
    388 			*(int16_t *)rp = bg;
    389 			rp += rs;
    390 			if (ri->ri_hwbits) {
    391 				*(int16_t *)hrp = bg;
    392 				hrp += rs;
    393 			}
    394 		}
    395 	} else {
    396 		uc -= font->firstchar;
    397 		fr = (u_char *)font->data + uc * ri->ri_fontscale;
    398 		fs = font->stride;
    399 
    400 		/* NOT fontbits if bg is white */
    401 		if (bg) {
    402 			while (height--) {
    403 				rp[0] = ~fr[0];
    404 				rp[1] = ~fr[1];
    405 				rp += rs;
    406 				if (ri->ri_hwbits) {
    407 					hrp[0] = ~fr[0];
    408 					hrp[1] = ~fr[1];
    409 					hrp += rs;
    410 				}
    411 				fr += fs;
    412 			}
    413 		} else {
    414 			while (height--) {
    415 				rp[0] = fr[0];
    416 				rp[1] = fr[1];
    417 				rp += rs;
    418 				if (ri->ri_hwbits) {
    419 					hrp[0] = fr[0];
    420 					hrp[1] = fr[1];
    421 					hrp += rs;
    422 				}
    423 				fr += fs;
    424 			}
    425 		}
    426 	}
    427 
    428 	/* Do underline */
    429 	if ((attr & 1) != 0) {
    430 		/* XXX alignment?! */
    431 		*(int16_t *)(rp - (ri->ri_stride << 1)) = fg;
    432 		if (ri->ri_hwbits) {
    433 			*(int16_t *)(hrp - (ri->ri_stride << 1)) = fg;
    434 		}
    435 	}
    436 }
    437 #endif	/* !RASOPS_SMALL */
    438 
    439 /*
    440  * Grab routines common to depths where (bpp < 8)
    441  */
    442 #define NAME(ident)	rasops1_##ident
    443 #define PIXEL_SHIFT	0
    444 
    445 #include <dev/rasops/rasops_bitops.h>
    446