Home | History | Annotate | Line # | Download | only in rasops
rasops_bitops.h revision 1.24
      1  1.24       rin /* 	$NetBSD: rasops_bitops.h,v 1.24 2019/08/07 12:36:36 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 #if   RASOPS_DEPTH == 1
     36  1.23       rin #define	PIXEL_SHIFT	0
     37  1.23       rin #elif RASOPS_DEPTH == 2
     38  1.23       rin #define	PIXEL_SHIFT	1
     39  1.23       rin #elif RASOPS_DEPTH == 4
     40  1.23       rin #define	PIXEL_SHIFT	2
     41  1.23       rin #else
     42  1.23       rin #error "Depth not supported"
     43  1.23       rin #endif
     44  1.23       rin 
     45  1.24       rin #define	NAME(name)		NAME1(RASOPS_DEPTH, name)
     46  1.24       rin #define	NAME1(depth, name)	NAME2(depth, name)
     47  1.24       rin #define	NAME2(depth, name)	rasops ## depth ## _ ## name
     48  1.23       rin 
     49   1.1        ad /*
     50   1.1        ad  * Erase columns.
     51   1.1        ad  */
     52   1.1        ad static void
     53  1.11    cegger NAME(erasecols)(void *cookie, int row, int col, int num, long attr)
     54   1.1        ad {
     55  1.19       rin 	struct rasops_info *ri = (struct rasops_info *)cookie;
     56  1.19       rin 	uint32_t lclr, rclr, clr;
     57  1.18       rin 	uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
     58   1.1        ad 	int height, cnt;
     59   1.6        pk 
     60  1.18       rin 	hp = NULL;	/* XXX GCC */
     61  1.18       rin 
     62   1.6        pk #ifdef RASOPS_CLIPPING
     63   1.1        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
     64   1.1        ad 		return;
     65   1.1        ad 
     66   1.1        ad 	if (col < 0) {
     67   1.1        ad 		num += col;
     68   1.1        ad 		col = 0;
     69   1.1        ad 	}
     70   1.1        ad 
     71  1.19       rin 	if (col + num > ri->ri_cols)
     72   1.1        ad 		num = ri->ri_cols - col;
     73   1.6        pk 
     74   1.1        ad 	if (num <= 0)
     75   1.1        ad 		return;
     76   1.1        ad #endif
     77  1.20       rin 
     78   1.1        ad 	col *= ri->ri_font->fontwidth << PIXEL_SHIFT;
     79   1.1        ad 	num *= ri->ri_font->fontwidth << PIXEL_SHIFT;
     80   1.1        ad 	height = ri->ri_font->fontheight;
     81  1.17       rin 	clr = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
     82  1.15   tsutsui 	rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + ((col >> 3) & ~3));
     83  1.12  macallan 	if (ri->ri_hwbits)
     84  1.18       rin 		hp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
     85  1.12  macallan 		    ((col >> 3) & ~3));
     86  1.19       rin 	col &= 31;
     87  1.19       rin 
     88  1.19       rin 	if (col + num <= 32) {
     89  1.19       rin 		lmask = ~rasops_pmask[col][num & 31];
     90   1.1        ad 		lclr = clr & ~lmask;
     91   1.1        ad 
     92   1.1        ad 		while (height--) {
     93   1.1        ad 			dp = rp;
     94  1.15   tsutsui 			DELTA(rp, ri->ri_stride, uint32_t *);
     95   1.1        ad 
     96  1.12  macallan 			tmp = (*dp & lmask) | lclr;
     97  1.12  macallan 			*dp = tmp;
     98  1.12  macallan 			if (ri->ri_hwbits) {
     99  1.18       rin 				*hp = tmp;
    100  1.18       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    101  1.12  macallan 			}
    102   1.1        ad 		}
    103   1.1        ad 	} else {
    104  1.19       rin 		lmask = rasops_rmask[col];
    105   1.1        ad 		rmask = rasops_lmask[(col + num) & 31];
    106   1.6        pk 
    107   1.1        ad 		if (lmask)
    108  1.19       rin 			num = (num - (32 - col)) >> 5;
    109   1.1        ad 		else
    110   1.1        ad 			num = num >> 5;
    111   1.6        pk 
    112   1.1        ad 		lclr = clr & ~lmask;
    113   1.1        ad 		rclr = clr & ~rmask;
    114   1.1        ad 
    115   1.1        ad 		while (height--) {
    116   1.1        ad 			dp = rp;
    117   1.1        ad 
    118   1.8   thorpej 			if (lmask) {
    119  1.18       rin 				*dp = (*dp & lmask) | lclr;
    120   1.8   thorpej 				dp++;
    121   1.8   thorpej 			}
    122   1.1        ad 
    123   1.1        ad 			for (cnt = num; cnt > 0; cnt--)
    124   1.1        ad 				*dp++ = clr;
    125  1.18       rin 
    126  1.18       rin 			if (rmask)
    127  1.18       rin 				*dp = (*dp & rmask) | rclr;
    128  1.18       rin 
    129  1.12  macallan 			if (ri->ri_hwbits) {
    130  1.18       rin 				memcpy(hp, rp, ((lmask != 0) + num +
    131  1.18       rin 				    (rmask != 0)) << 2);
    132  1.18       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    133  1.12  macallan 			}
    134  1.18       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    135   1.1        ad 		}
    136   1.1        ad 	}
    137   1.1        ad }
    138   1.1        ad 
    139   1.1        ad /*
    140   1.1        ad  * Actually paint the cursor.
    141   1.1        ad  */
    142   1.1        ad static void
    143  1.11    cegger NAME(do_cursor)(struct rasops_info *ri)
    144   1.1        ad {
    145  1.19       rin 	int height, row, col, num, cnt;
    146  1.19       rin 	uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
    147  1.18       rin 
    148  1.19       rin 	hp = NULL;	/* XXX GCC */
    149   1.6        pk 
    150   1.1        ad 	row = ri->ri_crow;
    151   1.1        ad 	col = ri->ri_ccol * ri->ri_font->fontwidth << PIXEL_SHIFT;
    152   1.1        ad 	height = ri->ri_font->fontheight;
    153   1.1        ad 	num = ri->ri_font->fontwidth << PIXEL_SHIFT;
    154  1.16       rin 	rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
    155  1.16       rin 	    ((col >> 3) & ~3));
    156  1.12  macallan 	if (ri->ri_hwbits)
    157  1.19       rin 		hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
    158  1.12  macallan 		    ((col >> 3) & ~3));
    159  1.19       rin 	col &= 31;
    160   1.6        pk 
    161  1.19       rin 	if (col + num <= 32) {
    162  1.19       rin 		lmask = rasops_pmask[col][num & 31];
    163   1.1        ad 
    164   1.1        ad 		while (height--) {
    165  1.18       rin 			tmp = *rp ^ lmask;
    166  1.18       rin 			*rp = tmp;
    167  1.18       rin 			if (ri->ri_hwbits) {
    168  1.19       rin 				*hp = tmp;
    169  1.19       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    170  1.12  macallan 			}
    171  1.18       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    172  1.12  macallan 		}
    173   1.1        ad 	} else {
    174  1.19       rin 		lmask = ~rasops_rmask[col];
    175   1.1        ad 		rmask = ~rasops_lmask[(col + num) & 31];
    176   1.1        ad 
    177  1.19       rin 		if (lmask != -1)
    178  1.19       rin 			num = (num - (32 - col)) >> 5;
    179  1.19       rin 		else
    180  1.19       rin 			num = num >> 5;
    181  1.19       rin 
    182   1.1        ad 		while (height--) {
    183   1.1        ad 			dp = rp;
    184  1.19       rin 
    185  1.19       rin 			if (lmask != -1) {
    186  1.19       rin 				*dp = *dp ^ lmask;
    187  1.19       rin 				dp++;
    188  1.12  macallan 			}
    189  1.18       rin 
    190  1.19       rin 			for (cnt = num; cnt; cnt--) {
    191  1.19       rin 				*dp = ~*dp;
    192  1.12  macallan 				dp++;
    193  1.12  macallan 			}
    194   1.1        ad 
    195  1.19       rin 			if (rmask != -1)
    196  1.19       rin 				*dp = *dp ^ rmask;
    197  1.19       rin 
    198  1.19       rin 			if (ri->ri_hwbits) {
    199  1.19       rin 				memcpy(hp, rp, ((lmask != -1) + num +
    200  1.19       rin 				    (rmask != -1)) << 2);
    201  1.19       rin 				DELTA(hp, ri->ri_stride, uint32_t *);
    202  1.12  macallan 			}
    203  1.20       rin 
    204  1.19       rin 			DELTA(rp, ri->ri_stride, uint32_t *);
    205   1.1        ad 		}
    206   1.1        ad 	}
    207   1.1        ad }
    208   1.1        ad 
    209   1.1        ad /*
    210   1.4        ad  * Copy columns. Ick!
    211   1.1        ad  */
    212   1.1        ad static void
    213  1.11    cegger NAME(copycols)(void *cookie, int row, int src, int dst, int num)
    214   1.1        ad {
    215  1.18       rin 	struct rasops_info *ri = (struct rasops_info *)cookie;
    216  1.15   tsutsui 	int height, lnum, rnum, sb, db, cnt, full;
    217  1.15   tsutsui 	uint32_t tmp, lmask, rmask;
    218  1.18       rin 	uint32_t *sp, *dp, *srp, *drp, *dhp, *hp;
    219   1.6        pk 
    220  1.18       rin 	dhp = hp = NULL;	/* XXX GCC */
    221   1.1        ad 
    222   1.1        ad #ifdef RASOPS_CLIPPING
    223   1.1        ad 	if (dst == src)
    224   1.1        ad 		return;
    225   1.6        pk 
    226   1.1        ad 	/* Catches < 0 case too */
    227   1.1        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    228   1.1        ad 		return;
    229   1.6        pk 
    230   1.1        ad 	if (src < 0) {
    231   1.1        ad 		num += src;
    232   1.1        ad 		src = 0;
    233   1.1        ad 	}
    234   1.1        ad 
    235  1.18       rin 	if (src + num > ri->ri_cols)
    236   1.1        ad 		num = ri->ri_cols - src;
    237   1.1        ad 
    238   1.1        ad 	if (dst < 0) {
    239   1.1        ad 		num += dst;
    240   1.1        ad 		dst = 0;
    241   1.1        ad 	}
    242   1.1        ad 
    243  1.18       rin 	if (dst + num > ri->ri_cols)
    244   1.1        ad 		num = ri->ri_cols - dst;
    245   1.6        pk 
    246   1.1        ad 	if (num <= 0)
    247   1.1        ad 		return;
    248   1.1        ad #endif
    249   1.6        pk 
    250   1.1        ad 	cnt = ri->ri_font->fontwidth << PIXEL_SHIFT;
    251   1.1        ad 	src *= cnt;
    252   1.1        ad 	dst *= cnt;
    253   1.1        ad 	num *= cnt;
    254   1.1        ad 	row *= ri->ri_yscale;
    255   1.1        ad 	height = ri->ri_font->fontheight;
    256   1.4        ad 	db = dst & 31;
    257   1.1        ad 
    258   1.6        pk 	if (db + num <= 32) {
    259   1.4        ad 		/* Destination is contained within a single word */
    260  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
    261  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
    262  1.12  macallan 		if (ri->ri_hwbits)
    263  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    264  1.12  macallan 			    ((dst >> 3) & ~3));
    265   1.1        ad 		sb = src & 31;
    266   1.1        ad 
    267   1.1        ad 		while (height--) {
    268   1.1        ad 			GETBITS(srp, sb, num, tmp);
    269   1.1        ad 			PUTBITS(tmp, db, num, drp);
    270  1.12  macallan 			if (ri->ri_hwbits) {
    271  1.12  macallan 				PUTBITS(tmp, db, num, dhp);
    272  1.15   tsutsui 				DELTA(dhp, ri->ri_stride, uint32_t *);
    273  1.12  macallan 			}
    274  1.15   tsutsui 			DELTA(srp, ri->ri_stride, uint32_t *);
    275  1.15   tsutsui 			DELTA(drp, ri->ri_stride, uint32_t *);
    276   1.1        ad 		}
    277   1.6        pk 
    278   1.1        ad 		return;
    279   1.1        ad 	}
    280   1.1        ad 
    281   1.4        ad 	lmask = rasops_rmask[db];
    282   1.1        ad 	rmask = rasops_lmask[(dst + num) & 31];
    283   1.4        ad 	lnum = (32 - db) & 31;
    284   1.6        pk 	rnum = (dst + num) & 31;
    285   1.6        pk 
    286   1.1        ad 	if (lmask)
    287  1.21       rin 		full = (num - lnum) >> 5;
    288   1.1        ad 	else
    289   1.1        ad 		full = num >> 5;
    290   1.1        ad 
    291   1.4        ad 	if (src < dst && src + num > dst) {
    292   1.4        ad 		/* Copy right-to-left */
    293  1.15   tsutsui 		bool sbover;
    294  1.15   tsutsui 		int sboff;
    295  1.15   tsutsui 
    296  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row +
    297  1.15   tsutsui 		    (((src + num) >> 3) & ~3));
    298  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row +
    299  1.15   tsutsui 		    (((dst + num) >> 3) & ~3));
    300  1.12  macallan 		if (ri->ri_hwbits)
    301  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    302  1.15   tsutsui 			    (((dst + num) >> 3) & ~3));
    303   1.1        ad 
    304  1.15   tsutsui 		sb = src & 31;
    305  1.15   tsutsui 		sbover = (sb + lnum) >= 32;
    306  1.15   tsutsui 		sboff = (src + num) & 31;
    307  1.15   tsutsui 		if ((sboff -= rnum) < 0) {
    308  1.14   tsutsui 			srp--;
    309  1.15   tsutsui 			sboff += 32;
    310   1.4        ad 		}
    311   1.6        pk 
    312   1.1        ad 		while (height--) {
    313   1.1        ad 			sp = srp;
    314   1.1        ad 			dp = drp;
    315   1.6        pk 
    316  1.15   tsutsui 			if (rnum) {
    317  1.15   tsutsui 				GETBITS(sp, sboff, rnum, tmp);
    318  1.15   tsutsui 				PUTBITS(tmp, 0, rnum, dp);
    319   1.1        ad 			}
    320   1.1        ad 
    321   1.4        ad 			/* Now aligned to 32-bits wrt dp */
    322  1.15   tsutsui 			for (cnt = full; cnt; cnt--) {
    323  1.15   tsutsui 				--dp;
    324  1.15   tsutsui 				--sp;
    325  1.15   tsutsui 				GETBITS(sp, sboff, 32, tmp);
    326  1.15   tsutsui 				*dp = tmp;
    327   1.1        ad 			}
    328   1.1        ad 
    329   1.1        ad 			if (lmask) {
    330  1.15   tsutsui 				if (sbover)
    331  1.15   tsutsui 					--sp;
    332  1.15   tsutsui 				--dp;
    333   1.4        ad 				GETBITS(sp, sb, lnum, tmp);
    334  1.15   tsutsui 				PUTBITS(tmp, db, lnum, dp);
    335   1.1        ad  			}
    336  1.18       rin 
    337  1.18       rin 			if (ri->ri_hwbits) {
    338  1.18       rin 				hp = dhp;
    339  1.22       rin 				hp -= (lmask != 0) + full;
    340  1.22       rin 				memcpy(hp, dp, ((lmask != 0) + full +
    341  1.22       rin 				    (rnum != 0)) << 2);
    342  1.18       rin 				DELTA(dhp, ri->ri_stride, uint32_t *);
    343  1.18       rin 			}
    344  1.22       rin 
    345  1.22       rin 			DELTA(srp, ri->ri_stride, uint32_t *);
    346  1.22       rin 			DELTA(drp, ri->ri_stride, uint32_t *);
    347   1.1        ad  		}
    348   1.1        ad 	} else {
    349   1.4        ad 		/* Copy left-to-right */
    350  1.15   tsutsui 		srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
    351  1.15   tsutsui 		drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
    352  1.12  macallan 		if (ri->ri_hwbits)
    353  1.15   tsutsui 			dhp = (uint32_t *)(ri->ri_hwbits + row +
    354  1.12  macallan 			    ((dst >> 3) & ~3));
    355   1.1        ad 
    356   1.1        ad 		while (height--) {
    357   1.1        ad 			sb = src & 31;
    358   1.1        ad 			sp = srp;
    359   1.1        ad 			dp = drp;
    360   1.6        pk 
    361   1.1        ad 			if (lmask) {
    362   1.1        ad 				GETBITS(sp, sb, lnum, tmp);
    363   1.1        ad 				PUTBITS(tmp, db, lnum, dp);
    364   1.1        ad 				dp++;
    365   1.6        pk 
    366  1.20       rin 				sb += lnum;
    367  1.20       rin 				if (sb > 31) {
    368   1.1        ad 					sp++;
    369   1.1        ad 					sb -= 32;
    370   1.1        ad 				}
    371   1.1        ad 			}
    372   1.6        pk 
    373   1.4        ad 			/* Now aligned to 32-bits wrt dp */
    374   1.4        ad 			for (cnt = full; cnt; cnt--, sp++) {
    375   1.1        ad 				GETBITS(sp, sb, 32, tmp);
    376   1.1        ad 				*dp++ = tmp;
    377   1.1        ad 			}
    378   1.1        ad 
    379   1.1        ad 			if (rmask) {
    380   1.1        ad 				GETBITS(sp, sb, rnum, tmp);
    381   1.1        ad 				PUTBITS(tmp, 0, rnum, dp);
    382   1.1        ad  			}
    383  1.18       rin 
    384  1.18       rin 			if (ri->ri_hwbits) {
    385  1.18       rin 				memcpy(dhp, drp, ((lmask != 0) + full +
    386  1.18       rin 				    (rmask != 0)) << 2);
    387  1.18       rin 				DELTA(dhp, ri->ri_stride, uint32_t *);
    388  1.18       rin 			}
    389  1.18       rin 
    390  1.18       rin 			DELTA(srp, ri->ri_stride, uint32_t *);
    391  1.18       rin 			DELTA(drp, ri->ri_stride, uint32_t *);
    392   1.1        ad  		}
    393   1.1        ad  	}
    394   1.1        ad }
    395   1.5        ad 
    396  1.23       rin #undef	PIXEL_SHIFT
    397  1.24       rin 
    398  1.24       rin #undef	NAME
    399  1.24       rin #undef	NAME1
    400  1.24       rin #undef	NAME2
    401  1.23       rin 
    402   1.1        ad #endif /* _RASOPS_BITOPS_H_ */
    403