/* * QEMU Cirrus CLGD 54xx VGA Emulator. * * Copyright (c) 2004 Fabrice Bellard * * Permission is hereby granted, free of charge, to any person obtaining a copy * of this software and associated documentation files (the "Software"), to deal * in the Software without restriction, including without limitation the rights * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell * copies of the Software, and to permit persons to whom the Software is * furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in * all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN * THE SOFTWARE. */#if DEPTH == 8#define PUTPIXEL()    ROP_OP(d[0], col)#elif DEPTH == 16#define PUTPIXEL()    ROP_OP(((uint16_t *)d)[0], col);#elif DEPTH == 24#define PUTPIXEL()    ROP_OP(d[0], col); \                      ROP_OP(d[1], (col >> 8)); \                      ROP_OP(d[2], (col >> 16))#elif DEPTH == 32#define PUTPIXEL()    ROP_OP(((uint32_t *)d)[0], col)#else#error unsupported DEPTH#endifstatic voidglue(glue(glue(cirrus_patternfill_, ROP_NAME), _),DEPTH)     (CirrusVGAState * s, uint8_t * dst,      const uint8_t * src,      int dstpitch, int srcpitch,      int bltwidth, int bltheight){    uint8_t *d;    int x, y, pattern_y, pattern_pitch, pattern_x;    unsigned int col;    const uint8_t *src1;#if DEPTH == 24    int skipleft = s->gr[0x2f] & 0x1f;#else    int skipleft = (s->gr[0x2f] & 0x07) * (DEPTH / 8);#endif#if DEPTH == 8    pattern_pitch = 8;#elif DEPTH == 16    pattern_pitch = 16;#else    pattern_pitch = 32;#endif    pattern_y = s->cirrus_blt_srcaddr & 7;    for(y = 0; y < bltheight; y++) {        pattern_x = skipleft;        d = dst + skipleft;        src1 = src + pattern_y * pattern_pitch;        for (x = skipleft; x < bltwidth; x += (DEPTH / 8)) {#if DEPTH == 8            col = src1[pattern_x];            pattern_x = (pattern_x + 1) & 7;#elif DEPTH == 16            col = ((uint16_t *)(src1 + pattern_x))[0];            pattern_x = (pattern_x + 2) & 15;#elif DEPTH == 24            {                const uint8_t *src2 = src1 + pattern_x * 3;                col = src2[0] | (src2[1] << 8) | (src2[2] << 16);                pattern_x = (pattern_x + 1) & 7;            }#else            col = ((uint32_t *)(src1 + pattern_x))[0];            pattern_x = (pattern_x + 4) & 31;#endif            PUTPIXEL();            d += (DEPTH / 8);        }        pattern_y = (pattern_y + 1) & 7;        dst += dstpitch;    }}/* NOTE: srcpitch is ignored */static voidglue(glue(glue(cirrus_colorexpand_transp_, ROP_NAME), _),DEPTH)     (CirrusVGAState * s, uint8_t * dst,      const uint8_t * src,      int dstpitch, int srcpitch,      int bltwidth, int bltheight){    uint8_t *d;    int x, y;    unsigned bits, bits_xor;    unsigned int col;    unsigned bitmask;    unsigned index;#if DEPTH == 24    int dstskipleft = s->gr[0x2f] & 0x1f;    int srcskipleft = dstskipleft / 3;#else    int srcskipleft = s->gr[0x2f] & 0x07;    int dstskipleft = srcskipleft * (DEPTH / 8);#endif    if (s->cirrus_blt_modeext & CIRRUS_BLTMODEEXT_COLOREXPINV) {        bits_xor = 0xff;        col = s->cirrus_blt_bgcol;    } else {        bits_xor = 0x00;        col = s->cirrus_blt_fgcol;    }    for(y = 0; y < bltheight; y++) {        bitmask = 0x80 >> srcskipleft;        bits = *src++ ^ bits_xor;        d = dst + dstskipleft;        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {            if ((bitmask & 0xff) == 0) {                bitmask = 0x80;                bits = *src++ ^ bits_xor;            }            index = (bits & bitmask);            if (index) {                PUTPIXEL();            }            d += (DEPTH / 8);            bitmask >>= 1;        }        dst += dstpitch;    }}static voidglue(glue(glue(cirrus_colorexpand_, ROP_NAME), _),DEPTH)     (CirrusVGAState * s, uint8_t * dst,      const uint8_t * src,      int dstpitch, int srcpitch,      int bltwidth, int bltheight){    uint32_t colors[2];    uint8_t *d;    int x, y;    unsigned bits;    unsigned int col;    unsigned bitmask;    int srcskipleft = s->gr[0x2f] & 0x07;    int dstskipleft = srcskipleft * (DEPTH / 8);    colors[0] = s->cirrus_blt_bgcol;    colors[1] = s->cirrus_blt_fgcol;    for(y = 0; y < bltheight; y++) {        bitmask = 0x80 >> srcskipleft;        bits = *src++;        d = dst + dstskipleft;        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {            if ((bitmask & 0xff) == 0) {                bitmask = 0x80;                bits = *src++;            }            col = colors[!!(bits & bitmask)];            PUTPIXEL();            d += (DEPTH / 8);            bitmask >>= 1;        }        dst += dstpitch;    }}static voidglue(glue(glue(cirrus_colorexpand_pattern_transp_, ROP_NAME), _),DEPTH)     (CirrusVGAState * s, uint8_t * dst,      const uint8_t * src,      int dstpitch, int srcpitch,      int bltwidth, int bltheight){    uint8_t *d;    int x, y, bitpos, pattern_y;    unsigned int bits, bits_xor;    unsigned int col;#if DEPTH == 24    int dstskipleft = s->gr[0x2f] & 0x1f;    int srcskipleft = dstskipleft / 3;#else    int srcskipleft = s->gr[0x2f] & 0x07;    int dstskipleft = srcskipleft * (DEPTH / 8);#endif    if (s->cirrus_blt_modeext & CIRRUS_BLTMODEEXT_COLOREXPINV) {        bits_xor = 0xff;        col = s->cirrus_blt_bgcol;    } else {        bits_xor = 0x00;        col = s->cirrus_blt_fgcol;    }    pattern_y = s->cirrus_blt_srcaddr & 7;    for(y = 0; y < bltheight; y++) {        bits = src[pattern_y] ^ bits_xor;        bitpos = 7 - srcskipleft;        d = dst + dstskipleft;        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {            if ((bits >> bitpos) & 1) {                PUTPIXEL();            }            d += (DEPTH / 8);            bitpos = (bitpos - 1) & 7;        }        pattern_y = (pattern_y + 1) & 7;        dst += dstpitch;    }}static voidglue(glue(glue(cirrus_colorexpand_pattern_, ROP_NAME), _),DEPTH)     (CirrusVGAState * s, uint8_t * dst,      const uint8_t * src,      int dstpitch, int srcpitch,      int bltwidth, int bltheight){    uint32_t colors[2];    uint8_t *d;    int x, y, bitpos, pattern_y;    unsigned int bits;    unsigned int col;    int srcskipleft = s->gr[0x2f] & 0x07;    int dstskipleft = srcskipleft * (DEPTH / 8);    colors[0] = s->cirrus_blt_bgcol;    colors[1] = s->cirrus_blt_fgcol;    pattern_y = s->cirrus_blt_srcaddr & 7;    for(y = 0; y < bltheight; y++) {        bits = src[pattern_y];        bitpos = 7 - srcskipleft;        d = dst + dstskipleft;        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {            col = colors[(bits >> bitpos) & 1];            PUTPIXEL();            d += (DEPTH / 8);            bitpos = (bitpos - 1) & 7;        }        pattern_y = (pattern_y + 1) & 7;        dst += dstpitch;    }}static voidglue(glue(glue(cirrus_fill_, ROP_NAME), _),DEPTH)     (CirrusVGAState *s,      uint8_t *dst, int dst_pitch,      int width, int height){    uint8_t *d, *d1;    uint32_t col;    int x, y;    col = s->cirrus_blt_fgcol;    d1 = dst;    for(y = 0; y < height; y++) {        d = d1;        for(x = 0; x < width; x += (DEPTH / 8)) {            PUTPIXEL();            d += (DEPTH / 8);        }        d1 += dst_pitch;    }}#undef DEPTH#undef PUTPIXEL