Home | History | Annotate | Line # | Download | only in rasops
rasops_bitops.h revision 1.23
      1  1.23       rin /* 	$NetBSD: rasops_bitops.h,v 1.23 2019/08/02 04:39:09 rin Exp $	*/
      2   1.1        ad 
      3   1.3        ad /*-
      4   1.3        ad  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5   1.1        ad  * All rights reserved.
      6   1.1        ad  *
      7   1.3        ad  * This code is derived from software contributed to The NetBSD Foundation
      8   1.7        ad  * by Andrew Doran.
      9   1.3        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.3        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.3        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.3        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.3        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.3        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.3        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.3        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.3        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.3        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.3        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.3        ad  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1        ad  */
     31   1.1        ad 
     32   1.1        ad #ifndef _RASOPS_BITOPS_H_
     33   1.1        ad #define _RASOPS_BITOPS_H_ 1
     34   1.1        ad 
     35  1.23       rin #define	NAME(name)		NAME1(RASOPS_DEPTH, name)
     36  1.23       rin #define	NAME1(depth, name)	NAME2(depth, name)
     37  1.23       rin #define	NAME2(depth, name)	rasops ## depth ## _ ## name
     38  1.23       rin 
     39  1.23       rin #if   RASOPS_DEPTH == 1
     40  1.23       rin #define	PIXEL_SHIFT	0
     41  1.23       rin #elif RASOPS_DEPTH == 2
     42  1.23       rin #define	PIXEL_SHIFT	1
     43  1.23       rin #elif RASOPS_DEPTH == 4
     44  1.23       rin #define	PIXEL_SHIFT	2
     45  1.23       rin #else
     46  1.23       rin #error "Depth not supported"
     47  1.23       rin #endif
     48  1.23       rin 
     49  1.23       rin #define	PIXEL_BITS	RASOPS_DEPTH
     50  1.23       rin #define	COLOR_MASK	__BITS(32 - PIXEL_BITS, 31)
     51  1.23       rin 
     52  1.23       rin #if RASOPS_DEPTH != 1
     53  1.23       rin /*
     54  1.23       rin  * Paint a single character. This function is also applicable to
     55  1.23       rin  * monochrome, but that in rasops1.c is much simpler and faster.
     56  1.23       rin  */
     57  1.23       rin static void
     58  1.23       rin NAME(putchar)(void *cookie, int row, int col, u_int uc, long attr)
     59  1.23       rin {
     60  1.23       rin 	struct rasops_info *ri = (struct rasops_info *)cookie;
     61  1.23       rin 	struct wsdisplay_font *font = PICK_FONT(ri, uc);
     62  1.23       rin 	int full, cnt, bit;
     63  1.23       rin 	uint32_t fs, rs, fb, bg, fg, lmask, rmask, lbg, rbg, clr[2];
     64  1.23       rin 	uint32_t height, width;
     65  1.23       rin 	uint32_t *rp, *bp, *hp, tmp;
     66  1.23       rin 	uint8_t *fr;
     67  1.23       rin 	bool space;
     68  1.23       rin 
     69  1.23       rin 	hp = NULL;	/* XXX GCC */
     70  1.23       rin 
     71  1.23       rin #ifdef RASOPS_CLIPPING
     72  1.23       rin 	/* Catches 'row < 0' case too */
     73  1.23       rin 	if ((unsigned)row >= (unsigned)ri->ri_rows)
     74  1.23       rin 		return;
     75  1.23       rin 
     76  1.23       rin 	if ((unsigned)col >= (unsigned)ri->ri_cols)
     77  1.23       rin 		return;
     78  1.23       rin #endif
     79  1.23       rin 
     80  1.23       rin 	width = font->fontwidth << PIXEL_SHIFT;
     81  1.23       rin 	col *= width;
     82  1.23       rin 	height = font->fontheight;
     83  1.23       rin 	rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
     84  1.23       rin 	    ((col >> 3) & ~3));
     85  1.23       rin 	if (ri->ri_hwbits)
     86  1.23       rin 		hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
     87  1.23       rin 		    ((col >> 3) & ~3));
     88  1.23       rin 	col &= 31;
     89  1.23       rin 	rs = ri->ri_stride;
     90  1.23       rin 
     91  1.23       rin 	bg = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
     92  1.23       rin 	fg = ri->ri_devcmap[((uint32_t)attr >> 24) & 0xf];
     93  1.23       rin 
     94  1.23       rin 	/* If fg and bg match this becomes a space character */
     95  1.23       rin 	if (uc == ' ' || __predict_false(fg == bg)) {
     96  1.23       rin 		space = true;
     97  1.23       rin 		fr = NULL;	/* XXX GCC */
     98  1.23       rin 		fs = 0;		/* XXX GCC */
     99  1.23       rin 	} else {
    100  1.23       rin 		space = false;
    101  1.23       rin 		fr = FONT_GLYPH(uc, font, ri);
    102  1.23       rin 		fs = font->stride;
    103  1.23       rin 	}
    104  1.23       rin 
    105  1.23       rin 	if (col + width <= 32) {
    106  1.23       rin 		/* Single word, only one mask */
    107  1.23       rin 
    108  1.23       rin 		rmask = rasops_pmask[col][width & 31];
    109  1.23       rin 		lmask = ~rmask;
    110  1.23       rin 
    111  1.23       rin 		if (space) {
    112  1.23       rin 			bg &= rmask;
    113  1.23       rin 			while (height--) {
    114  1.23       rin 				tmp = (*rp & lmask) | bg;
    115  1.23       rin 				*rp = tmp;
    116  1.23       rin 				DELTA(rp, rs, uint32_t *);
    117  1.23       rin 				if (ri->ri_hwbits) {
    118  1.23       rin 					*hp = tmp;
    119  1.23       rin 					DELTA(hp, rs, uint32_t *);
    120  1.23       rin 				}
    121  1.23       rin 			}
    122  1.23       rin 		} else {
    123  1.23       rin 			clr[0] = bg & COLOR_MASK;
    124  1.23       rin 			clr[1] = fg & COLOR_MASK;
    125  1.23       rin 			while (height--) {
    126  1.23       rin 				fb = be32uatoh(fr);
    127  1.23       rin 				fr += fs;
    128  1.23       rin 				tmp = 0;
    129  1.23       rin 				for (bit = col; bit < col + width;
    130  1.23       rin 				    bit += PIXEL_BITS) {
    131  1.23       rin 					tmp |= clr[(fb >> 31) & 1] >> bit;
    132  1.23       rin 					fb <<= 1;
    133  1.23       rin 				}
    134  1.23       rin 				tmp = (*rp & lmask) | MBE(tmp);
    135  1.23       rin 				*rp = tmp;
    136  1.23       rin 				DELTA(rp, rs, uint32_t *);
    137  1.23       rin 				if (ri->ri_hwbits) {
    138  1.23       rin 					*hp = tmp;
    139  1.23       rin 					DELTA(hp, rs, uint32_t *);
    140  1.23       rin 				}
    141  1.23       rin 			}
    142  1.23       rin 		}
    143  1.23       rin 
    144  1.23       rin 		/* Do underline */
    145  1.23       rin 		if ((attr & WSATTR_UNDERLINE) != 0) {
    146  1.23       rin 			DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
    147  1.23       rin 			tmp = (*rp & lmask) | (fg & rmask);
    148  1.23       rin 			*rp = tmp;
    149  1.23       rin 			if (ri->ri_hwbits) {
    150  1.23       rin 				DELTA(hp, -(ri->ri_stride << 1), uint32_t *);
    151  1.23       rin 				*hp = tmp;
    152  1.23       rin 			}
    153  1.23       rin 		}
    154  1.23       rin 
    155  1.23       rin 		return;
    156  1.23       rin 	}
    157  1.23       rin 
    158  1.23       rin 	/* Word boundary, two masks needed */
    159  1.23       rin 
    160  1.23       rin 	lmask = ~rasops_lmask[col];
    161  1.23       rin 	rmask = ~rasops_rmask[(col + width) & 31];
    162  1.23       rin 
    163  1.23       rin 	if (lmask != -1)
    164  1.23       rin 		width -= 32 - col;
    165  1.23       rin 	full = width / 32;
    166  1.23       rin 	width -= full * 32;
    167  1.23       rin 
    168  1.23       rin 	if (space) {
    169  1.23       rin 		lbg = bg & ~lmask;
    170  1.23       rin 		rbg = bg & ~rmask;
    171  1.23       rin 
    172  1.23       rin 		while (height--) {
    173  1.23       rin 			bp = rp;
    174  1.23       rin 
    175  1.23       rin 			if (lmask != -1) {
    176  1.23       rin 				*bp = (*bp & lmask) | lbg;
    177  1.23       rin 				bp++;
    178  1.23       rin 			}
    179  1.23       rin 
    180  1.23       rin 			for (cnt = full; cnt; cnt--)
    181  1.23       rin 				*bp++ = bg;
    182  1.23       rin 
    183  1.23       rin 			if (rmask != -1)
    184  1.23       rin 				*bp = (*bp & rmask) | rbg;
    185  1.23       rin 
    186  1.23       rin 			if (ri->ri_hwbits) {
    187  1.23       rin 				memcpy(hp, rp, ((lmask != -1) + full +
    188  1.23       rin 				    (rmask != -1)) << 2);
    189  1.23       rin 				DELTA(hp, rs, uint32_t *);
    190  1.23       rin 			}
    191  1.23       rin 			DELTA(rp, rs, uint32_t *);
    192  1.23       rin 		}
    193  1.23       rin 	} else {
    194  1.23       rin 		clr[0] = bg & COLOR_MASK;
    195  1.23       rin 		clr[1] = fg & COLOR_MASK;
    196  1.23       rin 
    197  1.23       rin 		while (height--) {
    198  1.23       rin 			bp = rp;
    199  1.23       rin 
    200  1.23       rin 			fb = be32uatoh(fr);
    201  1.23       rin 			fr += fs;
    202  1.23       rin 
    203  1.23       rin 			if (lmask != -1) {
    204  1.23       rin 				tmp = 0;
    205  1.23       rin 				for (bit = col; bit < 32; bit += PIXEL_BITS) {
    206  1.23       rin 					tmp |= clr[(fb >> 31) & 1] >> bit;
    207  1.23       rin 					fb <<= 1;
    208  1.23       rin 				}
    209  1.23       rin 				*bp = (*bp & lmask) | MBE(tmp);
    210  1.23       rin 				bp++;
    211  1.23       rin 			}
    212  1.23       rin 
    213  1.23       rin 			for (cnt = full; cnt; cnt--) {
    214  1.23       rin 				tmp = 0;
    215  1.23       rin 				for (bit = 0; bit < 32; bit += PIXEL_BITS) {
    216  1.23       rin 					tmp |= clr[(fb >> 31) & 1] >> bit;
    217  1.23       rin 					fb <<= 1;
    218  1.23       rin 				}
    219  1.23       rin 				*bp++ = MBE(tmp);
    220  1.23       rin 			}
    221  1.23       rin 
    222  1.23       rin 			if (rmask != -1) {
    223  1.23       rin 				tmp = 0;
    224  1.23       rin 				for (bit = 0; bit < width; bit += PIXEL_BITS) {
    225  1.23       rin 					tmp |= clr[(fb >> 31) & 1] >> bit;
    226  1.23       rin 					fb <<= 1;
    227  1.23       rin 				}
    228  1.23       rin 				*bp = (*bp & rmask) | MBE(tmp);
    229  1.23       rin 			}
    230  1.23       rin 
    231  1.23       rin 			if (ri->ri_hwbits) {
    232  1.23       rin 				memcpy(hp, rp, ((lmask != -1) + full +
    233  1.23       rin 				    (rmask != -1)) << 2);
    234  1.23       rin 				DELTA(hp, rs, uint32_t *);
    235  1.23       rin 			}
    236  1.23       rin 
    237  1.23       rin 			DELTA(rp, rs, uint32_t *);
    238  1.23       rin 		}
    239  1.23       rin 	}
    240  1.23       rin 
    241  1.23       rin 	/* Do underline */
    242  1.23       rin 	if ((attr & WSATTR_UNDERLINE) != 0) {
    243  1.23       rin 		DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
    244  1.23       rin 		bp = rp;
    245  1.23       rin 		if (lmask != -1) {
    246  1.23       rin 			*bp = (*bp & lmask) | (fg & ~lmask);
    247  1.23       rin 			bp++;
    248  1.23       rin 		}
    249  1.23       rin 		for (cnt = full; cnt; cnt--)
    250  1.23       rin 			*bp++ = fg;
    251  1.23       rin 		if (rmask != -1)
    252  1.23       rin 			*bp = (*bp & rmask) | (fg & ~rmask);
    253  1.23       rin 		if (ri->ri_hwbits) {
    254  1.23       rin 			DELTA(hp, -(ri->ri_stride << 1), uint32_t *);
    255  1.23       rin 			memcpy(hp, rp, ((lmask != -1) + full +
    256  1.23       rin 			    (rmask != -1)) << 2);
    257  1.23       rin 		}
    258  1.23       rin 	}
    259  1.23       rin }
    260  1.23       rin #endif /* RASOPS_DEPTH != 1 */
    261  1.23       rin 
    262   1.1        ad /*
    263   1.1        ad  * Erase columns.
    264   1.1        ad  */
    265   1.1        ad static void
    266  1.11    cegger NAME(erasecols)(void *cookie, int row, int col, int num, long attr)
    267   1.1        ad {
    268  1.19       rin 	struct rasops_info *ri = (struct rasops_info *)cookie;
    269  1.19       rin 	uint32_t lclr, rclr, clr;
    270  1.18       rin 	uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
    271   1.1        ad 	int height, cnt;
    272   1.6        pk 
    273  1.18       rin 	hp = NULL;	/* XXX GCC */
    274  1.18       rin 
    275   1.6        pk #ifdef RASOPS_CLIPPING
    276   1.1        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    277   1.1        ad 		return;
    278   1.1        ad 
    279   1.1        ad 	if (col < 0) {
    280   1.1        ad 		num += col;
    281   1.1        ad 		col = 0;
    282   1.1        ad 	}
    283   1.1        ad 
    284  1.19       rin 	if (col + num > ri->ri_cols)
    285   1.1        ad 		num = ri->ri_cols - col;
    286   1.6        pk 
    287   1.1        ad 	if (num <= 0)
    288   1.1        ad 		return;
    289   1.1        ad #endif
    290  1.20       rin 
    291   1.1        ad 	col *= ri->ri_font->fontwidth << PIXEL_SHIFT;
    292   1.1        ad 	num *= ri->ri_font->fontwidth << PIXEL_SHIFT;
    293   1.1        ad 	height = ri->ri_font->fontheight;
    294  1.17       rin 	clr = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
    295  1.15   tsutsui 	rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + ((col >> 3) & ~3));
    296  1.12  macallan 	if (ri->ri_hwbits)
    297  1.18       rin 		hp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
    298  1.12  macallan 		    ((col >> 3) & ~3));
    299  1.19       rin 	col &= 31;
    300  1.19       rin 
    301  1.19       rin 	if (col + num <= 32) {
    302  1.19       rin 		lmask = ~rasops_pmask[col][num & 31];
    303   1.1        ad 		lclr = clr & ~lmask;
    304   1.1        ad 
    305   1.1        ad 		while (height--) {
    306   1.1        ad 			dp = rp;
    307  1.15   tsutsui 			DELTA(rp, ri->ri_stride, uint32_t *);
    308   1.1        ad 
    309  1.12  macallan 			tmp = (*dp & lmask) | lclr;
    310  1.12  macallan 			*dp = tmp;
    311  1.12  macallan 			if (ri->ri_hwbits) {
    312  1.18       rin 				*hp = tmp;
    313  1.18       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    314  1.12  macallan 			}
    315   1.1        ad 		}
    316   1.1        ad 	} else {
    317  1.19       rin 		lmask = rasops_rmask[col];
    318   1.1        ad 		rmask = rasops_lmask[(col + num) & 31];
    319   1.6        pk 
    320   1.1        ad 		if (lmask)
    321  1.19       rin 			num = (num - (32 - col)) >> 5;
    322   1.1        ad 		else
    323   1.1        ad 			num = num >> 5;
    324   1.6        pk 
    325   1.1        ad 		lclr = clr & ~lmask;
    326   1.1        ad 		rclr = clr & ~rmask;
    327   1.1        ad 
    328   1.1        ad 		while (height--) {
    329   1.1        ad 			dp = rp;
    330   1.1        ad 
    331   1.8   thorpej 			if (lmask) {
    332  1.18       rin 				*dp = (*dp & lmask) | lclr;
    333   1.8   thorpej 				dp++;
    334   1.8   thorpej 			}
    335   1.1        ad 
    336   1.1        ad 			for (cnt = num; cnt > 0; cnt--)
    337   1.1        ad 				*dp++ = clr;
    338  1.18       rin 
    339  1.18       rin 			if (rmask)
    340  1.18       rin 				*dp = (*dp & rmask) | rclr;
    341  1.18       rin 
    342  1.12  macallan 			if (ri->ri_hwbits) {
    343  1.18       rin 				memcpy(hp, rp, ((lmask != 0) + num +
    344  1.18       rin 				    (rmask != 0)) << 2);
    345  1.18       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    346  1.12  macallan 			}
    347  1.18       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    348   1.1        ad 		}
    349   1.1        ad 	}
    350   1.1        ad }
    351   1.1        ad 
    352   1.1        ad /*
    353   1.1        ad  * Actually paint the cursor.
    354   1.1        ad  */
    355   1.1        ad static void
    356  1.11    cegger NAME(do_cursor)(struct rasops_info *ri)
    357   1.1        ad {
    358  1.19       rin 	int height, row, col, num, cnt;
    359  1.19       rin 	uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
    360  1.18       rin 
    361  1.19       rin 	hp = NULL;	/* XXX GCC */
    362   1.6        pk 
    363   1.1        ad 	row = ri->ri_crow;
    364   1.1        ad 	col = ri->ri_ccol * ri->ri_font->fontwidth << PIXEL_SHIFT;
    365   1.1        ad 	height = ri->ri_font->fontheight;
    366   1.1        ad 	num = ri->ri_font->fontwidth << PIXEL_SHIFT;
    367  1.16       rin 	rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
    368  1.16       rin 	    ((col >> 3) & ~3));
    369  1.12  macallan 	if (ri->ri_hwbits)
    370  1.19       rin 		hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
    371  1.12  macallan 		    ((col >> 3) & ~3));
    372  1.19       rin 	col &= 31;
    373   1.6        pk 
    374  1.19       rin 	if (col + num <= 32) {
    375  1.19       rin 		lmask = rasops_pmask[col][num & 31];
    376   1.1        ad 
    377   1.1        ad 		while (height--) {
    378  1.18       rin 			tmp = *rp ^ lmask;
    379  1.18       rin 			*rp = tmp;
    380  1.18       rin 			if (ri->ri_hwbits) {
    381  1.19       rin 				*hp = tmp;
    382  1.19       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    383  1.12  macallan 			}
    384  1.18       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    385  1.12  macallan 		}
    386   1.1        ad 	} else {
    387  1.19       rin 		lmask = ~rasops_rmask[col];
    388   1.1        ad 		rmask = ~rasops_lmask[(col + num) & 31];
    389   1.1        ad 
    390  1.19       rin 		if (lmask != -1)
    391  1.19       rin 			num = (num - (32 - col)) >> 5;
    392  1.19       rin 		else
    393  1.19       rin 			num = num >> 5;
    394  1.19       rin 
    395   1.1        ad 		while (height--) {
    396   1.1        ad 			dp = rp;
    397  1.19       rin 
    398  1.19       rin 			if (lmask != -1) {
    399  1.19       rin 				*dp = *dp ^ lmask;
    400  1.19       rin 				dp++;
    401  1.12  macallan 			}
    402  1.18       rin 
    403  1.19       rin 			for (cnt = num; cnt; cnt--) {
    404  1.19       rin 				*dp = ~*dp;
    405  1.12  macallan 				dp++;
    406  1.12  macallan 			}
    407   1.1        ad 
    408  1.19       rin 			if (rmask != -1)
    409  1.19       rin 				*dp = *dp ^ rmask;
    410  1.19       rin 
    411  1.19       rin 			if (ri->ri_hwbits) {
    412  1.19       rin 				memcpy(hp, rp, ((lmask != -1) + num +
    413  1.19       rin 				    (rmask != -1)) << 2);
    414  1.19       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    415  1.12  macallan 			}
    416  1.20       rin 
    417  1.19       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    418   1.1        ad 		}
    419   1.1        ad 	}
    420   1.1        ad }
    421   1.1        ad 
    422   1.1        ad /*
    423   1.4        ad  * Copy columns. Ick!
    424   1.1        ad  */
    425   1.1        ad static void
    426  1.11    cegger NAME(copycols)(void *cookie, int row, int src, int dst, int num)
    427   1.1        ad {
    428  1.18       rin 	struct rasops_info *ri = (struct rasops_info *)cookie;
    429  1.15   tsutsui 	int height, lnum, rnum, sb, db, cnt, full;
    430  1.15   tsutsui 	uint32_t tmp, lmask, rmask;
    431  1.18       rin 	uint32_t *sp, *dp, *srp, *drp, *dhp, *hp;
    432   1.6        pk 
    433  1.18       rin 	dhp = hp = NULL;	/* XXX GCC */
    434   1.1        ad 
    435   1.1        ad #ifdef RASOPS_CLIPPING
    436   1.1        ad 	if (dst == src)
    437   1.1        ad 		return;
    438   1.6        pk 
    439   1.1        ad 	/* Catches < 0 case too */
    440   1.1        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    441   1.1        ad 		return;
    442   1.6        pk 
    443   1.1        ad 	if (src < 0) {
    444   1.1        ad 		num += src;
    445   1.1        ad 		src = 0;
    446   1.1        ad 	}
    447   1.1        ad 
    448  1.18       rin 	if (src + num > ri->ri_cols)
    449   1.1        ad 		num = ri->ri_cols - src;
    450   1.1        ad 
    451   1.1        ad 	if (dst < 0) {
    452   1.1        ad 		num += dst;
    453   1.1        ad 		dst = 0;
    454   1.1        ad 	}
    455   1.1        ad 
    456  1.18       rin 	if (dst + num > ri->ri_cols)
    457   1.1        ad 		num = ri->ri_cols - dst;
    458   1.6        pk 
    459   1.1        ad 	if (num <= 0)
    460   1.1        ad 		return;
    461   1.1        ad #endif
    462   1.6        pk 
    463   1.1        ad 	cnt = ri->ri_font->fontwidth << PIXEL_SHIFT;
    464   1.1        ad 	src *= cnt;
    465   1.1        ad 	dst *= cnt;
    466   1.1        ad 	num *= cnt;
    467   1.1        ad 	row *= ri->ri_yscale;
    468   1.1        ad 	height = ri->ri_font->fontheight;
    469   1.4        ad 	db = dst & 31;
    470   1.1        ad 
    471   1.6        pk 	if (db + num <= 32) {
    472   1.4        ad 		/* Destination is contained within a single word */
    473  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
    474  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
    475  1.12  macallan 		if (ri->ri_hwbits)
    476  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    477  1.12  macallan 			    ((dst >> 3) & ~3));
    478   1.1        ad 		sb = src & 31;
    479   1.1        ad 
    480   1.1        ad 		while (height--) {
    481   1.1        ad 			GETBITS(srp, sb, num, tmp);
    482   1.1        ad 			PUTBITS(tmp, db, num, drp);
    483  1.12  macallan 			if (ri->ri_hwbits) {
    484  1.12  macallan 				PUTBITS(tmp, db, num, dhp);
    485  1.15   tsutsui 				DELTA(dhp, ri->ri_stride, uint32_t *);
    486  1.12  macallan 			}
    487  1.15   tsutsui 			DELTA(srp, ri->ri_stride, uint32_t *);
    488  1.15   tsutsui 			DELTA(drp, ri->ri_stride, uint32_t *);
    489   1.1        ad 		}
    490   1.6        pk 
    491   1.1        ad 		return;
    492   1.1        ad 	}
    493   1.1        ad 
    494   1.4        ad 	lmask = rasops_rmask[db];
    495   1.1        ad 	rmask = rasops_lmask[(dst + num) & 31];
    496   1.4        ad 	lnum = (32 - db) & 31;
    497   1.6        pk 	rnum = (dst + num) & 31;
    498   1.6        pk 
    499   1.1        ad 	if (lmask)
    500  1.21       rin 		full = (num - lnum) >> 5;
    501   1.1        ad 	else
    502   1.1        ad 		full = num >> 5;
    503   1.1        ad 
    504   1.4        ad 	if (src < dst && src + num > dst) {
    505   1.4        ad 		/* Copy right-to-left */
    506  1.15   tsutsui 		bool sbover;
    507  1.15   tsutsui 		int sboff;
    508  1.15   tsutsui 
    509  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row +
    510  1.15   tsutsui 		    (((src + num) >> 3) & ~3));
    511  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row +
    512  1.15   tsutsui 		    (((dst + num) >> 3) & ~3));
    513  1.12  macallan 		if (ri->ri_hwbits)
    514  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    515  1.15   tsutsui 			    (((dst + num) >> 3) & ~3));
    516   1.1        ad 
    517  1.15   tsutsui 		sb = src & 31;
    518  1.15   tsutsui 		sbover = (sb + lnum) >= 32;
    519  1.15   tsutsui 		sboff = (src + num) & 31;
    520  1.15   tsutsui 		if ((sboff -= rnum) < 0) {
    521  1.14   tsutsui 			srp--;
    522  1.15   tsutsui 			sboff += 32;
    523   1.4        ad 		}
    524   1.6        pk 
    525   1.1        ad 		while (height--) {
    526   1.1        ad 			sp = srp;
    527   1.1        ad 			dp = drp;
    528   1.6        pk 
    529  1.15   tsutsui 			if (rnum) {
    530  1.15   tsutsui 				GETBITS(sp, sboff, rnum, tmp);
    531  1.15   tsutsui 				PUTBITS(tmp, 0, rnum, dp);
    532   1.1        ad 			}
    533   1.1        ad 
    534   1.4        ad 			/* Now aligned to 32-bits wrt dp */
    535  1.15   tsutsui 			for (cnt = full; cnt; cnt--) {
    536  1.15   tsutsui 				--dp;
    537  1.15   tsutsui 				--sp;
    538  1.15   tsutsui 				GETBITS(sp, sboff, 32, tmp);
    539  1.15   tsutsui 				*dp = tmp;
    540   1.1        ad 			}
    541   1.1        ad 
    542   1.1        ad 			if (lmask) {
    543  1.15   tsutsui 				if (sbover)
    544  1.15   tsutsui 					--sp;
    545  1.15   tsutsui 				--dp;
    546   1.4        ad 				GETBITS(sp, sb, lnum, tmp);
    547  1.15   tsutsui 				PUTBITS(tmp, db, lnum, dp);
    548   1.1        ad  			}
    549  1.18       rin 
    550  1.18       rin 			if (ri->ri_hwbits) {
    551  1.18       rin 				hp = dhp;
    552  1.22       rin 				hp -= (lmask != 0) + full;
    553  1.22       rin 				memcpy(hp, dp, ((lmask != 0) + full +
    554  1.22       rin 				    (rnum != 0)) << 2);
    555  1.18       rin 				DELTA(dhp, ri->ri_stride, uint32_t *);
    556  1.18       rin 			}
    557  1.22       rin 
    558  1.22       rin 			DELTA(srp, ri->ri_stride, uint32_t *);
    559  1.22       rin 			DELTA(drp, ri->ri_stride, uint32_t *);
    560   1.1        ad  		}
    561   1.1        ad 	} else {
    562   1.4        ad 		/* Copy left-to-right */
    563  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
    564  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
    565  1.12  macallan 		if (ri->ri_hwbits)
    566  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    567  1.12  macallan 			    ((dst >> 3) & ~3));
    568   1.1        ad 
    569   1.1        ad 		while (height--) {
    570   1.1        ad 			sb = src & 31;
    571   1.1        ad 			sp = srp;
    572   1.1        ad 			dp = drp;
    573   1.6        pk 
    574   1.1        ad 			if (lmask) {
    575   1.1        ad 				GETBITS(sp, sb, lnum, tmp);
    576   1.1        ad 				PUTBITS(tmp, db, lnum, dp);
    577   1.1        ad 				dp++;
    578   1.6        pk 
    579  1.20       rin 				sb += lnum;
    580  1.20       rin 				if (sb > 31) {
    581   1.1        ad 					sp++;
    582   1.1        ad 					sb -= 32;
    583   1.1        ad 				}
    584   1.1        ad 			}
    585   1.6        pk 
    586   1.4        ad 			/* Now aligned to 32-bits wrt dp */
    587   1.4        ad 			for (cnt = full; cnt; cnt--, sp++) {
    588   1.1        ad 				GETBITS(sp, sb, 32, tmp);
    589   1.1        ad 				*dp++ = tmp;
    590   1.1        ad 			}
    591   1.1        ad 
    592   1.1        ad 			if (rmask) {
    593   1.1        ad 				GETBITS(sp, sb, rnum, tmp);
    594   1.1        ad 				PUTBITS(tmp, 0, rnum, dp);
    595   1.1        ad  			}
    596  1.18       rin 
    597  1.18       rin 			if (ri->ri_hwbits) {
    598  1.18       rin 				memcpy(dhp, drp, ((lmask != 0) + full +
    599  1.18       rin 				    (rmask != 0)) << 2);
    600  1.18       rin 				DELTA(dhp, ri->ri_stride, uint32_t *);
    601  1.18       rin 			}
    602  1.18       rin 
    603  1.18       rin 			DELTA(srp, ri->ri_stride, uint32_t *);
    604  1.18       rin 			DELTA(drp, ri->ri_stride, uint32_t *);
    605   1.1        ad  		}
    606   1.1        ad  	}
    607   1.1        ad }
    608   1.5        ad 
    609  1.23       rin #undef	PIXEL_SHIFT
    610  1.23       rin #undef	PIXEL_BITS
    611  1.23       rin #undef	COLOR_MASK
    612  1.23       rin 
    613   1.1        ad #endif /* _RASOPS_BITOPS_H_ */
    614