]>
Commit | Line | Data |
---|---|---|
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)[48] = | |
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_555_lblp_bgr,BITS), | |
53 | glue(pl110_draw_line32_lblp_bgr,BITS), | |
54 | glue(pl110_draw_line16_lblp_bgr,BITS), | |
55 | glue(pl110_draw_line12_lblp_bgr,BITS), | |
56 | ||
57 | glue(pl110_draw_line1_bbbp_bgr,BITS), | |
58 | glue(pl110_draw_line2_bbbp_bgr,BITS), | |
59 | glue(pl110_draw_line4_bbbp_bgr,BITS), | |
60 | glue(pl110_draw_line8_bbbp_bgr,BITS), | |
61 | glue(pl110_draw_line16_555_bbbp_bgr,BITS), | |
62 | glue(pl110_draw_line32_bbbp_bgr,BITS), | |
63 | glue(pl110_draw_line16_bbbp_bgr,BITS), | |
64 | glue(pl110_draw_line12_bbbp_bgr,BITS), | |
65 | ||
66 | glue(pl110_draw_line1_lbbp_bgr,BITS), | |
67 | glue(pl110_draw_line2_lbbp_bgr,BITS), | |
68 | glue(pl110_draw_line4_lbbp_bgr,BITS), | |
69 | glue(pl110_draw_line8_lbbp_bgr,BITS), | |
70 | glue(pl110_draw_line16_555_lbbp_bgr,BITS), | |
71 | glue(pl110_draw_line32_lbbp_bgr,BITS), | |
72 | glue(pl110_draw_line16_lbbp_bgr,BITS), | |
73 | glue(pl110_draw_line12_lbbp_bgr,BITS), | |
74 | ||
75 | glue(pl110_draw_line1_lblp_rgb,BITS), | |
76 | glue(pl110_draw_line2_lblp_rgb,BITS), | |
77 | glue(pl110_draw_line4_lblp_rgb,BITS), | |
78 | glue(pl110_draw_line8_lblp_rgb,BITS), | |
79 | glue(pl110_draw_line16_555_lblp_rgb,BITS), | |
80 | glue(pl110_draw_line32_lblp_rgb,BITS), | |
81 | glue(pl110_draw_line16_lblp_rgb,BITS), | |
82 | glue(pl110_draw_line12_lblp_rgb,BITS), | |
83 | ||
84 | glue(pl110_draw_line1_bbbp_rgb,BITS), | |
85 | glue(pl110_draw_line2_bbbp_rgb,BITS), | |
86 | glue(pl110_draw_line4_bbbp_rgb,BITS), | |
87 | glue(pl110_draw_line8_bbbp_rgb,BITS), | |
88 | glue(pl110_draw_line16_555_bbbp_rgb,BITS), | |
89 | glue(pl110_draw_line32_bbbp_rgb,BITS), | |
90 | glue(pl110_draw_line16_bbbp_rgb,BITS), | |
91 | glue(pl110_draw_line12_bbbp_rgb,BITS), | |
92 | ||
93 | glue(pl110_draw_line1_lbbp_rgb,BITS), | |
94 | glue(pl110_draw_line2_lbbp_rgb,BITS), | |
95 | glue(pl110_draw_line4_lbbp_rgb,BITS), | |
96 | glue(pl110_draw_line8_lbbp_rgb,BITS), | |
97 | glue(pl110_draw_line16_555_lbbp_rgb,BITS), | |
98 | glue(pl110_draw_line32_lbbp_rgb,BITS), | |
99 | glue(pl110_draw_line16_lbbp_rgb,BITS), | |
100 | glue(pl110_draw_line12_lbbp_rgb,BITS), | |
101 | }; | |
102 | ||
103 | #undef BITS | |
104 | #undef COPY_PIXEL | |
105 | ||
106 | #else | |
107 | ||
108 | #if ORDER == 0 | |
109 | #define NAME glue(glue(lblp_, BORDER), BITS) | |
110 | #ifdef HOST_WORDS_BIGENDIAN | |
111 | #define SWAP_WORDS 1 | |
112 | #endif | |
113 | #elif ORDER == 1 | |
114 | #define NAME glue(glue(bbbp_, BORDER), BITS) | |
115 | #ifndef HOST_WORDS_BIGENDIAN | |
116 | #define SWAP_WORDS 1 | |
117 | #endif | |
118 | #else | |
119 | #define SWAP_PIXELS 1 | |
120 | #define NAME glue(glue(lbbp_, BORDER), BITS) | |
121 | #ifdef HOST_WORDS_BIGENDIAN | |
122 | #define SWAP_WORDS 1 | |
123 | #endif | |
124 | #endif | |
125 | ||
126 | #define FN_2(x, y) FN(x, y) FN(x+1, y) | |
127 | #define FN_4(x, y) FN_2(x, y) FN_2(x+2, y) | |
128 | #define FN_8(y) FN_4(0, y) FN_4(4, y) | |
129 | ||
130 | static void glue(pl110_draw_line1_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
131 | { | |
132 | uint32_t *palette = opaque; | |
133 | uint32_t data; | |
134 | while (width > 0) { | |
135 | data = *(uint32_t *)src; | |
136 | #ifdef SWAP_PIXELS | |
137 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 7 - (x))) & 1]); | |
138 | #else | |
139 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x) + y)) & 1]); | |
140 | #endif | |
141 | #ifdef SWAP_WORDS | |
142 | FN_8(24) | |
143 | FN_8(16) | |
144 | FN_8(8) | |
145 | FN_8(0) | |
146 | #else | |
147 | FN_8(0) | |
148 | FN_8(8) | |
149 | FN_8(16) | |
150 | FN_8(24) | |
151 | #endif | |
152 | #undef FN | |
153 | width -= 32; | |
154 | src += 4; | |
155 | } | |
156 | } | |
157 | ||
158 | static void glue(pl110_draw_line2_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
159 | { | |
160 | uint32_t *palette = opaque; | |
161 | uint32_t data; | |
162 | while (width > 0) { | |
163 | data = *(uint32_t *)src; | |
164 | #ifdef SWAP_PIXELS | |
165 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 6 - (x)*2)) & 3]); | |
166 | #else | |
167 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*2 + y)) & 3]); | |
168 | #endif | |
169 | #ifdef SWAP_WORDS | |
170 | FN_4(0, 24) | |
171 | FN_4(0, 16) | |
172 | FN_4(0, 8) | |
173 | FN_4(0, 0) | |
174 | #else | |
175 | FN_4(0, 0) | |
176 | FN_4(0, 8) | |
177 | FN_4(0, 16) | |
178 | FN_4(0, 24) | |
179 | #endif | |
180 | #undef FN | |
181 | width -= 16; | |
182 | src += 4; | |
183 | } | |
184 | } | |
185 | ||
186 | static void glue(pl110_draw_line4_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
187 | { | |
188 | uint32_t *palette = opaque; | |
189 | uint32_t data; | |
190 | while (width > 0) { | |
191 | data = *(uint32_t *)src; | |
192 | #ifdef SWAP_PIXELS | |
193 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 4 - (x)*4)) & 0xf]); | |
194 | #else | |
195 | #define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*4 + y)) & 0xf]); | |
196 | #endif | |
197 | #ifdef SWAP_WORDS | |
198 | FN_2(0, 24) | |
199 | FN_2(0, 16) | |
200 | FN_2(0, 8) | |
201 | FN_2(0, 0) | |
202 | #else | |
203 | FN_2(0, 0) | |
204 | FN_2(0, 8) | |
205 | FN_2(0, 16) | |
206 | FN_2(0, 24) | |
207 | #endif | |
208 | #undef FN | |
209 | width -= 8; | |
210 | src += 4; | |
211 | } | |
212 | } | |
213 | ||
214 | static void glue(pl110_draw_line8_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
215 | { | |
216 | uint32_t *palette = opaque; | |
217 | uint32_t data; | |
218 | while (width > 0) { | |
219 | data = *(uint32_t *)src; | |
220 | #define FN(x) COPY_PIXEL(d, palette[(data >> (x)) & 0xff]); | |
221 | #ifdef SWAP_WORDS | |
222 | FN(24) | |
223 | FN(16) | |
224 | FN(8) | |
225 | FN(0) | |
226 | #else | |
227 | FN(0) | |
228 | FN(8) | |
229 | FN(16) | |
230 | FN(24) | |
231 | #endif | |
232 | #undef FN | |
233 | width -= 4; | |
234 | src += 4; | |
235 | } | |
236 | } | |
237 | ||
238 | static void glue(pl110_draw_line16_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
239 | { | |
240 | uint32_t data; | |
241 | unsigned int r, g, b; | |
242 | while (width > 0) { | |
243 | data = *(uint32_t *)src; | |
244 | #ifdef SWAP_WORDS | |
245 | data = bswap32(data); | |
246 | #endif | |
247 | #ifdef RGB | |
248 | #define LSB r | |
249 | #define MSB b | |
250 | #else | |
251 | #define LSB b | |
252 | #define MSB r | |
253 | #endif | |
254 | #if 0 | |
255 | LSB = data & 0x1f; | |
256 | data >>= 5; | |
257 | g = data & 0x3f; | |
258 | data >>= 6; | |
259 | MSB = data & 0x1f; | |
260 | data >>= 5; | |
261 | #else | |
262 | LSB = (data & 0x1f) << 3; | |
263 | data >>= 5; | |
264 | g = (data & 0x3f) << 2; | |
265 | data >>= 6; | |
266 | MSB = (data & 0x1f) << 3; | |
267 | data >>= 5; | |
268 | #endif | |
269 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
270 | LSB = (data & 0x1f) << 3; | |
271 | data >>= 5; | |
272 | g = (data & 0x3f) << 2; | |
273 | data >>= 6; | |
274 | MSB = (data & 0x1f) << 3; | |
275 | data >>= 5; | |
276 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
277 | #undef MSB | |
278 | #undef LSB | |
279 | width -= 2; | |
280 | src += 4; | |
281 | } | |
282 | } | |
283 | ||
284 | static void glue(pl110_draw_line32_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
285 | { | |
286 | uint32_t data; | |
287 | unsigned int r, g, b; | |
288 | while (width > 0) { | |
289 | data = *(uint32_t *)src; | |
290 | #ifdef RGB | |
291 | #define LSB r | |
292 | #define MSB b | |
293 | #else | |
294 | #define LSB b | |
295 | #define MSB r | |
296 | #endif | |
297 | #ifndef SWAP_WORDS | |
298 | LSB = data & 0xff; | |
299 | g = (data >> 8) & 0xff; | |
300 | MSB = (data >> 16) & 0xff; | |
301 | #else | |
302 | LSB = (data >> 24) & 0xff; | |
303 | g = (data >> 16) & 0xff; | |
304 | MSB = (data >> 8) & 0xff; | |
305 | #endif | |
306 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
307 | #undef MSB | |
308 | #undef LSB | |
309 | width--; | |
310 | src += 4; | |
311 | } | |
312 | } | |
313 | ||
314 | static void glue(pl110_draw_line16_555_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
315 | { | |
316 | /* RGB 555 plus an intensity bit (which we ignore) */ | |
317 | uint32_t data; | |
318 | unsigned int r, g, b; | |
319 | while (width > 0) { | |
320 | data = *(uint32_t *)src; | |
321 | #ifdef SWAP_WORDS | |
322 | data = bswap32(data); | |
323 | #endif | |
324 | #ifdef RGB | |
325 | #define LSB r | |
326 | #define MSB b | |
327 | #else | |
328 | #define LSB b | |
329 | #define MSB r | |
330 | #endif | |
331 | LSB = (data & 0x1f) << 3; | |
332 | data >>= 5; | |
333 | g = (data & 0x1f) << 3; | |
334 | data >>= 5; | |
335 | MSB = (data & 0x1f) << 3; | |
336 | data >>= 5; | |
337 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
338 | LSB = (data & 0x1f) << 3; | |
339 | data >>= 5; | |
340 | g = (data & 0x1f) << 3; | |
341 | data >>= 5; | |
342 | MSB = (data & 0x1f) << 3; | |
343 | data >>= 6; | |
344 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
345 | #undef MSB | |
346 | #undef LSB | |
347 | width -= 2; | |
348 | src += 4; | |
349 | } | |
350 | } | |
351 | ||
352 | static void glue(pl110_draw_line12_,NAME)(void *opaque, uint8_t *d, const uint8_t *src, int width, int deststep) | |
353 | { | |
354 | /* RGB 444 with 4 bits of zeroes at the top of each halfword */ | |
355 | uint32_t data; | |
356 | unsigned int r, g, b; | |
357 | while (width > 0) { | |
358 | data = *(uint32_t *)src; | |
359 | #ifdef SWAP_WORDS | |
360 | data = bswap32(data); | |
361 | #endif | |
362 | #ifdef RGB | |
363 | #define LSB r | |
364 | #define MSB b | |
365 | #else | |
366 | #define LSB b | |
367 | #define MSB r | |
368 | #endif | |
369 | LSB = (data & 0xf) << 4; | |
370 | data >>= 4; | |
371 | g = (data & 0xf) << 4; | |
372 | data >>= 4; | |
373 | MSB = (data & 0xf) << 4; | |
374 | data >>= 8; | |
375 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
376 | LSB = (data & 0xf) << 4; | |
377 | data >>= 4; | |
378 | g = (data & 0xf) << 4; | |
379 | data >>= 4; | |
380 | MSB = (data & 0xf) << 4; | |
381 | data >>= 8; | |
382 | COPY_PIXEL(d, glue(rgb_to_pixel,BITS)(r, g, b)); | |
383 | #undef MSB | |
384 | #undef LSB | |
385 | width -= 2; | |
386 | src += 4; | |
387 | } | |
388 | } | |
389 | ||
390 | #undef SWAP_PIXELS | |
391 | #undef NAME | |
392 | #undef SWAP_WORDS | |
393 | #undef ORDER | |
394 | ||
395 | #endif |