803 lines
		
	
	
		
			24 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			803 lines
		
	
	
		
			24 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * Copyright © 1998 Keith Packard
 | 
						|
 *
 | 
						|
 * Permission to use, copy, modify, distribute, and sell this software and its
 | 
						|
 * documentation for any purpose is hereby granted without fee, provided that
 | 
						|
 * the above copyright notice appear in all copies and that both that
 | 
						|
 * copyright notice and this permission notice appear in supporting
 | 
						|
 * documentation, and that the name of Keith Packard not be used in
 | 
						|
 * advertising or publicity pertaining to distribution of the software without
 | 
						|
 * specific, written prior permission.  Keith Packard makes no
 | 
						|
 * representations about the suitability of this software for any purpose.  It
 | 
						|
 * is provided "as is" without express or implied warranty.
 | 
						|
 *
 | 
						|
 * KEITH PACKARD DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
 | 
						|
 * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
 | 
						|
 * EVENT SHALL KEITH PACKARD BE LIABLE FOR ANY SPECIAL, INDIRECT OR
 | 
						|
 * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
 | 
						|
 * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
 | 
						|
 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
 | 
						|
 * PERFORMANCE OF THIS SOFTWARE.
 | 
						|
 */
 | 
						|
 | 
						|
#ifdef HAVE_DIX_CONFIG_H
 | 
						|
#include <dix-config.h>
 | 
						|
#endif
 | 
						|
 | 
						|
#include "fb.h"
 | 
						|
 | 
						|
#ifdef __clang__
 | 
						|
/* shift overflow is intentional */
 | 
						|
#pragma clang diagnostic ignored "-Wshift-overflow"
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 *  Example: srcX = 13 dstX = 8	(FB unit 32 dstBpp 8)
 | 
						|
 *
 | 
						|
 *	**** **** **** **** **** **** **** ****
 | 
						|
 *			^
 | 
						|
 *	********  ********  ********  ********
 | 
						|
 *		  ^
 | 
						|
 *  leftShift = 12
 | 
						|
 *  rightShift = 20
 | 
						|
 *
 | 
						|
 *  Example: srcX = 0 dstX = 8 (FB unit 32 dstBpp 8)
 | 
						|
 *
 | 
						|
 *	**** **** **** **** **** **** **** ****
 | 
						|
 *	^		
 | 
						|
 *	********  ********  ********  ********
 | 
						|
 *		  ^
 | 
						|
 *
 | 
						|
 *  leftShift = 24
 | 
						|
 *  rightShift = 8
 | 
						|
 */
 | 
						|
 | 
						|
#define LoadBits {\
 | 
						|
    if (leftShift) { \
 | 
						|
	bitsRight = (src < srcEnd ? READ(src++) : 0); \
 | 
						|
	bits = (FbStipLeft (bitsLeft, leftShift) | \
 | 
						|
		FbStipRight(bitsRight, rightShift)); \
 | 
						|
	bitsLeft = bitsRight; \
 | 
						|
    } else \
 | 
						|
	bits = (src < srcEnd ? READ(src++) : 0); \
 | 
						|
}
 | 
						|
 | 
						|
#define LaneCases1(n,a)	    case n: FbLaneCase(n,a); break
 | 
						|
#define LaneCases2(n,a)	    LaneCases1(n,a); LaneCases1(n+1,a)
 | 
						|
#define LaneCases4(n,a)	    LaneCases2(n,a); LaneCases2(n+2,a)
 | 
						|
#define LaneCases8(n,a)	    LaneCases4(n,a); LaneCases4(n+4,a)
 | 
						|
#define LaneCases16(n,a)    LaneCases8(n,a); LaneCases8(n+8,a)
 | 
						|
#define LaneCases32(n,a)    LaneCases16(n,a); LaneCases16(n+16,a)
 | 
						|
#define LaneCases64(n,a)    LaneCases32(n,a); LaneCases32(n+32,a)
 | 
						|
#define LaneCases128(n,a)   LaneCases64(n,a); LaneCases64(n+64,a)
 | 
						|
#define LaneCases256(n,a)   LaneCases128(n,a); LaneCases128(n+128,a)
 | 
						|
 | 
						|
#if FB_SHIFT == 6
 | 
						|
#define LaneCases(a)	    LaneCases256(0,a)
 | 
						|
#endif
 | 
						|
 | 
						|
#if FB_SHIFT == 5
 | 
						|
#define LaneCases(a)	    LaneCases16(0,a)
 | 
						|
#endif
 | 
						|
 | 
						|
#if FB_SHIFT == 6
 | 
						|
