hw/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 licenced under the GNU LGPL
   8  *
   9  * Framebuffer format conversion routines.
  10  */
  11
  12 #ifndef ORDER
  13
  14 #if BITS == 8
  15 #define COPY_PIXEL(to, from) *(to++) = from
  16 #elif BITS == 15 || BITS == 16
  17 #define COPY_PIXEL(to, from) *(uint16_t *)to = from; to += 2;
  18 #elif BITS == 24
  19 #define COPY_PIXEL(to, from) \
  20   *(to++) = from; *(to++) = (from) >> 8; *(to++) = (from) >> 16
  21 #elif BITS == 32
  22 #define COPY_PIXEL(to, from) *(uint32_t *)to = from; to += 4;
  23 #else
  24 #error unknown bit depth
  25 #endif
  26
  27 #define ORDER 0
  28 #include "pl110_template.h"
  29 #define ORDER 1
  30 #include "pl110_template.h"
  31 #define ORDER 2
  32 #include "pl110_template.h"
  33
  34 static drawfn glue(pl110_draw_fn_,BITS)[18] =
  35 {
  36     glue(pl110_draw_line1_lblp,BITS),
  37     glue(pl110_draw_line2_lblp,BITS),
  38     glue(pl110_draw_line4_lblp,BITS),
  39     glue(pl110_draw_line8_lblp,BITS),
  40     glue(pl110_draw_line16_lblp,BITS),
  41     glue(pl110_draw_line32_lblp,BITS),
  42
  43     glue(pl110_draw_line1_bbbp,BITS),
  44     glue(pl110_draw_line2_bbbp,BITS),
  45     glue(pl110_draw_line4_bbbp,BITS),
  46     glue(pl110_draw_line8_bbbp,BITS),
  47     glue(pl110_draw_line16_bbbp,BITS),
  48     glue(pl110_draw_line32_bbbp,BITS),
  49
  50     glue(pl110_draw_line1_lbbp,BITS),
  51     glue(pl110_draw_line2_lbbp,BITS),
  52     glue(pl110_draw_line4_lbbp,BITS),
  53     glue(pl110_draw_line8_lbbp,BITS),
  54     glue(pl110_draw_line16_lbbp,BITS),
  55     glue(pl110_draw_line32_lbbp,BITS)
  56 };
  57
  58 #undef BITS
  59 #undef COPY_PIXEL
  60
  61 #else
  62
  63 #if ORDER == 0
  64 #define NAME glue(lblp, BITS)
  65 #ifdef WORDS_BIGENDIAN
  66 #define SWAP_WORDS 1
  67 #endif
  68 #elif ORDER == 1
  69 #define NAME glue(bbbp, BITS)
  70 #ifndef WORDS_BIGENDIAN
  71 #define SWAP_WORDS 1
  72 #endif
  73 #else
  74 #define SWAP_PIXELS 1
  75 #define NAME glue(lbbp, BITS)
  76 #ifdef WORDS_BIGENDIAN
  77 #define SWAP_WORDS 1
  78 #endif
  79 #endif
  80
  81 #define FN_2(x, y) FN(x, y) FN(x+1, y)
  82 #define FN_4(x, y) FN_2(x, y) FN_2(x+1, y)
  83 #define FN_8(y) FN_4(0, y) FN_4(4, y)
  84
  85 static void glue(pl110_draw_line1_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
  86 {
  87     uint32_t data;
  88     while (width > 0) {
  89         data = *(uint32_t *)src;
  90 #ifdef SWAP_PIXELS
  91 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 7 - (x))) & 1]);
  92 #else
  93 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x) + y)) & 1]);
  94 #endif
  95 #ifdef SWAP_WORDS
  96         FN_8(24)
  97         FN_8(16)
  98         FN_8(8)
  99         FN_8(0)
 100 #else
 101         FN_8(0)
 102         FN_8(8)
 103         FN_8(16)
 104         FN_8(24)
 105 #endif
 106 #undef FN
 107         width -= 32;
 108         src += 4;
 109     }
 110 }
 111
 112 static void glue(pl110_draw_line2_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
 113 {
 114     uint32_t data;
 115     while (width > 0) {
 116         data = *(uint32_t *)src;
 117 #ifdef SWAP_PIXELS
 118 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 6 - (x)*2)) & 3]);
 119 #else
 120 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x)*2 + y)) & 3]);
 121 #endif
 122 #ifdef SWAP_WORDS
 123         FN_4(0, 24)
 124         FN_4(0, 16)
 125         FN_4(0, 8)
 126         FN_4(0, 0)
 127 #else
 128         FN_4(0, 0)
 129         FN_4(0, 8)
 130         FN_4(0, 16)
 131         FN_4(0, 24)
 132 #endif
 133 #undef FN
 134         width -= 16;
 135         src += 4;
 136     }
 137 }
 138
 139 static void glue(pl110_draw_line4_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
 140 {
 141     uint32_t data;
 142     while (width > 0) {
 143         data = *(uint32_t *)src;
 144 #ifdef SWAP_PIXELS
 145 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 4 - (x)*4)) & 0xf]);
 146 #else
 147 #define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x)*4 + y)) & 0xf]);
 148 #endif
 149 #ifdef SWAP_WORDS
 150         FN_2(0, 24)
 151         FN_2(0, 16)
 152         FN_2(0, 8)
 153         FN_2(0, 0)
 154 #else
 155         FN_2(0, 0)
 156         FN_2(0, 8)
 157         FN_2(0, 16)
 158         FN_2(0, 24)
 159 #endif
 160 #undef FN
 161         width -= 8;
 162         src += 4;
 163     }
 164 }
 165
 166 static void glue(pl110_draw_line8_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
 167 {
 168     uint32_t data;
 169     while (width > 0) {
 170         data = *(uint32_t *)src;
 171 #define FN(x) COPY_PIXEL(d, pallette[(data >> (x)) & 0xff]);
 172 #ifdef SWAP_WORDS
 173         FN(24)
 174         FN(16)
 175         FN(8)
 176         FN(0)
 177 #else
 178         FN(0)
 179         FN(8)
 180         FN(16)
 181         FN(24)
 182 #endif
 183 #undef FN
 184         width -= 4;
 185         src += 4;
 186     }
 187 }
 188
 189 static void glue(pl110_draw_line16_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
 190 {
 191     uint32_t data;
 192     unsigned int r, g, b;
 193     while (width > 0) {
 194         data = *(uint32_t *)src;
 195 #ifdef SWAP_WORDS
 196         data = bswap32(data);
 197 #endif
 198 #if 0
 199         r = data & 0x1f;
 200         data >>= 5;
 201         g = data & 0x3f;
 202         data >>= 6;
 203         b = data & 0x1f;
 204         data >>= 5;
 205 #else
 206         r = (data & 0x1f) << 3;
 207         data >>= 5;
 208         g = (data & 0x3f) << 2;
 209         data >>= 6;
 210         b = (data & 0x1f) << 3;
 211         data >>= 5;
 212 #endif
 213         COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 214         r = (data & 0x1f) << 3;
 215         data >>= 5;
 216         g = (data & 0x3f) << 2;
 217         data >>= 6;
 218         b = (data & 0x1f) << 3;
 219         data >>= 5;
 220         COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 221         width -= 2;
 222         src += 4;
 223     }
 224 }
 225
 226 static void glue(pl110_draw_line32_,NAME)(uint32_t *pallette, uint8_t *d, const uint8_t *src, int width)
 227 {
 228     uint32_t data;
 229     unsigned int r, g, b;
 230     while (width > 0) {
 231         data = *(uint32_t *)src;
 232 #ifdef SWAP_WORDS
 233         r = data & 0xff;
 234         g = (data >> 8) & 0xff;
 235         b = (data >> 16) & 0xff;
 236 #else
 237         r = (data >> 24) & 0xff;
 238         g = (data >> 16) & 0xff;
 239         b = (data >> 8) & 0xff;
 240 #endif
 241         COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 242         width--;
 243         src += 4;
 244     }
 245 }
 246
 247 #undef SWAP_PIXELS
 248 #undef NAME
 249 #undef SWAP_WORDS
 250 #undef ORDER
 251
 252 #endif