target/arm: Honor HCR_EL2.TID1 trapping requirements
[qemu/ar7.git] / hw / display / omap_lcd_template.h
blob1025ff3825d4f3920e107851c9a60516b83ede93
1 /*
2 * QEMU OMAP LCD Emulator templates
4 * Copyright (c) 2006 Andrzej Zaborowski <balrog@zabor.org>
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
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.
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.
30 #if DEPTH == 32
31 # define BPP 4
32 # define PIXEL_TYPE uint32_t
33 #else
34 # error unsupport depth
35 #endif
38 * 2-bit colour
40 static void glue(draw_line2_, DEPTH)(void *opaque,
41 uint8_t *d, const uint8_t *s, int width, int deststep)
43 uint16_t *pal = opaque;
44 uint8_t v, r, g, b;
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);
77 * 4-bit colour
79 static void glue(draw_line4_, DEPTH)(void *opaque,
80 uint8_t *d, const uint8_t *s, int width, int deststep)
82 uint16_t *pal = opaque;
83 uint8_t v, r, g, b;
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);
104 * 8-bit colour
106 static void glue(draw_line8_, DEPTH)(void *opaque,
107 uint8_t *d, const uint8_t *s, int width, int deststep)
109 uint16_t *pal = opaque;
110 uint8_t v, r, g, b;
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);
124 * 12-bit colour
126 static void glue(draw_line12_, DEPTH)(void *opaque,
127 uint8_t *d, const uint8_t *s, int width, int deststep)
129 uint16_t v;
130 uint8_t r, g, b;
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);
144 * 16-bit colour
146 static void glue(draw_line16_, DEPTH)(void *opaque,
147 uint8_t *d, const uint8_t *s, int width, int deststep)
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;
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
167 #undef DEPTH
168 #undef BPP
169 #undef PIXEL_TYPE