Merge branch 'upstream-merge'
[qemu-kvm/markmc.git] / hw / tcx.c
blob708bb8063722d9a25ed8b66997f5fd144c83d622
1 /*
2 * QEMU TCX Frame buffer
4 * Copyright (c) 2003-2005 Fabrice Bellard
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
25 #include "console.h"
26 #include "pixel_ops.h"
27 #include "sysbus.h"
28 #include "qdev-addr.h"
30 #define MAXX 1024
31 #define MAXY 768
32 #define TCX_DAC_NREGS 16
33 #define TCX_THC_NREGS_8 0x081c
34 #define TCX_THC_NREGS_24 0x1000
35 #define TCX_TEC_NREGS 0x1000
37 typedef struct TCXState {
38 SysBusDevice busdev;
39 target_phys_addr_t addr;
40 DisplayState *ds;
41 uint8_t *vram;
42 uint32_t *vram24, *cplane;
43 ram_addr_t vram_offset, vram24_offset, cplane_offset;
44 uint32_t vram_size;
45 uint16_t width, height, depth;
46 uint8_t r[256], g[256], b[256];
47 uint32_t palette[256];
48 uint8_t dac_index, dac_state;
49 } TCXState;
51 static void tcx_screen_dump(void *opaque, const char *filename);
52 static void tcx24_screen_dump(void *opaque, const char *filename);
54 static void tcx_set_dirty(TCXState *s)
56 unsigned int i;
58 for (i = 0; i < MAXX * MAXY; i += TARGET_PAGE_SIZE) {
59 cpu_physical_memory_set_dirty(s->vram_offset + i);
63 static void tcx24_set_dirty(TCXState *s)
65 unsigned int i;
67 for (i = 0; i < MAXX * MAXY * 4; i += TARGET_PAGE_SIZE) {
68 cpu_physical_memory_set_dirty(s->vram24_offset + i);
69 cpu_physical_memory_set_dirty(s->cplane_offset + i);
73 static void update_palette_entries(TCXState *s, int start, int end)
75 int i;
76 for(i = start; i < end; i++) {
77 switch(ds_get_bits_per_pixel(s->ds)) {
78 default:
79 case 8:
80 s->palette[i] = rgb_to_pixel8(s->r[i], s->g[i], s->b[i]);
81 break;
82 case 15:
83 s->palette[i] = rgb_to_pixel15(s->r[i], s->g[i], s->b[i]);
84 break;
85 case 16:
86 s->palette[i] = rgb_to_pixel16(s->r[i], s->g[i], s->b[i]);
87 break;
88 case 32:
89 if (is_surface_bgr(s->ds->surface))
90 s->palette[i] = rgb_to_pixel32bgr(s->r[i], s->g[i], s->b[i]);
91 else
92 s->palette[i] = rgb_to_pixel32(s->r[i], s->g[i], s->b[i]);
93 break;
96 if (s->depth == 24) {
97 tcx24_set_dirty(s);
98 } else {
99 tcx_set_dirty(s);
103 static void tcx_draw_line32(TCXState *s1, uint8_t *d,
104 const uint8_t *s, int width)
106 int x;
107 uint8_t val;
108 uint32_t *p = (uint32_t *)d;
110 for(x = 0; x < width; x++) {
111 val = *s++;
112 *p++ = s1->palette[val];
116 static void tcx_draw_line16(TCXState *s1, uint8_t *d,
117 const uint8_t *s, int width)
119 int x;
120 uint8_t val;
121 uint16_t *p = (uint16_t *)d;
123 for(x = 0; x < width; x++) {
124 val = *s++;
125 *p++ = s1->palette[val];
129 static void tcx_draw_line8(TCXState *s1, uint8_t *d,
130 const uint8_t *s, int width)
132 int x;
133 uint8_t val;
135 for(x = 0; x < width; x++) {
136 val = *s++;
137 *d++ = s1->palette[val];
142 XXX Could be much more optimal:
143 * detect if line/page/whole screen is in 24 bit mode
144 * if destination is also BGR, use memcpy
146 static inline void tcx24_draw_line32(TCXState *s1, uint8_t *d,
147 const uint8_t *s, int width,
148 const uint32_t *cplane,
149 const uint32_t *s24)
151 int x, bgr, r, g, b;
152 uint8_t val, *p8;
153 uint32_t *p = (uint32_t *)d;
154 uint32_t dval;
156 bgr = is_surface_bgr(s1->ds->surface);
157 for(x = 0; x < width; x++, s++, s24++) {
158 if ((be32_to_cpu(*cplane++) & 0xff000000) == 0x03000000) {
159 // 24-bit direct, BGR order
160 p8 = (uint8_t *)s24;
161 p8++;
162 b = *p8++;
163 g = *p8++;
164 r = *p8++;
165 if (bgr)
166 dval = rgb_to_pixel32bgr(r, g, b);
167 else
168 dval = rgb_to_pixel32(r, g, b);
169 } else {
170 val = *s;
171 dval = s1->palette[val];
173 *p++ = dval;
177 static inline int check_dirty(ram_addr_t page, ram_addr_t page24,
178 ram_addr_t cpage)
180 int ret;
181 unsigned int off;
183 ret = cpu_physical_memory_get_dirty(page, VGA_DIRTY_FLAG);
184 for (off = 0; off < TARGET_PAGE_SIZE * 4; off += TARGET_PAGE_SIZE) {
185 ret |= cpu_physical_memory_get_dirty(page24 + off, VGA_DIRTY_FLAG);
186 ret |= cpu_physical_memory_get_dirty(cpage + off, VGA_DIRTY_FLAG);
188 return ret;
191 static inline void reset_dirty(TCXState *ts, ram_addr_t page_min,
192 ram_addr_t page_max, ram_addr_t page24,
193 ram_addr_t cpage)
195 cpu_physical_memory_reset_dirty(page_min, page_max + TARGET_PAGE_SIZE,
196 VGA_DIRTY_FLAG);
197 page_min -= ts->vram_offset;
198 page_max -= ts->vram_offset;
199 cpu_physical_memory_reset_dirty(page24 + page_min * 4,
200 page24 + page_max * 4 + TARGET_PAGE_SIZE,
201 VGA_DIRTY_FLAG);
202 cpu_physical_memory_reset_dirty(cpage + page_min * 4,
203 cpage + page_max * 4 + TARGET_PAGE_SIZE,
204 VGA_DIRTY_FLAG);
207 /* Fixed line length 1024 allows us to do nice tricks not possible on
208 VGA... */
209 static void tcx_update_display(void *opaque)
211 TCXState *ts = opaque;
212 ram_addr_t page, page_min, page_max;
213 int y, y_start, dd, ds;
214 uint8_t *d, *s;
215 void (*f)(TCXState *s1, uint8_t *dst, const uint8_t *src, int width);
217 if (ds_get_bits_per_pixel(ts->ds) == 0)
218 return;
219 page = ts->vram_offset;
220 y_start = -1;
221 page_min = -1;
222 page_max = 0;
223 d = ds_get_data(ts->ds);
224 s = ts->vram;
225 dd = ds_get_linesize(ts->ds);
226 ds = 1024;
228 switch (ds_get_bits_per_pixel(ts->ds)) {
229 case 32:
230 f = tcx_draw_line32;
231 break;
232 case 15:
233 case 16:
234 f = tcx_draw_line16;
235 break;
236 default:
237 case 8:
238 f = tcx_draw_line8;
239 break;
240 case 0:
241 return;
244 for(y = 0; y < ts->height; y += 4, page += TARGET_PAGE_SIZE) {
245 if (cpu_physical_memory_get_dirty(page, VGA_DIRTY_FLAG)) {
246 if (y_start < 0)
247 y_start = y;
248 if (page < page_min)
249 page_min = page;
250 if (page > page_max)
251 page_max = page;
252 f(ts, d, s, ts->width);
253 d += dd;
254 s += ds;
255 f(ts, d, s, ts->width);
256 d += dd;
257 s += ds;
258 f(ts, d, s, ts->width);
259 d += dd;
260 s += ds;
261 f(ts, d, s, ts->width);
262 d += dd;
263 s += ds;
264 } else {
265 if (y_start >= 0) {
266 /* flush to display */
267 dpy_update(ts->ds, 0, y_start,
268 ts->width, y - y_start);
269 y_start = -1;
271 d += dd * 4;
272 s += ds * 4;
275 if (y_start >= 0) {
276 /* flush to display */
277 dpy_update(ts->ds, 0, y_start,
278 ts->width, y - y_start);
280 /* reset modified pages */
281 if (page_max >= page_min) {
282 cpu_physical_memory_reset_dirty(page_min, page_max + TARGET_PAGE_SIZE,
283 VGA_DIRTY_FLAG);
287 static void tcx24_update_display(void *opaque)
289 TCXState *ts = opaque;
290 ram_addr_t page, page_min, page_max, cpage, page24;
291 int y, y_start, dd, ds;
292 uint8_t *d, *s;
293 uint32_t *cptr, *s24;
295 if (ds_get_bits_per_pixel(ts->ds) != 32)
296 return;
297 page = ts->vram_offset;
298 page24 = ts->vram24_offset;
299 cpage = ts->cplane_offset;
300 y_start = -1;
301 page_min = -1;
302 page_max = 0;
303 d = ds_get_data(ts->ds);
304 s = ts->vram;
305 s24 = ts->vram24;
306 cptr = ts->cplane;
307 dd = ds_get_linesize(ts->ds);
308 ds = 1024;
310 for(y = 0; y < ts->height; y += 4, page += TARGET_PAGE_SIZE,
311 page24 += TARGET_PAGE_SIZE, cpage += TARGET_PAGE_SIZE) {
312 if (check_dirty(page, page24, cpage)) {
313 if (y_start < 0)
314 y_start = y;
315 if (page < page_min)
316 page_min = page;
317 if (page > page_max)
318 page_max = page;
319 tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
320 d += dd;
321 s += ds;
322 cptr += ds;
323 s24 += ds;
324 tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
325 d += dd;
326 s += ds;
327 cptr += ds;
328 s24 += ds;
329 tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
330 d += dd;
331 s += ds;
332 cptr += ds;
333 s24 += ds;
334 tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
335 d += dd;
336 s += ds;
337 cptr += ds;
338 s24 += ds;
339 } else {
340 if (y_start >= 0) {
341 /* flush to display */
342 dpy_update(ts->ds, 0, y_start,
343 ts->width, y - y_start);
344 y_start = -1;
346 d += dd * 4;
347 s += ds * 4;
348 cptr += ds * 4;
349 s24 += ds * 4;
352 if (y_start >= 0) {
353 /* flush to display */
354 dpy_update(ts->ds, 0, y_start,
355 ts->width, y - y_start);
357 /* reset modified pages */
358 if (page_max >= page_min) {
359 reset_dirty(ts, page_min, page_max, page24, cpage);
363 static void tcx_invalidate_display(void *opaque)
365 TCXState *s = opaque;
367 tcx_set_dirty(s);
368 qemu_console_resize(s->ds, s->width, s->height);
371 static void tcx24_invalidate_display(void *opaque)
373 TCXState *s = opaque;
375 tcx_set_dirty(s);
376 tcx24_set_dirty(s);
377 qemu_console_resize(s->ds, s->width, s->height);
380 static int vmstate_tcx_post_load(void *opaque, int version_id)
382 TCXState *s = opaque;
384 update_palette_entries(s, 0, 256);
385 if (s->depth == 24) {
386 tcx24_set_dirty(s);
387 } else {
388 tcx_set_dirty(s);
391 return 0;
394 static const VMStateDescription vmstate_tcx = {
395 .name ="tcx",
396 .version_id = 4,
397 .minimum_version_id = 4,
398 .minimum_version_id_old = 4,
399 .post_load = vmstate_tcx_post_load,
400 .fields = (VMStateField []) {
401 VMSTATE_UINT16(height, TCXState),
402 VMSTATE_UINT16(width, TCXState),
403 VMSTATE_UINT16(depth, TCXState),
404 VMSTATE_BUFFER(r, TCXState),
405 VMSTATE_BUFFER(g, TCXState),
406 VMSTATE_BUFFER(b, TCXState),
407 VMSTATE_UINT8(dac_index, TCXState),
408 VMSTATE_UINT8(dac_state, TCXState),
409 VMSTATE_END_OF_LIST()
413 static void tcx_reset(DeviceState *d)
415 TCXState *s = container_of(d, TCXState, busdev.qdev);
417 /* Initialize palette */
418 memset(s->r, 0, 256);
419 memset(s->g, 0, 256);
420 memset(s->b, 0, 256);
421 s->r[255] = s->g[255] = s->b[255] = 255;
422 update_palette_entries(s, 0, 256);
423 memset(s->vram, 0, MAXX*MAXY);
424 cpu_physical_memory_reset_dirty(s->vram_offset, s->vram_offset +
425 MAXX * MAXY * (1 + 4 + 4), VGA_DIRTY_FLAG);
426 s->dac_index = 0;
427 s->dac_state = 0;
430 static uint32_t tcx_dac_readl(void *opaque, target_phys_addr_t addr)
432 return 0;
435 static void tcx_dac_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
437 TCXState *s = opaque;
439 switch (addr) {
440 case 0:
441 s->dac_index = val >> 24;
442 s->dac_state = 0;
443 break;
444 case 4:
445 switch (s->dac_state) {
446 case 0:
447 s->r[s->dac_index] = val >> 24;
448 update_palette_entries(s, s->dac_index, s->dac_index + 1);
449 s->dac_state++;
450 break;
451 case 1:
452 s->g[s->dac_index] = val >> 24;
453 update_palette_entries(s, s->dac_index, s->dac_index + 1);
454 s->dac_state++;
455 break;
456 case 2:
457 s->b[s->dac_index] = val >> 24;
458 update_palette_entries(s, s->dac_index, s->dac_index + 1);
459 s->dac_index = (s->dac_index + 1) & 255; // Index autoincrement
460 default:
461 s->dac_state = 0;
462 break;
464 break;
465 default:
466 break;
468 return;
471 static CPUReadMemoryFunc * const tcx_dac_read[3] = {
472 NULL,
473 NULL,
474 tcx_dac_readl,
477 static CPUWriteMemoryFunc * const tcx_dac_write[3] = {
478 NULL,
479 NULL,
480 tcx_dac_writel,
483 static uint32_t tcx_dummy_readl(void *opaque, target_phys_addr_t addr)
485 return 0;
488 static void tcx_dummy_writel(void *opaque, target_phys_addr_t addr,
489 uint32_t val)
493 static CPUReadMemoryFunc * const tcx_dummy_read[3] = {
494 NULL,
495 NULL,
496 tcx_dummy_readl,
499 static CPUWriteMemoryFunc * const tcx_dummy_write[3] = {
500 NULL,
501 NULL,
502 tcx_dummy_writel,
505 static int tcx_init1(SysBusDevice *dev)
507 TCXState *s = FROM_SYSBUS(TCXState, dev);
508 int io_memory, dummy_memory;
509 ram_addr_t vram_offset;
510 int size;
511 uint8_t *vram_base;
513 vram_offset = qemu_ram_alloc(s->vram_size * (1 + 4 + 4));
514 vram_base = qemu_get_ram_ptr(vram_offset);
515 s->vram_offset = vram_offset;
517 /* 8-bit plane */
518 s->vram = vram_base;
519 size = s->vram_size;
520 sysbus_init_mmio(dev, size, s->vram_offset);
521 vram_offset += size;
522 vram_base += size;
524 /* DAC */
525 io_memory = cpu_register_io_memory(tcx_dac_read, tcx_dac_write, s);
526 sysbus_init_mmio(dev, TCX_DAC_NREGS, io_memory);
528 /* TEC (dummy) */
529 dummy_memory = cpu_register_io_memory(tcx_dummy_read, tcx_dummy_write,
531 sysbus_init_mmio(dev, TCX_TEC_NREGS, dummy_memory);
532 /* THC: NetBSD writes here even with 8-bit display: dummy */
533 sysbus_init_mmio(dev, TCX_THC_NREGS_24, dummy_memory);
535 if (s->depth == 24) {
536 /* 24-bit plane */
537 size = s->vram_size * 4;
538 s->vram24 = (uint32_t *)vram_base;
539 s->vram24_offset = vram_offset;
540 sysbus_init_mmio(dev, size, vram_offset);
541 vram_offset += size;
542 vram_base += size;
544 /* Control plane */
545 size = s->vram_size * 4;
546 s->cplane = (uint32_t *)vram_base;
547 s->cplane_offset = vram_offset;
548 sysbus_init_mmio(dev, size, vram_offset);
550 s->ds = graphic_console_init(tcx24_update_display,
551 tcx24_invalidate_display,
552 tcx24_screen_dump, NULL, s);
553 } else {
554 /* THC 8 bit (dummy) */
555 sysbus_init_mmio(dev, TCX_THC_NREGS_8, dummy_memory);
557 s->ds = graphic_console_init(tcx_update_display,
558 tcx_invalidate_display,
559 tcx_screen_dump, NULL, s);
562 tcx_reset(&s->busdev.qdev);
563 qemu_console_resize(s->ds, s->width, s->height);
564 return 0;
567 static void tcx_screen_dump(void *opaque, const char *filename)
569 TCXState *s = opaque;
570 FILE *f;
571 uint8_t *d, *d1, v;
572 int y, x;
574 f = fopen(filename, "wb");
575 if (!f)
576 return;
577 fprintf(f, "P6\n%d %d\n%d\n", s->width, s->height, 255);
578 d1 = s->vram;
579 for(y = 0; y < s->height; y++) {
580 d = d1;
581 for(x = 0; x < s->width; x++) {
582 v = *d;
583 fputc(s->r[v], f);
584 fputc(s->g[v], f);
585 fputc(s->b[v], f);
586 d++;
588 d1 += MAXX;
590 fclose(f);
591 return;
594 static void tcx24_screen_dump(void *opaque, const char *filename)
596 TCXState *s = opaque;
597 FILE *f;
598 uint8_t *d, *d1, v;
599 uint32_t *s24, *cptr, dval;
600 int y, x;
602 f = fopen(filename, "wb");
603 if (!f)
604 return;
605 fprintf(f, "P6\n%d %d\n%d\n", s->width, s->height, 255);
606 d1 = s->vram;
607 s24 = s->vram24;
608 cptr = s->cplane;
609 for(y = 0; y < s->height; y++) {
610 d = d1;
611 for(x = 0; x < s->width; x++, d++, s24++) {
612 if ((*cptr++ & 0xff000000) == 0x03000000) { // 24-bit direct
613 dval = *s24 & 0x00ffffff;
614 fputc((dval >> 16) & 0xff, f);
615 fputc((dval >> 8) & 0xff, f);
616 fputc(dval & 0xff, f);
617 } else {
618 v = *d;
619 fputc(s->r[v], f);
620 fputc(s->g[v], f);
621 fputc(s->b[v], f);
624 d1 += MAXX;
626 fclose(f);
627 return;
630 static SysBusDeviceInfo tcx_info = {
631 .init = tcx_init1,
632 .qdev.name = "SUNW,tcx",
633 .qdev.size = sizeof(TCXState),
634 .qdev.reset = tcx_reset,
635 .qdev.vmsd = &vmstate_tcx,
636 .qdev.props = (Property[]) {
637 DEFINE_PROP_TADDR("addr", TCXState, addr, -1),
638 DEFINE_PROP_HEX32("vram_size", TCXState, vram_size, -1),
639 DEFINE_PROP_UINT16("width", TCXState, width, -1),
640 DEFINE_PROP_UINT16("height", TCXState, height, -1),
641 DEFINE_PROP_UINT16("depth", TCXState, depth, -1),
642 DEFINE_PROP_END_OF_LIST(),
646 static void tcx_register_devices(void)
648 sysbus_register_withprop(&tcx_info);
651 device_init(tcx_register_devices)