1 | /* |
2 | * QEMU OMAP LCD Emulator templates |
3 | * |
4 | * Copyright (c) 2006 Andrzej Zaborowski <balrog@zabor.org> |
5 | * |
6 | * Redistribution and use in source and binary forms, with or without |
7 | * modification, are permitted provided that the following conditions |
8 | * are met: |
9 | * |
10 | * 1. Redistributions of source code must retain the above copyright |
11 | * notice, this list of conditions and the following disclaimer. |
12 | * 2. Redistributions in binary form must reproduce the above copyright |
13 | * notice, this list of conditions and the following disclaimer in |
14 | * the documentation and/or other materials provided with the |
15 | * distribution. |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' |
18 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, |
19 | * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A |
20 | * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR |
21 | * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, |
22 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, |
23 | * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR |
24 | * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY |
25 | * OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
27 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
28 | */ |
29 | |
30 | #if DEPTH == 32 |
31 | # define BPP 4 |
32 | # define PIXEL_TYPE uint32_t |
33 | #else |
34 | # error unsupport depth |
35 | #endif |
36 | |
37 | /* |
38 | * 2-bit colour |
39 | */ |
40 | static void glue(draw_line2_, DEPTH)(void *opaque, |
41 | uint8_t *d, const uint8_t *s, int width, int deststep) |
42 | { |
43 | uint16_t *pal = opaque; |
44 | uint8_t v, r, g, b; |
45 | |
46 | do { |
47 | v = ldub_p((void *) s); |
48 | r = (pal[v & 3] >> 4) & 0xf0; |
49 | g = pal[v & 3] & 0xf0; |
50 | b = (pal[v & 3] << 4) & 0xf0; |
51 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
52 | d += BPP; |
53 | v >>= 2; |
54 | r = (pal[v & 3] >> 4) & 0xf0; |
55 | g = pal[v & 3] & 0xf0; |
56 | b = (pal[v & 3] << 4) & 0xf0; |
57 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
58 | d += BPP; |
59 | v >>= 2; |
60 | r = (pal[v & 3] >> 4) & 0xf0; |
61 | g = pal[v & 3] & 0xf0; |
62 | b = (pal[v & 3] << 4) & 0xf0; |
63 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
64 | d += BPP; |
65 | v >>= 2; |
66 | r = (pal[v & 3] >> 4) & 0xf0; |
67 | g = pal[v & 3] & 0xf0; |
68 | b = (pal[v & 3] << 4) & 0xf0; |
69 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
70 | d += BPP; |
71 | s ++; |
72 | width -= 4; |
73 | } while (width > 0); |
74 | } |
75 | |
76 | /* |
77 | * 4-bit colour |
78 | */ |
79 | static void glue(draw_line4_, DEPTH)(void *opaque, |
80 | uint8_t *d, const uint8_t *s, int width, int deststep) |
81 | { |
82 | uint16_t *pal = opaque; |
83 | uint8_t v, r, g, b; |
84 | |
85 | do { |
86 | v = ldub_p((void *) s); |
87 | r = (pal[v & 0xf] >> 4) & 0xf0; |
88 | g = pal[v & 0xf] & 0xf0; |
89 | b = (pal[v & 0xf] << 4) & 0xf0; |
90 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
91 | d += BPP; |
92 | v >>= 4; |
93 | r = (pal[v & 0xf] >> 4) & 0xf0; |
94 | g = pal[v & 0xf] & 0xf0; |
95 | b = (pal[v & 0xf] << 4) & 0xf0; |
96 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
97 | d += BPP; |
98 | s ++; |
99 | width -= 2; |
100 | } while (width > 0); |
101 | } |
102 | |
103 | /* |
104 | * 8-bit colour |
105 | */ |
106 | static void glue(draw_line8_, DEPTH)(void *opaque, |
107 | uint8_t *d, const uint8_t *s, int width, int deststep) |
108 | { |
109 | uint16_t *pal = opaque; |
110 | uint8_t v, r, g, b; |
111 | |
112 | do { |
113 | v = ldub_p((void *) s); |
114 | r = (pal[v] >> 4) & 0xf0; |
115 | g = pal[v] & 0xf0; |
116 | b = (pal[v] << 4) & 0xf0; |
117 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
118 | s ++; |
119 | d += BPP; |
120 | } while (-- width != 0); |
121 | } |
122 | |
123 | /* |
124 | * 12-bit colour |
125 | */ |
126 | static void glue(draw_line12_, DEPTH)(void *opaque, |
127 | uint8_t *d, const uint8_t *s, int width, int deststep) |
128 | { |
129 | uint16_t v; |
130 | uint8_t r, g, b; |
131 | |
132 | do { |
133 | v = lduw_le_p((void *) s); |
134 | r = (v >> 4) & 0xf0; |
135 | g = v & 0xf0; |
136 | b = (v << 4) & 0xf0; |
137 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
138 | s += 2; |
139 | d += BPP; |
140 | } while (-- width != 0); |
141 | } |
142 | |
143 | /* |
144 | * 16-bit colour |
145 | */ |
146 | static void glue(draw_line16_, DEPTH)(void *opaque, |
147 | uint8_t *d, const uint8_t *s, int width, int deststep) |
148 | { |
149 | #if defined(HOST_WORDS_BIGENDIAN) == defined(TARGET_WORDS_BIGENDIAN) |
150 | memcpy(d, s, width * 2); |
151 | #else |
152 | uint16_t v; |
153 | uint8_t r, g, b; |
154 | |
155 | do { |
156 | v = lduw_le_p((void *) s); |
157 | r = (v >> 8) & 0xf8; |
158 | g = (v >> 3) & 0xfc; |
159 | b = (v << 3) & 0xf8; |
160 | ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b); |
161 | s += 2; |
162 | d += BPP; |
163 | } while (-- width != 0); |
164 | #endif |
165 | } |
166 | |
167 | #undef DEPTH |
168 | #undef BPP |
169 | #undef PIXEL_TYPE |
170 | |