hw/vmware_vga.c

   1 /*
   2  * QEMU VMware-SVGA "chipset".
   3  *
   4  * Copyright (c) 2007 Andrzej Zaborowski  <balrog@zabor.org>
   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 "hw.h"
  25 #include "loader.h"
  26 #include "console.h"
  27 #include "pci.h"
  28 #include "vmware_vga.h"
  29
  30 #define VERBOSE
  31 #undef DIRECT_VRAM
  32 #define HW_RECT_ACCEL
  33 #define HW_FILL_ACCEL
  34 #define HW_MOUSE_ACCEL
  35
  36 # include "vga_int.h"
  37
  38 struct vmsvga_state_s {
  39     VGACommonState vga;
  40
  41     int width;
  42     int height;
  43     int invalidated;
  44     int depth;
  45     int bypp;
  46     int enable;
  47     int config;
  48     struct {
  49         int id;
  50         int x;
  51         int y;
  52         int on;
  53     } cursor;
  54
  55     int index;
  56     int scratch_size;
  57     uint32_t *scratch;
  58     int new_width;
  59     int new_height;
  60     uint32_t guest;
  61     uint32_t svgaid;
  62     uint32_t wred;
  63     uint32_t wgreen;
  64     uint32_t wblue;
  65     int syncing;
  66     int fb_size;
  67
  68     MemoryRegion fifo_ram;
  69     uint8_t *fifo_ptr;
  70     unsigned int fifo_size;
  71
  72     union {
  73         uint32_t *fifo;
  74         struct __attribute__((__packed__)) {
  75             uint32_t min;
  76             uint32_t max;
  77             uint32_t next_cmd;
  78             uint32_t stop;
  79             /* Add registers here when adding capabilities.  */
  80             uint32_t fifo[0];
  81         } *cmd;
  82     };
  83
  84 #define REDRAW_FIFO_LEN 512
  85     struct vmsvga_rect_s {
  86         int x, y, w, h;
  87     } redraw_fifo[REDRAW_FIFO_LEN];
  88     int redraw_fifo_first, redraw_fifo_last;
  89 };
  90
  91 struct pci_vmsvga_state_s {
  92     PCIDevice card;
  93     struct vmsvga_state_s chip;
  94     MemoryRegion io_bar;
  95 };
  96
  97 #define SVGA_MAGIC              0x900000UL
  98 #define SVGA_MAKE_ID(ver)       (SVGA_MAGIC << 8 | (ver))
  99 #define SVGA_ID_0               SVGA_MAKE_ID(0)
 100 #define SVGA_ID_1               SVGA_MAKE_ID(1)
 101 #define SVGA_ID_2               SVGA_MAKE_ID(2)
 102
 103 #define SVGA_LEGACY_BASE_PORT   0x4560
 104 #define SVGA_INDEX_PORT         0x0
 105 #define SVGA_VALUE_PORT         0x1
 106 #define SVGA_BIOS_PORT          0x2
 107
 108 #define SVGA_VERSION_2
 109
 110 #ifdef SVGA_VERSION_2
 111 # define SVGA_ID                SVGA_ID_2
 112 # define SVGA_IO_BASE           SVGA_LEGACY_BASE_PORT
 113 # define SVGA_IO_MUL            1
 114 # define SVGA_FIFO_SIZE         0x10000
 115 # define SVGA_PCI_DEVICE_ID     PCI_DEVICE_ID_VMWARE_SVGA2
 116 #else
 117 # define SVGA_ID                SVGA_ID_1
 118 # define SVGA_IO_BASE           SVGA_LEGACY_BASE_PORT
 119 # define SVGA_IO_MUL            4
 120 # define SVGA_FIFO_SIZE         0x10000
 121 # define SVGA_PCI_DEVICE_ID     PCI_DEVICE_ID_VMWARE_SVGA
 122 #endif
 123
 124 enum {
 125     /* ID 0, 1 and 2 registers */
 126     SVGA_REG_ID = 0,
 127     SVGA_REG_ENABLE = 1,
 128     SVGA_REG_WIDTH = 2,
 129     SVGA_REG_HEIGHT = 3,
 130     SVGA_REG_MAX_WIDTH = 4,
 131     SVGA_REG_MAX_HEIGHT = 5,
 132     SVGA_REG_DEPTH = 6,
 133     SVGA_REG_BITS_PER_PIXEL = 7,        /* Current bpp in the guest */
 134     SVGA_REG_PSEUDOCOLOR = 8,
 135     SVGA_REG_RED_MASK = 9,
 136     SVGA_REG_GREEN_MASK = 10,
 137     SVGA_REG_BLUE_MASK = 11,
 138     SVGA_REG_BYTES_PER_LINE = 12,
 139     SVGA_REG_FB_START = 13,
 140     SVGA_REG_FB_OFFSET = 14,
 141     SVGA_REG_VRAM_SIZE = 15,
 142     SVGA_REG_FB_SIZE = 16,
 143
 144     /* ID 1 and 2 registers */
 145     SVGA_REG_CAPABILITIES = 17,
 146     SVGA_REG_MEM_START = 18,            /* Memory for command FIFO */
 147     SVGA_REG_MEM_SIZE = 19,
 148     SVGA_REG_CONFIG_DONE = 20,          /* Set when memory area configured */
 149     SVGA_REG_SYNC = 21,                 /* Write to force synchronization */
 150     SVGA_REG_BUSY = 22,                 /* Read to check if sync is done */
 151     SVGA_REG_GUEST_ID = 23,             /* Set guest OS identifier */
 152     SVGA_REG_CURSOR_ID = 24,            /* ID of cursor */
 153     SVGA_REG_CURSOR_X = 25,             /* Set cursor X position */
 154     SVGA_REG_CURSOR_Y = 26,             /* Set cursor Y position */
 155     SVGA_REG_CURSOR_ON = 27,            /* Turn cursor on/off */
 156     SVGA_REG_HOST_BITS_PER_PIXEL = 28,  /* Current bpp in the host */
 157     SVGA_REG_SCRATCH_SIZE = 29,         /* Number of scratch registers */
 158     SVGA_REG_MEM_REGS = 30,             /* Number of FIFO registers */
 159     SVGA_REG_NUM_DISPLAYS = 31,         /* Number of guest displays */
 160     SVGA_REG_PITCHLOCK = 32,            /* Fixed pitch for all modes */
 161
 162     SVGA_PALETTE_BASE = 1024,           /* Base of SVGA color map */
 163     SVGA_PALETTE_END  = SVGA_PALETTE_BASE + 767,
 164     SVGA_SCRATCH_BASE = SVGA_PALETTE_BASE + 768,
 165 };
 166
 167 #define SVGA_CAP_NONE                   0
 168 #define SVGA_CAP_RECT_FILL              (1 << 0)
 169 #define SVGA_CAP_RECT_COPY              (1 << 1)
 170 #define SVGA_CAP_RECT_PAT_FILL          (1 << 2)
 171 #define SVGA_CAP_LEGACY_OFFSCREEN       (1 << 3)
 172 #define SVGA_CAP_RASTER_OP              (1 << 4)
 173 #define SVGA_CAP_CURSOR                 (1 << 5)
 174 #define SVGA_CAP_CURSOR_BYPASS          (1 << 6)
 175 #define SVGA_CAP_CURSOR_BYPASS_2        (1 << 7)
 176 #define SVGA_CAP_8BIT_EMULATION         (1 << 8)
 177 #define SVGA_CAP_ALPHA_CURSOR           (1 << 9)
 178 #define SVGA_CAP_GLYPH                  (1 << 10)
 179 #define SVGA_CAP_GLYPH_CLIPPING         (1 << 11)
 180 #define SVGA_CAP_OFFSCREEN_1            (1 << 12)
 181 #define SVGA_CAP_ALPHA_BLEND            (1 << 13)
 182 #define SVGA_CAP_3D                     (1 << 14)
 183 #define SVGA_CAP_EXTENDED_FIFO          (1 << 15)
 184 #define SVGA_CAP_MULTIMON               (1 << 16)
 185 #define SVGA_CAP_PITCHLOCK              (1 << 17)
 186
 187 /*
 188  * FIFO offsets (seen as an array of 32-bit words)
 189  */
 190 enum {
 191     /*
 192      * The original defined FIFO offsets
 193      */
 194     SVGA_FIFO_MIN = 0,
 195     SVGA_FIFO_MAX,      /* The distance from MIN to MAX must be at least 10K */
 196     SVGA_FIFO_NEXT_CMD,
 197     SVGA_FIFO_STOP,
 198
 199     /*
 200      * Additional offsets added as of SVGA_CAP_EXTENDED_FIFO
 201      */
 202     SVGA_FIFO_CAPABILITIES = 4,
 203     SVGA_FIFO_FLAGS,
 204     SVGA_FIFO_FENCE,
 205     SVGA_FIFO_3D_HWVERSION,
 206     SVGA_FIFO_PITCHLOCK,
 207 };
 208
 209 #define SVGA_FIFO_CAP_NONE              0
 210 #define SVGA_FIFO_CAP_FENCE             (1 << 0)
 211 #define SVGA_FIFO_CAP_ACCELFRONT        (1 << 1)
 212 #define SVGA_FIFO_CAP_PITCHLOCK         (1 << 2)
 213
 214 #define SVGA_FIFO_FLAG_NONE             0
 215 #define SVGA_FIFO_FLAG_ACCELFRONT       (1 << 0)
 216
 217 /* These values can probably be changed arbitrarily.  */
 218 #define SVGA_SCRATCH_SIZE               0x8000
 219 #define SVGA_MAX_WIDTH                  2360
 220 #define SVGA_MAX_HEIGHT                 1770
 221
 222 #ifdef VERBOSE
 223 # define GUEST_OS_BASE          0x5001
 224 static const char *vmsvga_guest_id[] = {
 225     [0x00] = "Dos",
 226     [0x01] = "Windows 3.1",
 227     [0x02] = "Windows 95",
 228     [0x03] = "Windows 98",
 229     [0x04] = "Windows ME",
 230     [0x05] = "Windows NT",
 231     [0x06] = "Windows 2000",
 232     [0x07] = "Linux",
 233     [0x08] = "OS/2",
 234     [0x09] = "an unknown OS",
 235     [0x0a] = "BSD",
 236     [0x0b] = "Whistler",
 237     [0x0c] = "an unknown OS",
 238     [0x0d] = "an unknown OS",
 239     [0x0e] = "an unknown OS",
 240     [0x0f] = "an unknown OS",
 241     [0x10] = "an unknown OS",
 242     [0x11] = "an unknown OS",
 243     [0x12] = "an unknown OS",
 244     [0x13] = "an unknown OS",
 245     [0x14] = "an unknown OS",
 246     [0x15] = "Windows 2003",
 247 };
 248 #endif
 249
 250 enum {
 251     SVGA_CMD_INVALID_CMD = 0,
 252     SVGA_CMD_UPDATE = 1,
 253     SVGA_CMD_RECT_FILL = 2,
 254     SVGA_CMD_RECT_COPY = 3,
 255     SVGA_CMD_DEFINE_BITMAP = 4,
 256     SVGA_CMD_DEFINE_BITMAP_SCANLINE = 5,
 257     SVGA_CMD_DEFINE_PIXMAP = 6,
 258     SVGA_CMD_DEFINE_PIXMAP_SCANLINE = 7,
 259     SVGA_CMD_RECT_BITMAP_FILL = 8,
 260     SVGA_CMD_RECT_PIXMAP_FILL = 9,
 261     SVGA_CMD_RECT_BITMAP_COPY = 10,
 262     SVGA_CMD_RECT_PIXMAP_COPY = 11,
 263     SVGA_CMD_FREE_OBJECT = 12,
 264     SVGA_CMD_RECT_ROP_FILL = 13,
 265     SVGA_CMD_RECT_ROP_COPY = 14,
 266     SVGA_CMD_RECT_ROP_BITMAP_FILL = 15,
 267     SVGA_CMD_RECT_ROP_PIXMAP_FILL = 16,
 268     SVGA_CMD_RECT_ROP_BITMAP_COPY = 17,
 269     SVGA_CMD_RECT_ROP_PIXMAP_COPY = 18,
 270     SVGA_CMD_DEFINE_CURSOR = 19,
 271     SVGA_CMD_DISPLAY_CURSOR = 20,
 272     SVGA_CMD_MOVE_CURSOR = 21,
 273     SVGA_CMD_DEFINE_ALPHA_CURSOR = 22,
 274     SVGA_CMD_DRAW_GLYPH = 23,
 275     SVGA_CMD_DRAW_GLYPH_CLIPPED = 24,
 276     SVGA_CMD_UPDATE_VERBOSE = 25,
 277     SVGA_CMD_SURFACE_FILL = 26,
 278     SVGA_CMD_SURFACE_COPY = 27,
 279     SVGA_CMD_SURFACE_ALPHA_BLEND = 28,
 280     SVGA_CMD_FRONT_ROP_FILL = 29,
 281     SVGA_CMD_FENCE = 30,
 282 };
 283
 284 /* Legal values for the SVGA_REG_CURSOR_ON register in cursor bypass mode */
 285 enum {
 286     SVGA_CURSOR_ON_HIDE = 0,
 287     SVGA_CURSOR_ON_SHOW = 1,
 288     SVGA_CURSOR_ON_REMOVE_FROM_FB = 2,
 289     SVGA_CURSOR_ON_RESTORE_TO_FB = 3,
 290 };
 291
 292 static inline void vmsvga_update_rect(struct vmsvga_state_s *s,
 293                 int x, int y, int w, int h)
 294 {
 295 #ifndef DIRECT_VRAM
 296     int line;
 297     int bypl;
 298     int width;
 299     int start;
 300     uint8_t *src;
 301     uint8_t *dst;
 302
 303     if (x + w > s->width) {
 304         fprintf(stderr, "%s: update width too large x: %d, w: %d\n",
 305                         __FUNCTION__, x, w);
 306         x = MIN(x, s->width);
 307         w = s->width - x;
 308     }
 309
 310     if (y + h > s->height) {
 311         fprintf(stderr, "%s: update height too large y: %d, h: %d\n",
 312                         __FUNCTION__, y, h);
 313         y = MIN(y, s->height);
 314         h = s->height - y;
 315     }
 316
 317     line = h;
 318     bypl = s->bypp * s->width;
 319     width = s->bypp * w;
 320     start = s->bypp * x + bypl * y;
 321     src = s->vga.vram_ptr + start;
 322     dst = ds_get_data(s->vga.ds) + start;
 323
 324     for (; line > 0; line --, src += bypl, dst += bypl)
 325         memcpy(dst, src, width);
 326 #endif
 327
 328     dpy_update(s->vga.ds, x, y, w, h);
 329 }
 330
 331 static inline void vmsvga_update_screen(struct vmsvga_state_s *s)
 332 {
 333 #ifndef DIRECT_VRAM
 334     memcpy(ds_get_data(s->vga.ds), s->vga.vram_ptr, s->bypp * s->width * s->height);
 335 #endif
 336
 337     dpy_update(s->vga.ds, 0, 0, s->width, s->height);
 338 }
 339
 340 #ifdef DIRECT_VRAM
 341 # define vmsvga_update_rect_delayed     vmsvga_update_rect
 342 #else
 343 static inline void vmsvga_update_rect_delayed(struct vmsvga_state_s *s,
 344                 int x, int y, int w, int h)
 345 {
 346     struct vmsvga_rect_s *rect = &s->redraw_fifo[s->redraw_fifo_last ++];
 347     s->redraw_fifo_last &= REDRAW_FIFO_LEN - 1;
 348     rect->x = x;
 349     rect->y = y;
 350     rect->w = w;
 351     rect->h = h;
 352 }
 353 #endif
 354
 355 static inline void vmsvga_update_rect_flush(struct vmsvga_state_s *s)
 356 {
 357     struct vmsvga_rect_s *rect;
 358     if (s->invalidated) {
 359         s->redraw_fifo_first = s->redraw_fifo_last;
 360         return;
 361     }
 362     /* Overlapping region updates can be optimised out here - if someone
 363      * knows a smart algorithm to do that, please share.  */
 364     while (s->redraw_fifo_first != s->redraw_fifo_last) {
 365         rect = &s->redraw_fifo[s->redraw_fifo_first ++];
 366         s->redraw_fifo_first &= REDRAW_FIFO_LEN - 1;
 367         vmsvga_update_rect(s, rect->x, rect->y, rect->w, rect->h);
 368     }
 369 }
 370
 371 #ifdef HW_RECT_ACCEL
 372 static inline void vmsvga_copy_rect(struct vmsvga_state_s *s,
 373                 int x0, int y0, int x1, int y1, int w, int h)
 374 {
 375 # ifdef DIRECT_VRAM
 376     uint8_t *vram = ds_get_data(s->ds);
 377 # else
 378     uint8_t *vram = s->vga.vram_ptr;
 379 # endif
 380     int bypl = s->bypp * s->width;
 381     int width = s->bypp * w;
 382     int line = h;
 383     uint8_t *ptr[2];
 384
 385 # ifdef DIRECT_VRAM
 386     if (s->ds->dpy_copy)
 387         qemu_console_copy(s->ds, x0, y0, x1, y1, w, h);
 388     else
 389 # endif
 390     {
 391         if (y1 > y0) {
 392             ptr[0] = vram + s->bypp * x0 + bypl * (y0 + h - 1);
 393             ptr[1] = vram + s->bypp * x1 + bypl * (y1 + h - 1);
 394             for (; line > 0; line --, ptr[0] -= bypl, ptr[1] -= bypl)
 395                 memmove(ptr[1], ptr[0], width);
 396         } else {
 397             ptr[0] = vram + s->bypp * x0 + bypl * y0;
 398             ptr[1] = vram + s->bypp * x1 + bypl * y1;
 399             for (; line > 0; line --, ptr[0] += bypl, ptr[1] += bypl)
 400                 memmove(ptr[1], ptr[0], width);
 401         }
 402     }
 403
 404     vmsvga_update_rect_delayed(s, x1, y1, w, h);
 405 }
 406 #endif
 407
 408 #ifdef HW_FILL_ACCEL
 409 static inline void vmsvga_fill_rect(struct vmsvga_state_s *s,
 410                 uint32_t c, int x, int y, int w, int h)
 411 {
 412 # ifdef DIRECT_VRAM
 413     uint8_t *vram = ds_get_data(s->ds);
 414 # else
 415     uint8_t *vram = s->vga.vram_ptr;
 416 # endif
 417     int bypp = s->bypp;
 418     int bypl = bypp * s->width;
 419     int width = bypp * w;
 420     int line = h;
 421     int column;
 422     uint8_t *fst = vram + bypp * x + bypl * y;
 423     uint8_t *dst;
 424     uint8_t *src;
 425     uint8_t col[4];
 426
 427 # ifdef DIRECT_VRAM
 428     if (s->ds->dpy_fill)
 429         s->ds->dpy_fill(s->ds, x, y, w, h, c);
 430     else
 431 # endif
 432     {
 433         col[0] = c;
 434         col[1] = c >> 8;
 435         col[2] = c >> 16;
 436         col[3] = c >> 24;
 437
 438         if (line --) {
 439             dst = fst;
 440             src = col;
 441             for (column = width; column > 0; column --) {
 442                 *(dst ++) = *(src ++);
 443                 if (src - col == bypp)
 444                     src = col;
 445             }
 446             dst = fst;
 447             for (; line > 0; line --) {
 448                 dst += bypl;
 449                 memcpy(dst, fst, width);
 450             }
 451         }
 452     }
 453
 454     vmsvga_update_rect_delayed(s, x, y, w, h);
 455 }
 456 #endif
 457
 458 struct vmsvga_cursor_definition_s {
 459     int width;
 460     int height;
 461     int id;
 462     int bpp;
 463     int hot_x;
 464     int hot_y;
 465     uint32_t mask[1024];
 466     uint32_t image[4096];
 467 };
 468
 469 #define SVGA_BITMAP_SIZE(w, h)          ((((w) + 31) >> 5) * (h))
 470 #define SVGA_PIXMAP_SIZE(w, h, bpp)     (((((w) * (bpp)) + 31) >> 5) * (h))
 471
 472 #ifdef HW_MOUSE_ACCEL
 473 static inline void vmsvga_cursor_define(struct vmsvga_state_s *s,
 474                 struct vmsvga_cursor_definition_s *c)
 475 {
 476     QEMUCursor *qc;
 477     int i, pixels;
 478
 479     qc = cursor_alloc(c->width, c->height);
 480     qc->hot_x = c->hot_x;
 481     qc->hot_y = c->hot_y;
 482     switch (c->bpp) {
 483     case 1:
 484         cursor_set_mono(qc, 0xffffff, 0x000000, (void*)c->image,
 485                         1, (void*)c->mask);
 486 #ifdef DEBUG
 487         cursor_print_ascii_art(qc, "vmware/mono");
 488 #endif
 489         break;
 490     case 32:
 491         /* fill alpha channel from mask, set color to zero */
 492         cursor_set_mono(qc, 0x000000, 0x000000, (void*)c->mask,
 493                         1, (void*)c->mask);
 494         /* add in rgb values */
 495         pixels = c->width * c->height;
 496         for (i = 0; i < pixels; i++) {
 497             qc->data[i] |= c->image[i] & 0xffffff;
 498         }
 499 #ifdef DEBUG
 500         cursor_print_ascii_art(qc, "vmware/32bit");
 501 #endif
 502         break;
 503     default:
 504         fprintf(stderr, "%s: unhandled bpp %d, using fallback cursor\n",
 505                 __FUNCTION__, c->bpp);
 506         cursor_put(qc);
 507         qc = cursor_builtin_left_ptr();
 508     }
 509
 510     if (s->vga.ds->cursor_define)
 511         s->vga.ds->cursor_define(qc);
 512     cursor_put(qc);
 513 }
 514 #endif
 515
 516 #define CMD(f)  le32_to_cpu(s->cmd->f)
 517
 518 static inline int vmsvga_fifo_length(struct vmsvga_state_s *s)
 519 {
 520     int num;
 521     if (!s->config || !s->enable)
 522         return 0;
 523     num = CMD(next_cmd) - CMD(stop);
 524     if (num < 0)
 525         num += CMD(max) - CMD(min);
 526     return num >> 2;
 527 }
 528
 529 static inline uint32_t vmsvga_fifo_read_raw(struct vmsvga_state_s *s)
 530 {
 531     uint32_t cmd = s->fifo[CMD(stop) >> 2];
 532     s->cmd->stop = cpu_to_le32(CMD(stop) + 4);
 533     if (CMD(stop) >= CMD(max))
 534         s->cmd->stop = s->cmd->min;
 535     return cmd;
 536 }
 537
 538 static inline uint32_t vmsvga_fifo_read(struct vmsvga_state_s *s)
 539 {
 540     return le32_to_cpu(vmsvga_fifo_read_raw(s));
 541 }
 542
 543 static void vmsvga_fifo_run(struct vmsvga_state_s *s)
 544 {
 545     uint32_t cmd, colour;
 546     int args, len;
 547     int x, y, dx, dy, width, height;
 548     struct vmsvga_cursor_definition_s cursor;
 549     uint32_t cmd_start;
 550
 551     len = vmsvga_fifo_length(s);
 552     while (len > 0) {
 553         /* May need to go back to the start of the command if incomplete */
 554         cmd_start = s->cmd->stop;
 555
 556         switch (cmd = vmsvga_fifo_read(s)) {
 557         case SVGA_CMD_UPDATE:
 558         case SVGA_CMD_UPDATE_VERBOSE:
 559             len -= 5;
 560             if (len < 0)
 561                 goto rewind;
 562
 563             x = vmsvga_fifo_read(s);
 564             y = vmsvga_fifo_read(s);
 565             width = vmsvga_fifo_read(s);
 566             height = vmsvga_fifo_read(s);
 567             vmsvga_update_rect_delayed(s, x, y, width, height);
 568             break;
 569
 570         case SVGA_CMD_RECT_FILL:
 571             len -= 6;
 572             if (len < 0)
 573                 goto rewind;
 574
 575             colour = vmsvga_fifo_read(s);
 576             x = vmsvga_fifo_read(s);
 577             y = vmsvga_fifo_read(s);
 578             width = vmsvga_fifo_read(s);
 579             height = vmsvga_fifo_read(s);
 580 #ifdef HW_FILL_ACCEL
 581             vmsvga_fill_rect(s, colour, x, y, width, height);
 582             break;
 583 #else
 584             args = 0;
 585             goto badcmd;
 586 #endif
 587
 588         case SVGA_CMD_RECT_COPY:
 589             len -= 7;
 590             if (len < 0)
 591                 goto rewind;
 592
 593             x = vmsvga_fifo_read(s);
 594             y = vmsvga_fifo_read(s);
 595             dx = vmsvga_fifo_read(s);
 596             dy = vmsvga_fifo_read(s);
 597             width = vmsvga_fifo_read(s);
 598             height = vmsvga_fifo_read(s);
 599 #ifdef HW_RECT_ACCEL
 600             vmsvga_copy_rect(s, x, y, dx, dy, width, height);
 601             break;
 602 #else
 603             args = 0;
 604             goto badcmd;
 605 #endif
 606
 607         case SVGA_CMD_DEFINE_CURSOR:
 608             len -= 8;
 609             if (len < 0)
 610                 goto rewind;
 611
 612             cursor.id = vmsvga_fifo_read(s);
 613             cursor.hot_x = vmsvga_fifo_read(s);
 614             cursor.hot_y = vmsvga_fifo_read(s);
 615             cursor.width = x = vmsvga_fifo_read(s);
 616             cursor.height = y = vmsvga_fifo_read(s);
 617             vmsvga_fifo_read(s);
 618             cursor.bpp = vmsvga_fifo_read(s);
 619
 620             args = SVGA_BITMAP_SIZE(x, y) + SVGA_PIXMAP_SIZE(x, y, cursor.bpp);
 621             if (SVGA_BITMAP_SIZE(x, y) > sizeof cursor.mask ||
 622                 SVGA_PIXMAP_SIZE(x, y, cursor.bpp) > sizeof cursor.image)
 623                     goto badcmd;
 624
 625             len -= args;
 626             if (len < 0)
 627                 goto rewind;
 628
 629             for (args = 0; args < SVGA_BITMAP_SIZE(x, y); args ++)
 630                 cursor.mask[args] = vmsvga_fifo_read_raw(s);
 631             for (args = 0; args < SVGA_PIXMAP_SIZE(x, y, cursor.bpp); args ++)
 632                 cursor.image[args] = vmsvga_fifo_read_raw(s);
 633 #ifdef HW_MOUSE_ACCEL
 634             vmsvga_cursor_define(s, &cursor);
 635             break;
 636 #else
 637             args = 0;
 638             goto badcmd;
 639 #endif
 640
 641         /*
 642          * Other commands that we at least know the number of arguments
 643          * for so we can avoid FIFO desync if driver uses them illegally.
 644          */
 645         case SVGA_CMD_DEFINE_ALPHA_CURSOR:
 646             len -= 6;
 647             if (len < 0)
 648                 goto rewind;
 649
 650             vmsvga_fifo_read(s);
 651             vmsvga_fifo_read(s);
 652             vmsvga_fifo_read(s);
 653             x = vmsvga_fifo_read(s);
 654             y = vmsvga_fifo_read(s);
 655             args = x * y;
 656             goto badcmd;
 657         case SVGA_CMD_RECT_ROP_FILL:
 658             args = 6;
 659             goto badcmd;
 660         case SVGA_CMD_RECT_ROP_COPY:
 661             args = 7;
 662             goto badcmd;
 663         case SVGA_CMD_DRAW_GLYPH_CLIPPED:
 664             len -= 4;
 665             if (len < 0)
 666                 goto rewind;
 667
 668             vmsvga_fifo_read(s);
 669             vmsvga_fifo_read(s);
 670             args = 7 + (vmsvga_fifo_read(s) >> 2);
 671             goto badcmd;
 672         case SVGA_CMD_SURFACE_ALPHA_BLEND:
 673             args = 12;
 674             goto badcmd;
 675
 676         /*
 677          * Other commands that are not listed as depending on any
 678          * CAPABILITIES bits, but are not described in the README either.
 679          */
 680         case SVGA_CMD_SURFACE_FILL:
 681         case SVGA_CMD_SURFACE_COPY:
 682         case SVGA_CMD_FRONT_ROP_FILL:
 683         case SVGA_CMD_FENCE:
 684         case SVGA_CMD_INVALID_CMD:
 685             break; /* Nop */
 686
 687         default:
 688             args = 0;
 689         badcmd:
 690             len -= args;
 691             if (len < 0)
 692                 goto rewind;
 693             while (args --)
 694                 vmsvga_fifo_read(s);
 695             printf("%s: Unknown command 0x%02x in SVGA command FIFO\n",
 696                             __FUNCTION__, cmd);
 697             break;
 698
 699         rewind:
 700             s->cmd->stop = cmd_start;
 701             break;
 702         }
 703     }
 704
 705     s->syncing = 0;
 706 }
 707
 708 static uint32_t vmsvga_index_read(void *opaque, uint32_t address)
 709 {
 710     struct vmsvga_state_s *s = opaque;
 711     return s->index;
 712 }
 713
 714 static void vmsvga_index_write(void *opaque, uint32_t address, uint32_t index)
 715 {
 716     struct vmsvga_state_s *s = opaque;
 717     s->index = index;
 718 }
 719
 720 static uint32_t vmsvga_value_read(void *opaque, uint32_t address)
 721 {
 722     uint32_t caps;
 723     struct vmsvga_state_s *s = opaque;
 724     switch (s->index) {
 725     case SVGA_REG_ID:
 726         return s->svgaid;
 727
 728     case SVGA_REG_ENABLE:
 729         return s->enable;
 730
 731     case SVGA_REG_WIDTH:
 732         return s->width;
 733
 734     case SVGA_REG_HEIGHT:
 735         return s->height;
 736
 737     case SVGA_REG_MAX_WIDTH:
 738         return SVGA_MAX_WIDTH;
 739
 740     case SVGA_REG_MAX_HEIGHT:
 741         return SVGA_MAX_HEIGHT;
 742
 743     case SVGA_REG_DEPTH:
 744         return s->depth;
 745
 746     case SVGA_REG_BITS_PER_PIXEL:
 747         return (s->depth + 7) & ~7;
 748
 749     case SVGA_REG_PSEUDOCOLOR:
 750         return 0x0;
 751
 752     case SVGA_REG_RED_MASK:
 753         return s->wred;
 754     case SVGA_REG_GREEN_MASK:
 755         return s->wgreen;
 756     case SVGA_REG_BLUE_MASK:
 757         return s->wblue;
 758
 759     case SVGA_REG_BYTES_PER_LINE:
 760         return ((s->depth + 7) >> 3) * s->new_width;
 761
 762     case SVGA_REG_FB_START: {
 763         struct pci_vmsvga_state_s *pci_vmsvga
 764             = container_of(s, struct pci_vmsvga_state_s, chip);
 765         return pci_get_bar_addr(&pci_vmsvga->card, 1);
 766     }
 767
 768     case SVGA_REG_FB_OFFSET:
 769         return 0x0;
 770
 771     case SVGA_REG_VRAM_SIZE:
 772         return s->vga.vram_size;
 773
 774     case SVGA_REG_FB_SIZE:
 775         return s->fb_size;
 776
 777     case SVGA_REG_CAPABILITIES:
 778         caps = SVGA_CAP_NONE;
 779 #ifdef HW_RECT_ACCEL
 780         caps |= SVGA_CAP_RECT_COPY;
 781 #endif
 782 #ifdef HW_FILL_ACCEL
 783         caps |= SVGA_CAP_RECT_FILL;
 784 #endif
 785 #ifdef HW_MOUSE_ACCEL
 786         if (s->vga.ds->mouse_set)
 787             caps |= SVGA_CAP_CURSOR | SVGA_CAP_CURSOR_BYPASS_2 |
 788                     SVGA_CAP_CURSOR_BYPASS;
 789 #endif
 790         return caps;
 791
 792     case SVGA_REG_MEM_START: {
 793         struct pci_vmsvga_state_s *pci_vmsvga
 794             = container_of(s, struct pci_vmsvga_state_s, chip);
 795         return pci_get_bar_addr(&pci_vmsvga->card, 2);
 796     }
 797
 798     case SVGA_REG_MEM_SIZE:
 799         return s->fifo_size;
 800
 801     case SVGA_REG_CONFIG_DONE:
 802         return s->config;
 803
 804     case SVGA_REG_SYNC:
 805     case SVGA_REG_BUSY:
 806         return s->syncing;
 807
 808     case SVGA_REG_GUEST_ID:
 809         return s->guest;
 810
 811     case SVGA_REG_CURSOR_ID:
 812         return s->cursor.id;
 813
 814     case SVGA_REG_CURSOR_X:
 815         return s->cursor.x;
 816
 817     case SVGA_REG_CURSOR_Y:
 818         return s->cursor.x;
 819
 820     case SVGA_REG_CURSOR_ON:
 821         return s->cursor.on;
 822
 823     case SVGA_REG_HOST_BITS_PER_PIXEL:
 824         return (s->depth + 7) & ~7;
 825
 826     case SVGA_REG_SCRATCH_SIZE:
 827         return s->scratch_size;
 828
 829     case SVGA_REG_MEM_REGS:
 830     case SVGA_REG_NUM_DISPLAYS:
 831     case SVGA_REG_PITCHLOCK:
 832     case SVGA_PALETTE_BASE ... SVGA_PALETTE_END:
 833         return 0;
 834
 835     default:
 836         if (s->index >= SVGA_SCRATCH_BASE &&
 837                 s->index < SVGA_SCRATCH_BASE + s->scratch_size)
 838             return s->scratch[s->index - SVGA_SCRATCH_BASE];
 839         printf("%s: Bad register %02x\n", __FUNCTION__, s->index);
 840     }
 841
 842     return 0;
 843 }
 844
 845 static void vmsvga_value_write(void *opaque, uint32_t address, uint32_t value)
 846 {
 847     struct vmsvga_state_s *s = opaque;
 848     switch (s->index) {
 849     case SVGA_REG_ID:
 850         if (value == SVGA_ID_2 || value == SVGA_ID_1 || value == SVGA_ID_0)
 851             s->svgaid = value;
 852         break;
 853
 854     case SVGA_REG_ENABLE:
 855         s->enable = value;
 856         s->config &= !!value;
 857         s->width = -1;
 858         s->height = -1;
 859         s->invalidated = 1;
 860         s->vga.invalidate(&s->vga);
 861         if (s->enable) {
 862             s->fb_size = ((s->depth + 7) >> 3) * s->new_width * s->new_height;
 863             vga_dirty_log_stop(&s->vga);
 864         } else {
 865             vga_dirty_log_start(&s->vga);
 866         }
 867         break;
 868
 869     case SVGA_REG_WIDTH:
 870         s->new_width = value;
 871         s->invalidated = 1;
 872         break;
 873
 874     case SVGA_REG_HEIGHT:
 875         s->new_height = value;
 876         s->invalidated = 1;
 877         break;
 878
 879     case SVGA_REG_DEPTH:
 880     case SVGA_REG_BITS_PER_PIXEL:
 881         if (value != s->depth) {
 882             printf("%s: Bad colour depth: %i bits\n", __FUNCTION__, value);
 883             s->config = 0;
 884         }
 885         break;
 886
 887     case SVGA_REG_CONFIG_DONE:
 888         if (value) {
 889             s->fifo = (uint32_t *) s->fifo_ptr;
 890             /* Check range and alignment.  */
 891             if ((CMD(min) | CMD(max) |
 892                         CMD(next_cmd) | CMD(stop)) & 3)
 893                 break;
 894             if (CMD(min) < (uint8_t *) s->cmd->fifo - (uint8_t *) s->fifo)
 895                 break;
 896             if (CMD(max) > SVGA_FIFO_SIZE)
 897                 break;
 898             if (CMD(max) < CMD(min) + 10 * 1024)
 899                 break;
 900         }
 901         s->config = !!value;
 902         break;
 903
 904     case SVGA_REG_SYNC:
 905         s->syncing = 1;
 906         vmsvga_fifo_run(s); /* Or should we just wait for update_display? */
 907         break;
 908
 909     case SVGA_REG_GUEST_ID:
 910         s->guest = value;
 911 #ifdef VERBOSE
 912         if (value >= GUEST_OS_BASE && value < GUEST_OS_BASE +
 913                 ARRAY_SIZE(vmsvga_guest_id))
 914             printf("%s: guest runs %s.\n", __FUNCTION__,
 915                             vmsvga_guest_id[value - GUEST_OS_BASE]);
 916 #endif
 917         break;
 918
 919     case SVGA_REG_CURSOR_ID:
 920         s->cursor.id = value;
 921         break;
 922
 923     case SVGA_REG_CURSOR_X:
 924         s->cursor.x = value;
 925         break;
 926
 927     case SVGA_REG_CURSOR_Y:
 928         s->cursor.y = value;
 929         break;
 930
 931     case SVGA_REG_CURSOR_ON:
 932         s->cursor.on |= (value == SVGA_CURSOR_ON_SHOW);
 933         s->cursor.on &= (value != SVGA_CURSOR_ON_HIDE);
 934 #ifdef HW_MOUSE_ACCEL
 935         if (s->vga.ds->mouse_set && value <= SVGA_CURSOR_ON_SHOW)
 936             s->vga.ds->mouse_set(s->cursor.x, s->cursor.y, s->cursor.on);
 937 #endif
 938         break;
 939
 940     case SVGA_REG_MEM_REGS:
 941     case SVGA_REG_NUM_DISPLAYS:
 942     case SVGA_REG_PITCHLOCK:
 943     case SVGA_PALETTE_BASE ... SVGA_PALETTE_END:
 944         break;
 945
 946     default:
 947         if (s->index >= SVGA_SCRATCH_BASE &&
 948                 s->index < SVGA_SCRATCH_BASE + s->scratch_size) {
 949             s->scratch[s->index - SVGA_SCRATCH_BASE] = value;
 950             break;
 951         }
 952         printf("%s: Bad register %02x\n", __FUNCTION__, s->index);
 953     }
 954 }
 955
 956 static uint32_t vmsvga_bios_read(void *opaque, uint32_t address)
 957 {
 958     printf("%s: what are we supposed to return?\n", __FUNCTION__);
 959     return 0xcafe;
 960 }
 961
 962 static void vmsvga_bios_write(void *opaque, uint32_t address, uint32_t data)
 963 {
 964     printf("%s: what are we supposed to do with (%08x)?\n",
 965                     __FUNCTION__, data);
 966 }
 967
 968 static inline void vmsvga_size(struct vmsvga_state_s *s)
 969 {
 970     if (s->new_width != s->width || s->new_height != s->height) {
 971         s->width = s->new_width;
 972         s->height = s->new_height;
 973         qemu_console_resize(s->vga.ds, s->width, s->height);
 974         s->invalidated = 1;
 975     }
 976 }
 977
 978 static void vmsvga_update_display(void *opaque)
 979 {
 980     struct vmsvga_state_s *s = opaque;
 981     if (!s->enable) {
 982         s->vga.update(&s->vga);
 983         return;
 984     }
 985
 986     vmsvga_size(s);
 987
 988     vmsvga_fifo_run(s);
 989     vmsvga_update_rect_flush(s);
 990
 991     /*
 992      * Is it more efficient to look at vram VGA-dirty bits or wait
 993      * for the driver to issue SVGA_CMD_UPDATE?
 994      */
 995     if (s->invalidated) {
 996         s->invalidated = 0;
 997         vmsvga_update_screen(s);
 998     }
 999 }
