~ubuntu-branches/ubuntu/wily/qemu-kvm-spice/wily

« back to all changes in this revision

Viewing changes to hw/pl110_template.h

  • Committer: Bazaar Package Importer
  • Author(s): Serge Hallyn
  • Date: 2011-10-19 10:44:56 UTC
  • Revision ID: james.westby@ubuntu.com-20111019104456-xgvskumk3sxi97f4
Tags: upstream-0.15.0+noroms
ImportĀ upstreamĀ versionĀ 0.15.0+noroms

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
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
 
 
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
#undef RGB
 
28
#define BORDER bgr
 
29
#define ORDER 0
 
30
#include "pl110_template.h"
 
31
#define ORDER 1
 
32
#include "pl110_template.h"
 
33
#define ORDER 2
 
34
#include "pl110_template.h"
 
35
#undef BORDER
 
36
#define RGB
 
37
#define BORDER rgb
 
38
#define ORDER 0
 
39
#include "pl110_template.h"
 
40
#define ORDER 1
 
41
#include "pl110_template.h"
 
42
#define ORDER 2
 
43
#include "pl110_template.h"
 
44
#undef BORDER
 
45
 
 
46
static drawfn glue(pl110_draw_fn_,BITS)[36] =
 
47
{
 
48
    glue(pl110_draw_line1_lblp_bgr,BITS),
 
49
    glue(pl110_draw_line2_lblp_bgr,BITS),
 
50
    glue(pl110_draw_line4_lblp_bgr,BITS),
 
51
    glue(pl110_draw_line8_lblp_bgr,BITS),
 
52
    glue(pl110_draw_line16_lblp_bgr,BITS),
 
53
    glue(pl110_draw_line32_lblp_bgr,BITS),
 
54
 
 
55
    glue(pl110_draw_line1_bbbp_bgr,BITS),
 
56
    glue(pl110_draw_line2_bbbp_bgr,BITS),
 
57
    glue(pl110_draw_line4_bbbp_bgr,BITS),
 
58
    glue(pl110_draw_line8_bbbp_bgr,BITS),
 
59
    glue(pl110_draw_line16_bbbp_bgr,BITS),
 
60
    glue(pl110_draw_line32_bbbp_bgr,BITS),
 
61
 
 
62
    glue(pl110_draw_line1_lbbp_bgr,BITS),
 
63
    glue(pl110_draw_line2_lbbp_bgr,BITS),
 
64
    glue(pl110_draw_line4_lbbp_bgr,BITS),
 
65
    glue(pl110_draw_line8_lbbp_bgr,BITS),
 
66
    glue(pl110_draw_line16_lbbp_bgr,BITS),
 
67
    glue(pl110_draw_line32_lbbp_bgr,BITS),
 
68
 
 
69
    glue(pl110_draw_line1_lblp_rgb,BITS),
 
70
    glue(pl110_draw_line2_lblp_rgb,BITS),
 
71
    glue(pl110_draw_line4_lblp_rgb,BITS),
 
72
    glue(pl110_draw_line8_lblp_rgb,BITS),
 
73
    glue(pl110_draw_line16_lblp_rgb,BITS),
 
74
    glue(pl110_draw_line32_lblp_rgb,BITS),
 
75
 
 
76
    glue(pl110_draw_line1_bbbp_rgb,BITS),
 
77
    glue(pl110_draw_line2_bbbp_rgb,BITS),
 
78
    glue(pl110_draw_line4_bbbp_rgb,BITS),
 
79
    glue(pl110_draw_line8_bbbp_rgb,BITS),
 
80
    glue(pl110_draw_line16_bbbp_rgb,BITS),
 
81
    glue(pl110_draw_line32_bbbp_rgb,BITS),
 
82
 
 
83
    glue(pl110_draw_line1_lbbp_rgb,BITS),
 
84
    glue(pl110_draw_line2_lbbp_rgb,BITS),
 
85
    glue(pl110_draw_line4_lbbp_rgb,BITS),
 
86
    glue(pl110_draw_line8_lbbp_rgb,BITS),
 
87
    glue(pl110_draw_line16_lbbp_rgb,BITS),
 
88
    glue(pl110_draw_line32_lbbp_rgb,BITS),
 
89
};
 
90
 
 
91
#undef BITS
 
92
#undef COPY_PIXEL
 
93
 
 
94
#else
 
95
 
 
96
#if ORDER == 0
 
97
#define NAME glue(glue(lblp_, BORDER), BITS)
 
98
#ifdef HOST_WORDS_BIGENDIAN
 
99
#define SWAP_WORDS 1
 
100
#endif
 
101
#elif ORDER == 1
 
102
#define NAME glue(glue(bbbp_, BORDER), BITS)
 
103
#ifndef HOST_WORDS_BIGENDIAN
 
104
#define SWAP_WORDS 1
 
105
#endif
 
106
#else
 
107
#define SWAP_PIXELS 1
 
108
#define NAME glue(glue(lbbp_, BORDER), BITS)
 
109
#ifdef HOST_WORDS_BIGENDIAN
 
110
#define SWAP_WORDS 1
 
111
#endif
 
112
#endif
 
113
 
 
114
#define FN_2(x, y) FN(x, y) FN(x+1, y)
 
115
#define FN_4(x, y) FN_2(x, y) FN_2(x+2, y)
 
116
#define FN_8(y) FN_4(0, y) FN_4(4, y)
 
117
 
 
118
static void glue(pl110_draw_line1_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
119
{
 
120
    uint32_t *pallette = opaque;
 
121
    uint32_t data;
 
122
    while (width > 0) {
 
123
        data = *(uint32_t *)src;
 
124
#ifdef SWAP_PIXELS
 
125
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 7 - (x))) & 1]);
 
126
#else
 
