1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25static inline void vga_draw_glyph_line(uint8_t *d, uint32_t font_data,
26 uint32_t xorcol, uint32_t bgcol)
27{
28 ((uint32_t *)d)[0] = (-((font_data >> 7)) & xorcol) ^ bgcol;
29 ((uint32_t *)d)[1] = (-((font_data >> 6) & 1) & xorcol) ^ bgcol;
30 ((uint32_t *)d)[2] = (-((font_data >> 5) & 1) & xorcol) ^ bgcol;
31 ((uint32_t *)d)[3] = (-((font_data >> 4) & 1) & xorcol) ^ bgcol;
32 ((uint32_t *)d)[4] = (-((font_data >> 3) & 1) & xorcol) ^ bgcol;
33 ((uint32_t *)d)[5] = (-((font_data >> 2) & 1) & xorcol) ^ bgcol;
34 ((uint32_t *)d)[6] = (-((font_data >> 1) & 1) & xorcol) ^ bgcol;
35 ((uint32_t *)d)[7] = (-((font_data >> 0) & 1) & xorcol) ^ bgcol;
36}
37
38static void vga_draw_glyph8(uint8_t *d, int linesize,
39 const uint8_t *font_ptr, int h,
40 uint32_t fgcol, uint32_t bgcol)
41{
42 uint32_t font_data, xorcol;
43
44 xorcol = bgcol ^ fgcol;
45 do {
46 font_data = font_ptr[0];
47 vga_draw_glyph_line(d, font_data, xorcol, bgcol);
48 font_ptr += 4;
49 d += linesize;
50 } while (--h);
51}
52
53static void vga_draw_glyph16(uint8_t *d, int linesize,
54 const uint8_t *font_ptr, int h,
55 uint32_t fgcol, uint32_t bgcol)
56{
57 uint32_t font_data, xorcol;
58
59 xorcol = bgcol ^ fgcol;
60 do {
61 font_data = font_ptr[0];
62 vga_draw_glyph_line(d, expand4to8[font_data >> 4],
63 xorcol, bgcol);
64 vga_draw_glyph_line(d + 32, expand4to8[font_data & 0x0f],
65 xorcol, bgcol);
66 font_ptr += 4;
67 d += linesize;
68 } while (--h);
69}
70
71static void vga_draw_glyph9(uint8_t *d, int linesize,
72 const uint8_t *font_ptr, int h,
73 uint32_t fgcol, uint32_t bgcol, int dup9)
74{
75 uint32_t font_data, xorcol, v;
76
77 xorcol = bgcol ^ fgcol;
78 do {
79 font_data = font_ptr[0];
80 ((uint32_t *)d)[0] = (-((font_data >> 7)) & xorcol) ^ bgcol;
81 ((uint32_t *)d)[1] = (-((font_data >> 6) & 1) & xorcol) ^ bgcol;
82 ((uint32_t *)d)[2] = (-((font_data >> 5) & 1) & xorcol) ^ bgcol;
83 ((uint32_t *)d)[3] = (-((font_data >> 4) & 1) & xorcol) ^ bgcol;
84 ((uint32_t *)d)[4] = (-((font_data >> 3) & 1) & xorcol) ^ bgcol;
85 ((uint32_t *)d)[5] = (-((font_data >> 2) & 1) & xorcol) ^ bgcol;
86 ((uint32_t *)d)[6] = (-((font_data >> 1) & 1) & xorcol) ^ bgcol;
87 v = (-((font_data >> 0) & 1) & xorcol) ^ bgcol;
88 ((uint32_t *)d)[7] = v;
89 if (dup9)
90 ((uint32_t *)d)[8] = v;
91 else
92 ((uint32_t *)d)[8] = bgcol;
93 font_ptr += 4;
94 d += linesize;
95 } while (--h);
96}
97
98static inline uint8_t vga_read_byte(VGACommonState *vga, uint32_t addr)
99{
100 return vga->vram_ptr[addr & vga->vbe_size_mask];
101}
102
103static inline uint16_t vga_read_word_le(VGACommonState *vga, uint32_t addr)
104{
105 uint32_t offset = addr & vga->vbe_size_mask & ~1;
106 uint16_t *ptr = (uint16_t *)(vga->vram_ptr + offset);
107 return lduw_le_p(ptr);
108}
109
110static inline uint16_t vga_read_word_be(VGACommonState *vga, uint32_t addr)
111{
112 uint32_t offset = addr & vga->vbe_size_mask & ~1;
113 uint16_t *ptr = (uint16_t *)(vga->vram_ptr + offset);
114 return lduw_be_p(ptr);
115}
116
117static inline uint32_t vga_read_dword_le(VGACommonState *vga, uint32_t addr)
118{
119 uint32_t offset = addr & vga->vbe_size_mask & ~3;
120 uint32_t *ptr = (uint32_t *)(vga->vram_ptr + offset);
121 return ldl_le_p(ptr);
122}
123
124
125
126
127static void vga_draw_line2(VGACommonState *vga, uint8_t *d,
128 uint32_t addr, int width)
129{
130 uint32_t plane_mask, *palette, data, v;
131 int x;
132
133 palette = vga->last_palette;
134 plane_mask = mask16[vga->ar[VGA_ATC_PLANE_ENABLE] & 0xf];
135 width >>= 3;
136 for(x = 0; x < width; x++) {
137 data = vga_read_dword_le(vga, addr);
138 data &= plane_mask;
139 v = expand2[GET_PLANE(data, 0)];
140 v |= expand2[GET_PLANE(data, 2)] << 2;
141 ((uint32_t *)d)[0] = palette[v >> 12];
142 ((uint32_t *)d)[1] = palette[(v >> 8) & 0xf];
143 ((uint32_t *)d)[2] = palette[(v >> 4) & 0xf];
144 ((uint32_t *)d)[3] = palette[(v >> 0) & 0xf];
145
146 v = expand2[GET_PLANE(data, 1)];
147 v |= expand2[GET_PLANE(data, 3)] << 2;
148 ((uint32_t *)d)[4] = palette[v >> 12];
149 ((uint32_t *)d)[5] = palette[(v >> 8) & 0xf];
150 ((uint32_t *)d)[6] = palette[(v >> 4) & 0xf];
151 ((uint32_t *)d)[7] = palette[(v >> 0) & 0xf];
152 d += 32;
153 addr += 4;
154 }
155}
156
157#define PUT_PIXEL2(d, n, v) \
158((uint32_t *)d)[2*(n)] = ((uint32_t *)d)[2*(n)+1] = (v)
159
160
161
162
163static void vga_draw_line2d2(VGACommonState *vga, uint8_t *d,
164 uint32_t addr, int width)
165{
166 uint32_t plane_mask, *palette, data, v;
167 int x;
168
169 palette = vga->last_palette;
170 plane_mask = mask16[vga->ar[VGA_ATC_PLANE_ENABLE] & 0xf];
171 width >>= 3;
172 for(x = 0; x < width; x++) {
173 data = vga_read_dword_le(vga, addr);
174 data &= plane_mask;
175 v = expand2[GET_PLANE(data, 0)];
176 v |= expand2[GET_PLANE(data, 2)] << 2;
177 PUT_PIXEL2(d, 0, palette[v >> 12]);
178 PUT_PIXEL2(d, 1, palette[(v >> 8) & 0xf]);
179 PUT_PIXEL2(d, 2, palette[(v >> 4) & 0xf]);
180 PUT_PIXEL2(d, 3, palette[(v >> 0) & 0xf]);
181
182 v = expand2[GET_PLANE(data, 1)];
183 v |= expand2[GET_PLANE(data, 3)] << 2;
184 PUT_PIXEL2(d, 4, palette[v >> 12]);
185 PUT_PIXEL2(d, 5, palette[(v >> 8) & 0xf]);
186 PUT_PIXEL2(d, 6, palette[(v >> 4) & 0xf]);
187 PUT_PIXEL2(d, 7, palette[(v >> 0) & 0xf]);
188 d += 64;
189 addr += 4;
190 }
191}
192
193
194
195
196static void vga_draw_line4(VGACommonState *vga, uint8_t *d,
197 uint32_t addr, int width)
198{
199 uint32_t plane_mask, data, v, *palette;
200 int x;
201
202 palette = vga->last_palette;
203 plane_mask = mask16[vga->ar[VGA_ATC_PLANE_ENABLE] & 0xf];
204 width >>= 3;
205 for(x = 0; x < width; x++) {
206 data = vga_read_dword_le(vga, addr);
207 data &= plane_mask;
208 v = expand4[GET_PLANE(data, 0)];
209 v |= expand4[GET_PLANE(data, 1)] << 1;
210 v |= expand4[GET_PLANE(data, 2)] << 2;
211 v |= expand4[GET_PLANE(data, 3)] << 3;
212 ((uint32_t *)d)[0] = palette[v >> 28];
213 ((uint32_t *)d)[1] = palette[(v >> 24) & 0xf];
214 ((uint32_t *)d)[2] = palette[(v >> 20) & 0xf];
215 ((uint32_t *)d)[3] = palette[(v >> 16) & 0xf];
216 ((uint32_t *)d)[4] = palette[(v >> 12) & 0xf];
217 ((uint32_t *)d)[5] = palette[(v >> 8) & 0xf];
218 ((uint32_t *)d)[6] = palette[(v >> 4) & 0xf];
219 ((uint32_t *)d)[7] = palette[(v >> 0) & 0xf];
220 d += 32;
221 addr += 4;
222 }
223}
224
225
226
227
228static void vga_draw_line4d2(VGACommonState *vga, uint8_t *d,
229 uint32_t addr, int width)
230{
231 uint32_t plane_mask, data, v, *palette;
232 int x;
233
234 palette = vga->last_palette;
235 plane_mask = mask16[vga->ar[VGA_ATC_PLANE_ENABLE] & 0xf];
236 width >>= 3;
237 for(x = 0; x < width; x++) {
238 data = vga_read_dword_le(vga, addr);
239 data &= plane_mask;
240 v = expand4[GET_PLANE(data, 0)];
241 v |= expand4[GET_PLANE(data, 1)] << 1;
242 v |= expand4[GET_PLANE(data, 2)] << 2;
243 v |= expand4[GET_PLANE(data, 3)] << 3;
244 PUT_PIXEL2(d, 0, palette[v >> 28]);
245 PUT_PIXEL2(d, 1, palette[(v >> 24) & 0xf]);
246 PUT_PIXEL2(d, 2, palette[(v >> 20) & 0xf]);
247 PUT_PIXEL2(d, 3, palette[(v >> 16) & 0xf]);
248 PUT_PIXEL2(d, 4, palette[(v >> 12) & 0xf]);
249 PUT_PIXEL2(d, 5, palette[(v >> 8) & 0xf]);
250 PUT_PIXEL2(d, 6, palette[(v >> 4) & 0xf]);
251 PUT_PIXEL2(d, 7, palette[(v >> 0) & 0xf]);
252 d += 64;
253 addr += 4;
254 }
255}
256
257
258
259
260
261
262static void vga_draw_line8d2(VGACommonState *vga, uint8_t *d,
263 uint32_t addr, int width)
264{
265 uint32_t *palette;
266 int x;
267
268 palette = vga->last_palette;
269 width >>= 3;
270 for(x = 0; x < width; x++) {
271 PUT_PIXEL2(d, 0, palette[vga_read_byte(vga, addr + 0)]);
272 PUT_PIXEL2(d, 1, palette[vga_read_byte(vga, addr + 1)]);
273 PUT_PIXEL2(d, 2, palette[vga_read_byte(vga, addr + 2)]);
274 PUT_PIXEL2(d, 3, palette[vga_read_byte(vga, addr + 3)]);
275 d += 32;
276 addr += 4;
277 }
278}
279
280
281
282
283
284
285static void vga_draw_line8(VGACommonState *vga, uint8_t *d,
286 uint32_t addr, int width)
287{
288 uint32_t *palette;
289 int x;
290
291 palette = vga->last_palette;
292 width >>= 3;
293 for(x = 0; x < width; x++) {
294 ((uint32_t *)d)[0] = palette[vga_read_byte(vga, addr + 0)];
295 ((uint32_t *)d)[1] = palette[vga_read_byte(vga, addr + 1)];
296 ((uint32_t *)d)[2] = palette[vga_read_byte(vga, addr + 2)];
297 ((uint32_t *)d)[3] = palette[vga_read_byte(vga, addr + 3)];
298 ((uint32_t *)d)[4] = palette[vga_read_byte(vga, addr + 4)];
299 ((uint32_t *)d)[5] = palette[vga_read_byte(vga, addr + 5)];
300 ((uint32_t *)d)[6] = palette[vga_read_byte(vga, addr + 6)];
301 ((uint32_t *)d)[7] = palette[vga_read_byte(vga, addr + 7)];
302 d += 32;
303 addr += 8;
304 }
305}
306
307
308
309
310static void vga_draw_line15_le(VGACommonState *vga, uint8_t *d,
311 uint32_t addr, int width)
312{
313 int w;
314 uint32_t v, r, g, b;
315
316 w = width;
317 do {
318 v = vga_read_word_le(vga, addr);
319 r = (v >> 7) & 0xf8;
320 g = (v >> 2) & 0xf8;
321 b = (v << 3) & 0xf8;
322 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
323 addr += 2;
324 d += 4;
325 } while (--w != 0);
326}
327
328static void vga_draw_line15_be(VGACommonState *vga, uint8_t *d,
329 uint32_t addr, int width)
330{
331 int w;
332 uint32_t v, r, g, b;
333
334 w = width;
335 do {
336 v = vga_read_word_be(vga, addr);
337 r = (v >> 7) & 0xf8;
338 g = (v >> 2) & 0xf8;
339 b = (v << 3) & 0xf8;
340 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
341 addr += 2;
342 d += 4;
343 } while (--w != 0);
344}
345
346
347
348
349static void vga_draw_line16_le(VGACommonState *vga, uint8_t *d,
350 uint32_t addr, int width)
351{
352 int w;
353 uint32_t v, r, g, b;
354
355 w = width;
356 do {
357 v = vga_read_word_le(vga, addr);
358 r = (v >> 8) & 0xf8;
359 g = (v >> 3) & 0xfc;
360 b = (v << 3) & 0xf8;
361 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
362 addr += 2;
363 d += 4;
364 } while (--w != 0);
365}
366
367static void vga_draw_line16_be(VGACommonState *vga, uint8_t *d,
368 uint32_t addr, int width)
369{
370 int w;
371 uint32_t v, r, g, b;
372
373 w = width;
374 do {
375 v = vga_read_word_be(vga, addr);
376 r = (v >> 8) & 0xf8;
377 g = (v >> 3) & 0xfc;
378 b = (v << 3) & 0xf8;
379 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
380 addr += 2;
381 d += 4;
382 } while (--w != 0);
383}
384
385
386
387
388static void vga_draw_line24_le(VGACommonState *vga, uint8_t *d,
389 uint32_t addr, int width)
390{
391 int w;
392 uint32_t r, g, b;
393
394 w = width;
395 do {
396 b = vga_read_byte(vga, addr + 0);
397 g = vga_read_byte(vga, addr + 1);
398 r = vga_read_byte(vga, addr + 2);
399 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
400 addr += 3;
401 d += 4;
402 } while (--w != 0);
403}
404
405static void vga_draw_line24_be(VGACommonState *vga, uint8_t *d,
406 uint32_t addr, int width)
407{
408 int w;
409 uint32_t r, g, b;
410
411 w = width;
412 do {
413 r = vga_read_byte(vga, addr + 0);
414 g = vga_read_byte(vga, addr + 1);
415 b = vga_read_byte(vga, addr + 2);
416 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
417 addr += 3;
418 d += 4;
419 } while (--w != 0);
420}
421
422
423
424
425static void vga_draw_line32_le(VGACommonState *vga, uint8_t *d,
426 uint32_t addr, int width)
427{
428 int w;
429 uint32_t r, g, b;
430
431 w = width;
432 do {
433 b = vga_read_byte(vga, addr + 0);
434 g = vga_read_byte(vga, addr + 1);
435 r = vga_read_byte(vga, addr + 2);
436 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
437 addr += 4;
438 d += 4;
439 } while (--w != 0);
440}
441
442static void vga_draw_line32_be(VGACommonState *vga, uint8_t *d,
443 uint32_t addr, int width)
444{
445 int w;
446 uint32_t r, g, b;
447
448 w = width;
449 do {
450 r = vga_read_byte(vga, addr + 1);
451 g = vga_read_byte(vga, addr + 2);
452 b = vga_read_byte(vga, addr + 3);
453 ((uint32_t *)d)[0] = rgb_to_pixel32(r, g, b);
454 addr += 4;
455 d += 4;
456 } while (--w != 0);
457}
458