cachepc-qemu

Fork of AMDESE/qemu with changes for cachepc side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-qemu
Log | Files | Refs | Submodules | LICENSE | sfeed.txt

cirrus_vga_rop2.h (8493B)


      1/*
      2 * QEMU Cirrus CLGD 54xx VGA Emulator.
      3 *
      4 * Copyright (c) 2004 Fabrice Bellard
      5 *
      6 * Permission is hereby granted, free of charge, to any person obtaining a copy
      7 * of this software and associated documentation files (the "Software"), to deal
      8 * in the Software without restriction, including without limitation the rights
      9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
     10 * copies of the Software, and to permit persons to whom the Software is
     11 * furnished to do so, subject to the following conditions:
     12 *
     13 * The above copyright notice and this permission notice shall be included in
     14 * all copies or substantial portions of the Software.
     15 *
     16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
     19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
     20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
     21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
     22 * THE SOFTWARE.
     23 */
     24
     25#if DEPTH == 8
     26#define PUTPIXEL(s, a, c)    ROP_OP(s, a, c)
     27#elif DEPTH == 16
     28#define PUTPIXEL(s, a, c)    ROP_OP_16(s, a, c)
     29#elif DEPTH == 24
     30#define PUTPIXEL(s, a, c)    do {          \
     31        ROP_OP(s, a,     c);               \
     32        ROP_OP(s, a + 1, (c >> 8));        \
     33        ROP_OP(s, a + 2, (c >> 16));       \
     34    } while (0)
     35#elif DEPTH == 32
     36#define PUTPIXEL(s, a, c)    ROP_OP_32(s, a, c)
     37#else
     38#error unsupported DEPTH
     39#endif
     40
     41static void
     42glue(glue(glue(cirrus_patternfill_, ROP_NAME), _),DEPTH)
     43     (CirrusVGAState *s, uint32_t dstaddr,
     44      uint32_t srcaddr,
     45      int dstpitch, int srcpitch,
     46      int bltwidth, int bltheight)
     47{
     48    uint32_t addr;
     49    int x, y, pattern_y, pattern_pitch, pattern_x;
     50    unsigned int col;
     51    uint32_t src1addr;
     52#if DEPTH == 24
     53    int skipleft = s->vga.gr[0x2f] & 0x1f;
     54#else
     55    int skipleft = (s->vga.gr[0x2f] & 0x07) * (DEPTH / 8);
     56#endif
     57
     58#if DEPTH == 8
     59    pattern_pitch = 8;
     60#elif DEPTH == 16
     61    pattern_pitch = 16;
     62#else
     63    pattern_pitch = 32;
     64#endif
     65    pattern_y = s->cirrus_blt_srcaddr & 7;
     66    for(y = 0; y < bltheight; y++) {
     67        pattern_x = skipleft;
     68        addr = dstaddr + skipleft;
     69        src1addr = srcaddr + pattern_y * pattern_pitch;
     70        for (x = skipleft; x < bltwidth; x += (DEPTH / 8)) {
     71#if DEPTH == 8
     72            col = cirrus_src(s, src1addr + pattern_x);
     73            pattern_x = (pattern_x + 1) & 7;
     74#elif DEPTH == 16
     75            col = cirrus_src16(s, src1addr + pattern_x);
     76            pattern_x = (pattern_x + 2) & 15;
     77#elif DEPTH == 24
     78            {
     79                uint32_t src2addr = src1addr + pattern_x * 3;
     80                col = cirrus_src(s, src2addr) |
     81                    (cirrus_src(s, src2addr + 1) << 8) |
     82                    (cirrus_src(s, src2addr + 2) << 16);
     83                pattern_x = (pattern_x + 1) & 7;
     84            }
     85#else
     86            col = cirrus_src32(s, src1addr + pattern_x);
     87            pattern_x = (pattern_x + 4) & 31;
     88#endif
     89            PUTPIXEL(s, addr, col);
     90            addr += (DEPTH / 8);
     91        }
     92        pattern_y = (pattern_y + 1) & 7;
     93        dstaddr += dstpitch;
     94    }
     95}
     96
     97/* NOTE: srcpitch is ignored */
     98static void
     99glue(glue(glue(cirrus_colorexpand_transp_, ROP_NAME), _),DEPTH)
    100     (CirrusVGAState *s, uint32_t dstaddr,
    101      uint32_t srcaddr,
    102      int dstpitch, int srcpitch,
    103      int bltwidth, int bltheight)
    104{
    105    uint32_t addr;
    106    int x, y;
    107    unsigned bits, bits_xor;
    108    unsigned int col;
    109    unsigned bitmask;
    110    unsigned index;
    111#if DEPTH == 24
    112    int dstskipleft = s->vga.gr[0x2f] & 0x1f;
    113    int srcskipleft = dstskipleft / 3;
    114#else
    115    int srcskipleft = s->vga.gr[0x2f] & 0x07;
    116    int dstskipleft = srcskipleft * (DEPTH / 8);
    117#endif
    118
    119    if (s->cirrus_blt_modeext & CIRRUS_BLTMODEEXT_COLOREXPINV) {
    120        bits_xor = 0xff;
    121        col = s->cirrus_blt_bgcol;
    122    } else {
    123        bits_xor = 0x00;
    124        col = s->cirrus_blt_fgcol;
    125    }
    126
    127    for(y = 0; y < bltheight; y++) {
    128        bitmask = 0x80 >> srcskipleft;
    129        bits = cirrus_src(s, srcaddr++) ^ bits_xor;
    130        addr = dstaddr + dstskipleft;
    131        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {
    132            if ((bitmask & 0xff) == 0) {
    133                bitmask = 0x80;
    134                bits = cirrus_src(s, srcaddr++) ^ bits_xor;
    135            }
    136            index = (bits & bitmask);
    137            if (index) {
    138                PUTPIXEL(s, addr, col);
    139            }
    140            addr += (DEPTH / 8);
    141            bitmask >>= 1;
    142        }
    143        dstaddr += dstpitch;
    144    }
    145}
    146
    147static void
    148glue(glue(glue(cirrus_colorexpand_, ROP_NAME), _),DEPTH)
    149     (CirrusVGAState *s, uint32_t dstaddr,
    150      uint32_t srcaddr,
    151      int dstpitch, int srcpitch,
    152      int bltwidth, int bltheight)
    153{
    154    uint32_t colors[2];
    155    uint32_t addr;
    156    int x, y;
    157    unsigned bits;
    158    unsigned int col;
    159    unsigned bitmask;
    160    int srcskipleft = s->vga.gr[0x2f] & 0x07;
    161    int dstskipleft = srcskipleft * (DEPTH / 8);
    162
    163    colors[0] = s->cirrus_blt_bgcol;
    164    colors[1] = s->cirrus_blt_fgcol;
    165    for(y = 0; y < bltheight; y++) {
    166        bitmask = 0x80 >> srcskipleft;
    167        bits = cirrus_src(s, srcaddr++);
    168        addr = dstaddr + dstskipleft;
    169        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {
    170            if ((bitmask & 0xff) == 0) {
    171                bitmask = 0x80;
    172                bits = cirrus_src(s, srcaddr++);
    173            }
    174            col = colors[!!(bits & bitmask)];
    175            PUTPIXEL(s, addr, col);
    176            addr += (DEPTH / 8);
    177            bitmask >>= 1;
    178        }
    179        dstaddr += dstpitch;
    180    }
    181}
    182
    183static void
    184glue(glue(glue(cirrus_colorexpand_pattern_transp_, ROP_NAME), _),DEPTH)
    185     (CirrusVGAState *s, uint32_t dstaddr,
    186      uint32_t srcaddr,
    187      int dstpitch, int srcpitch,
    188      int bltwidth, int bltheight)
    189{
    190    uint32_t addr;
    191    int x, y, bitpos, pattern_y;
    192    unsigned int bits, bits_xor;
    193    unsigned int col;
    194#if DEPTH == 24
    195    int dstskipleft = s->vga.gr[0x2f] & 0x1f;
    196    int srcskipleft = dstskipleft / 3;
    197#else
    198    int srcskipleft = s->vga.gr[0x2f] & 0x07;
    199    int dstskipleft = srcskipleft * (DEPTH / 8);
    200#endif
    201
    202    if (s->cirrus_blt_modeext & CIRRUS_BLTMODEEXT_COLOREXPINV) {
    203        bits_xor = 0xff;
    204        col = s->cirrus_blt_bgcol;
    205    } else {
    206        bits_xor = 0x00;
    207        col = s->cirrus_blt_fgcol;
    208    }
    209    pattern_y = s->cirrus_blt_srcaddr & 7;
    210
    211    for(y = 0; y < bltheight; y++) {
    212        bits = cirrus_src(s, srcaddr + pattern_y) ^ bits_xor;
    213        bitpos = 7 - srcskipleft;
    214        addr = dstaddr + dstskipleft;
    215        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {
    216            if ((bits >> bitpos) & 1) {
    217                PUTPIXEL(s, addr, col);
    218            }
    219            addr += (DEPTH / 8);
    220            bitpos = (bitpos - 1) & 7;
    221        }
    222        pattern_y = (pattern_y + 1) & 7;
    223        dstaddr += dstpitch;
    224    }
    225}
    226
    227static void
    228glue(glue(glue(cirrus_colorexpand_pattern_, ROP_NAME), _),DEPTH)
    229     (CirrusVGAState *s, uint32_t dstaddr,
    230      uint32_t srcaddr,
    231      int dstpitch, int srcpitch,
    232      int bltwidth, int bltheight)
    233{
    234    uint32_t colors[2];
    235    uint32_t addr;
    236    int x, y, bitpos, pattern_y;
    237    unsigned int bits;
    238    unsigned int col;
    239    int srcskipleft = s->vga.gr[0x2f] & 0x07;
    240    int dstskipleft = srcskipleft * (DEPTH / 8);
    241
    242    colors[0] = s->cirrus_blt_bgcol;
    243    colors[1] = s->cirrus_blt_fgcol;
    244    pattern_y = s->cirrus_blt_srcaddr & 7;
    245
    246    for(y = 0; y < bltheight; y++) {
    247        bits = cirrus_src(s, srcaddr + pattern_y);
    248        bitpos = 7 - srcskipleft;
    249        addr = dstaddr + dstskipleft;
    250        for (x = dstskipleft; x < bltwidth; x += (DEPTH / 8)) {
    251            col = colors[(bits >> bitpos) & 1];
    252            PUTPIXEL(s, addr, col);
    253            addr += (DEPTH / 8);
    254            bitpos = (bitpos - 1) & 7;
    255        }
    256        pattern_y = (pattern_y + 1) & 7;
    257        dstaddr += dstpitch;
    258    }
    259}
    260
    261static void
    262glue(glue(glue(cirrus_fill_, ROP_NAME), _),DEPTH)
    263     (CirrusVGAState *s,
    264      uint32_t dstaddr, int dst_pitch,
    265      int width, int height)
    266{
    267    uint32_t addr;
    268    uint32_t col;
    269    int x, y;
    270
    271    col = s->cirrus_blt_fgcol;
    272
    273    for(y = 0; y < height; y++) {
    274        addr = dstaddr;
    275        for(x = 0; x < width; x += (DEPTH / 8)) {
    276            PUTPIXEL(s, addr, col);
    277            addr += (DEPTH / 8);
    278        }
    279        dstaddr += dst_pitch;
    280    }
    281}
    282
    283#undef DEPTH
    284#undef PUTPIXEL