CARD8 fb8Lane[256] = {
 | 
						|
    0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20,
 | 
						|
        21,
 | 
						|
    22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40,
 | 
						|
    41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59,
 | 
						|
    60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78,
 | 
						|
    79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97,
 | 
						|
    98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112,
 | 
						|
        113, 114, 115,
 | 
						|
    116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130,
 | 
						|
        131, 132, 133,
 | 
						|
    134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148,
 | 
						|
        149, 150, 151,
 | 
						|
    152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166,
 | 
						|
        167, 168, 169,
 | 
						|
    170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184,
 | 
						|
        185, 186, 187,
 | 
						|
    188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202,
 | 
						|
        203, 204, 205,
 | 
						|
    206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220,
 | 
						|
        221, 222, 223,
 | 
						|
    224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238,
 | 
						|
        239, 240, 241,
 | 
						|
    242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255,
 | 
						|
};
 | 
						|
 | 
						|
CARD8 fb16Lane[256] = {
 | 
						|
    0x00, 0x03, 0x0c, 0x0f,
 | 
						|
    0x30, 0x33, 0x3c, 0x3f,
 | 
						|
    0xc0, 0xc3, 0xcc, 0xcf,
 | 
						|
    0xf0, 0xf3, 0xfc, 0xff,
 | 
						|
};
 | 
						|
 | 
						|
CARD8 fb32Lane[16] = {
 | 
						|
    0x00, 0x0f, 0xf0, 0xff,
 | 
						|
};
 | 
						|
#endif
 | 
						|
 | 
						|
#if FB_SHIFT == 5
 | 
						|
CARD8 fb8Lane[16] = {
 | 
						|
    0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15
 | 
						|
};
 | 
						|
 | 
						|
CARD8 fb16Lane[16] = {
 | 
						|
    0, 3, 12, 15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
};
 | 
						|
 | 
						|
CARD8 fb32Lane[16] = {
 | 
						|
    0, 15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
};
 | 
						|
#endif
 | 
						|
 | 
						|
CARD8 *fbLaneTable[33] = {
 | 
						|
    0, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
    fb8Lane, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
    fb16Lane, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
    0, 0, 0, 0, 0, 0, 0, 0,
 | 
						|
    fb32Lane
 | 
						|
};
 | 
						|
 | 
						|
void
 | 
						|
