Home | History | Annotate | Line # | Download | only in rasops
rasops.c revision 1.36
      1  1.36   nathanw /*	 $NetBSD: rasops.c,v 1.36 2001/02/12 04:33:36 nathanw Exp $	*/
      2   1.1        ad 
      3   1.9        ad /*-
      4   1.9        ad  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5   1.1        ad  * All rights reserved.
      6   1.1        ad  *
      7   1.9        ad  * This code is derived from software contributed to The NetBSD Foundation
      8  1.32        ad  * by Andrew Doran.
      9   1.9        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.9        ad  * 3. All advertising materials mentioning features or use of this software
     19   1.9        ad  *    must display the following acknowledgement:
     20   1.9        ad  *	This product includes software developed by the NetBSD
     21   1.9        ad  *	Foundation, Inc. and its contributors.
     22   1.9        ad  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.9        ad  *    contributors may be used to endorse or promote products derived
     24   1.9        ad  *    from this software without specific prior written permission.
     25   1.1        ad  *
     26   1.9        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.9        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.9        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.9        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.9        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.9        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.9        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.9        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.9        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.9        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.9        ad  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1        ad  */
     38   1.2        ad 
     39   1.1        ad #include <sys/cdefs.h>
     40  1.36   nathanw __KERNEL_RCSID(0, "$NetBSD: rasops.c,v 1.36 2001/02/12 04:33:36 nathanw Exp $");
     41   1.1        ad 
     42  1.18        ad #include "opt_rasops.h"
     43   1.4        ad #include "rasops_glue.h"
     44   1.1        ad 
     45   1.1        ad #include <sys/types.h>
     46   1.1        ad #include <sys/param.h>
     47   1.1        ad #include <sys/systm.h>
     48   1.1        ad #include <sys/time.h>
     49   1.1        ad 
     50   1.3        ad #include <machine/bswap.h>
     51   1.4        ad #include <machine/endian.h>
     52   1.3        ad 
     53   1.1        ad #include <dev/wscons/wsdisplayvar.h>
     54   1.1        ad #include <dev/wscons/wsconsio.h>
     55   1.1        ad #include <dev/wsfont/wsfont.h>
     56   1.1        ad #include <dev/rasops/rasops.h>
     57   1.1        ad 
     58  1.11        ad #ifndef _KERNEL
     59  1.11        ad #include <errno.h>
     60  1.11        ad #endif
     61  1.11        ad 
     62   1.1        ad /* ANSI colormap (R,G,B). Upper 8 are high-intensity */
     63  1.23  drochner const u_char rasops_cmap[256*3] = {
     64   1.1        ad 	0x00, 0x00, 0x00, /* black */
     65   1.1        ad 	0x7f, 0x00, 0x00, /* red */
     66   1.1        ad 	0x00, 0x7f, 0x00, /* green */
     67   1.1        ad 	0x7f, 0x7f, 0x00, /* brown */
     68   1.1        ad 	0x00, 0x00, 0x7f, /* blue */
     69   1.1        ad 	0x7f, 0x00, 0x7f, /* magenta */
     70   1.1        ad 	0x00, 0x7f, 0x7f, /* cyan */
     71   1.1        ad 	0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
     72   1.1        ad 
     73   1.1        ad 	0x7f, 0x7f, 0x7f, /* black */
     74   1.1        ad 	0xff, 0x00, 0x00, /* red */
     75   1.1        ad 	0x00, 0xff, 0x00, /* green */
     76   1.1        ad 	0xff, 0xff, 0x00, /* brown */
     77   1.1        ad 	0x00, 0x00, 0xff, /* blue */
     78   1.1        ad 	0xff, 0x00, 0xff, /* magenta */
     79   1.1        ad 	0x00, 0xff, 0xff, /* cyan */
     80   1.1        ad 	0xff, 0xff, 0xff, /* white */
     81  1.23  drochner 
     82  1.23  drochner 	/*
     83  1.23  drochner 	 * For the cursor, we need at least the last (255th)
     84  1.23  drochner 	 * color to be white. Fill up white completely for
     85  1.23  drochner 	 * simplicity.
     86  1.23  drochner 	 */
     87  1.23  drochner #define _CMWHITE 0xff, 0xff, 0xff,
     88  1.23  drochner #define _CMWHITE16	_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     89  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     90  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
     91  1.23  drochner 			_CMWHITE _CMWHITE _CMWHITE _CMWHITE
     92  1.23  drochner 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
     93  1.23  drochner 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
     94  1.23  drochner 	_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
     95  1.23  drochner #undef _CMWHITE16
     96  1.23  drochner #undef _CMWHITE
     97   1.1        ad };
     98   1.1        ad 
     99   1.1        ad /* True if color is gray */
    100  1.30        pk const u_char rasops_isgray[16] = {
    101  1.30        pk 	1, 0, 0, 0,
    102   1.1        ad 	0, 0, 0, 1,
    103   1.1        ad 	1, 0, 0, 0,
    104   1.1        ad 	0, 0, 0, 1
    105   1.1        ad };
    106   1.1        ad 
    107   1.4        ad /* Generic functions */
    108   1.1        ad static void	rasops_copyrows __P((void *, int, int, int));
    109   1.1        ad static int	rasops_mapchar __P((void *, int, u_int *));
    110   1.1        ad static void	rasops_cursor __P((void *, int, int, int));
    111   1.1        ad static int	rasops_alloc_cattr __P((void *, int, int, int, long *));
    112   1.1        ad static int	rasops_alloc_mattr __P((void *, int, int, int, long *));
    113   1.4        ad static void	rasops_do_cursor __P((struct rasops_info *));
    114   1.4        ad static void	rasops_init_devcmap __P((struct rasops_info *));
    115   1.1        ad 
    116   1.1        ad /*
    117   1.1        ad  * Initalize a 'rasops_info' descriptor.
    118   1.1        ad  */
    119   1.1        ad int
    120  1.13        ad rasops_init(ri, wantrows, wantcols)
    121   1.1        ad 	struct rasops_info *ri;
    122  1.13        ad 	int wantrows, wantcols;
    123   1.1        ad {
    124  1.20        ad 
    125  1.30        pk #ifdef _KERNEL
    126   1.1        ad 	/* Select a font if the caller doesn't care */
    127   1.1        ad 	if (ri->ri_font == NULL) {
    128   1.1        ad 		int cookie;
    129  1.30        pk 
    130   1.1        ad 		wsfont_init();
    131   1.1        ad 
    132   1.1        ad 		/* Want 8 pixel wide, don't care about aestethics */
    133   1.7        ad 		if ((cookie = wsfont_find(NULL, 8, 0, 0)) <= 0)
    134   1.1        ad 			cookie = wsfont_find(NULL, 0, 0, 0);
    135   1.1        ad 
    136   1.7        ad 		if (cookie <= 0) {
    137   1.1        ad 			printf("rasops_init: font table is empty\n");
    138   1.1        ad 			return (-1);
    139   1.1        ad 		}
    140  1.30        pk 
    141  1.30        pk 		if (wsfont_lock(cookie, &ri->ri_font,
    142  1.26      shin 		    WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R) <= 0) {
    143   1.1        ad 			printf("rasops_init: couldn't lock font\n");
    144   1.1        ad 			return (-1);
    145   1.1        ad 		}
    146   1.8        ad 
    147   1.5        ad 		ri->ri_wsfcookie = cookie;
    148   1.1        ad 	}
    149   1.4        ad #endif
    150  1.30        pk 
    151   1.1        ad 	/* This should never happen in reality... */
    152   1.1        ad #ifdef DEBUG
    153  1.31  sommerfe 	if ((long)ri->ri_bits & 3) {
    154   1.1        ad 		printf("rasops_init: bits not aligned on 32-bit boundary\n");
    155   1.1        ad 		return (-1);
    156   1.1        ad 	}
    157   1.1        ad 
    158   1.1        ad 	if ((int)ri->ri_stride & 3) {
    159   1.1        ad 		printf("rasops_init: stride not aligned on 32-bit boundary\n");
    160   1.1        ad 		return (-1);
    161   1.1        ad 	}
    162   1.1        ad #endif
    163   1.4        ad 
    164  1.13        ad 	if (rasops_reconfig(ri, wantrows, wantcols))
    165   1.4        ad 		return (-1);
    166  1.30        pk 
    167   1.4        ad 	rasops_init_devcmap(ri);
    168   1.4        ad 	return (0);
    169   1.4        ad }
    170   1.4        ad 
    171   1.4        ad /*
    172  1.13        ad  * Reconfigure (because parameters have changed in some way).
    173   1.4        ad  */
    174   1.4        ad int
    175  1.13        ad rasops_reconfig(ri, wantrows, wantcols)
    176   1.4        ad 	struct rasops_info *ri;
    177  1.13        ad 	int wantrows, wantcols;
    178   1.4        ad {
    179  1.20        ad 	int bpp, s;
    180  1.30        pk 
    181  1.13        ad 	s = splhigh();
    182  1.30        pk 
    183   1.4        ad 	if (ri->ri_font->fontwidth > 32 || ri->ri_font->fontwidth < 4)
    184   1.4        ad 		panic("rasops_init: fontwidth assumptions botched!\n");
    185  1.30        pk 
    186   1.4        ad 	/* Need this to frob the setup below */
    187   1.4        ad 	bpp = (ri->ri_depth == 15 ? 16 : ri->ri_depth);
    188   1.4        ad 
    189  1.13        ad 	if ((ri->ri_flg & RI_CFGDONE) != 0)
    190   1.4        ad 		ri->ri_bits = ri->ri_origbits;
    191  1.30        pk 
    192   1.1        ad 	/* Don't care if the caller wants a hideously small console */
    193   1.1        ad 	if (wantrows < 10)
    194  1.13        ad 		wantrows = 10;
    195  1.30        pk 
    196   1.1        ad 	if (wantcols < 20)
    197  1.13        ad 		wantcols = 20;
    198  1.30        pk 
    199   1.1        ad 	/* Now constrain what they get */
    200   1.1        ad 	ri->ri_emuwidth = ri->ri_font->fontwidth * wantcols;
    201   1.1        ad 	ri->ri_emuheight = ri->ri_font->fontheight * wantrows;
    202  1.30        pk 
    203   1.1        ad 	if (ri->ri_emuwidth > ri->ri_width)
    204   1.1        ad 		ri->ri_emuwidth = ri->ri_width;
    205  1.30        pk 
    206   1.1        ad 	if (ri->ri_emuheight > ri->ri_height)
    207   1.1        ad 		ri->ri_emuheight = ri->ri_height;
    208  1.30        pk 
    209   1.1        ad 	/* Reduce width until aligned on a 32-bit boundary */
    210  1.20        ad 	while ((ri->ri_emuwidth * bpp & 31) != 0)
    211   1.1        ad 		ri->ri_emuwidth--;
    212  1.30        pk 
    213   1.1        ad 	ri->ri_cols = ri->ri_emuwidth / ri->ri_font->fontwidth;
    214   1.1        ad 	ri->ri_rows = ri->ri_emuheight / ri->ri_font->fontheight;
    215   1.4        ad 	ri->ri_emustride = ri->ri_emuwidth * bpp >> 3;
    216   1.1        ad 	ri->ri_delta = ri->ri_stride - ri->ri_emustride;
    217   1.1        ad 	ri->ri_ccol = 0;
    218   1.1        ad 	ri->ri_crow = 0;
    219   1.4        ad 	ri->ri_pelbytes = bpp >> 3;
    220  1.30        pk 
    221   1.4        ad 	ri->ri_xscale = (ri->ri_font->fontwidth * bpp) >> 3;
    222   1.1        ad 	ri->ri_yscale = ri->ri_font->fontheight * ri->ri_stride;
    223   1.1        ad 	ri->ri_fontscale = ri->ri_font->fontheight * ri->ri_font->stride;
    224   1.1        ad 
    225  1.30        pk #ifdef DEBUG
    226  1.18        ad 	if ((ri->ri_delta & 3) != 0)
    227  1.13        ad 		panic("rasops_init: ri_delta not aligned on 32-bit boundary");
    228  1.30        pk #endif
    229   1.1        ad 	/* Clear the entire display */
    230  1.13        ad 	if ((ri->ri_flg & RI_CLEAR) != 0)
    231  1.13        ad 		memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    232  1.30        pk 
    233  1.30        pk 	/* Now centre our window if needs be */
    234   1.1        ad 	ri->ri_origbits = ri->ri_bits;
    235  1.30        pk 
    236  1.13        ad 	if ((ri->ri_flg & RI_CENTER) != 0) {
    237  1.36   nathanw 		ri->ri_bits += (((ri->ri_width * bpp >> 3) -
    238  1.36   nathanw 		    ri->ri_emustride) >> 1) & ~3;
    239  1.30        pk 		ri->ri_bits += ((ri->ri_height - ri->ri_emuheight) >> 1) *
    240   1.1        ad 		    ri->ri_stride;
    241  1.30        pk 
    242  1.30        pk 		ri->ri_yorigin = (int)(ri->ri_bits - ri->ri_origbits)
    243   1.5        ad 		   / ri->ri_stride;
    244  1.30        pk 		ri->ri_xorigin = (((int)(ri->ri_bits - ri->ri_origbits)
    245  1.28   nathanw 		   % ri->ri_stride) * 8 / bpp);
    246   1.5        ad 	} else
    247   1.5        ad 		ri->ri_xorigin = ri->ri_yorigin = 0;
    248   1.4        ad 
    249  1.30        pk 	/*
    250   1.4        ad 	 * Fill in defaults for operations set.  XXX this nukes private
    251   1.4        ad 	 * routines used by accelerated fb drivers.
    252   1.4        ad 	 */
    253   1.1        ad 	ri->ri_ops.mapchar = rasops_mapchar;
    254   1.1        ad 	ri->ri_ops.copyrows = rasops_copyrows;
    255   1.1        ad 	ri->ri_ops.copycols = rasops_copycols;
    256   1.4        ad 	ri->ri_ops.erasecols = rasops_erasecols;
    257   1.4        ad 	ri->ri_ops.eraserows = rasops_eraserows;
    258   1.1        ad 	ri->ri_ops.cursor = rasops_cursor;
    259   1.4        ad 	ri->ri_do_cursor = rasops_do_cursor;
    260  1.30        pk 
    261  1.13        ad 	if (ri->ri_depth < 8 || (ri->ri_flg & RI_FORCEMONO) != 0) {
    262   1.1        ad 		ri->ri_ops.alloc_attr = rasops_alloc_mattr;
    263  1.24  drochner 		ri->ri_caps = WSSCREEN_UNDERLINE | WSSCREEN_REVERSE;
    264   1.4        ad 	} else {
    265   1.1        ad 		ri->ri_ops.alloc_attr = rasops_alloc_cattr;
    266  1.30        pk 		ri->ri_caps = WSSCREEN_UNDERLINE | WSSCREEN_HILIT |
    267  1.24  drochner 		    WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
    268   1.4        ad 	}
    269   1.4        ad 
    270   1.1        ad 	switch (ri->ri_depth) {
    271  1.20        ad #if NRASOPS1 > 0
    272   1.1        ad 	case 1:
    273   1.1        ad 		rasops1_init(ri);
    274   1.1        ad 		break;
    275   1.1        ad #endif
    276  1.20        ad #if NRASOPS2 > 0
    277   1.4        ad 	case 2:
    278   1.4        ad 		rasops2_init(ri);
    279  1.34  takemura 		break;
    280  1.34  takemura #endif
    281  1.34  takemura #if NRASOPS4 > 0
    282  1.34  takemura 	case 4:
    283  1.34  takemura 		rasops4_init(ri);
    284   1.4        ad 		break;
    285   1.4        ad #endif
    286  1.20        ad #if NRASOPS8 > 0
    287   1.1        ad 	case 8:
    288   1.1        ad 		rasops8_init(ri);
    289   1.1        ad 		break;
    290   1.1        ad #endif
    291  1.20        ad #if NRASOPS15 > 0 || NRASOPS16 > 0
    292   1.1        ad 	case 15:
    293   1.1        ad 	case 16:
    294   1.1        ad 		rasops15_init(ri);
    295   1.1        ad 		break;
    296   1.1        ad #endif
    297  1.20        ad #if NRASOPS24 > 0
    298   1.1        ad 	case 24:
    299   1.1        ad 		rasops24_init(ri);
    300   1.1        ad 		break;
    301   1.1        ad #endif
    302  1.20        ad #if NRASOPS32 > 0
    303   1.1        ad 	case 32:
    304   1.1        ad 		rasops32_init(ri);
    305   1.1        ad 		break;
    306   1.1        ad #endif
    307   1.1        ad 	default:
    308  1.13        ad 		ri->ri_flg &= ~RI_CFGDONE;
    309  1.13        ad 		splx(s);
    310   1.1        ad 		return (-1);
    311   1.1        ad 	}
    312  1.30        pk 
    313  1.13        ad 	ri->ri_flg |= RI_CFGDONE;
    314  1.13        ad 	splx(s);
    315   1.1        ad 	return (0);
    316   1.1        ad }
    317   1.1        ad 
    318   1.1        ad /*
    319   1.1        ad  * Map a character.
    320   1.1        ad  */
    321   1.1        ad static int
    322   1.1        ad rasops_mapchar(cookie, c, cp)
    323   1.1        ad 	void *cookie;
    324   1.1        ad 	int c;
    325   1.1        ad 	u_int *cp;
    326   1.1        ad {
    327   1.1        ad 	struct rasops_info *ri;
    328  1.30        pk 
    329   1.1        ad 	ri = (struct rasops_info *)cookie;
    330   1.8        ad 
    331  1.30        pk #ifdef DIAGNOSTIC
    332   1.8        ad 	if (ri->ri_font == NULL)
    333   1.8        ad 		panic("rasops_mapchar: no font selected\n");
    334  1.30        pk #endif
    335  1.35    marcus 	if (ri->ri_font->encoding != WSDISPLAY_FONTENC_ISO) {
    336  1.35    marcus 
    337  1.35    marcus 		if ( (c = wsfont_map_unichar(ri->ri_font, c)) < 0) {
    338  1.35    marcus 
    339  1.35    marcus 			*cp = ' ';
    340  1.35    marcus 			return (0);
    341  1.35    marcus 
    342  1.35    marcus 		}
    343  1.35    marcus 	}
    344  1.35    marcus 
    345  1.30        pk 
    346   1.1        ad 	if (c < ri->ri_font->firstchar) {
    347   1.1        ad 		*cp = ' ';
    348   1.1        ad 		return (0);
    349   1.1        ad 	}
    350  1.30        pk 
    351   1.1        ad 	if (c - ri->ri_font->firstchar >= ri->ri_font->numchars) {
    352   1.1        ad 		*cp = ' ';
    353   1.1        ad 		return (0);
    354   1.1        ad 	}
    355  1.30        pk 
    356   1.1        ad 	*cp = c;
    357   1.1        ad 	return (5);
    358   1.1        ad }
    359   1.1        ad 
    360   1.1        ad /*
    361   1.1        ad  * Allocate a color attribute.
    362   1.1        ad  */
    363   1.1        ad static int
    364   1.1        ad rasops_alloc_cattr(cookie, fg, bg, flg, attr)
    365   1.1        ad 	void *cookie;
    366   1.1        ad 	int fg, bg, flg;
    367   1.1        ad 	long *attr;
    368   1.1        ad {
    369   1.1        ad 	int swap;
    370   1.1        ad 
    371   1.1        ad #ifdef RASOPS_CLIPPING
    372   1.1        ad 	fg &= 7;
    373   1.1        ad 	bg &= 7;
    374   1.1        ad #endif
    375  1.17        ad 	if ((flg & WSATTR_BLINK) != 0)
    376   1.1        ad 		return (EINVAL);
    377  1.23  drochner 
    378  1.23  drochner 	if ((flg & WSATTR_WSCOLORS) == 0) {
    379  1.23  drochner 		fg = WSCOL_WHITE;
    380  1.23  drochner 		bg = WSCOL_BLACK;
    381  1.23  drochner 	}
    382  1.23  drochner 
    383  1.17        ad 	if ((flg & WSATTR_REVERSE) != 0) {
    384   1.1        ad 		swap = fg;
    385   1.1        ad 		fg = bg;
    386   1.1        ad 		bg = swap;
    387   1.1        ad 	}
    388   1.1        ad 
    389  1.17        ad 	if ((flg & WSATTR_HILIT) != 0)
    390   1.1        ad 		fg += 8;
    391  1.30        pk 
    392   1.1        ad 	flg = ((flg & WSATTR_UNDERLINE) ? 1 : 0);
    393  1.30        pk 
    394   1.1        ad 	if (rasops_isgray[fg])
    395   1.1        ad 		flg |= 2;
    396   1.1        ad 
    397   1.1        ad 	if (rasops_isgray[bg])
    398   1.1        ad 		flg |= 4;
    399   1.1        ad 
    400   1.1        ad 	*attr = (bg << 16) | (fg << 24) | flg;
    401  1.17        ad 	return (0);
    402   1.1        ad }
    403   1.1        ad 
    404   1.1        ad /*
    405   1.1        ad  * Allocate a mono attribute.
    406   1.1        ad  */
    407   1.1        ad static int
    408   1.1        ad rasops_alloc_mattr(cookie, fg, bg, flg, attr)
    409   1.1        ad 	void *cookie;
    410   1.1        ad 	int fg, bg, flg;
    411   1.1        ad 	long *attr;
    412   1.1        ad {
    413   1.1        ad 	int swap;
    414   1.1        ad 
    415  1.23  drochner 	if ((flg & (WSATTR_BLINK | WSATTR_HILIT | WSATTR_WSCOLORS)) != 0)
    416   1.1        ad 		return (EINVAL);
    417  1.23  drochner 
    418  1.23  drochner 	fg = 1;
    419  1.23  drochner 	bg = 0;
    420  1.23  drochner 
    421  1.17        ad 	if ((flg & WSATTR_REVERSE) != 0) {
    422   1.1        ad 		swap = fg;
    423   1.1        ad 		fg = bg;
    424   1.1        ad 		bg = swap;
    425   1.1        ad 	}
    426   1.1        ad 
    427   1.1        ad 	*attr = (bg << 16) | (fg << 24) | ((flg & WSATTR_UNDERLINE) ? 7 : 6);
    428  1.17        ad 	return (0);
    429   1.1        ad }
    430   1.1        ad 
    431   1.1        ad /*
    432   1.1        ad  * Copy rows.
    433   1.1        ad  */
    434   1.1        ad static void
    435   1.1        ad rasops_copyrows(cookie, src, dst, num)
    436   1.1        ad 	void *cookie;
    437   1.1        ad 	int src, dst, num;
    438   1.1        ad {
    439  1.18        ad 	int32_t *sp, *dp, *srp, *drp;
    440   1.1        ad 	struct rasops_info *ri;
    441  1.18        ad 	int n8, n1, cnt, delta;
    442  1.30        pk 
    443   1.1        ad 	ri = (struct rasops_info *)cookie;
    444   1.1        ad 
    445   1.1        ad #ifdef RASOPS_CLIPPING
    446   1.1        ad 	if (dst == src)
    447   1.1        ad 		return;
    448  1.30        pk 
    449   1.1        ad 	if (src < 0) {
    450   1.1        ad 		num += src;
    451   1.1        ad 		src = 0;
    452   1.1        ad 	}
    453   1.1        ad 
    454   1.1        ad 	if ((src + num) > ri->ri_rows)
    455   1.1        ad 		num = ri->ri_rows - src;
    456   1.1        ad 
    457   1.1        ad 	if (dst < 0) {
    458   1.1        ad 		num += dst;
    459   1.1        ad 		dst = 0;
    460   1.1        ad 	}
    461   1.1        ad 
    462   1.1        ad 	if ((dst + num) > ri->ri_rows)
    463   1.1        ad 		num = ri->ri_rows - dst;
    464  1.30        pk 
    465   1.1        ad 	if (num <= 0)
    466   1.1        ad 		return;
    467   1.1        ad #endif
    468   1.1        ad 
    469   1.1        ad 	num *= ri->ri_font->fontheight;
    470   1.1        ad 	n8 = ri->ri_emustride >> 5;
    471   1.1        ad 	n1 = (ri->ri_emustride >> 2) & 7;
    472  1.30        pk 
    473   1.1        ad 	if (dst < src) {
    474  1.18        ad 		srp = (int32_t *)(ri->ri_bits + src * ri->ri_yscale);
    475  1.18        ad 		drp = (int32_t *)(ri->ri_bits + dst * ri->ri_yscale);
    476  1.18        ad 		delta = ri->ri_stride;
    477   1.1        ad 	} else {
    478   1.1        ad 		src = ri->ri_font->fontheight * src + num - 1;
    479   1.1        ad 		dst = ri->ri_font->fontheight * dst + num - 1;
    480   1.1        ad 		srp = (int32_t *)(ri->ri_bits + src * ri->ri_stride);
    481   1.1        ad 		drp = (int32_t *)(ri->ri_bits + dst * ri->ri_stride);
    482  1.18        ad 		delta = -ri->ri_stride;
    483  1.18        ad 	}
    484  1.30        pk 
    485  1.18        ad 	while (num--) {
    486  1.18        ad 		dp = drp;
    487  1.18        ad 		sp = srp;
    488  1.18        ad 		DELTA(drp, delta, int32_t *);
    489  1.18        ad 		DELTA(srp, delta, int32_t *);
    490  1.18        ad 
    491  1.18        ad 		for (cnt = n8; cnt; cnt--) {
    492  1.18        ad 			dp[0] = sp[0];
    493  1.18        ad 			dp[1] = sp[1];
    494  1.18        ad 			dp[2] = sp[2];
    495  1.18        ad 			dp[3] = sp[3];
    496  1.18        ad 			dp[4] = sp[4];
    497  1.18        ad 			dp[5] = sp[5];
    498  1.18        ad 			dp[6] = sp[6];
    499  1.18        ad 			dp[7] = sp[7];
    500  1.18        ad 			dp += 8;
    501  1.18        ad 			sp += 8;
    502  1.18        ad 		}
    503  1.30        pk 
    504  1.18        ad 		for (cnt = n1; cnt; cnt--)
    505  1.18        ad 			*dp++ = *sp++;
    506   1.1        ad 	}
    507   1.1        ad }
    508   1.1        ad 
    509   1.1        ad /*
    510   1.1        ad  * Copy columns. This is slow, and hard to optimize due to alignment,
    511   1.1        ad  * and the fact that we have to copy both left->right and right->left.
    512   1.1        ad  * We simply cop-out here and use bcopy(), since it handles all of
    513   1.1        ad  * these cases anyway.
    514   1.1        ad  */
    515   1.4        ad void
    516   1.1        ad rasops_copycols(cookie, row, src, dst, num)
    517   1.1        ad 	void *cookie;
    518   1.1        ad 	int row, src, dst, num;
    519   1.1        ad {
    520   1.1        ad 	struct rasops_info *ri;
    521   1.1        ad 	u_char *sp, *dp;
    522   1.1        ad 	int height;
    523  1.30        pk 
    524   1.1        ad 	ri = (struct rasops_info *)cookie;
    525   1.1        ad 
    526   1.1        ad #ifdef RASOPS_CLIPPING
    527   1.1        ad 	if (dst == src)
    528   1.1        ad 		return;
    529  1.30        pk 
    530   1.3        ad 	/* Catches < 0 case too */
    531   1.3        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    532   1.1        ad 		return;
    533  1.30        pk 
    534   1.1        ad 	if (src < 0) {
    535   1.1        ad 		num += src;
    536   1.1        ad 		src = 0;
    537   1.1        ad 	}
    538   1.1        ad 
    539   1.1        ad 	if ((src + num) > ri->ri_cols)
    540   1.1        ad 		num = ri->ri_cols - src;
    541   1.1        ad 
    542   1.1        ad 	if (dst < 0) {
    543   1.1        ad 		num += dst;
    544   1.1        ad 		dst = 0;
    545   1.1        ad 	}
    546   1.1        ad 
    547   1.1        ad 	if ((dst + num) > ri->ri_cols)
    548   1.1        ad 		num = ri->ri_cols - dst;
    549  1.30        pk 
    550   1.1        ad 	if (num <= 0)
    551   1.1        ad 		return;
    552   1.1        ad #endif
    553  1.30        pk 
    554   1.1        ad 	num *= ri->ri_xscale;
    555   1.1        ad 	row *= ri->ri_yscale;
    556   1.1        ad 	height = ri->ri_font->fontheight;
    557  1.30        pk 
    558   1.1        ad 	sp = ri->ri_bits + row + src * ri->ri_xscale;
    559   1.1        ad 	dp = ri->ri_bits + row + dst * ri->ri_xscale;
    560  1.30        pk 
    561   1.1        ad 	while (height--) {
    562   1.1        ad 		bcopy(sp, dp, num);
    563   1.1        ad 		dp += ri->ri_stride;
    564   1.1        ad 		sp += ri->ri_stride;
    565   1.1        ad 	}
    566   1.1        ad }
    567   1.1        ad 
    568   1.1        ad /*
    569   1.1        ad  * Turn cursor off/on.
    570   1.1        ad  */
    571   1.1        ad static void
    572   1.1        ad rasops_cursor(cookie, on, row, col)
    573   1.1        ad 	void *cookie;
    574   1.1        ad 	int on, row, col;
    575   1.1        ad {
    576   1.1        ad 	struct rasops_info *ri;
    577  1.30        pk 
    578   1.1        ad 	ri = (struct rasops_info *)cookie;
    579  1.30        pk 
    580   1.1        ad 	/* Turn old cursor off */
    581  1.13        ad 	if ((ri->ri_flg & RI_CURSOR) != 0)
    582  1.30        pk #ifdef RASOPS_CLIPPING
    583  1.13        ad 		if ((ri->ri_flg & RI_CURSORCLIP) == 0)
    584   1.1        ad #endif
    585   1.1        ad 			ri->ri_do_cursor(ri);
    586   1.1        ad 
    587   1.1        ad 	/* Select new cursor */
    588   1.1        ad #ifdef RASOPS_CLIPPING
    589  1.13        ad 	ri->ri_flg &= ~RI_CURSORCLIP;
    590  1.30        pk 
    591   1.1        ad 	if (row < 0 || row >= ri->ri_rows)
    592  1.13        ad 		ri->ri_flg |= RI_CURSORCLIP;
    593   1.1        ad 	else if (col < 0 || col >= ri->ri_cols)
    594  1.13        ad 		ri->ri_flg |= RI_CURSORCLIP;
    595   1.1        ad #endif
    596   1.1        ad 	ri->ri_crow = row;
    597   1.1        ad 	ri->ri_ccol = col;
    598   1.1        ad 
    599   1.1        ad 	if (on) {
    600  1.13        ad 		ri->ri_flg |= RI_CURSOR;
    601  1.30        pk #ifdef RASOPS_CLIPPING
    602  1.13        ad 		if ((ri->ri_flg & RI_CURSORCLIP) == 0)
    603   1.1        ad #endif
    604   1.1        ad 			ri->ri_do_cursor(ri);
    605  1.30        pk 	} else
    606  1.13        ad 		ri->ri_flg &= ~RI_CURSOR;
    607   1.1        ad }
    608   1.1        ad 
    609   1.1        ad /*
    610   1.1        ad  * Make the device colormap
    611   1.1        ad  */
    612   1.4        ad static void
    613   1.1        ad rasops_init_devcmap(ri)
    614   1.1        ad 	struct rasops_info *ri;
    615   1.1        ad {
    616  1.23  drochner 	const u_char *p;
    617   1.1        ad 	int i, c;
    618  1.30        pk 
    619   1.4        ad 	switch (ri->ri_depth) {
    620   1.4        ad 	case 1:
    621   1.4        ad 		ri->ri_devcmap[0] = 0;
    622   1.4        ad 		for (i = 1; i < 16; i++)
    623   1.4        ad 			ri->ri_devcmap[i] = -1;
    624   1.4        ad 		return;
    625   1.4        ad 
    626   1.4        ad 	case 2:
    627   1.4        ad 		for (i = 1; i < 15; i++)
    628   1.4        ad 			ri->ri_devcmap[i] = 0xaaaaaaaa;
    629  1.30        pk 
    630   1.4        ad 		ri->ri_devcmap[0] = 0;
    631   1.4        ad 		ri->ri_devcmap[8] = 0x55555555;
    632   1.4        ad 		ri->ri_devcmap[15] = -1;
    633   1.4        ad 		return;
    634   1.4        ad 
    635   1.4        ad 	case 8:
    636   1.4        ad 		for (i = 0; i < 16; i++)
    637   1.4        ad 			ri->ri_devcmap[i] = i | (i<<8) | (i<<16) | (i<<24);
    638   1.4        ad 		return;
    639   1.4        ad 	}
    640  1.30        pk 
    641   1.1        ad 	p = rasops_cmap;
    642  1.30        pk 
    643  1.29   nathanw 	for (i = 0; i < 16; i++) {
    644   1.1        ad 		if (ri->ri_rnum <= 8)
    645  1.12        ad 			c = (*p >> (8 - ri->ri_rnum)) << ri->ri_rpos;
    646  1.30        pk 		else
    647  1.12        ad 			c = (*p << (ri->ri_rnum - 8)) << ri->ri_rpos;
    648  1.29   nathanw 		p++;
    649   1.1        ad 
    650   1.1        ad 		if (ri->ri_gnum <= 8)
    651  1.12        ad 			c |= (*p >> (8 - ri->ri_gnum)) << ri->ri_gpos;
    652  1.30        pk 		else
    653  1.12        ad 			c |= (*p << (ri->ri_gnum - 8)) << ri->ri_gpos;
    654  1.29   nathanw 		p++;
    655   1.1        ad 
    656   1.1        ad 		if (ri->ri_bnum <= 8)
    657  1.12        ad 			c |= (*p >> (8 - ri->ri_bnum)) << ri->ri_bpos;
    658  1.30        pk 		else
    659  1.12        ad 			c |= (*p << (ri->ri_bnum - 8)) << ri->ri_bpos;
    660  1.29   nathanw 		p++;
    661   1.4        ad 
    662   1.4        ad 		/* Fill the word for generic routines, which want this */
    663   1.4        ad 		if (ri->ri_depth == 24)
    664   1.4        ad 			c = c | ((c & 0xff) << 24);
    665   1.4        ad 		else if (ri->ri_depth <= 16)
    666   1.4        ad 			c = c | (c << 16);
    667   1.1        ad 
    668   1.4        ad 		/* 24bpp does bswap on the fly. {32,16,15}bpp do it here. */
    669  1.13        ad 		if ((ri->ri_flg & RI_BSWAP) == 0)
    670   1.3        ad 			ri->ri_devcmap[i] = c;
    671   1.4        ad 		else if (ri->ri_depth == 32)
    672   1.3        ad 			ri->ri_devcmap[i] = bswap32(c);
    673   1.4        ad 		else if (ri->ri_depth == 16 || ri->ri_depth == 15)
    674   1.3        ad 			ri->ri_devcmap[i] = bswap16(c);
    675   1.4        ad 		else
    676   1.4        ad 			ri->ri_devcmap[i] = c;
    677   1.1        ad 	}
    678   1.1        ad }
    679   1.1        ad 
    680   1.1        ad /*
    681   1.1        ad  * Unpack a rasops attribute
    682   1.1        ad  */
    683   1.1        ad void
    684   1.1        ad rasops_unpack_attr(attr, fg, bg, underline)
    685   1.1        ad 	long attr;
    686   1.1        ad 	int *fg, *bg, *underline;
    687   1.1        ad {
    688  1.30        pk 
    689  1.30        pk 	*fg = ((u_int)attr >> 24) & 0xf;
    690  1.30        pk 	*bg = ((u_int)attr >> 16) & 0xf;
    691  1.25        ad 	if (underline != NULL)
    692  1.24  drochner 		*underline = (u_int)attr & 1;
    693   1.4        ad }
    694   1.4        ad 
    695   1.4        ad /*
    696   1.4        ad  * Erase rows. This isn't static, since 24-bpp uses it in special cases.
    697   1.4        ad  */
    698   1.4        ad void
    699   1.4        ad rasops_eraserows(cookie, row, num, attr)
    700   1.4        ad 	void *cookie;
    701   1.4        ad 	int row, num;
    702   1.4        ad 	long attr;
    703   1.4        ad {
    704   1.4        ad 	struct rasops_info *ri;
    705  1.14        ad 	int np, nw, cnt, delta;
    706   1.4        ad 	int32_t *dp, clr;
    707  1.30        pk 
    708   1.4        ad 	ri = (struct rasops_info *)cookie;
    709   1.4        ad 
    710   1.4        ad #ifdef RASOPS_CLIPPING
    711   1.4        ad 	if (row < 0) {
    712   1.4        ad 		num += row;
    713   1.4        ad 		row = 0;
    714   1.4        ad 	}
    715   1.4        ad 
    716   1.4        ad 	if ((row + num) > ri->ri_rows)
    717   1.4        ad 		num = ri->ri_rows - row;
    718  1.30        pk 
    719   1.4        ad 	if (num <= 0)
    720   1.4        ad 		return;
    721   1.4        ad #endif
    722   1.4        ad 
    723  1.30        pk 	clr = ri->ri_devcmap[(attr >> 16) & 0xf];
    724   1.4        ad 
    725  1.30        pk 	/*
    726  1.20        ad 	 * XXX The wsdisplay_emulops interface seems a little deficient in
    727  1.30        pk 	 * that there is no way to clear the *entire* screen. We provide a
    728  1.30        pk 	 * workaround here: if the entire console area is being cleared, and
    729  1.13        ad 	 * the RI_FULLCLEAR flag is set, clear the entire display.
    730  1.30        pk 	 */
    731  1.13        ad 	if (num == ri->ri_rows && (ri->ri_flg & RI_FULLCLEAR) != 0) {
    732  1.13        ad 		np = ri->ri_stride >> 5;
    733  1.13        ad 		nw = (ri->ri_stride >> 2) & 7;
    734  1.13        ad 		num = ri->ri_height;
    735  1.14        ad 		dp = (int32_t *)ri->ri_origbits;
    736  1.14        ad 		delta = 0;
    737  1.13        ad 	} else {
    738  1.13        ad 		np = ri->ri_emustride >> 5;
    739  1.13        ad 		nw = (ri->ri_emustride >> 2) & 7;
    740  1.13        ad 		num *= ri->ri_font->fontheight;
    741  1.14        ad 		dp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale);
    742  1.14        ad 		delta = ri->ri_delta;
    743  1.13        ad 	}
    744  1.30        pk 
    745   1.4        ad 	while (num--) {
    746   1.4        ad 		for (cnt = np; cnt; cnt--) {
    747   1.4        ad 			dp[0] = clr;
    748   1.4        ad 			dp[1] = clr;
    749   1.4        ad 			dp[2] = clr;
    750   1.4        ad 			dp[3] = clr;
    751   1.4        ad 			dp[4] = clr;
    752   1.4        ad 			dp[5] = clr;
    753   1.4        ad 			dp[6] = clr;
    754   1.4        ad 			dp[7] = clr;
    755   1.4        ad 			dp += 8;
    756   1.4        ad 		}
    757  1.30        pk 
    758   1.4        ad 		for (cnt = nw; cnt; cnt--) {
    759   1.4        ad 			*(int32_t *)dp = clr;
    760   1.4        ad 			DELTA(dp, 4, int32_t *);
    761  1.30        pk 		}
    762  1.30        pk 
    763  1.14        ad 		DELTA(dp, delta, int32_t *);
    764   1.4        ad 	}
    765   1.4        ad }
    766   1.4        ad 
    767   1.4        ad /*
    768   1.4        ad  * Actually turn the cursor on or off. This does the dirty work for
    769   1.4        ad  * rasops_cursor().
    770   1.4        ad  */
    771   1.4        ad static void
    772   1.4        ad rasops_do_cursor(ri)
    773   1.4        ad 	struct rasops_info *ri;
    774   1.4        ad {
    775  1.21        ad 	int full1, height, cnt, slop1, slop2, row, col;
    776   1.4        ad 	u_char *dp, *rp;
    777  1.30        pk 
    778   1.4        ad 	row = ri->ri_crow;
    779   1.4        ad 	col = ri->ri_ccol;
    780  1.30        pk 
    781   1.4        ad 	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
    782   1.4        ad 	height = ri->ri_font->fontheight;
    783  1.27  nisimura 	slop1 = (4 - ((long)rp & 3)) & 3;
    784  1.30        pk 
    785   1.4        ad 	if (slop1 > ri->ri_xscale)
    786   1.4        ad 		slop1 = ri->ri_xscale;
    787  1.30        pk 
    788   1.4        ad 	slop2 = (ri->ri_xscale - slop1) & 3;
    789   1.4        ad 	full1 = (ri->ri_xscale - slop1 - slop2) >> 2;
    790  1.30        pk 
    791   1.4        ad 	if ((slop1 | slop2) == 0) {
    792   1.4        ad 		/* A common case */
    793   1.4        ad 		while (height--) {
    794   1.4        ad 			dp = rp;
    795   1.4        ad 			rp += ri->ri_stride;
    796  1.30        pk 
    797   1.4        ad 			for (cnt = full1; cnt; cnt--) {
    798  1.21        ad 				*(int32_t *)dp ^= ~0;
    799   1.4        ad 				dp += 4;
    800   1.4        ad 			}
    801   1.4        ad 		}
    802   1.4        ad 	} else {
    803   1.4        ad 		/* XXX this is stupid.. use masks instead */
    804   1.4        ad 		while (height--) {
    805   1.4        ad 			dp = rp;
    806   1.4        ad 			rp += ri->ri_stride;
    807  1.30        pk 
    808   1.4        ad 			if (slop1 & 1)
    809  1.22     enami 				*dp++ ^= ~0;
    810   1.4        ad 
    811   1.4        ad 			if (slop1 & 2) {
    812  1.21        ad 				*(int16_t *)dp ^= ~0;
    813   1.4        ad 				dp += 2;
    814   1.4        ad 			}
    815  1.30        pk 
    816   1.4        ad 			for (cnt = full1; cnt; cnt--) {
    817  1.21        ad 				*(int32_t *)dp ^= ~0;
    818   1.4        ad 				dp += 4;
    819   1.4        ad 			}
    820   1.4        ad 
    821   1.4        ad 			if (slop2 & 1)
    822  1.21        ad 				*dp++ ^= ~0;
    823   1.4        ad 
    824   1.4        ad 			if (slop2 & 2)
    825  1.21        ad 				*(int16_t *)dp ^= ~0;
    826   1.4        ad 		}
    827   1.4        ad 	}
    828   1.4        ad }
    829   1.4        ad 
    830   1.4        ad /*
    831   1.4        ad  * Erase columns.
    832   1.4        ad  */
    833   1.4        ad void
    834   1.4        ad rasops_erasecols(cookie, row, col, num, attr)
    835   1.4        ad 	void *cookie;
    836   1.4        ad 	int row, col, num;
    837   1.4        ad 	long attr;
    838   1.4        ad {
    839   1.4        ad 	int n8, height, cnt, slop1, slop2, clr;
    840   1.4        ad 	struct rasops_info *ri;
    841   1.4        ad 	int32_t *rp, *dp;
    842  1.30        pk 
    843   1.4        ad 	ri = (struct rasops_info *)cookie;
    844  1.30        pk 
    845  1.30        pk #ifdef RASOPS_CLIPPING
    846   1.4        ad 	if ((unsigned)row >= (unsigned)ri->ri_rows)
    847   1.4        ad 		return;
    848   1.4        ad 
    849   1.4        ad 	if (col < 0) {
    850   1.4        ad 		num += col;
    851   1.4        ad 		col = 0;
    852   1.4        ad 	}
    853   1.4        ad 
    854   1.4        ad 	if ((col + num) > ri->ri_cols)
    855   1.4        ad 		num = ri->ri_cols - col;
    856  1.30        pk 
    857   1.4        ad 	if (num <= 0)
    858   1.4        ad 		return;
    859   1.4        ad #endif
    860  1.30        pk 
    861   1.4        ad 	num = num * ri->ri_xscale;
    862   1.4        ad 	rp = (int32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
    863   1.4        ad 	height = ri->ri_font->fontheight;
    864  1.30        pk 	clr = ri->ri_devcmap[(attr >> 16) & 0xf];
    865  1.30        pk 
    866   1.4        ad 	/* Don't bother using the full loop for <= 32 pels */
    867   1.4        ad 	if (num <= 32) {
    868   1.6        ad 		if (((num | ri->ri_xscale) & 3) == 0) {
    869   1.6        ad 			/* Word aligned blt */
    870   1.6        ad 			num >>= 2;
    871   1.6        ad 
    872   1.6        ad 			while (height--) {
    873   1.6        ad 				dp = rp;
    874   1.6        ad 				DELTA(rp, ri->ri_stride, int32_t *);
    875  1.30        pk 
    876   1.6        ad 				for (cnt = num; cnt; cnt--)
    877   1.6        ad 					*dp++ = clr;
    878   1.6        ad 			}
    879   1.6        ad 		} else if (((num | ri->ri_xscale) & 1) == 0) {
    880  1.30        pk 			/*
    881   1.4        ad 			 * Halfword aligned blt. This is needed so the
    882  1.30        pk 			 * 15/16 bit ops can use this function.
    883   1.4        ad 			 */
    884   1.4        ad 			num >>= 1;
    885   1.4        ad 
    886   1.4        ad 			while (height--) {
    887   1.4        ad 				dp = rp;
    888   1.4        ad 				DELTA(rp, ri->ri_stride, int32_t *);
    889   1.4        ad 
    890   1.4        ad 				for (cnt = num; cnt; cnt--) {
    891   1.4        ad 					*(int16_t *)dp = clr;
    892   1.4        ad 					DELTA(dp, 2, int32_t *);
    893   1.4        ad 				}
    894   1.4        ad 			}
    895   1.4        ad 		} else {
    896   1.4        ad 			while (height--) {
    897   1.4        ad 				dp = rp;
    898   1.4        ad 				DELTA(rp, ri->ri_stride, int32_t *);
    899   1.4        ad 
    900   1.4        ad 				for (cnt = num; cnt; cnt--) {
    901   1.4        ad 					*(u_char *)dp = clr;
    902   1.4        ad 					DELTA(dp, 1, int32_t *);
    903   1.4        ad 				}
    904   1.4        ad 			}
    905   1.4        ad 		}
    906  1.30        pk 
    907   1.4        ad 		return;
    908   1.4        ad 	}
    909  1.30        pk 
    910  1.27  nisimura 	slop1 = (4 - ((long)rp & 3)) & 3;
    911   1.4        ad 	slop2 = (num - slop1) & 3;
    912   1.4        ad 	num -= slop1 + slop2;
    913   1.4        ad 	n8 = num >> 5;
    914   1.4        ad 	num = (num >> 2) & 7;
    915   1.4        ad 
    916   1.4        ad 	while (height--) {
    917   1.4        ad 		dp = rp;
    918   1.4        ad 		DELTA(rp, ri->ri_stride, int32_t *);
    919  1.30        pk 
    920   1.4        ad 		/* Align span to 4 bytes */
    921   1.4        ad 		if (slop1 & 1) {
    922   1.4        ad 			*(u_char *)dp = clr;
    923   1.4        ad 			DELTA(dp, 1, int32_t *);
    924   1.4        ad 		}
    925   1.4        ad 
    926   1.4        ad 		if (slop1 & 2) {
    927   1.4        ad 			*(int16_t *)dp = clr;
    928   1.4        ad 			DELTA(dp, 2, int32_t *);
    929   1.4        ad 		}
    930  1.30        pk 
    931   1.4        ad 		/* Write 32 bytes per loop */
    932   1.4        ad 		for (cnt = n8; cnt; cnt--) {
    933   1.4        ad 			dp[0] = clr;
    934   1.4        ad 			dp[1] = clr;
    935   1.4        ad 			dp[2] = clr;
    936   1.4        ad 			dp[3] = clr;
    937   1.4        ad 			dp[4] = clr;
    938   1.4        ad 			dp[5] = clr;
    939   1.4        ad 			dp[6] = clr;
    940   1.4        ad 			dp[7] = clr;
    941   1.4        ad 			dp += 8;
    942   1.4        ad 		}
    943  1.30        pk 
    944  1.30        pk 		/* Write 4 bytes per loop */
    945   1.4        ad 		for (cnt = num; cnt; cnt--)
    946   1.4        ad 			*dp++ = clr;
    947  1.30        pk 
    948  1.30        pk 		/* Write unaligned trailing slop */
    949   1.4        ad 		if (slop2 & 1) {
    950   1.4        ad 			*(u_char *)dp = clr;
    951   1.4        ad 			DELTA(dp, 1, int32_t *);
    952   1.4        ad 		}
    953   1.4        ad 
    954   1.4        ad 		if (slop2 & 2)
    955   1.4        ad 			*(int16_t *)dp = clr;
    956   1.4        ad 	}
    957   1.1        ad }
    958