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