fbBltOne(FbStip * src, FbStride srcStride,      /* FbStip units per scanline */
 | 
						|
         int srcX,              /* bit position of source */
 | 
						|
         FbBits * dst, FbStride dstStride,      /* FbBits units per scanline */
 | 
						|
         int dstX,              /* bit position of dest */
 | 
						|
         int dstBpp,            /* bits per destination unit */
 | 
						|
         int width,             /* width in bits of destination */
 | 
						|
         int height,            /* height in scanlines */
 | 
						|
         FbBits fgand,          /* rrop values */
 | 
						|
         FbBits fgxor, FbBits bgand, FbBits bgxor)
 | 
						|
{
 | 
						|
    const FbBits *fbBits;
 | 
						|
    FbBits *srcEnd;
 | 
						|
    int pixelsPerDst;           /* dst pixels per FbBits */
 | 
						|
    int unitsPerSrc;            /* src patterns per FbStip */
 | 
						|
    int leftShift, rightShift;  /* align source with dest */
 | 
						|
    FbBits startmask, endmask;  /* dest scanline masks */
 | 
						|
    FbStip bits = 0, bitsLeft, bitsRight;       /* source bits */
 | 
						|
    FbStip left;
 | 
						|
    FbBits mask;
 | 
						|
    int nDst;                   /* dest longwords (w.o. end) */
 | 
						|
    int w;
 | 
						|
    int n, nmiddle;
 | 
						|
    int dstS;                   /* stipple-relative dst X coordinate */
 | 
						|
    Bool copy;                  /* accelerate dest-invariant */
 | 
						|
    Bool transparent;           /* accelerate 0 nop */
 | 
						|
    int srcinc;                 /* source units consumed */
 | 
						|
    Bool endNeedsLoad = FALSE;  /* need load for endmask */
 | 
						|
    CARD8 *fbLane;
 | 
						|
    int startbyte, endbyte;
 | 
						|
 | 
						|
    if (dstBpp == 24) {
 | 
						|
        fbBltOne24(src, srcStride, srcX,
 | 
						|
                   dst, dstStride, dstX, dstBpp,
 | 
						|
                   width, height, fgand, fgxor, bgand, bgxor);
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    /*
 | 
						|
     * Do not read past the end of the buffer!
 | 
						|
     */
 | 
						|
    srcEnd = src + height * srcStride;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Number of destination units in FbBits == number of stipple pixels
 | 
						|
     * used each time
 | 
						|
     */
 | 
						|
    pixelsPerDst = FB_UNIT / dstBpp;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Number of source stipple patterns in FbStip 
 | 
						|
     */
 | 
						|
    unitsPerSrc = FB_STIP_UNIT / pixelsPerDst;
 | 
						|
 | 
						|
    copy = FALSE;
 | 
						|
    transparent = FALSE;
 | 
						|
    if (bgand == 0 && fgand == 0)
 | 
						|
        copy = TRUE;
 | 
						|
    else if (bgand == FB_ALLONES && bgxor == 0)
 | 
						|
        transparent = TRUE;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Adjust source and dest to nearest FbBits boundary
 | 
						|
     */
 | 
						|
    src += srcX >> FB_STIP_SHIFT;
 | 
						|
    dst += dstX >> FB_SHIFT;
 | 
						|
    srcX &= FB_STIP_MASK;
 | 
						|
    dstX &= FB_MASK;
 | 
						|
 | 
						|
    FbMaskBitsBytes(dstX, width, copy,
 | 
						|
                    startmask, startbyte, nmiddle, endmask, endbyte);
 | 
						|
 | 
						|
    /*
 | 
						|
     * Compute effective dest alignment requirement for
 | 
						|
     * source -- must align source to dest unit boundary
 | 
						|
     */
 | 
						|
    dstS = dstX / dstBpp;
 | 
						|
    /*
 | 
						|
     * Compute shift constants for effective alignement
 | 
						|
     */
 | 
						|
    if (srcX >= dstS) {
 | 
						|
        leftShift = srcX - dstS;
 | 
						|
        rightShift = FB_STIP_UNIT - leftShift;
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        rightShift = dstS - srcX;
 | 
						|
        leftShift = FB_STIP_UNIT - rightShift;
 | 
						|
    }
 | 
						|
    /*
 | 
						|
     * Get pointer to stipple mask array for this depth
 | 
						|
     */
 | 
						|
    fbBits = 0;                 /* unused */
 | 
						|
    if (pixelsPerDst <= 8)
 | 
						|
        fbBits = fbStippleTable[pixelsPerDst];
 | 
						|
    fbLane = 0;
 | 
						|
    if (transparent && fgand == 0 && dstBpp >= 8)
 | 
						|
        fbLane = fbLaneTable[dstBpp];
 | 
						|
 | 
						|
    /*
 | 
						|
     * Compute total number of destination words written, but 
 | 
						|
     * don't count endmask 
 | 
						|
     */
 | 
						|
    nDst = nmiddle;
 | 
						|
    if (startmask)
 | 
						|
        nDst++;
 | 
						|
 | 
						|
    dstStride -= nDst;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Compute total number of source words consumed
 | 
						|
     */
 | 
						|
 | 
						|
    srcinc = (nDst + unitsPerSrc - 1) / unitsPerSrc;
 | 
						|
 | 
						|
    if (srcX > dstS)
 | 
						|
        srcinc++;
 | 
						|
    if (endmask) {
 | 
						|
        endNeedsLoad = nDst % unitsPerSrc == 0;
 | 
						|
        if (endNeedsLoad)
 | 
						|
            srcinc++;
 | 
						|
    }
 | 
						|
 | 
						|
    srcStride -= srcinc;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Copy rectangle
 | 
						|
     */
 | 
						|
    while (height--) {
 | 
						|
        w = nDst;               /* total units across scanline */
 | 
						|
        n = unitsPerSrc;        /* units avail in single stipple */
 | 
						|
        if (n > w)
 | 
						|
            n = w;
 | 
						|
 | 
						|
        bitsLeft = 0;
 | 
						|
        if (srcX > dstS)
 | 
						|
            bitsLeft = READ(src++);
 | 
						|
        if (n) {
 | 
						|
            /*
 | 
						|
             * Load first set of stipple bits
 | 
						|
             */
 | 
						|
            LoadBits;
 | 
						|
 | 
						|
            /*
 | 
						|
             * Consume stipple bits for startmask
 | 
						|
             */
 | 
						|
            if (startmask) {
 | 
						|
#if FB_UNIT > 32
 | 
						|
                if (pixelsPerDst == 16)
 | 
						|
                    mask = FbStipple16Bits(FbLeftStipBits(bits, 16));
 | 
						|
                else
 | 
						|
#endif
 | 
						|
                    mask = fbBits[FbLeftStipBits(bits, pixelsPerDst)];
 | 
						|
                if (fbLane) {
 | 
						|
                    fbTransparentSpan(dst, mask & startmask, fgxor, 1);
 | 
						|
                }
 | 
						|
                else {
 | 
						|
                    if (mask || !transparent)
 | 
						|
                        FbDoLeftMaskByteStippleRRop(dst, mask,
 | 
						|
                                                    fgand, fgxor, bgand, bgxor,
 | 
						|
                                                    startbyte, startmask);
 | 
						|
                }
 | 
						|
                bits = FbStipLeft(bits, pixelsPerDst);
 | 
						|
                dst++;
 | 
						|
                n--;
 | 
						|
                w--;
 | 
						|
            }
 | 
						|
            /*
 | 
						|
             * Consume stipple bits across scanline
 | 
						|
             */
 | 
						|
            for (;;) {
 | 
						|
                w -= n;
 | 
						|
                if (copy) {
 | 
						|
                    while (n--) {
 | 
						|
#if FB_UNIT > 32
 | 
						|
                        if (pixelsPerDst == 16)
 | 
						|
                            mask = FbStipple16Bits(FbLeftStipBits(bits, 16));
 | 
						|
                        else
 | 
						|
#endif
 | 
						|
                            mask = fbBits[FbLeftStipBits(bits, pixelsPerDst)];
 | 
						|
                        WRITE(dst, FbOpaqueStipple(mask, fgxor, bgxor));
 | 
						|
                        dst++;
 | 
						|
                        bits = FbStipLeft(bits, pixelsPerDst);
 | 
						|
                    }
 | 
						|
                }
 | 
						|
                else {
 | 
						|
                    if (fbLane) {
 | 
						|
                        while (bits && n) {
 | 
						|
                            switch (fbLane[FbLeftStipBits(bits, pixelsPerDst)]) {
 | 
						|
                                LaneCases((CARD8 *) dst);
 | 
						|
                            }
 | 
						|
                            bits = FbStipLeft(bits, pixelsPerDst);
 | 
						|
                            dst++;
 | 
						|
                            n--;
 | 
						|
                        }
 | 
						|
                        dst += n;
 | 
						|
                    }
 | 
						|
                    else {
 | 
						|
                        while (n--) {
 | 
						|
                            left = FbLeftStipBits(bits, pixelsPerDst);
 | 
						|
                            if (left || !transparent) {
 | 
						|
                                mask = fbBits[left];
 | 
						|
                                WRITE(dst, FbStippleRRop(READ(dst), mask,
 | 
						|
                                                         fgand, fgxor, bgand,
 | 
						|
                                                         bgxor));
 | 
						|
                            }
 | 
						|
                            dst++;
 | 
						|
                            bits = FbStipLeft(bits, pixelsPerDst);
 | 
						|
                        }
 | 
						|
                    }
 | 
						|
                }
 | 
						|
                if (!w)
 | 
						|
                    break;
 | 
						|
                /*
 | 
						|
                 * Load another set and reset number of available units
 | 
						|
                 */
 | 
						|
                LoadBits;
 | 
						|
                n = unitsPerSrc;
 | 
						|
                if (n > w)
 | 
						|
                    n = w;
 | 
						|
            }
 | 
						|
        }
 | 
						|
        /*
 | 
						|
         * Consume stipple bits for endmask
 | 
						|
         */
 | 
						|
        if (endmask) {
 | 
						|
            if (endNeedsLoad) {
 | 
						|
                LoadBits;
 | 
						|
            }
 | 
						|
#if FB_UNIT > 32
 | 
						|
            if (pixelsPerDst == 16)
 | 
						|
                mask = FbStipple16Bits(FbLeftStipBits(bits, 16));
 | 
						|
            else
 | 
						|
#endif
 | 
						|
                mask = fbBits[FbLeftStipBits(bits, pixelsPerDst)];
 | 
						|
            if (fbLane) {
 | 
						|
                fbTransparentSpan(dst, mask & endmask, fgxor, 1);
 | 
						|
            }
 | 
						|
            else {
 | 
						|
                if (mask || !transparent)
 | 
						|
                    FbDoRightMaskByteStippleRRop(dst, mask,
 | 
						|
                                                 fgand, fgxor, bgand, bgxor,
 | 
						|
                                                 endbyte, endmask);
 | 
						|
            }
 | 
						|
        }
 | 
						|
        dst += dstStride;
 | 
						|
        src += srcStride;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * Crufty macros to initialize the mask array, most of this
 | 
						|
 * is to avoid compile-time warnings about shift overflow
 | 
						|
 */
 | 
						|
 | 
						|
#if BITMAP_BIT_ORDER == MSBFirst
 | 
						|
#define Mask24Pos(x,r) ((x)*24-(r))
 | 
						|
#else
 | 
						|
#define Mask24Pos(x,r) ((x)*24-((r) ? 24 - (r) : 0))
 | 
						|
#endif
 | 
						|
 | 
						|
#define Mask24Neg(x,r)	(Mask24Pos(x,r) < 0 ? -Mask24Pos(x,r) : 0)
 | 
						|
#define Mask24Check(x,r)    (Mask24Pos(x,r) < 0 ? 0 : \
 | 
						|
			     Mask24Pos(x,r) >= FB_UNIT ? 0 : Mask24Pos(x,r))
 | 
						|
 | 
						|
#define Mask24(x,r) (Mask24Pos(x,r) < FB_UNIT ? \
 | 
						|
		     (Mask24Pos(x,r) < 0 ? \
 | 
						|
		      0xffffffU >> Mask24Neg (x,r) : \
 | 
						|
		      0xffffffU << Mask24Check(x,r)) : 0)
 | 
						|
 | 
						|
#define SelMask24(b,n,r)	((((b) >> n) & 1) * Mask24(n,r))
 | 
						|
 | 
						|
/*
 | 
						|
 * Untested for MSBFirst or FB_UNIT == 32
 | 
						|
 */
 | 
						|
 | 
						|
#if FB_UNIT == 64
 | 
						|
#define C4_24(b,r) \
 | 
						|
    (SelMask24(b,0,r) | \
 | 
						|
     SelMask24(b,1,r) | \
 | 
						|
     SelMask24(b,2,r) | \
 | 
						|
     SelMask24(b,3,r))
 | 
						|
 | 
						|
#define FbStip24New(rot)    (2 + (rot != 0))
 | 
						|
#define FbStip24Len	    4
 | 
						|
 | 
						|
const FbBits fbStipple24Bits[3][1 << FbStip24Len] = {
 | 
						|
    /* rotate 0 */
 | 
						|
    {
 | 
						|
     C4_24(0, 0), C4_24(1, 0), C4_24(2, 0), C4_24(3, 0),
 | 
						|
     C4_24(4, 0), C4_24(5, 0), C4_24(6, 0), C4_24(7, 0),
 | 
						|
     C4_24(8, 0), C4_24(9, 0), C4_24(10, 0), C4_24(11, 0),
 | 
						|
     C4_24(12, 0), C4_24(13, 0), C4_24(14, 0), C4_24(15, 0),
 | 
						|
     },
 | 
						|
    /* rotate 8 */
 | 
						|
    {
 | 
						|
     C4_24(0, 8), C4_24(1, 8), C4_24(2, 8), C4_24(3, 8),
 | 
						|
     C4_24(4, 8), C4_24(5, 8), C4_24(6, 8), C4_24(7, 8),
 | 
						|
     C4_24(8, 8), C4_24(9, 8), C4_24(10, 8), C4_24(11, 8),
 | 
						|
     C4_24(12, 8), C4_24(13, 8), C4_24(14, 8), C4_24(15, 8),
 | 
						|
     },
 | 
						|
    /* rotate 16 */
 | 
						|
    {
 | 
						|
     C4_24(0, 16), C4_24(1, 16), C4_24(2, 16), C4_24(3, 16),
 | 
						|
     C4_24(4, 16), C4_24(5, 16), C4_24(6, 16), C4_24(7, 16),
 | 
						|
     C4_24(8, 16), C4_24(9, 16), C4_24(10, 16), C4_24(11, 16),
 | 
						|
     C4_24(12, 16), C4_24(13, 16), C4_24(14, 16), C4_24(15, 16),
 | 
						|
     }
 | 
						|
};
 | 
						|
 | 
						|
#endif
 | 
						|
 | 
						|
#if FB_UNIT == 32
 | 
						|
#define C2_24(b,r)  \
 | 
						|
    (SelMask24(b,0,r) | \
 | 
						|
     SelMask24(b,1,r))
 | 
						|
 | 
						|
#define FbStip24Len	    2
 | 
						|
#if BITMAP_BIT_ORDER == MSBFirst
 | 
						|
#define FbStip24New(rot)    (1 + (rot == 0))
 | 
						|
#else
 | 
						|
#define FbStip24New(rot)    (1 + (rot == 8))
 | 
						|
#endif
 | 
						|
 | 
						|
const FbBits fbStipple24Bits[3][1 << FbStip24Len] = {
 | 
						|
    /* rotate 0 */
 | 
						|
    {
 | 
						|
     C2_24(0, 0), C2_24(1, 0), C2_24(2, 0), C2_24(3, 0),
 | 
						|
     },
 | 
						|
    /* rotate 8 */
 | 
						|
    {
 | 
						|
     C2_24(0, 8), C2_24(1, 8), C2_24(2, 8), C2_24(3, 8),
 | 
						|
     },
 | 
						|
    /* rotate 16 */
 | 
						|
    {
 | 
						|
     C2_24(0, 16), C2_24(1, 16), C2_24(2, 16), C2_24(3, 16),
 | 
						|
     }
 | 
						|
};
 | 
						|
#endif
 | 
						|
 | 
						|
#if BITMAP_BIT_ORDER == LSBFirst
 | 
						|
 | 
						|
#define FbMergeStip24Bits(left, right, new) \
 | 
						|
	(FbStipLeft (left, new) | FbStipRight ((right), (FbStip24Len - (new))))
 | 
						|
 | 
						|
#define FbMergePartStip24Bits(left, right, llen, rlen) \
 | 
						|
	(left | FbStipRight(right, llen))
 | 
						|
 | 
						|
#else
 | 
						|
 | 
						|
#define FbMergeStip24Bits(left, right, new) \
 | 
						|
	((FbStipLeft (left, new) & ((1 << FbStip24Len) - 1)) | right)
 | 
						|
 | 
						|
#define FbMergePartStip24Bits(left, right, llen, rlen) \
 | 
						|
	(FbStipLeft(left, rlen) | right)
 | 
						|
 | 
						|
#endif
 | 
						|
 | 
						|
#define fbFirstStipBits(len,stip) {\
 | 
						|
    int	__len = (len); \
 | 
						|
    if (len <= remain) { \
 | 
						|
	stip = FbLeftStipBits(bits, len); \
 | 
						|
    } else { \
 | 
						|
	stip = FbLeftStipBits(bits, remain); \
 | 
						|
	bits = (src < srcEnd ? READ(src++) : 0); \
 | 
						|
	__len = (len) - remain; \
 | 
						|
	stip = FbMergePartStip24Bits(stip, FbLeftStipBits(bits, __len), \
 | 
						|
				     remain, __len); \
 | 
						|
	remain = FB_STIP_UNIT; \
 | 
						|
    } \
 | 
						|
    bits = FbStipLeft (bits, __len); \
 | 
						|
    remain -= __len; \
 | 
						|
}
 | 
						|
 | 
						|
