root / hw / pxa2xx_template.h @ bb9e3216
History | View | Annotate | Download (11.3 kB)
1 |
/*
|
---|---|
2 |
* Intel XScale PXA255/270 LCDC emulation.
|
3 |
*
|
4 |
* Copyright (c) 2006 Openedhand Ltd.
|
5 |
* Written by Andrzej Zaborowski <balrog@zabor.org>
|
6 |
*
|
7 |
* This code is licensed under the GPLv2.
|
8 |
*
|
9 |
* Framebuffer format conversion routines.
|
10 |
*/
|
11 |
|
12 |
# define SKIP_PIXEL(to) to += deststep
|
13 |
#if BITS == 8 |
14 |
# define COPY_PIXEL(to, from) *to = from; SKIP_PIXEL(to)
|
15 |
#elif BITS == 15 || BITS == 16 |
16 |
# define COPY_PIXEL(to, from) *(uint16_t *) to = from; SKIP_PIXEL(to)
|
17 |
#elif BITS == 24 |
18 |
# define COPY_PIXEL(to, from) \
|
19 |
*(uint16_t *) to = from; *(to + 2) = (from) >> 16; SKIP_PIXEL(to) |
20 |
#elif BITS == 32 |
21 |
# define COPY_PIXEL(to, from) *(uint32_t *) to = from; SKIP_PIXEL(to)
|
22 |
#else
|
23 |
# error unknown bit depth
|
24 |
#endif
|
25 |
|
26 |
#ifdef HOST_WORDS_BIGENDIAN
|
27 |
# define SWAP_WORDS 1 |
28 |
#endif
|
29 |
|
30 |
#define FN_2(x) FN(x + 1) FN(x) |
31 |
#define FN_4(x) FN_2(x + 2) FN_2(x) |
32 |
|
33 |
static void glue(pxa2xx_draw_line2_, BITS)(void *opaque, |
34 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
35 |
{ |
36 |
uint32_t *palette = opaque; |
37 |
uint32_t data; |
38 |
while (width > 0) { |
39 |
data = *(uint32_t *) src; |
40 |
#define FN(x) COPY_PIXEL(dest, palette[(data >> ((x) * 2)) & 3]); |
41 |
#ifdef SWAP_WORDS
|
42 |
FN_4(12)
|
43 |
FN_4(8)
|
44 |
FN_4(4)
|
45 |
FN_4(0)
|
46 |
#else
|
47 |
FN_4(0)
|
48 |
FN_4(4)
|
49 |
FN_4(8)
|
50 |
FN_4(12)
|
51 |
#endif
|
52 |
#undef FN
|
53 |
width -= 16;
|
54 |
src += 4;
|
55 |
} |
56 |
} |
57 |
|
58 |
static void glue(pxa2xx_draw_line4_, BITS)(void *opaque, |
59 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
60 |
{ |
61 |
uint32_t *palette = opaque; |
62 |
uint32_t data; |
63 |
while (width > 0) { |
64 |
data = *(uint32_t *) src; |
65 |
#define FN(x) COPY_PIXEL(dest, palette[(data >> ((x) * 4)) & 0xf]); |
66 |
#ifdef SWAP_WORDS
|
67 |
FN_2(6)
|
68 |
FN_2(4)
|
69 |
FN_2(2)
|
70 |
FN_2(0)
|
71 |
#else
|
72 |
FN_2(0)
|
73 |
FN_2(2)
|
74 |
FN_2(4)
|
75 |
FN_2(6)
|
76 |
#endif
|
77 |
#undef FN
|
78 |
width -= 8;
|
79 |
src += 4;
|
80 |
} |
81 |
} |
82 |
|
83 |
static void glue(pxa2xx_draw_line8_, BITS)(void *opaque, |
84 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
85 |
{ |
86 |
uint32_t *palette = opaque; |
87 |
uint32_t data; |
88 |
while (width > 0) { |
89 |
data = *(uint32_t *) src; |
90 |
#define FN(x) COPY_PIXEL(dest, palette[(data >> (x)) & 0xff]); |
91 |
#ifdef SWAP_WORDS
|
92 |
FN(24)
|
93 |
FN(16)
|
94 |
FN(8)
|
95 |
FN(0)
|
96 |
#else
|
97 |
FN(0)
|
98 |
FN(8)
|
99 |
FN(16)
|
100 |
FN(24)
|
101 |
#endif
|
102 |
#undef FN
|
103 |
width -= 4;
|
104 |
src += 4;
|
105 |
} |
106 |
} |
107 |
|
108 |
static void glue(pxa2xx_draw_line16_, BITS)(void *opaque, |
109 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
110 |
{ |
111 |
uint32_t data; |
112 |
unsigned int r, g, b; |
113 |
while (width > 0) { |
114 |
data = *(uint32_t *) src; |
115 |
#ifdef SWAP_WORDS
|
116 |
data = bswap32(data); |
117 |
#endif
|
118 |
b = (data & 0x1f) << 3; |
119 |
data >>= 5;
|
120 |
g = (data & 0x3f) << 2; |
121 |
data >>= 6;
|
122 |
r = (data & 0x1f) << 3; |
123 |
data >>= 5;
|
124 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
125 |
b = (data & 0x1f) << 3; |
126 |
data >>= 5;
|
127 |
g = (data & 0x3f) << 2; |
128 |
data >>= 6;
|
129 |
r = (data & 0x1f) << 3; |
130 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
131 |
width -= 2;
|
132 |
src += 4;
|
133 |
} |
134 |
} |
135 |
|
136 |
static void glue(pxa2xx_draw_line16t_, BITS)(void *opaque, |
137 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
138 |
{ |
139 |
uint32_t data; |
140 |
unsigned int r, g, b; |
141 |
while (width > 0) { |
142 |
data = *(uint32_t *) src; |
143 |
#ifdef SWAP_WORDS
|
144 |
data = bswap32(data); |
145 |
#endif
|
146 |
b = (data & 0x1f) << 3; |
147 |
data >>= 5;
|
148 |
g = (data & 0x1f) << 3; |
149 |
data >>= 5;
|
150 |
r = (data & 0x1f) << 3; |
151 |
data >>= 5;
|
152 |
if (data & 1) |
153 |
SKIP_PIXEL(dest); |
154 |
else
|
155 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
156 |
data >>= 1;
|
157 |
b = (data & 0x1f) << 3; |
158 |
data >>= 5;
|
159 |
g = (data & 0x1f) << 3; |
160 |
data >>= 5;
|
161 |
r = (data & 0x1f) << 3; |
162 |
data >>= 5;
|
163 |
if (data & 1) |
164 |
SKIP_PIXEL(dest); |
165 |
else
|
166 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
167 |
width -= 2;
|
168 |
src += 4;
|
169 |
} |
170 |
} |
171 |
|
172 |
static void glue(pxa2xx_draw_line18_, BITS)(void *opaque, |
173 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
174 |
{ |
175 |
uint32_t data; |
176 |
unsigned int r, g, b; |
177 |
while (width > 0) { |
178 |
data = *(uint32_t *) src; |
179 |
#ifdef SWAP_WORDS
|
180 |
data = bswap32(data); |
181 |
#endif
|
182 |
b = (data & 0x3f) << 2; |
183 |
data >>= 6;
|
184 |
g = (data & 0x3f) << 2; |
185 |
data >>= 6;
|
186 |
r = (data & 0x3f) << 2; |
187 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
188 |
width -= 1;
|
189 |
src += 4;
|
190 |
} |
191 |
} |
192 |
|
193 |
/* The wicked packed format */
|
194 |
static void glue(pxa2xx_draw_line18p_, BITS)(void *opaque, |
195 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
196 |
{ |
197 |
uint32_t data[3];
|
198 |
unsigned int r, g, b; |
199 |
while (width > 0) { |
200 |
data[0] = *(uint32_t *) src;
|
201 |
src += 4;
|
202 |
data[1] = *(uint32_t *) src;
|
203 |
src += 4;
|
204 |
data[2] = *(uint32_t *) src;
|
205 |
src += 4;
|
206 |
#ifdef SWAP_WORDS
|
207 |
data[0] = bswap32(data[0]); |
208 |
data[1] = bswap32(data[1]); |
209 |
data[2] = bswap32(data[2]); |
210 |
#endif
|
211 |
b = (data[0] & 0x3f) << 2; |
212 |
data[0] >>= 6; |
213 |
g = (data[0] & 0x3f) << 2; |
214 |
data[0] >>= 6; |
215 |
r = (data[0] & 0x3f) << 2; |
216 |
data[0] >>= 12; |
217 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
218 |
b = (data[0] & 0x3f) << 2; |
219 |
data[0] >>= 6; |
220 |
g = ((data[1] & 0xf) << 4) | (data[0] << 2); |
221 |
data[1] >>= 4; |
222 |
r = (data[1] & 0x3f) << 2; |
223 |
data[1] >>= 12; |
224 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
225 |
b = (data[1] & 0x3f) << 2; |
226 |
data[1] >>= 6; |
227 |
g = (data[1] & 0x3f) << 2; |
228 |
data[1] >>= 6; |
229 |
r = ((data[2] & 0x3) << 6) | (data[1] << 2); |
230 |
data[2] >>= 8; |
231 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
232 |
b = (data[2] & 0x3f) << 2; |
233 |
data[2] >>= 6; |
234 |
g = (data[2] & 0x3f) << 2; |
235 |
data[2] >>= 6; |
236 |
r = data[2] << 2; |
237 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
238 |
width -= 4;
|
239 |
} |
240 |
} |
241 |
|
242 |
static void glue(pxa2xx_draw_line19_, BITS)(void *opaque, |
243 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
244 |
{ |
245 |
uint32_t data; |
246 |
unsigned int r, g, b; |
247 |
while (width > 0) { |
248 |
data = *(uint32_t *) src; |
249 |
#ifdef SWAP_WORDS
|
250 |
data = bswap32(data); |
251 |
#endif
|
252 |
b = (data & 0x3f) << 2; |
253 |
data >>= 6;
|
254 |
g = (data & 0x3f) << 2; |
255 |
data >>= 6;
|
256 |
r = (data & 0x3f) << 2; |
257 |
data >>= 6;
|
258 |
if (data & 1) |
259 |
SKIP_PIXEL(dest); |
260 |
else
|
261 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
262 |
width -= 1;
|
263 |
src += 4;
|
264 |
} |
265 |
} |
266 |
|
267 |
/* The wicked packed format */
|
268 |
static void glue(pxa2xx_draw_line19p_, BITS)(void *opaque, |
269 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
270 |
{ |
271 |
uint32_t data[3];
|
272 |
unsigned int r, g, b; |
273 |
while (width > 0) { |
274 |
data[0] = *(uint32_t *) src;
|
275 |
src += 4;
|
276 |
data[1] = *(uint32_t *) src;
|
277 |
src += 4;
|
278 |
data[2] = *(uint32_t *) src;
|
279 |
src += 4;
|
280 |
# ifdef SWAP_WORDS
|
281 |
data[0] = bswap32(data[0]); |
282 |
data[1] = bswap32(data[1]); |
283 |
data[2] = bswap32(data[2]); |
284 |
# endif
|
285 |
b = (data[0] & 0x3f) << 2; |
286 |
data[0] >>= 6; |
287 |
g = (data[0] & 0x3f) << 2; |
288 |
data[0] >>= 6; |
289 |
r = (data[0] & 0x3f) << 2; |
290 |
data[0] >>= 6; |
291 |
if (data[0] & 1) |
292 |
SKIP_PIXEL(dest); |
293 |
else
|
294 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
295 |
data[0] >>= 6; |
296 |
b = (data[0] & 0x3f) << 2; |
297 |
data[0] >>= 6; |
298 |
g = ((data[1] & 0xf) << 4) | (data[0] << 2); |
299 |
data[1] >>= 4; |
300 |
r = (data[1] & 0x3f) << 2; |
301 |
data[1] >>= 6; |
302 |
if (data[1] & 1) |
303 |
SKIP_PIXEL(dest); |
304 |
else
|
305 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
306 |
data[1] >>= 6; |
307 |
b = (data[1] & 0x3f) << 2; |
308 |
data[1] >>= 6; |
309 |
g = (data[1] & 0x3f) << 2; |
310 |
data[1] >>= 6; |
311 |
r = ((data[2] & 0x3) << 6) | (data[1] << 2); |
312 |
data[2] >>= 2; |
313 |
if (data[2] & 1) |
314 |
SKIP_PIXEL(dest); |
315 |
else
|
316 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
317 |
data[2] >>= 6; |
318 |
b = (data[2] & 0x3f) << 2; |
319 |
data[2] >>= 6; |
320 |
g = (data[2] & 0x3f) << 2; |
321 |
data[2] >>= 6; |
322 |
r = data[2] << 2; |
323 |
data[2] >>= 6; |
324 |
if (data[2] & 1) |
325 |
SKIP_PIXEL(dest); |
326 |
else
|
327 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
328 |
width -= 4;
|
329 |
} |
330 |
} |
331 |
|
332 |
static void glue(pxa2xx_draw_line24_, BITS)(void *opaque, |
333 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
334 |
{ |
335 |
uint32_t data; |
336 |
unsigned int r, g, b; |
337 |
while (width > 0) { |
338 |
data = *(uint32_t *) src; |
339 |
#ifdef SWAP_WORDS
|
340 |
data = bswap32(data); |
341 |
#endif
|
342 |
b = data & 0xff;
|
343 |
data >>= 8;
|
344 |
g = data & 0xff;
|
345 |
data >>= 8;
|
346 |
r = data & 0xff;
|
347 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
348 |
width -= 1;
|
349 |
src += 4;
|
350 |
} |
351 |
} |
352 |
|
353 |
static void glue(pxa2xx_draw_line24t_, BITS)(void *opaque, |
354 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
355 |
{ |
356 |
uint32_t data; |
357 |
unsigned int r, g, b; |
358 |
while (width > 0) { |
359 |
data = *(uint32_t *) src; |
360 |
#ifdef SWAP_WORDS
|
361 |
data = bswap32(data); |
362 |
#endif
|
363 |
b = (data & 0x7f) << 1; |
364 |
data >>= 7;
|
365 |
g = data & 0xff;
|
366 |
data >>= 8;
|
367 |
r = data & 0xff;
|
368 |
data >>= 8;
|
369 |
if (data & 1) |
370 |
SKIP_PIXEL(dest); |
371 |
else
|
372 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
373 |
width -= 1;
|
374 |
src += 4;
|
375 |
} |
376 |
} |
377 |
|
378 |
static void glue(pxa2xx_draw_line25_, BITS)(void *opaque, |
379 |
uint8_t *dest, const uint8_t *src, int width, int deststep) |
380 |
{ |
381 |
uint32_t data; |
382 |
unsigned int r, g, b; |
383 |
while (width > 0) { |
384 |
data = *(uint32_t *) src; |
385 |
#ifdef SWAP_WORDS
|
386 |
data = bswap32(data); |
387 |
#endif
|
388 |
b = data & 0xff;
|
389 |
data >>= 8;
|
390 |
g = data & 0xff;
|
391 |
data >>= 8;
|
392 |
r = data & 0xff;
|
393 |
data >>= 8;
|
394 |
if (data & 1) |
395 |
SKIP_PIXEL(dest); |
396 |
else
|
397 |
COPY_PIXEL(dest, glue(rgb_to_pixel, BITS)(r, g, b)); |
398 |
width -= 1;
|
399 |
src += 4;
|
400 |
} |
401 |
} |
402 |
|
403 |
/* Overlay planes disabled, no transparency */
|
404 |
static drawfn glue(pxa2xx_draw_fn_, BITS)[16] = |
405 |
{ |
406 |
[0 ... 0xf] = NULL, |
407 |
[pxa_lcdc_2bpp] = glue(pxa2xx_draw_line2_, BITS), |
408 |
[pxa_lcdc_4bpp] = glue(pxa2xx_draw_line4_, BITS), |
409 |
[pxa_lcdc_8bpp] = glue(pxa2xx_draw_line8_, BITS), |
410 |
[pxa_lcdc_16bpp] = glue(pxa2xx_draw_line16_, BITS), |
411 |
[pxa_lcdc_18bpp] = glue(pxa2xx_draw_line18_, BITS), |
412 |
[pxa_lcdc_18pbpp] = glue(pxa2xx_draw_line18p_, BITS), |
413 |
[pxa_lcdc_24bpp] = glue(pxa2xx_draw_line24_, BITS), |
414 |
}; |
415 |
|
416 |
/* Overlay planes enabled, transparency used */
|
417 |
static drawfn glue(glue(pxa2xx_draw_fn_, BITS), t)[16] = |
418 |
{ |
419 |
[0 ... 0xf] = NULL, |
420 |
[pxa_lcdc_4bpp] = glue(pxa2xx_draw_line4_, BITS), |
421 |
[pxa_lcdc_8bpp] = glue(pxa2xx_draw_line8_, BITS), |
422 |
[pxa_lcdc_16bpp] = glue(pxa2xx_draw_line16t_, BITS), |
423 |
[pxa_lcdc_19bpp] = glue(pxa2xx_draw_line19_, BITS), |
424 |
[pxa_lcdc_19pbpp] = glue(pxa2xx_draw_line19p_, BITS), |
425 |
[pxa_lcdc_24bpp] = glue(pxa2xx_draw_line24t_, BITS), |
426 |
[pxa_lcdc_25bpp] = glue(pxa2xx_draw_line25_, BITS), |
427 |
}; |
428 |
|
429 |
#undef BITS
|
430 |
#undef COPY_PIXEL
|
431 |
#undef SKIP_PIXEL
|
432 |
|
433 |
#ifdef SWAP_WORDS
|
434 |
# undef SWAP_WORDS
|
435 |
#endif
|