1000
1001 static void vmsvga_reset(DeviceState *dev)
1002 {
1003     struct pci_vmsvga_state_s *pci =
1004         DO_UPCAST(struct pci_vmsvga_state_s, card.qdev, dev);
1005     struct vmsvga_state_s *s = &pci->chip;
1006
1007     s->index = 0;
1008     s->enable = 0;
1009     s->config = 0;
1010     s->width = -1;
1011     s->height = -1;
1012     s->svgaid = SVGA_ID;
1013     s->cursor.on = 0;
1014     s->redraw_fifo_first = 0;
1015     s->redraw_fifo_last = 0;
1016     s->syncing = 0;
1017
1018     vga_dirty_log_start(&s->vga);
1019 }
1020
1021 static void vmsvga_invalidate_display(void *opaque)
1022 {
1023     struct vmsvga_state_s *s = opaque;
1024     if (!s->enable) {
1025         s->vga.invalidate(&s->vga);
1026         return;
1027     }
1028
1029     s->invalidated = 1;
1030 }
1031
1032 /* save the vga display in a PPM image even if no display is
1033    available */
1034 static void vmsvga_screen_dump(void *opaque, const char *filename)
1035 {
1036     struct vmsvga_state_s *s = opaque;
1037     if (!s->enable) {
1038         s->vga.screen_dump(&s->vga, filename);
1039         return;
1040     }
1041
1042     if (s->depth == 32) {
1043         DisplaySurface *ds = qemu_create_displaysurface_from(s->width,
1044                 s->height, 32, ds_get_linesize(s->vga.ds), s->vga.vram_ptr);
1045         ppm_save(filename, ds);
1046         g_free(ds);
1047     }
1048 }
1049
1050 static void vmsvga_text_update(void *opaque, console_ch_t *chardata)
1051 {
1052     struct vmsvga_state_s *s = opaque;
1053
1054     if (s->vga.text_update)
1055         s->vga.text_update(&s->vga, chardata);
1056 }
1057
1058 #ifdef DIRECT_VRAM
1059 static uint32_t vmsvga_vram_readb(void *opaque, target_phys_addr_t addr)
1060 {
1061     struct vmsvga_state_s *s = opaque;
1062     if (addr < s->fb_size)
1063         return *(uint8_t *) (ds_get_data(s->ds) + addr);
1064     else
1065         return *(uint8_t *) (s->vram_ptr + addr);
1066 }
1067
1068 static uint32_t vmsvga_vram_readw(void *opaque, target_phys_addr_t addr)
1069 {
1070     struct vmsvga_state_s *s = opaque;
1071     if (addr < s->fb_size)
1072         return *(uint16_t *) (ds_get_data(s->ds) + addr);
1073     else
1074         return *(uint16_t *) (s->vram_ptr + addr);
1075 }
1076
1077 static uint32_t vmsvga_vram_readl(void *opaque, target_phys_addr_t addr)
1078 {
1079     struct vmsvga_state_s *s = opaque;
1080     if (addr < s->fb_size)
1081         return *(uint32_t *) (ds_get_data(s->ds) + addr);
1082     else
1083         return *(uint32_t *) (s->vram_ptr + addr);
1084 }
1085
1086 static void vmsvga_vram_writeb(void *opaque, target_phys_addr_t addr,
1087                 uint32_t value)
1088 {
1089     struct vmsvga_state_s *s = opaque;
1090     if (addr < s->fb_size)
1091         *(uint8_t *) (ds_get_data(s->ds) + addr) = value;
1092     else
1093         *(uint8_t *) (s->vram_ptr + addr) = value;
1094 }
1095
1096 static void vmsvga_vram_writew(void *opaque, target_phys_addr_t addr,
1097                 uint32_t value)
1098 {
1099     struct vmsvga_state_s *s = opaque;
1100     if (addr < s->fb_size)
1101         *(uint16_t *) (ds_get_data(s->ds) + addr) = value;
1102     else
1103         *(uint16_t *) (s->vram_ptr + addr) = value;
1104 }
1105
1106 static void vmsvga_vram_writel(void *opaque, target_phys_addr_t addr,
1107                 uint32_t value)
1108 {
1109     struct vmsvga_state_s *s = opaque;
1110     if (addr < s->fb_size)
1111         *(uint32_t *) (ds_get_data(s->ds) + addr) = value;
1112     else
1113         *(uint32_t *) (s->vram_ptr + addr) = value;
1114 }
1115
1116 static const MemoryRegionOps vmsvga_vram_io_ops = {
1117     .old_mmio = {
1118         .read = {
1119             vmsvga_vram_readb,
1120             vmsvga_vram_readw,
1121             vmsvga_vram_readl,
1122         },
1123         .write = {
1124             vmsvga_vram_writeb,
1125             vmsvga_vram_writew,
1126             vmsvga_vram_writel,
1127         },
1128     },
1129     .endianness = DEVICE_NATIVE_ENDIAN,
1130 }
1131
1132 #endif
1133
1134 static int vmsvga_post_load(void *opaque, int version_id)
1135 {
1136     struct vmsvga_state_s *s = opaque;
1137
1138     s->invalidated = 1;
1139     if (s->config)
1140         s->fifo = (uint32_t *) s->fifo_ptr;
1141
1142     return 0;
1143 }
1144
1145 static const VMStateDescription vmstate_vmware_vga_internal = {
1146     .name = "vmware_vga_internal",
1147     .version_id = 0,
1148     .minimum_version_id = 0,
1149     .minimum_version_id_old = 0,
1150     .post_load = vmsvga_post_load,
1151     .fields      = (VMStateField []) {
1152         VMSTATE_INT32_EQUAL(depth, struct vmsvga_state_s),
1153         VMSTATE_INT32(enable, struct vmsvga_state_s),
1154         VMSTATE_INT32(config, struct vmsvga_state_s),
1155         VMSTATE_INT32(cursor.id, struct vmsvga_state_s),
1156         VMSTATE_INT32(cursor.x, struct vmsvga_state_s),
1157         VMSTATE_INT32(cursor.y, struct vmsvga_state_s),
1158         VMSTATE_INT32(cursor.on, struct vmsvga_state_s),
1159         VMSTATE_INT32(index, struct vmsvga_state_s),
1160         VMSTATE_VARRAY_INT32(scratch, struct vmsvga_state_s,
1161                              scratch_size, 0, vmstate_info_uint32, uint32_t),
1162         VMSTATE_INT32(new_width, struct vmsvga_state_s),
1163         VMSTATE_INT32(new_height, struct vmsvga_state_s),
1164         VMSTATE_UINT32(guest, struct vmsvga_state_s),
1165         VMSTATE_UINT32(svgaid, struct vmsvga_state_s),
1166         VMSTATE_INT32(syncing, struct vmsvga_state_s),
1167         VMSTATE_INT32(fb_size, struct vmsvga_state_s),
1168         VMSTATE_END_OF_LIST()
1169     }
1170 };
1171
1172 static const VMStateDescription vmstate_vmware_vga = {
1173     .name = "vmware_vga",
1174     .version_id = 0,
1175     .minimum_version_id = 0,
1176     .minimum_version_id_old = 0,
1177     .fields      = (VMStateField []) {
1178         VMSTATE_PCI_DEVICE(card, struct pci_vmsvga_state_s),
1179         VMSTATE_STRUCT(chip, struct pci_vmsvga_state_s, 0,
1180                        vmstate_vmware_vga_internal, struct vmsvga_state_s),
1181         VMSTATE_END_OF_LIST()
1182     }
1183 };
1184
1185 static void vmsvga_init(struct vmsvga_state_s *s, int vga_ram_size,
1186                         MemoryRegion *address_space)
1187 {
1188     s->scratch_size = SVGA_SCRATCH_SIZE;
1189     s->scratch = g_malloc(s->scratch_size * 4);
1190
1191     s->vga.ds = graphic_console_init(vmsvga_update_display,
1192                                      vmsvga_invalidate_display,
1193                                      vmsvga_screen_dump,
1194                                      vmsvga_text_update, s);
1195
1196
1197     s->fifo_size = SVGA_FIFO_SIZE;
1198     memory_region_init_ram(&s->fifo_ram, NULL, "vmsvga.fifo", s->fifo_size);
1199     s->fifo_ptr = memory_region_get_ram_ptr(&s->fifo_ram);
1200
1201     vga_common_init(&s->vga, vga_ram_size);
1202     vga_init(&s->vga, address_space);
1203     vmstate_register(NULL, 0, &vmstate_vga_common, &s->vga);
1204
1205     s->depth = ds_get_bits_per_pixel(s->vga.ds);
1206     s->bypp = ds_get_bytes_per_pixel(s->vga.ds);
1207     switch (s->depth) {
1208     case 8:
1209         s->wred   = 0x00000007;
1210         s->wgreen = 0x00000038;
1211         s->wblue  = 0x000000c0;
1212         break;
1213     case 15:
1214         s->wred   = 0x0000001f;
1215         s->wgreen = 0x000003e0;
1216         s->wblue  = 0x00007c00;
1217         break;
1218     case 16:
1219         s->wred   = 0x0000001f;
1220         s->wgreen = 0x000007e0;
1221         s->wblue  = 0x0000f800;
1222         break;
1223     case 24:
1224         s->wred   = 0x00ff0000;
1225         s->wgreen = 0x0000ff00;
1226         s->wblue  = 0x000000ff;
1227         break;
1228     case 32:
1229         s->wred   = 0x00ff0000;
1230         s->wgreen = 0x0000ff00;
1231         s->wblue  = 0x000000ff;
1232         break;
1233     }
1234 }
1235
1236 static uint64_t vmsvga_io_read(void *opaque, target_phys_addr_t addr,
1237                                unsigned size)
1238 {
1239     struct vmsvga_state_s *s = opaque;
1240
1241     switch (addr) {
1242     case SVGA_IO_MUL * SVGA_INDEX_PORT: return vmsvga_index_read(s, addr);
1243     case SVGA_IO_MUL * SVGA_VALUE_PORT: return vmsvga_value_read(s, addr);
1244     case SVGA_IO_MUL * SVGA_BIOS_PORT: return vmsvga_bios_read(s, addr);
1245     default: return -1u;
1246     }
1247 }
1248
1249 static void vmsvga_io_write(void *opaque, target_phys_addr_t addr,
1250                             uint64_t data, unsigned size)
1251 {
1252     struct vmsvga_state_s *s = opaque;
1253
1254     switch (addr) {
1255     case SVGA_IO_MUL * SVGA_INDEX_PORT:
1256         return vmsvga_index_write(s, addr, data);
1257     case SVGA_IO_MUL * SVGA_VALUE_PORT:
1258         return vmsvga_value_write(s, addr, data);
1259     case SVGA_IO_MUL * SVGA_BIOS_PORT:
1260         return vmsvga_bios_write(s, addr, data);
1261     }
1262 }
1263
1264 static const MemoryRegionOps vmsvga_io_ops = {
1265     .read = vmsvga_io_read,
1266     .write = vmsvga_io_write,
1267     .endianness = DEVICE_LITTLE_ENDIAN,
1268     .valid = {
1269         .min_access_size = 4,
1270         .max_access_size = 4,
1271     },
1272 };
1273
1274 static int pci_vmsvga_initfn(PCIDevice *dev)
1275 {
1276     struct pci_vmsvga_state_s *s =
1277         DO_UPCAST(struct pci_vmsvga_state_s, card, dev);
1278     MemoryRegion *iomem;
1279
1280 #ifdef DIRECT_VRAM
1281     DirectMem *directmem = g_malloc(sizeof(*directmem));
1282
1283     iomem = &directmem->mr;
1284     memory_region_init_io(iomem, &vmsvga_vram_io_ops, &s->chip, "vmsvga",
1285                           memory_region_size(&s->chip.vga.vram));
1286 #else
1287     iomem = &s->chip.vga.vram;
1288 #endif
1289
1290     vga_dirty_log_restart(&s->chip.vga);
1291
1292     s->card.config[PCI_CACHE_LINE_SIZE] = 0x08;         /* Cache line size */
1293     s->card.config[PCI_LATENCY_TIMER] = 0x40;           /* Latency timer */
1294     s->card.config[PCI_INTERRUPT_LINE] = 0xff;          /* End */
1295
1296     memory_region_init_io(&s->io_bar, &vmsvga_io_ops, &s->chip,
1297                           "vmsvga-io", 0x10);
1298     pci_register_bar(&s->card, 0, PCI_BASE_ADDRESS_SPACE_IO, &s->io_bar);
1299
1300     vmsvga_init(&s->chip, VGA_RAM_SIZE, pci_address_space(dev));
1301
1302     pci_register_bar(&s->card, 1, PCI_BASE_ADDRESS_MEM_PREFETCH, iomem);
1303     pci_register_bar(&s->card, 2, PCI_BASE_ADDRESS_MEM_PREFETCH,
1304                      &s->chip.fifo_ram);
1305
1306     if (!dev->rom_bar) {
1307         /* compatibility with pc-0.13 and older */
1308         vga_init_vbe(&s->chip.vga, pci_address_space(dev));
1309     }
1310
1311     return 0;
1312 }
1313
1314 static PCIDeviceInfo vmsvga_info = {
1315     .qdev.name    = "vmware-svga",
1316     .qdev.size    = sizeof(struct pci_vmsvga_state_s),
1317     .qdev.vmsd    = &vmstate_vmware_vga,
1318     .qdev.reset   = vmsvga_reset,
1319     .no_hotplug   = 1,
1320     .init         = pci_vmsvga_initfn,
1321     .romfile      = "vgabios-vmware.bin",
1322
1323     .vendor_id    =  PCI_VENDOR_ID_VMWARE,
1324     .device_id    = SVGA_PCI_DEVICE_ID,
1325     .class_id     = PCI_CLASS_DISPLAY_VGA,
1326     .subsystem_vendor_id = PCI_VENDOR_ID_VMWARE,
1327     .subsystem_id = SVGA_PCI_DEVICE_ID,
1328 };
1329
1330 static void vmsvga_register(void)
1331 {
1332     pci_qdev_register(&vmsvga_info);
1333 }
1334 device_init(vmsvga_register);