#define fbInitStipBits(offset,len,stip) {\
 | 
						|
    bits = FbStipLeft (READ(src++),offset); \
 | 
						|
    remain = FB_STIP_UNIT - offset; \
 | 
						|
    fbFirstStipBits(len,stip); \
 | 
						|
    stip = FbMergeStip24Bits (0, stip, len); \
 | 
						|
}
 | 
						|
 | 
						|
#define fbNextStipBits(rot,stip) {\
 | 
						|
    int	    __new = FbStip24New(rot); \
 | 
						|
    FbStip  __right; \
 | 
						|
    fbFirstStipBits(__new, __right); \
 | 
						|
    stip = FbMergeStip24Bits (stip, __right, __new); \
 | 
						|
    rot = FbNext24Rot (rot); \
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * Use deep mask tables that incorporate rotation, pull
 | 
						|
 * a variable number of bits out of the stipple and
 | 
						|
 * reuse the right bits as needed for the next write
 | 
						|
 *
 | 
						|
 * Yes, this is probably too much code, but most 24-bpp screens
 | 
						|
 * have no acceleration so this code is used for stipples, copyplane
 | 
						|
 * and text
 | 
						|
 */
 | 
						|
void
 | 
						|
fbBltOne24(FbStip * srcLine, FbStride srcStride,        /* FbStip units per scanline */
 | 
						|
           int srcX,            /* bit position of source */
 | 
						|
           FbBits * dst, FbStride dstStride,    /* FbBits units per scanline */
 | 
						|
           int dstX,            /* bit position of dest */
 | 
						|
           int dstBpp,          /* bits per destination unit */
 | 
						|
           int width,           /* width in bits of destination */
 | 
						|
           int height,          /* height in scanlines */
 | 
						|
           FbBits fgand,        /* rrop values */
 | 
						|
           FbBits fgxor, FbBits bgand, FbBits bgxor)
 | 
						|
{
 | 
						|
    FbStip *src, *srcEnd;
 | 
						|
    FbBits leftMask, rightMask, mask;
 | 
						|
    int nlMiddle, nl;
 | 
						|
    FbStip stip, bits;
 | 
						|
    int remain;
 | 
						|
    int dstS;
 | 
						|
    int firstlen;
 | 
						|
    int rot0, rot;
 | 
						|
    int nDst;
 | 
						|
 | 
						|
    /*
 | 
						|
     * Do not read past the end of the buffer!
 | 
						|
     */
 | 
						|
    srcEnd = srcLine + height * srcStride;
 | 
						|
 | 
						|
    srcLine += srcX >> FB_STIP_SHIFT;
 | 
						|
    dst += dstX >> FB_SHIFT;
 | 
						|
    srcX &= FB_STIP_MASK;
 | 
						|
    dstX &= FB_MASK;
 | 
						|
    rot0 = FbFirst24Rot(dstX);
 | 
						|
 | 
						|
    FbMaskBits(dstX, width, leftMask, nlMiddle, rightMask);
 | 
						|
 | 
						|
    dstS = (dstX + 23) / 24;
 | 
						|
    firstlen = FbStip24Len - dstS;
 | 
						|
 | 
						|
    nDst = nlMiddle;
 | 
						|
    if (leftMask)
 | 
						|
        nDst++;
 | 
						|
    dstStride -= nDst;
 | 
						|
 | 
						|
    /* opaque copy */
 | 
						|
    if (bgand == 0 && fgand == 0) {
 | 
						|
        while (height--) {
 | 
						|
            rot = rot0;
 | 
						|
            src = srcLine;
 | 
						|
            srcLine += srcStride;
 | 
						|
            fbInitStipBits(srcX, firstlen, stip);
 | 
						|
            if (leftMask) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, (READ(dst) & ~leftMask) |
 | 
						|
                      (FbOpaqueStipple(mask,
 | 
						|
                                       FbRot24(fgxor, rot), FbRot24(bgxor, rot))
 | 
						|
                       & leftMask));
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            nl = nlMiddle;
 | 
						|
            while (nl--) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, FbOpaqueStipple(mask,
 | 
						|
                                           FbRot24(fgxor, rot),
 | 
						|
                                           FbRot24(bgxor, rot)));
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            if (rightMask) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, (READ(dst) & ~rightMask) |
 | 
						|
                      (FbOpaqueStipple(mask,
 | 
						|
                                       FbRot24(fgxor, rot), FbRot24(bgxor, rot))
 | 
						|
                       & rightMask));
 | 
						|
            }
 | 
						|
            dst += dstStride;
 | 
						|
            src += srcStride;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    /* transparent copy */
 | 
						|
    else if (bgand == FB_ALLONES && bgxor == 0 && fgand == 0) {
 | 
						|
        while (height--) {
 | 
						|
            rot = rot0;
 | 
						|
            src = srcLine;
 | 
						|
            srcLine += srcStride;
 | 
						|
            fbInitStipBits(srcX, firstlen, stip);
 | 
						|
            if (leftMask) {
 | 
						|
                if (stip) {
 | 
						|
                    mask = fbStipple24Bits[rot >> 3][stip] & leftMask;
 | 
						|
                    WRITE(dst,
 | 
						|
                          (READ(dst) & ~mask) | (FbRot24(fgxor, rot) & mask));
 | 
						|
                }
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            nl = nlMiddle;
 | 
						|
            while (nl--) {
 | 
						|
                if (stip) {
 | 
						|
                    mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                    WRITE(dst,
 | 
						|
                          (READ(dst) & ~mask) | (FbRot24(fgxor, rot) & mask));
 | 
						|
                }
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            if (rightMask) {
 | 
						|
                if (stip) {
 | 
						|
                    mask = fbStipple24Bits[rot >> 3][stip] & rightMask;
 | 
						|
                    WRITE(dst,
 | 
						|
                          (READ(dst) & ~mask) | (FbRot24(fgxor, rot) & mask));
 | 
						|
                }
 | 
						|
            }
 | 
						|
            dst += dstStride;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        while (height--) {
 | 
						|
            rot = rot0;
 | 
						|
            src = srcLine;
 | 
						|
            srcLine += srcStride;
 | 
						|
            fbInitStipBits(srcX, firstlen, stip);
 | 
						|
            if (leftMask) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, FbStippleRRopMask(READ(dst), mask,
 | 
						|
                                             FbRot24(fgand, rot),
 | 
						|
                                             FbRot24(fgxor, rot),
 | 
						|
                                             FbRot24(bgand, rot),
 | 
						|
                                             FbRot24(bgxor, rot), leftMask));
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            nl = nlMiddle;
 | 
						|
            while (nl--) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, FbStippleRRop(READ(dst), mask,
 | 
						|
                                         FbRot24(fgand, rot),
 | 
						|
                                         FbRot24(fgxor, rot),
 | 
						|
                                         FbRot24(bgand, rot),
 | 
						|
                                         FbRot24(bgxor, rot)));
 | 
						|
                dst++;
 | 
						|
                fbNextStipBits(rot, stip);
 | 
						|
            }
 | 
						|
            if (rightMask) {
 | 
						|
                mask = fbStipple24Bits[rot >> 3][stip];
 | 
						|
                WRITE(dst, FbStippleRRopMask(READ(dst), mask,
 | 
						|
                                             FbRot24(fgand, rot),
 | 
						|
                                             FbRot24(fgxor, rot),
 | 
						|
                                             FbRot24(bgand, rot),
 | 
						|
                                             FbRot24(bgxor, rot), rightMask));
 | 
						|
            }
 | 
						|
            dst += dstStride;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * Not very efficient, but simple -- copy a single plane
 | 
						|
 * from an N bit image to a 1 bit image
 | 
						|
 */
 | 
						|
 | 
						|
void
 | 
						|
fbBltPlane(FbBits * src,
 | 
						|
           FbStride srcStride,
 | 
						|
           int srcX,
 | 
						|
           int srcBpp,
 | 
						|
           FbStip * dst,
 | 
						|
           FbStride dstStride,
 | 
						|
           int dstX,
 | 
						|
           int width,
 | 
						|
           int height,
 | 
						|
           FbStip fgand,
 | 
						|
           FbStip fgxor, FbStip bgand, FbStip bgxor, Pixel planeMask)
 | 
						|
{
 | 
						|
    FbBits *s;
 | 
						|
    FbBits pm;
 | 
						|
    FbBits srcMask;
 | 
						|
    FbBits srcMaskFirst;
 | 
						|
    FbBits srcMask0 = 0;
 | 
						|
    FbBits srcBits;
 | 
						|
 | 
						|
    FbStip dstBits;
 | 
						|
    FbStip *d;
 | 
						|
    FbStip dstMask;
 | 
						|
    FbStip dstMaskFirst;
 | 
						|
    FbStip dstUnion;
 | 
						|
    int w;
 | 
						|
    int wt;
 | 
						|
    int rot0;
 | 
						|
 | 
						|
    if (!width)
 | 
						|
        return;
 | 
						|
 | 
						|
    src += srcX >> FB_SHIFT;
 | 
						|
    srcX &= FB_MASK;
 | 
						|
 | 
						|
    dst += dstX >> FB_STIP_SHIFT;
 | 
						|
    dstX &= FB_STIP_MASK;
 | 
						|
 | 
						|
    w = width / srcBpp;
 | 
						|
 | 
						|
    pm = fbReplicatePixel(planeMask, srcBpp);
 | 
						|
    if (srcBpp == 24) {
 | 
						|
        int tmpw = 24;
 | 
						|
 | 
						|
        rot0 = FbFirst24Rot(srcX);
 | 
						|
        if (srcX + tmpw > FB_UNIT)
 | 
						|
            tmpw = FB_UNIT - srcX;
 | 
						|
        srcMaskFirst = FbRot24(pm, rot0) & FbBitsMask(srcX, tmpw);
 | 
						|
    }
 | 
						|
    else {
 | 
						|
        rot0 = 0;
 | 
						|
        srcMaskFirst = pm & FbBitsMask(srcX, srcBpp);
 | 
						|
        srcMask0 = pm & FbBitsMask(0, srcBpp);
 | 
						|
    }
 | 
						|
 | 
						|
    dstMaskFirst = FbStipMask(dstX, 1);
 | 
						|
    while (height--) {
 | 
						|
        d = dst;
 | 
						|
        dst += dstStride;
 | 
						|
        s = src;
 | 
						|
        src += srcStride;
 | 
						|
 | 
						|
        srcMask = srcMaskFirst;
 | 
						|
        if (srcBpp == 24)
 | 
						|
            srcMask0 = FbRot24(pm, rot0) & FbBitsMask(0, srcBpp);
 | 
						|
        srcBits = READ(s++);
 | 
						|
 | 
						|
        dstMask = dstMaskFirst;
 | 
						|
        dstUnion = 0;
 | 
						|
        dstBits = 0;
 | 
						|
 | 
						|
        wt = w;
 | 
						|
 | 
						|
        while (wt--) {
 | 
						|
            if (!srcMask) {
 | 
						|
                srcBits = READ(s++);
 | 
						|
                if (srcBpp == 24)
 | 
						|
                    srcMask0 = FbNext24Pix(srcMask0) & FbBitsMask(0, 24);
 | 
						|
                srcMask = srcMask0;
 | 
						|
            }
 | 
						|
            if (!dstMask) {
 | 
						|
                WRITE(d, FbStippleRRopMask(READ(d), dstBits,
 | 
						|
                                           fgand, fgxor, bgand, bgxor,
 | 
						|
                                           dstUnion));
 | 
						|
                d++;
 | 
						|
                dstMask = FbStipMask(0, 1);
 | 
						|
                dstUnion = 0;
 | 
						|
                dstBits = 0;
 | 
						|
            }
 | 
						|
            if (srcBits & srcMask)
 | 
						|
                dstBits |= dstMask;
 | 
						|
            dstUnion |= dstMask;
 | 
						|
            if (srcBpp == FB_UNIT)
 | 
						|
                srcMask = 0;
 | 
						|
            else
 | 
						|
                srcMask = FbScrRight(srcMask, srcBpp);
 | 
						|
            dstMask = FbStipRight(dstMask, 1);
 | 
						|
        }
 | 
						|
        if (dstUnion)
 | 
						|
            WRITE(d, FbStippleRRopMask(READ(d), dstBits,
 | 
						|
                                       fgand, fgxor, bgand, bgxor, dstUnion));
 | 
						|
    }
 | 
						|
}
 |