Home | History | Annotate | Line # | Download | only in rasops
rasops8.c revision 1.37
      1 /* 	$NetBSD: rasops8.c,v 1.37 2019/07/24 18:33:49 rin 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: rasops8.c,v 1.37 2019/07/24 18:33:49 rin Exp $");
     34 
     35 #include "opt_rasops.h"
     36 
     37 #include <sys/param.h>
     38 #include <sys/systm.h>
     39 #include <sys/time.h>
     40 
     41 #include <dev/wscons/wsdisplayvar.h>
     42 #include <dev/wscons/wsconsio.h>
     43 #include <dev/rasops/rasops.h>
     44 
     45 static void 	rasops8_putchar(void *, int, int, u_int, long attr);
     46 static void 	rasops8_putchar_aa(void *, int, int, u_int, long attr);
     47 #ifndef RASOPS_SMALL
     48 static void 	rasops8_putchar8(void *, int, int, u_int, long attr);
     49 static void 	rasops8_putchar12(void *, int, int, u_int, long attr);
     50 static void 	rasops8_putchar16(void *, int, int, u_int, long attr);
     51 static void	rasops8_makestamp(struct rasops_info *ri, long);
     52 
     53 /*
     54  * 4x1 stamp for optimized character blitting
     55  */
     56 static uint32_t	stamp[16];
     57 static long	stamp_attr;
     58 static int	stamp_mutex;	/* XXX see note in README */
     59 #endif
     60 
     61 /*
     62  * XXX this confuses the hell out of gcc2 (not egcs) which always insists
     63  * that the shift count is negative.
     64  *
     65  * offset = STAMP_SHIFT(fontbits, nibble #) & STAMP_MASK
     66  * destination = STAMP_READ(offset)
     67  */
     68 #define STAMP_SHIFT(fb,n)	((n*4-2) >= 0 ? (fb)>>(n*4-2):(fb)<<-(n*4-2))
     69 #define STAMP_MASK		(0xf << 2)
     70 #define STAMP_READ(o)		(*(uint32_t *)((char *)stamp + (o)))
     71 
     72 /*
     73  * Initialize a 'rasops_info' descriptor for this depth.
     74  */
     75 void
     76 rasops8_init(struct rasops_info *ri)
     77 {
     78 
     79 	if (FONT_IS_ALPHA(ri->ri_font)) {
     80 		ri->ri_ops.putchar = rasops8_putchar_aa;
     81 	} else {
     82 		switch (ri->ri_font->fontwidth) {
     83 #ifndef RASOPS_SMALL
     84 		case 8:
     85 			ri->ri_ops.putchar = rasops8_putchar8;
     86 			break;
     87 		case 12:
     88 			ri->ri_ops.putchar = rasops8_putchar12;
     89 			break;
     90 		case 16:
     91 			ri->ri_ops.putchar = rasops8_putchar16;
     92 			break;
     93 #endif /* !RASOPS_SMALL */
     94 		default:
     95 			ri->ri_ops.putchar = rasops8_putchar;
     96 			break;
     97 		}
     98 	}
     99 	if (ri->ri_flg & RI_8BIT_IS_RGB) {
    100 		ri->ri_rnum = 3;
    101 		ri->ri_rpos = 5;
    102 		ri->ri_gnum = 3;
    103 		ri->ri_gpos = 2;
    104 		ri->ri_bnum = 2;
    105 		ri->ri_bpos = 0;
    106 	}
    107 }
    108 
    109 /*
    110  * Put a single character.
    111  */
    112 static void
    113 rasops8_putchar(void *cookie, int row, int col, u_int uc, long attr)
    114 {
    115 	int width, height, cnt, fs, fb;
    116 	uint8_t *dp, *rp, *hp, *hrp, *fr, clr[2];
    117 	struct rasops_info *ri = (struct rasops_info *)cookie;
    118 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    119 
    120 	hp = hrp = NULL;
    121 
    122 	if (!CHAR_IN_FONT(uc, font))
    123 		return;
    124 
    125 #ifdef RASOPS_CLIPPING
    126 	/* Catches 'row < 0' case too */
    127 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    128 		return;
    129 
    130 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    131 		return;
    132 #endif
    133 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    134 	if (ri->ri_hwbits)
    135 		hrp = ri->ri_hwbits + row * ri->ri_yscale + col *
    136 		    ri->ri_xscale;
    137 
    138 	height = font->fontheight;
    139 	width = font->fontwidth;
    140 	clr[0] = (uint8_t)ri->ri_devcmap[(attr >> 16) & 0xf];
    141 	clr[1] = (uint8_t)ri->ri_devcmap[(attr >> 24) & 0xf];
    142 
    143 	if (uc == ' ') {
    144 		uint8_t c = clr[0];
    145 
    146 		while (height--) {
    147 			memset(rp, c, width);
    148 			if (ri->ri_hwbits) {
    149 				memset(hrp, c, width);
    150 				hrp += ri->ri_stride;
    151 			}
    152 			rp += ri->ri_stride;
    153 		}
    154 	} else {
    155 		fr = WSFONT_GLYPH(uc, font);
    156 		fs = font->stride;
    157 
    158 		while (height--) {
    159 			dp = rp;
    160 			if (ri->ri_hwbits)
    161 				hp = hrp;
    162 			fb = fr[3] | (fr[2] << 8) | (fr[1] << 16) | (fr[0] << 24);
    163 			fr += fs;
    164 			rp += ri->ri_stride;
    165 			if (ri->ri_hwbits)
    166 				hrp += ri->ri_stride;
    167 
    168 			for (cnt = width; cnt; cnt--) {
    169 				*dp++ = clr[(fb >> 31) & 1];
    170 				if (ri->ri_hwbits)
    171 					*hp++ = clr[(fb >> 31) & 1];
    172 				fb <<= 1;
    173 			}
    174 		}
    175 	}
    176 
    177 	/* Do underline */
    178 	if ((attr & WSATTR_UNDERLINE) != 0) {
    179 		uint8_t c = clr[1];
    180 
    181 		rp -= (ri->ri_stride << 1);
    182 		if (ri->ri_hwbits)
    183 			hrp -= (ri->ri_stride << 1);
    184 
    185 		while (width--) {
    186 			*rp++ = c;
    187 			if (ri->ri_hwbits)
    188 				*hrp++ = c;
    189 		}
    190 	}
    191 }
    192 
    193 static void
    194 rasops8_putchar_aa(void *cookie, int row, int col, u_int uc, long attr)
    195 {
    196 	int width, height;
    197 	uint8_t *rp, *hrp, *fr, bg, fg, pixel;
    198 	struct rasops_info *ri = (struct rasops_info *)cookie;
    199 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    200 	int x, y, r, g, b, aval;
    201 	int r1, g1, b1, r0, g0, b0, fgo, bgo;
    202 	uint8_t scanline[32] __attribute__ ((aligned(8)));
    203 
    204 	hrp = NULL;
    205 
    206 	if (!CHAR_IN_FONT(uc, font))
    207 		return;
    208 
    209 #ifdef RASOPS_CLIPPING
    210 	/* Catches 'row < 0' case too */
    211 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    212 		return;
    213 
    214 	if ((unsigned)col >= (unsigned)ri->ri_cols)
    215 		return;
    216 #endif
    217 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    218 	if (ri->ri_hwbits)
    219 		hrp = ri->ri_hwbits + row * ri->ri_yscale + col *
    220 		    ri->ri_xscale;
    221 
    222 	height = font->fontheight;
    223 	width = font->fontwidth;
    224 	bg = (uint8_t)ri->ri_devcmap[(attr >> 16) & 0xf];
    225 	fg = (uint8_t)ri->ri_devcmap[(attr >> 24) & 0xf];
    226 
    227 	if (uc == ' ') {
    228 
    229 		while (height--) {
    230 			memset(rp, bg, width);
    231 			if (ri->ri_hwbits) {
    232 				memset(hrp, bg, width);
    233 				hrp += ri->ri_stride;
    234 			}
    235 			rp += ri->ri_stride;
    236 		}
    237 	} else {
    238 		fr = WSFONT_GLYPH(uc, font);
    239 		/*
    240 		 * we need the RGB colours here, get offsets into rasops_cmap
    241 		 */
    242 		fgo = ((attr >> 24) & 0xf) * 3;
    243 		bgo = ((attr >> 16) & 0xf) * 3;
    244 
    245 		r0 = rasops_cmap[bgo];
    246 		r1 = rasops_cmap[fgo];
    247 		g0 = rasops_cmap[bgo + 1];
    248 		g1 = rasops_cmap[fgo + 1];
    249 		b0 = rasops_cmap[bgo + 2];
    250 		b1 = rasops_cmap[fgo + 2];
    251 
    252 		for (y = 0; y < height; y++) {
    253 			for (x = 0; x < width; x++) {
    254 				aval = *fr;
    255 				fr++;
    256 				if (aval == 0) {
    257 					pixel = bg;
    258 				} else if (aval == 255) {
    259 					pixel = fg;
    260 				} else {
    261 					r = aval * r1 + (255 - aval) * r0;
    262 					g = aval * g1 + (255 - aval) * g0;
    263 					b = aval * b1 + (255 - aval) * b0;
    264 					pixel = ((r & 0xe000) >> 8) |
    265 						((g & 0xe000) >> 11) |
    266 						((b & 0xc000) >> 14);
    267 				}
    268 				scanline[x] = pixel;
    269 			}
    270 			memcpy(rp, scanline, width);
    271 			if (ri->ri_hwbits) {
    272 				memcpy(hrp, scanline, width);
    273 				hrp += ri->ri_stride;
    274 			}
    275 			rp += ri->ri_stride;
    276 
    277 		}
    278 	}
    279 
    280 	/* Do underline */
    281 	if ((attr & WSATTR_UNDERLINE) != 0) {
    282 
    283 		rp -= (ri->ri_stride << 1);
    284 		if (ri->ri_hwbits)
    285 			hrp -= (ri->ri_stride << 1);
    286 
    287 		while (width--) {
    288 			*rp++ = fg;
    289 			if (ri->ri_hwbits)
    290 				*hrp++ = fg;
    291 		}
    292 	}
    293 }
    294 
    295 #ifndef RASOPS_SMALL
    296 /*
    297  * Recompute the 4x1 blitting stamp.
    298  */
    299 static void
    300 rasops8_makestamp(struct rasops_info *ri, long attr)
    301 {
    302 	uint32_t fg, bg;
    303 	int i;
    304 
    305 	fg = ri->ri_devcmap[(attr >> 24) & 0xf] & 0xff;
    306 	bg = ri->ri_devcmap[(attr >> 16) & 0xf] & 0xff;
    307 	stamp_attr = attr;
    308 
    309 	for (i = 0; i < 16; i++) {
    310 #if BYTE_ORDER == BIG_ENDIAN
    311 #define NEED_LITTLE_ENDIAN_STAMP RI_BSWAP
    312 #else
    313 #define NEED_LITTLE_ENDIAN_STAMP 0
    314 #endif
    315 		if ((ri->ri_flg & RI_BSWAP) == NEED_LITTLE_ENDIAN_STAMP) {
    316 			/* little endian */
    317 			stamp[i] = (i & 8 ? fg : bg);
    318 			stamp[i] |= ((i & 4 ? fg : bg) << 8);
    319 			stamp[i] |= ((i & 2 ? fg : bg) << 16);
    320 			stamp[i] |= ((i & 1 ? fg : bg) << 24);
    321 		} else {
    322 			/* big endian */
    323 			stamp[i] = (i & 1 ? fg : bg);
    324 			stamp[i] |= ((i & 2 ? fg : bg) << 8);
    325 			stamp[i] |= ((i & 4 ? fg : bg) << 16);
    326 			stamp[i] |= ((i & 8 ? fg : bg) << 24);
    327 		}
    328 	}
    329 }
    330 
    331 /*
    332  * Put a single character. This is for 8-pixel wide fonts.
    333  */
    334 static void
    335 rasops8_putchar8(void *cookie, int row, int col, u_int uc, long attr)
    336 {
    337 	struct rasops_info *ri = (struct rasops_info *)cookie;
    338 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    339 	int height, fs;
    340 	uint32_t *rp, *hp;
    341 	uint8_t *fr;
    342 
    343 	/* Can't risk remaking the stamp if it's already in use */
    344 	if (stamp_mutex++) {
    345 		stamp_mutex--;
    346 		rasops8_putchar(cookie, row, col, uc, attr);
    347 		return;
    348 	}
    349 
    350 	hp = NULL;
    351 
    352 	if (!CHAR_IN_FONT(uc, font))
    353 		return;
    354 
    355 #ifdef RASOPS_CLIPPING
    356 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    357 		stamp_mutex--;
    358 		return;
    359 	}
    360 
    361 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    362 		stamp_mutex--;
    363 		return;
    364 	}
    365 #endif
    366 
    367 	/* Recompute stamp? */
    368 	if (attr != stamp_attr)
    369 		rasops8_makestamp(ri, attr);
    370 
    371 	rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
    372 	if (ri->ri_hwbits)
    373 		hp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
    374 		    col*ri->ri_xscale);
    375 	height = font->fontheight;
    376 
    377 	if (uc == ' ') {
    378 		while (height--) {
    379 			rp[0] = rp[1] = stamp[0];
    380 			DELTA(rp, ri->ri_stride, uint32_t *);
    381 			if (ri->ri_hwbits) {
    382 				hp[0] = stamp[0];
    383 				hp[1] = stamp[0];
    384 				DELTA(hp, ri->ri_stride, uint32_t *);
    385 			}
    386 		}
    387 	} else {
    388 		fr = WSFONT_GLYPH(uc, font);
    389 		fs = font->stride;
    390 
    391 		while (height--) {
    392 			rp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) & STAMP_MASK);
    393 			rp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) & STAMP_MASK);
    394 			if (ri->ri_hwbits) {
    395 				hp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) &
    396 				    STAMP_MASK);
    397 				hp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) &
    398 				    STAMP_MASK);
    399 			}
    400 
    401 			fr += fs;
    402 			DELTA(rp, ri->ri_stride, uint32_t *);
    403 			if (ri->ri_hwbits)
    404 				DELTA(hp, ri->ri_stride, uint32_t *);
    405 		}
    406 	}
    407 
    408 	/* Do underline */
    409 	if ((attr & WSATTR_UNDERLINE) != 0) {
    410 		DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
    411 		rp[0] = rp[1] = stamp[15];
    412 		if (ri->ri_hwbits) {
    413 			DELTA(hp, -(ri->ri_stride << 1), uint32_t *);
    414 			hp[0] = stamp[15];
    415 			hp[1] = stamp[15];
    416 		}
    417 	}
    418 
    419 	stamp_mutex--;
    420 }
    421 
    422 /*
    423  * Put a single character. This is for 12-pixel wide fonts.
    424  */
    425 static void
    426 rasops8_putchar12(void *cookie, int row, int col, u_int uc, long attr)
    427 {
    428 	struct rasops_info *ri = (struct rasops_info *)cookie;
    429 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    430 	int height, fs;
    431 	uint32_t *rp,  *hrp;
    432 	uint8_t *fr;
    433 
    434 	/* Can't risk remaking the stamp if it's already in use */
    435 	if (stamp_mutex++) {
    436 		stamp_mutex--;
    437 		rasops8_putchar(cookie, row, col, uc, attr);
    438 		return;
    439 	}
    440 
    441 	hrp = NULL;
    442 
    443 	if (!CHAR_IN_FONT(uc, font))
    444 	    return;
    445 
    446 #ifdef RASOPS_CLIPPING
    447 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    448 		stamp_mutex--;
    449 		return;
    450 	}
    451 
    452 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    453 		stamp_mutex--;
    454 		return;
    455 	}
    456 #endif
    457 
    458 	/* Recompute stamp? */
    459 	if (attr != stamp_attr)
    460 		rasops8_makestamp(ri, attr);
    461 
    462 	rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
    463 	if (ri->ri_hwbits)
    464 		hrp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
    465 		    col*ri->ri_xscale);
    466 	height = font->fontheight;
    467 
    468 	if (uc == ' ') {
    469 		while (height--) {
    470 			uint32_t c = stamp[0];
    471 
    472 			rp[0] = rp[1] = rp[2] = c;
    473 			DELTA(rp, ri->ri_stride, uint32_t *);
    474 			if (ri->ri_hwbits) {
    475 				hrp[0] = c;
    476 				hrp[1] = c;
    477 				hrp[2] = c;
    478 				DELTA(hrp, ri->ri_stride, uint32_t *);
    479 			}
    480 		}
    481 	} else {
    482 		fr = WSFONT_GLYPH(uc, font);
    483 		fs = font->stride;
    484 
    485 		while (height--) {
    486 			rp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) & STAMP_MASK);
    487 			rp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) & STAMP_MASK);
    488 			rp[2] = STAMP_READ(STAMP_SHIFT(fr[1], 1) & STAMP_MASK);
    489 			if (ri->ri_hwbits) {
    490 				hrp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) & STAMP_MASK);
    491 				hrp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) & STAMP_MASK);
    492 				hrp[2] = STAMP_READ(STAMP_SHIFT(fr[1], 1) & STAMP_MASK);
    493 			}
    494 
    495 			fr += fs;
    496 			DELTA(rp, ri->ri_stride, uint32_t *);
    497 			if (ri->ri_hwbits)
    498 				DELTA(hrp, ri->ri_stride, uint32_t *);
    499 		}
    500 	}
    501 
    502 	/* Do underline */
    503 	if ((attr & WSATTR_UNDERLINE) != 0) {
    504 		DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
    505 		rp[0] = rp[1] = rp[2] = stamp[15];
    506 		if (ri->ri_hwbits) {
    507 			DELTA(hrp, -(ri->ri_stride << 1), uint32_t *);
    508 			hrp[0] = stamp[15];
    509 			hrp[1] = stamp[15];
    510 			hrp[2] = stamp[15];
    511 		}
    512 	}
    513 
    514 	stamp_mutex--;
    515 }
    516 
    517 /*
    518  * Put a single character. This is for 16-pixel wide fonts.
    519  */
    520 static void
    521 rasops8_putchar16(void *cookie, int row, int col, u_int uc, long attr)
    522 {
    523 	struct rasops_info *ri = (struct rasops_info *)cookie;
    524 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
    525 	int height, fs;
    526 	uint32_t *rp, *hrp;
    527 	uint8_t *fr;
    528 
    529 	/* Can't risk remaking the stamp if it's already in use */
    530 	if (stamp_mutex++) {
    531 		stamp_mutex--;
    532 		rasops8_putchar(cookie, row, col, uc, attr);
    533 		return;
    534 	}
    535 
    536 	hrp = NULL;
    537 
    538 	if (!CHAR_IN_FONT(uc, font))
    539 		return;
    540 
    541 #ifdef RASOPS_CLIPPING
    542 	if ((unsigned)row >= (unsigned)ri->ri_rows) {
    543 		stamp_mutex--;
    544 		return;
    545 	}
    546 
    547 	if ((unsigned)col >= (unsigned)ri->ri_cols) {
    548 		stamp_mutex--;
    549 		return;
    550 	}
    551 #endif
    552 
    553 	/* Recompute stamp? */
    554 	if (attr != stamp_attr)
    555 		rasops8_makestamp(ri, attr);
    556 
    557 	rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
    558 	if (ri->ri_hwbits)
    559 		hrp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
    560 		    col*ri->ri_xscale);
    561 
    562 	height = font->fontheight;
    563 
    564 	if (uc == ' ') {
    565 		while (height--) {
    566 			rp[0] = rp[1] = rp[2] = rp[3] = stamp[0];
    567 			if (ri->ri_hwbits) {
    568 				hrp[0] = stamp[0];
    569 				hrp[1] = stamp[0];
    570 				hrp[2] = stamp[0];
    571 				hrp[3] = stamp[0];
    572 			}
    573 		}
    574 	} else {
    575 		fr = WSFONT_GLYPH(uc, font);
    576 		fs = font->stride;
    577 
    578 		while (height--) {
    579 			rp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) & STAMP_MASK);
    580 			rp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) & STAMP_MASK);
    581 			rp[2] = STAMP_READ(STAMP_SHIFT(fr[1], 1) & STAMP_MASK);
    582 			rp[3] = STAMP_READ(STAMP_SHIFT(fr[1], 0) & STAMP_MASK);
    583 			if (ri->ri_hwbits) {
    584 				hrp[0] = STAMP_READ(STAMP_SHIFT(fr[0], 1) & STAMP_MASK);
    585 				hrp[1] = STAMP_READ(STAMP_SHIFT(fr[0], 0) & STAMP_MASK);
    586 				hrp[2] = STAMP_READ(STAMP_SHIFT(fr[1], 1) & STAMP_MASK);
    587 				hrp[3] = STAMP_READ(STAMP_SHIFT(fr[1], 0) & STAMP_MASK);
    588 			}
    589 
    590 			fr += fs;
    591 			DELTA(rp, ri->ri_stride, uint32_t *);
    592 			if (ri->ri_hwbits)
    593 				DELTA(hrp, ri->ri_stride, uint32_t *);
    594 		}
    595 	}
    596 
    597 	/* Do underline */
    598 	if ((attr & WSATTR_UNDERLINE) != 0) {
    599 		DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
    600 		rp[0] = rp[1] = rp[2] = rp[3] = stamp[15];
    601 		if (ri->ri_hwbits) {
    602 			DELTA(hrp, -(ri->ri_stride << 1), uint32_t *);
    603 			hrp[0] = stamp[15];
    604 			hrp[1] = stamp[15];
    605 			hrp[2] = stamp[15];
    606 			hrp[3] = stamp[15];
    607 		}
    608 	}
    609 
    610 	stamp_mutex--;
    611 }
    612 #endif /* !RASOPS_SMALL */
    613