hw/display/pl110_template.h

   1 /*
   2  * Arm PrimeCell PL110 Color LCD Controller
   3  *
   4  * Copyright (c) 2005 CodeSourcery, LLC.
   5  * Written by Paul Brook
   6  *
   7  * This code is licensed under the GNU LGPL
   8  *
   9  * Framebuffer format conversion routines.
  10  */
  11
  12 #ifndef ORDER
  13 #error "pl110_template.h is only for inclusion by pl110.c"
  14 #endif
  15
  16 #if ORDER == 0
  17 #define NAME glue(lblp_, BORDER)
  18 #ifdef HOST_WORDS_BIGENDIAN
  19 #define SWAP_WORDS 1
  20 #endif
  21 #elif ORDER == 1
  22 #define NAME glue(bbbp_, BORDER)
  23 #ifndef HOST_WORDS_BIGENDIAN
  24 #define SWAP_WORDS 1
  25 #endif
  26 #else
  27 #define SWAP_PIXELS 1
  28 #define NAME glue(lbbp_, BORDER)
  29 #ifdef HOST_WORDS_BIGENDIAN
  30 #define SWAP_WORDS 1
  31 #endif
  32 #endif
  33
  34 #define FN_2(x, y) FN(x, y) FN(x+1, y)
  35 #define FN_4(x, y) FN_2(x, y) FN_2(x+2, y)
  36 #define FN_8(y) FN_4(0, y) FN_4(4, y)
  37
  38 static void glue(pl110_draw_line1_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
  39 {
  40     uint32_t *palette = opaque;
  41     uint32_t data;
  42     while (width > 0) {
  43         data = *(uint32_t *)src;
  44 #ifdef SWAP_PIXELS
  45 #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 7 - (x))) & 1]);
  46 #else
  47 #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x) + y)) & 1]);
  48 #endif
  49 #ifdef SWAP_WORDS
  50         FN_8(24)
  51         FN_8(16)
  52         FN_8(8)
  53         FN_8(0)
  54 #else
  55         FN_8(0)
  56         FN_8(8)
  57         FN_8(16)
  58         FN_8(24)
  59 #endif
  60 #undef FN
  61         width -= 32;
  62         src += 4;
  63     }
  64 }
  65
  66 static void glue(pl110_draw_line2_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
  67 {
  68     uint32_t *palette = opaque;
  69     uint32_t data;
  70     while (width > 0) {
  71         data = *(uint32_t *)src;
  72 #ifdef SWAP_PIXELS
  73 #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 6 - (x)*2)) & 3]);
  74 #else
  75 #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*2 + y)) & 3]);
  76 #endif
  77 #ifdef SWAP_WORDS
  78         FN_4(0, 24)
  79         FN_4(0, 16)
  80         FN_4(0, 8)
  81         FN_4(0, 0)
  82 #else
  83         FN_4(0, 0)
  84         FN_4(0, 8)
  85         FN_4(0, 16)
  86         FN_4(0, 24)
  87 #endif
  88 #undef FN
  89         width -= 16;
  90         src += 4;
  91     }
  92 }
  93
  94 static void glue(pl110_draw_line4_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
  95 {
  96     uint32_t *palette = opaque;
  97     uint32_t data;
  98     while (width > 0) {
  99         data = *(uint32_t *)src;
 100 #ifdef SWAP_PIXELS
 101 #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 4 - (x)*4)) & 0xf]);
 102 #else
 103 #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*4 + y)) & 0xf]);
 104 #endif
 105 #ifdef SWAP_WORDS
 106         FN_2(0, 24)
 107         FN_2(0, 16)
 108         FN_2(0, 8)
 109         FN_2(0, 0)
 110 #else
 111         FN_2(0, 0)
 112         FN_2(0, 8)
 113         FN_2(0, 16)
 114         FN_2(0, 24)
 115 #endif
 116 #undef FN
 117         width -= 8;
 118         src += 4;
 119     }
 120 }
 121
 122 static void glue(pl110_draw_line8_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 123 {
 124     uint32_t *palette = opaque;
 125     uint32_t data;
 126     while (width > 0) {
 127         data = *(uint32_t *)src;
 128 #define FN(x) COPY_PIXEL(d, palette[(data >> (x)) & 0xff]);
 129 #ifdef SWAP_WORDS
 130         FN(24)
 131         FN(16)
 132         FN(8)
 133         FN(0)
 134 #else
 135         FN(0)
 136         FN(8)
 137         FN(16)
 138         FN(24)
 139 #endif
 140 #undef FN
 141         width -= 4;
 142         src += 4;
 143     }
 144 }
 145
 146 static void glue(pl110_draw_line16_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 147 {
 148     uint32_t data;
 149     unsigned int r, g, b;
 150     while (width > 0) {
 151         data = *(uint32_t *)src;
 152 #ifdef SWAP_WORDS
 153         data = bswap32(data);
 154 #endif
 155 #ifdef RGB
 156 #define LSB r
 157 #define MSB b
 158 #else
 159 #define LSB b
 160 #define MSB r
 161 #endif
 162 #if 0
 163         LSB = data & 0x1f;
 164         data >>= 5;
 165         g = data & 0x3f;
 166         data >>= 6;
 167         MSB = data & 0x1f;
 168         data >>= 5;
 169 #else
 170         LSB = (data & 0x1f) << 3;
 171         data >>= 5;
 172         g = (data & 0x3f) << 2;
 173         data >>= 6;
 174         MSB = (data & 0x1f) << 3;
 175         data >>= 5;
 176 #endif
 177         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 178         LSB = (data & 0x1f) << 3;
 179         data >>= 5;
 180         g = (data & 0x3f) << 2;
 181         data >>= 6;
 182         MSB = (data & 0x1f) << 3;
 183         data >>= 5;
 184         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 185 #undef MSB
 186 #undef LSB
 187         width -= 2;
 188         src += 4;
 189     }
 190 }
 191
 192 static void glue(pl110_draw_line32_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 193 {
 194     uint32_t data;
 195     unsigned int r, g, b;
 196     while (width > 0) {
 197         data = *(uint32_t *)src;
 198 #ifdef RGB
 199 #define LSB r
 200 #define MSB b
 201 #else
 202 #define LSB b
 203 #define MSB r
 204 #endif
 205 #ifndef SWAP_WORDS
 206         LSB = data & 0xff;
 207         g = (data >> 8) & 0xff;
 208         MSB = (data >> 16) & 0xff;
 209 #else
 210         LSB = (data >> 24) & 0xff;
 211         g = (data >> 16) & 0xff;
 212         MSB = (data >> 8) & 0xff;
 213 #endif
 214         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 215 #undef MSB
 216 #undef LSB
 217         width--;
 218         src += 4;
 219     }
 220 }
 221
 222 static void glue(pl110_draw_line16_555_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 223 {
 224     /* RGB 555 plus an intensity bit (which we ignore) */
 225     uint32_t data;
 226     unsigned int r, g, b;
 227     while (width > 0) {
 228         data = *(uint32_t *)src;
 229 #ifdef SWAP_WORDS
 230         data = bswap32(data);
 231 #endif
 232 #ifdef RGB
 233 #define LSB r
 234 #define MSB b
 235 #else
 236 #define LSB b
 237 #define MSB r
 238 #endif
 239         LSB = (data & 0x1f) << 3;
 240         data >>= 5;
 241         g = (data & 0x1f) << 3;
 242         data >>= 5;
 243         MSB = (data & 0x1f) << 3;
 244         data >>= 5;
 245         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 246         LSB = (data & 0x1f) << 3;
 247         data >>= 5;
 248         g = (data & 0x1f) << 3;
 249         data >>= 5;
 250         MSB = (data & 0x1f) << 3;
 251         data >>= 6;
 252         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 253 #undef MSB
 254 #undef LSB
 255         width -= 2;
 256         src += 4;
 257     }
 258 }
 259
 260 static void glue(pl110_draw_line12_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 261 {
 262     /* RGB 444 with 4 bits of zeroes at the top of each halfword */
 263     uint32_t data;
 264     unsigned int r, g, b;
 265     while (width > 0) {
 266         data = *(uint32_t *)src;
 267 #ifdef SWAP_WORDS
 268         data = bswap32(data);
 269 #endif
 270 #ifdef RGB
 271 #define LSB r
 272 #define MSB b
 273 #else
 274 #define LSB b
 275 #define MSB r
 276 #endif
 277         LSB = (data & 0xf) << 4;
 278         data >>= 4;
 279         g = (data & 0xf) << 4;
 280         data >>= 4;
 281         MSB = (data & 0xf) << 4;
 282         data >>= 8;
 283         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 284         LSB = (data & 0xf) << 4;
 285         data >>= 4;
 286         g = (data & 0xf) << 4;
 287         data >>= 4;
 288         MSB = (data & 0xf) << 4;
 289         data >>= 8;
 290         COPY_PIXEL(d, rgb_to_pixel32(r, g, b));
 291 #undef MSB
 292 #undef LSB
 293         width -= 2;
 294         src += 4;
 295     }
 296 }
 297
 298 #undef SWAP_PIXELS
 299 #undef NAME
 300 #undef SWAP_WORDS
 301 #undef ORDER