127
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x) + y)) & 1]);
 
128
#endif
 
129
#ifdef SWAP_WORDS
 
130
        FN_8(24)
 
131
        FN_8(16)
 
132
        FN_8(8)
 
133
        FN_8(0)
 
134
#else
 
135
        FN_8(0)
 
136
        FN_8(8)
 
137
        FN_8(16)
 
138
        FN_8(24)
 
139
#endif
 
140
#undef FN
 
141
        width -= 32;
 
142
        src += 4;
 
143
    }
 
144
}
 
145
 
 
146
static void glue(pl110_draw_line2_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
147
{
 
148
    uint32_t *pallette = opaque;
 
149
    uint32_t data;
 
150
    while (width > 0) {
 
151
        data = *(uint32_t *)src;
 
152
#ifdef SWAP_PIXELS
 
153
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 6 - (x)*2)) & 3]);
 
154
#else
 
155
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x)*2 + y)) & 3]);
 
156
#endif
 
157
#ifdef SWAP_WORDS
 
158
        FN_4(0, 24)
 
159
        FN_4(0, 16)
 
160
        FN_4(0, 8)
 
161
        FN_4(0, 0)
 
162
#else
 
163
        FN_4(0, 0)
 
164
        FN_4(0, 8)
 
165
        FN_4(0, 16)
 
166
        FN_4(0, 24)
 
167
#endif
 
168
#undef FN
 
169
        width -= 16;
 
170
        src += 4;
 
171
    }
 
172
}
 
173
 
 
174
static void glue(pl110_draw_line4_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
175
{
 
176
    uint32_t *pallette = opaque;
 
177
    uint32_t data;
 
178
    while (width > 0) {
 
179
        data = *(uint32_t *)src;
 
180
#ifdef SWAP_PIXELS
 
181
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> (y + 4 - (x)*4)) & 0xf]);
 
182
#else
 
183
#define FN(x, y) COPY_PIXEL(d, pallette[(data >> ((x)*4 + y)) & 0xf]);
 
184
#endif
 
185
#ifdef SWAP_WORDS
 
186
        FN_2(0, 24)
 
187
        FN_2(0, 16)
 
188
        FN_2(0, 8)
 
189
        FN_2(0, 0)
 
190
#else
 
191
        FN_2(0, 0)
 
192
        FN_2(0, 8)
 
193
        FN_2(0, 16)
 
194
        FN_2(0, 24)
 
195
#endif
 
196
#undef FN
 
197
        width -= 8;
 
198
        src += 4;
 
199
    }
 
200
}
 
201
 
 
202
static void glue(pl110_draw_line8_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
203
{
 
204
    uint32_t *pallette = opaque;
 
205
    uint32_t data;
 
206
    while (width > 0) {
 
207
        data = *(uint32_t *)src;
 
208
#define FN(x) COPY_PIXEL(d, pallette[(data >> (x)) & 0xff]);
 
209
#ifdef SWAP_WORDS
 
210
        FN(24)
 
211
        FN(16)
 
212
        FN(8)
 
213
        FN(0)
 
214
#else
 
215
        FN(0)
 
216
        FN(8)
 
217
        FN(16)
 
218
        FN(24)
 
219
#endif
 
220
#undef FN
 
221
        width -= 4;
 
222
        src += 4;
 
223
    }
 
224
}
 
225
 
 
226
static void glue(pl110_draw_line16_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
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
        data = bswap32(data);
 
234
#endif
 
235
#ifdef RGB
 
236
#define LSB r
 
237
#define MSB b
 
238
#else
 
239
#define LSB b
 
240
#define MSB r
 
241
#endif
 
242
#if 0
 
243
        LSB = data & 0x1f;
 
244
        data >>= 5;
 
245
        g = data & 0x3f;
 
246
        data >>= 6;
 
247
        MSB = data & 0x1f;
 
248
        data >>= 5;
 
249
#else
 
250
        LSB = (data & 0x1f) << 3;
 
251
        data >>= 5;
 
252
        g = (data & 0x3f) << 2;
 
253
        data >>= 6;
 
254
        MSB = (data & 0x1f) << 3;
 
255
        data >>= 5;
 
256
#endif
 
257
        COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 
258
        LSB = (data & 0x1f) << 3;
 
259
        data >>= 5;
 
260
        g = (data & 0x3f) << 2;
 
261
        data >>= 6;
 
262
        MSB = (data & 0x1f) << 3;
 
263
        data >>= 5;
 
264
        COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 
265
#undef MSB
 
266
#undef LSB
 
267
        width -= 2;
 
268
        src += 4;
 
269
    }
 
270
}
 
271
 
 
272
static void glue(pl110_draw_line32_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep)
 
273
{
 
274
    uint32_t data;
 
275
    unsigned int r, g, b;
 
276
    while (width > 0) {
 
277
        data = *(uint32_t *)src;
 
278
#ifdef RGB
 
279
#define LSB r
 
280
#define MSB b
 
281
#else
 
282
#define LSB b
 
283
#define MSB r
 
284
#endif
 
285
#ifndef SWAP_WORDS
 
286
        LSB = data & 0xff;
 
287
        g = (data >> 8) & 0xff;
 
288
        MSB = (data >> 16) & 0xff;
 
289
#else
 
290
        LSB = (data >> 24) & 0xff;
 
291
        g = (data >> 16) & 0xff;
 
292
        MSB = (data >> 8) & 0xff;
 
293
#endif
 
294
        COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b));
 
295
#undef MSB
 
296
#undef LSB
 
297
        width--;
 
298
        src += 4;
 
299
    }
 
300
}
 
301
 
 
302
#undef SWAP_PIXELS
 
303
#undef NAME
 
304
#undef SWAP_WORDS
 
305
#undef ORDER
 
306
 
 
307
#endif