vcs.maemo.org Git - qemu/blob - hw/tcx.c

   1 /*
   2  * QEMU TCX Frame buffer
   3  *
   4  * Copyright (c) 2003-2005 Fabrice Bellard
   5  *
   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:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  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.
  23  */
  24 #include "vl.h"
  25
  26 #define MAXX 1024
  27 #define MAXY 768
  28 #define TCX_DAC_NREGS 16
  29
  30 typedef struct TCXState {
  31     uint32_t addr;
  32     DisplayState *ds;
  33     uint8_t *vram;
  34     uint32_t *vram24, *cplane;
  35     ram_addr_t vram_offset, vram24_offset, cplane_offset;
  36     uint16_t width, height, depth;
  37     uint8_t r[256], g[256], b[256];
  38     uint32_t palette[256];
  39     uint8_t dac_index, dac_state;
  40 } TCXState;
  41
  42 static void tcx_screen_dump(void *opaque, const char *filename);
  43 static void tcx24_screen_dump(void *opaque, const char *filename);
  44
  45 /* XXX: unify with vga draw line functions */
  46 static inline unsigned int rgb_to_pixel8(unsigned int r, unsigned int g, unsigned b)
  47 {
  48     return ((r >> 5) << 5) | ((g >> 5) << 2) | (b >> 6);
  49 }
  50
  51 static inline unsigned int rgb_to_pixel15(unsigned int r, unsigned int g, unsigned b)
  52 {
  53     return ((r >> 3) << 10) | ((g >> 3) << 5) | (b >> 3);
  54 }
  55
  56 static inline unsigned int rgb_to_pixel16(unsigned int r, unsigned int g, unsigned b)
  57 {
  58     return ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  59 }
  60
  61 static inline unsigned int rgb_to_pixel32(unsigned int r, unsigned int g, unsigned b)
  62 {
  63     return (r << 16) | (g << 8) | b;
  64 }
  65
  66 static void update_palette_entries(TCXState *s, int start, int end)
  67 {
  68     int i;
  69     for(i = start; i < end; i++) {
  70         switch(s->ds->depth) {
  71         default:
  72         case 8:
  73             s->palette[i] = rgb_to_pixel8(s->r[i], s->g[i], s->b[i]);
  74             break;
  75         case 15:
  76             s->palette[i] = rgb_to_pixel15(s->r[i], s->g[i], s->b[i]);
  77             break;
  78         case 16:
  79             s->palette[i] = rgb_to_pixel16(s->r[i], s->g[i], s->b[i]);
  80             break;
  81         case 32:
  82             s->palette[i] = rgb_to_pixel32(s->r[i], s->g[i], s->b[i]);
  83             break;
  84         }
  85     }
  86 }
  87
  88 static void tcx_draw_line32(TCXState *s1, uint8_t *d,
  89                             const uint8_t *s, int width)
  90 {
  91     int x;
  92     uint8_t val;
  93     uint32_t *p = (uint32_t *)d;
  94
  95     for(x = 0; x < width; x++) {
  96         val = *s++;
  97         *p++ = s1->palette[val];
  98     }
  99 }
 100
 101 static void tcx_draw_line16(TCXState *s1, uint8_t *d,
 102                             const uint8_t *s, int width)
 103 {
 104     int x;
 105     uint8_t val;
 106     uint16_t *p = (uint16_t *)d;
 107
 108     for(x = 0; x < width; x++) {
 109         val = *s++;
 110         *p++ = s1->palette[val];
 111     }
 112 }
 113
 114 static void tcx_draw_line8(TCXState *s1, uint8_t *d,
 115                            const uint8_t *s, int width)
 116 {
 117     int x;
 118     uint8_t val;
 119
 120     for(x = 0; x < width; x++) {
 121         val = *s++;
 122         *d++ = s1->palette[val];
 123     }
 124 }
 125
 126 static inline void tcx24_draw_line32(TCXState *s1, uint8_t *d,
 127                                      const uint8_t *s, int width,
 128                                      const uint32_t *cplane,
 129                                      const uint32_t *s24)
 130 {
 131     int x;
 132     uint8_t val;
 133     uint32_t *p = (uint32_t *)d;
 134     uint32_t dval;
 135
 136     for(x = 0; x < width; x++, s++, s24++) {
 137         if ((bswap32(*cplane++) & 0xff000000) == 0x03000000) { // 24-bit direct
 138             dval = bswap32(*s24) & 0x00ffffff;
 139         } else {
 140             val = *s;
 141             dval = s1->palette[val];
 142         }
 143         *p++ = dval;
 144     }
 145 }
 146
 147 static inline int check_dirty(TCXState *ts, ram_addr_t page, ram_addr_t page24,
 148                               ram_addr_t cpage)
 149 {
 150     int ret;
 151     unsigned int off;
 152
 153     ret = cpu_physical_memory_get_dirty(page, VGA_DIRTY_FLAG);
 154     for (off = 0; off < TARGET_PAGE_SIZE * 4; off += TARGET_PAGE_SIZE) {
 155         ret |= cpu_physical_memory_get_dirty(page24 + off, VGA_DIRTY_FLAG);
 156         ret |= cpu_physical_memory_get_dirty(cpage + off, VGA_DIRTY_FLAG);
 157     }
 158     return ret;
 159 }
 160
 161 static inline void reset_dirty(TCXState *ts, ram_addr_t page_min,
 162                                ram_addr_t page_max, ram_addr_t page24,
 163                               ram_addr_t cpage)
 164 {
 165     cpu_physical_memory_reset_dirty(page_min, page_max + TARGET_PAGE_SIZE,
 166                                     VGA_DIRTY_FLAG);
 167     page_min -= ts->vram_offset;
 168     page_max -= ts->vram_offset;
 169     cpu_physical_memory_reset_dirty(page24 + page_min * 4,
 170                                     page24 + page_max * 4 + TARGET_PAGE_SIZE,
 171                                     VGA_DIRTY_FLAG);
 172     cpu_physical_memory_reset_dirty(cpage + page_min * 4,
 173                                     cpage + page_max * 4 + TARGET_PAGE_SIZE,
 174                                     VGA_DIRTY_FLAG);
 175 }
 176
 177 /* Fixed line length 1024 allows us to do nice tricks not possible on
 178    VGA... */
 179 static void tcx_update_display(void *opaque)
 180 {
 181     TCXState *ts = opaque;
 182     ram_addr_t page, page_min, page_max;
 183     int y, y_start, dd, ds;
 184     uint8_t *d, *s;
 185     void (*f)(TCXState *s1, uint8_t *d, const uint8_t *s, int width);
 186
 187     if (ts->ds->depth == 0)
 188         return;
 189     page = ts->vram_offset;
 190     y_start = -1;
 191     page_min = 0xffffffff;
 192     page_max = 0;
 193     d = ts->ds->data;
 194     s = ts->vram;
 195     dd = ts->ds->linesize;
 196     ds = 1024;
 197
 198     switch (ts->ds->depth) {
 199     case 32:
 200         f = tcx_draw_line32;
 201         break;
 202     case 15:
 203     case 16:
 204         f = tcx_draw_line16;
 205         break;
 206     default:
 207     case 8:
 208         f = tcx_draw_line8;
 209         break;
 210     case 0:
 211         return;
 212     }
 213
 214     for(y = 0; y < ts->height; y += 4, page += TARGET_PAGE_SIZE) {
 215         if (cpu_physical_memory_get_dirty(page, VGA_DIRTY_FLAG)) {
 216             if (y_start < 0)
 217                 y_start = y;
 218             if (page < page_min)
 219                 page_min = page;
 220             if (page > page_max)
 221                 page_max = page;
 222             f(ts, d, s, ts->width);
 223             d += dd;
 224             s += ds;
 225             f(ts, d, s, ts->width);
 226             d += dd;
 227             s += ds;
 228             f(ts, d, s, ts->width);
 229             d += dd;
 230             s += ds;
 231             f(ts, d, s, ts->width);
 232             d += dd;
 233             s += ds;
 234         } else {
 235             if (y_start >= 0) {
 236                 /* flush to display */
 237                 dpy_update(ts->ds, 0, y_start,
 238                            ts->width, y - y_start);
 239                 y_start = -1;
 240             }
 241             d += dd * 4;
 242             s += ds * 4;
 243         }
 244     }
 245     if (y_start >= 0) {
 246         /* flush to display */
 247         dpy_update(ts->ds, 0, y_start,
 248                    ts->width, y - y_start);
 249     }
 250     /* reset modified pages */
 251     if (page_min <= page_max) {
 252         cpu_physical_memory_reset_dirty(page_min, page_max + TARGET_PAGE_SIZE,
 253                                         VGA_DIRTY_FLAG);
 254     }
 255 }
 256
 257 static void tcx24_update_display(void *opaque)
 258 {
 259     TCXState *ts = opaque;
 260     ram_addr_t page, page_min, page_max, cpage, page24;
 261     int y, y_start, dd, ds;
 262     uint8_t *d, *s;
 263     uint32_t *cptr, *s24;
 264
 265     if (ts->ds->depth != 32)
 266             return;
 267     page = ts->vram_offset;
 268     page24 = ts->vram24_offset;
 269     cpage = ts->cplane_offset;
 270     y_start = -1;
 271     page_min = 0xffffffff;
 272     page_max = 0;
 273     d = ts->ds->data;
 274     s = ts->vram;
 275     s24 = ts->vram24;
 276     cptr = ts->cplane;
 277     dd = ts->ds->linesize;
 278     ds = 1024;
 279
 280     for(y = 0; y < ts->height; y += 4, page += TARGET_PAGE_SIZE,
 281             page24 += TARGET_PAGE_SIZE, cpage += TARGET_PAGE_SIZE) {
 282         if (check_dirty(ts, page, page24, cpage)) {
 283             if (y_start < 0)
 284                 y_start = y;
 285             if (page < page_min)
 286                 page_min = page;
 287             if (page > page_max)
 288                 page_max = page;
 289             tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
 290             d += dd;
 291             s += ds;
 292             cptr += ds;
 293             s24 += ds;
 294             tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
 295             d += dd;
 296             s += ds;
 297             cptr += ds;
 298             s24 += ds;
 299             tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
 300             d += dd;
 301             s += ds;
 302             cptr += ds;
 303             s24 += ds;
 304             tcx24_draw_line32(ts, d, s, ts->width, cptr, s24);
 305             d += dd;
 306             s += ds;
 307             cptr += ds;
 308             s24 += ds;
 309         } else {
 310             if (y_start >= 0) {
 311                 /* flush to display */
 312                 dpy_update(ts->ds, 0, y_start,
 313                            ts->width, y - y_start);
 314                 y_start = -1;
 315             }
 316             d += dd * 4;
 317             s += ds * 4;
 318             cptr += ds * 4;
 319             s24 += ds * 4;
 320         }
 321     }
 322     if (y_start >= 0) {
 323         /* flush to display */
 324         dpy_update(ts->ds, 0, y_start,
 325                    ts->width, y - y_start);
 326     }
 327     /* reset modified pages */
 328     if (page_min <= page_max) {
 329         reset_dirty(ts, page_min, page_max, page24, cpage);
 330     }
 331 }
 332
 333 static void tcx_invalidate_display(void *opaque)
 334 {
 335     TCXState *s = opaque;
 336     int i;
 337
 338     for (i = 0; i < MAXX*MAXY; i += TARGET_PAGE_SIZE) {
 339         cpu_physical_memory_set_dirty(s->vram_offset + i);
 340     }
 341 }
 342
 343 static void tcx24_invalidate_display(void *opaque)
 344 {
 345     TCXState *s = opaque;
 346     int i;
 347
 348     tcx_invalidate_display(s);
 349     for (i = 0; i < MAXX*MAXY * 4; i += TARGET_PAGE_SIZE) {
 350         cpu_physical_memory_set_dirty(s->vram24_offset + i);
 351         cpu_physical_memory_set_dirty(s->cplane_offset + i);
 352     }
 353 }
 354
 355 static void tcx_save(QEMUFile *f, void *opaque)
 356 {
 357     TCXState *s = opaque;
 358
 359     qemu_put_be32s(f, (uint32_t *)&s->addr);
 360     qemu_put_be32s(f, (uint32_t *)&s->vram);
 361     qemu_put_be32s(f, (uint32_t *)&s->vram24);
 362     qemu_put_be32s(f, (uint32_t *)&s->cplane);
 363     qemu_put_be16s(f, (uint16_t *)&s->height);
 364     qemu_put_be16s(f, (uint16_t *)&s->width);
 365     qemu_put_be16s(f, (uint16_t *)&s->depth);
 366     qemu_put_buffer(f, s->r, 256);
 367     qemu_put_buffer(f, s->g, 256);
 368     qemu_put_buffer(f, s->b, 256);
 369     qemu_put_8s(f, &s->dac_index);
 370     qemu_put_8s(f, &s->dac_state);
 371 }
 372
 373 static int tcx_load(QEMUFile *f, void *opaque, int version_id)
 374 {
 375     TCXState *s = opaque;
 376
 377     if (version_id != 2)
 378         return -EINVAL;
 379
 380     qemu_get_be32s(f, (uint32_t *)&s->addr);
 381     qemu_get_be32s(f, (uint32_t *)&s->vram);
 382     qemu_get_be32s(f, (uint32_t *)&s->vram24);
 383     qemu_get_be32s(f, (uint32_t *)&s->cplane);
 384     qemu_get_be16s(f, (uint16_t *)&s->height);
 385     qemu_get_be16s(f, (uint16_t *)&s->width);
 386     qemu_get_be16s(f, (uint16_t *)&s->depth);
 387     qemu_get_buffer(f, s->r, 256);
 388     qemu_get_buffer(f, s->g, 256);
 389     qemu_get_buffer(f, s->b, 256);
 390     qemu_get_8s(f, &s->dac_index);
 391     qemu_get_8s(f, &s->dac_state);
 392     update_palette_entries(s, 0, 256);
 393     tcx_invalidate_display(s);
 394
 395     return 0;
 396 }
 397
 398 static void tcx_reset(void *opaque)
 399 {
 400     TCXState *s = opaque;
 401
 402     /* Initialize palette */
 403     memset(s->r, 0, 256);
 404     memset(s->g, 0, 256);
 405     memset(s->b, 0, 256);
 406     s->r[255] = s->g[255] = s->b[255] = 255;
 407     update_palette_entries(s, 0, 256);
 408     memset(s->vram, 0, MAXX*MAXY);
 409     cpu_physical_memory_reset_dirty(s->vram_offset, s->vram_offset +
 410                                     MAXX * MAXY * (1 + 4 + 4), VGA_DIRTY_FLAG);
 411     s->dac_index = 0;
 412     s->dac_state = 0;
 413 }
 414
 415 static uint32_t tcx_dac_readl(void *opaque, target_phys_addr_t addr)
 416 {
 417     return 0;
 418 }
 419
 420 static void tcx_dac_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
 421 {
 422     TCXState *s = opaque;
 423     uint32_t saddr;
 424
 425     saddr = (addr & (TCX_DAC_NREGS - 1)) >> 2;
 426     switch (saddr) {
 427     case 0:
 428         s->dac_index = val >> 24;
 429         s->dac_state = 0;
 430         break;
 431     case 1:
 432         switch (s->dac_state) {
 433         case 0:
 434             s->r[s->dac_index] = val >> 24;
 435             update_palette_entries(s, s->dac_index, s->dac_index + 1);
 436             s->dac_state++;
 437             break;
 438         case 1:
 439             s->g[s->dac_index] = val >> 24;
 440             update_palette_entries(s, s->dac_index, s->dac_index + 1);
 441             s->dac_state++;
 442             break;
 443         case 2:
 444             s->b[s->dac_index] = val >> 24;
 445             update_palette_entries(s, s->dac_index, s->dac_index + 1);
 446             s->dac_index = (s->dac_index + 1) & 255; // Index autoincrement
 447         default:
 448             s->dac_state = 0;
 449             break;
 450         }
 451         break;
 452     default:
 453         break;
 454     }
 455     return;
 456 }
 457
 458 static CPUReadMemoryFunc *tcx_dac_read[3] = {
 459     tcx_dac_readl,
 460     tcx_dac_readl,
 461     tcx_dac_readl,
 462 };
 463
 464 static CPUWriteMemoryFunc *tcx_dac_write[3] = {
 465     tcx_dac_writel,
 466     tcx_dac_writel,
 467     tcx_dac_writel,
 468 };
 469
 470 void tcx_init(DisplayState *ds, uint32_t addr, uint8_t *vram_base,
 471               unsigned long vram_offset, int vram_size, int width, int height,
 472               int depth)
 473 {
 474     TCXState *s;
 475     int io_memory;
 476     int size;
 477
 478     s = qemu_mallocz(sizeof(TCXState));
 479     if (!s)
 480         return;
 481     s->ds = ds;
 482     s->addr = addr;
 483     s->vram_offset = vram_offset;
 484     s->width = width;
 485     s->height = height;
 486     s->depth = depth;
 487
 488     // 8-bit plane
 489     s->vram = vram_base;
 490     size = vram_size;
 491     cpu_register_physical_memory(addr + 0x00800000, size, vram_offset);
 492     vram_offset += size;
 493     vram_base += size;
 494
 495     io_memory = cpu_register_io_memory(0, tcx_dac_read, tcx_dac_write, s);
 496     cpu_register_physical_memory(addr + 0x00200000, TCX_DAC_NREGS, io_memory);
 497
 498     if (depth == 24) {
 499         // 24-bit plane
 500         size = vram_size * 4;
 501         s->vram24 = (uint32_t *)vram_base;
 502         s->vram24_offset = vram_offset;
 503         cpu_register_physical_memory(addr + 0x02000000, size, vram_offset);
 504         vram_offset += size;
 505         vram_base += size;
 506
 507         // Control plane
 508         size = vram_size * 4;
 509         s->cplane = (uint32_t *)vram_base;
 510         s->cplane_offset = vram_offset;
 511         cpu_register_physical_memory(addr + 0x0a000000, size, vram_offset);
 512         graphic_console_init(s->ds, tcx24_update_display, tcx24_invalidate_display,
 513                              tcx24_screen_dump, s);
 514     } else {
 515         graphic_console_init(s->ds, tcx_update_display, tcx_invalidate_display,
 516                              tcx_screen_dump, s);
 517     }
 518
 519     register_savevm("tcx", addr, 1, tcx_save, tcx_load, s);
 520     qemu_register_reset(tcx_reset, s);
 521     tcx_reset(s);
 522     dpy_resize(s->ds, width, height);
 523 }
 524
 525 static void tcx_screen_dump(void *opaque, const char *filename)
 526 {
 527     TCXState *s = opaque;
 528     FILE *f;
 529     uint8_t *d, *d1, v;
 530     int y, x;
 531
 532     f = fopen(filename, "wb");
 533     if (!f)
 534         return;
 535     fprintf(f, "P6\n%d %d\n%d\n", s->width, s->height, 255);
 536     d1 = s->vram;
 537     for(y = 0; y < s->height; y++) {
 538         d = d1;
 539         for(x = 0; x < s->width; x++) {
 540             v = *d;
 541             fputc(s->r[v], f);
 542             fputc(s->g[v], f);
 543             fputc(s->b[v], f);
 544             d++;
 545         }
 546         d1 += MAXX;
 547     }
 548     fclose(f);
 549     return;
 550 }
 551
 552 static void tcx24_screen_dump(void *opaque, const char *filename)
 553 {
 554     TCXState *s = opaque;
 555     FILE *f;
 556     uint8_t *d, *d1, v;
 557     uint32_t *s24, *cptr, dval;
 558     int y, x;
 559
 560     f = fopen(filename, "wb");
 561     if (!f)
 562         return;
 563     fprintf(f, "P6\n%d %d\n%d\n", s->width, s->height, 255);
 564     d1 = s->vram;
 565     s24 = s->vram24;
 566     cptr = s->cplane;
 567     for(y = 0; y < s->height; y++) {
 568         d = d1;
 569         for(x = 0; x < s->width; x++, d++, s24++) {
 570             if ((*cptr++ & 0xff000000) == 0x03000000) { // 24-bit direct
 571                 dval = *s24 & 0x00ffffff;
 572                 fputc((dval >> 16) & 0xff, f);
 573                 fputc((dval >> 8) & 0xff, f);
 574                 fputc(dval & 0xff, f);
 575             } else {
 576                 v = *d;
 577                 fputc(s->r[v], f);
 578                 fputc(s->g[v], f);
 579                 fputc(s->b[v], f);
 580             }
 581         }
 582         d1 += MAXX;
 583     }
 584     fclose(f);
 585     return;
 586 }