1 /* 2 * QEMU VGA Emulator. 3 * 4 * Copyright (c) 2003 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 "hw/hw.h" 25 #include "vga.h" 26 #include "ui/console.h" 27 #include "hw/i386/pc.h" 28 #include "hw/pci/pci.h" 29 #include "vga_int.h" 30 #include "ui/pixel_ops.h" 31 #include "qemu/timer.h" 32 #include "hw/xen/xen.h" 33 #include "trace.h" 34 35 //#define DEBUG_VGA 36 //#define DEBUG_VGA_MEM 37 //#define DEBUG_VGA_REG 38 39 //#define DEBUG_BOCHS_VBE 40 41 /* 16 state changes per vertical frame @60 Hz */ 42 #define VGA_TEXT_CURSOR_PERIOD_MS (1000 * 2 * 16 / 60) 43 44 /* 45 * Video Graphics Array (VGA) 46 * 47 * Chipset docs for original IBM VGA: 48 * http://www.mcamafia.de/pdf/ibm_vgaxga_trm2.pdf 49 * 50 * FreeVGA site: 51 * http://www.osdever.net/FreeVGA/home.htm 52 * 53 * Standard VGA features and Bochs VBE extensions are implemented. 54 */ 55 56 /* force some bits to zero */ 57 const uint8_t sr_mask[8] = { 58 0x03, 59 0x3d, 60 0x0f, 61 0x3f, 62 0x0e, 63 0x00, 64 0x00, 65 0xff, 66 }; 67 68 const uint8_t gr_mask[16] = { 69 0x0f, /* 0x00 */ 70 0x0f, /* 0x01 */ 71 0x0f, /* 0x02 */ 72 0x1f, /* 0x03 */ 73 0x03, /* 0x04 */ 74 0x7b, /* 0x05 */ 75 0x0f, /* 0x06 */ 76 0x0f, /* 0x07 */ 77 0xff, /* 0x08 */ 78 0x00, /* 0x09 */ 79 0x00, /* 0x0a */ 80 0x00, /* 0x0b */ 81 0x00, /* 0x0c */ 82 0x00, /* 0x0d */ 83 0x00, /* 0x0e */ 84 0x00, /* 0x0f */ 85 }; 86 87 #define cbswap_32(__x) \ 88 ((uint32_t)( \ 89 (((uint32_t)(__x) & (uint32_t)0x000000ffUL) << 24) | \ 90 (((uint32_t)(__x) & (uint32_t)0x0000ff00UL) << 8) | \ 91 (((uint32_t)(__x) & (uint32_t)0x00ff0000UL) >> 8) | \ 92 (((uint32_t)(__x) & (uint32_t)0xff000000UL) >> 24) )) 93 94 #ifdef HOST_WORDS_BIGENDIAN 95 #define PAT(x) cbswap_32(x) 96 #else 97 #define PAT(x) (x) 98 #endif 99 100 #ifdef HOST_WORDS_BIGENDIAN 101 #define BIG 1 102 #else 103 #define BIG 0 104 #endif 105 106 #ifdef HOST_WORDS_BIGENDIAN 107 #define GET_PLANE(data, p) (((data) >> (24 - (p) * 8)) & 0xff) 108 #else 109 #define GET_PLANE(data, p) (((data) >> ((p) * 8)) & 0xff) 110 #endif 111 112 static const uint32_t mask16[16] = { 113 PAT(0x00000000), 114 PAT(0x000000ff), 115 PAT(0x0000ff00), 116 PAT(0x0000ffff), 117 PAT(0x00ff0000), 118 PAT(0x00ff00ff), 119 PAT(0x00ffff00), 120 PAT(0x00ffffff), 121 PAT(0xff000000), 122 PAT(0xff0000ff), 123 PAT(0xff00ff00), 124 PAT(0xff00ffff), 125 PAT(0xffff0000), 126 PAT(0xffff00ff), 127 PAT(0xffffff00), 128 PAT(0xffffffff), 129 }; 130 131 #undef PAT 132 133 #ifdef HOST_WORDS_BIGENDIAN 134 #define PAT(x) (x) 135 #else 136 #define PAT(x) cbswap_32(x) 137 #endif 138 139 static uint32_t expand4[256]; 140 static uint16_t expand2[256]; 141 static uint8_t expand4to8[16]; 142 143 static void vga_update_memory_access(VGACommonState *s) 144 { 145 hwaddr base, offset, size; 146 147 if (s->legacy_address_space == NULL) { 148 return; 149 } 150 151 if (s->has_chain4_alias) { 152 memory_region_del_subregion(s->legacy_address_space, &s->chain4_alias); 153 object_unparent(OBJECT(&s->chain4_alias)); 154 s->has_chain4_alias = false; 155 s->plane_updated = 0xf; 156 } 157 if ((s->sr[VGA_SEQ_PLANE_WRITE] & VGA_SR02_ALL_PLANES) == 158 VGA_SR02_ALL_PLANES && s->sr[VGA_SEQ_MEMORY_MODE] & VGA_SR04_CHN_4M) { 159 offset = 0; 160 switch ((s->gr[VGA_GFX_MISC] >> 2) & 3) { 161 case 0: 162 base = 0xa0000; 163 size = 0x20000; 164 break; 165 case 1: 166 base = 0xa0000; 167 size = 0x10000; 168 offset = s->bank_offset; 169 break; 170 case 2: 171 base = 0xb0000; 172 size = 0x8000; 173 break; 174 case 3: 175 default: 176 base = 0xb8000; 177 size = 0x8000; 178 break; 179 } 180 memory_region_init_alias(&s->chain4_alias, memory_region_owner(&s->vram), 181 "vga.chain4", &s->vram, offset, size); 182 memory_region_add_subregion_overlap(s->legacy_address_space, base, 183 &s->chain4_alias, 2); 184 s->has_chain4_alias = true; 185 } 186 } 187 188 static void vga_dumb_update_retrace_info(VGACommonState *s) 189 { 190 (void) s; 191 } 192 193 static void vga_precise_update_retrace_info(VGACommonState *s) 194 { 195 int htotal_chars; 196 int hretr_start_char; 197 int hretr_skew_chars; 198 int hretr_end_char; 199 200 int vtotal_lines; 201 int vretr_start_line; 202 int vretr_end_line; 203 204 int dots; 205 #if 0 206 int div2, sldiv2; 207 #endif 208 int clocking_mode; 209 int clock_sel; 210 const int clk_hz[] = {25175000, 28322000, 25175000, 25175000}; 211 int64_t chars_per_sec; 212 struct vga_precise_retrace *r = &s->retrace_info.precise; 213 214 htotal_chars = s->cr[VGA_CRTC_H_TOTAL] + 5; 215 hretr_start_char = s->cr[VGA_CRTC_H_SYNC_START]; 216 hretr_skew_chars = (s->cr[VGA_CRTC_H_SYNC_END] >> 5) & 3; 217 hretr_end_char = s->cr[VGA_CRTC_H_SYNC_END] & 0x1f; 218 219 vtotal_lines = (s->cr[VGA_CRTC_V_TOTAL] | 220 (((s->cr[VGA_CRTC_OVERFLOW] & 1) | 221 ((s->cr[VGA_CRTC_OVERFLOW] >> 4) & 2)) << 8)) + 2; 222 vretr_start_line = s->cr[VGA_CRTC_V_SYNC_START] | 223 ((((s->cr[VGA_CRTC_OVERFLOW] >> 2) & 1) | 224 ((s->cr[VGA_CRTC_OVERFLOW] >> 6) & 2)) << 8); 225 vretr_end_line = s->cr[VGA_CRTC_V_SYNC_END] & 0xf; 226 227 clocking_mode = (s->sr[VGA_SEQ_CLOCK_MODE] >> 3) & 1; 228 clock_sel = (s->msr >> 2) & 3; 229 dots = (s->msr & 1) ? 8 : 9; 230 231 chars_per_sec = clk_hz[clock_sel] / dots; 232 233 htotal_chars <<= clocking_mode; 234 235 r->total_chars = vtotal_lines * htotal_chars; 236 if (r->freq) { 237 r->ticks_per_char = get_ticks_per_sec() / (r->total_chars * r->freq); 238 } else { 239 r->ticks_per_char = get_ticks_per_sec() / chars_per_sec; 240 } 241 242 r->vstart = vretr_start_line; 243 r->vend = r->vstart + vretr_end_line + 1; 244 245 r->hstart = hretr_start_char + hretr_skew_chars; 246 r->hend = r->hstart + hretr_end_char + 1; 247 r->htotal = htotal_chars; 248 249 #if 0 250 div2 = (s->cr[VGA_CRTC_MODE] >> 2) & 1; 251 sldiv2 = (s->cr[VGA_CRTC_MODE] >> 3) & 1; 252 printf ( 253 "hz=%f\n" 254 "htotal = %d\n" 255 "hretr_start = %d\n" 256 "hretr_skew = %d\n" 257 "hretr_end = %d\n" 258 "vtotal = %d\n" 259 "vretr_start = %d\n" 260 "vretr_end = %d\n" 261 "div2 = %d sldiv2 = %d\n" 262 "clocking_mode = %d\n" 263 "clock_sel = %d %d\n" 264 "dots = %d\n" 265 "ticks/char = %" PRId64 "\n" 266 "\n", 267 (double) get_ticks_per_sec() / (r->ticks_per_char * r->total_chars), 268 htotal_chars, 269 hretr_start_char, 270 hretr_skew_chars, 271 hretr_end_char, 272 vtotal_lines, 273 vretr_start_line, 274 vretr_end_line, 275 div2, sldiv2, 276 clocking_mode, 277 clock_sel, 278 clk_hz[clock_sel], 279 dots, 280 r->ticks_per_char 281 ); 282 #endif 283 } 284 285 static uint8_t vga_precise_retrace(VGACommonState *s) 286 { 287 struct vga_precise_retrace *r = &s->retrace_info.precise; 288 uint8_t val = s->st01 & ~(ST01_V_RETRACE | ST01_DISP_ENABLE); 289 290 if (r->total_chars) { 291 int cur_line, cur_line_char, cur_char; 292 int64_t cur_tick; 293 294 cur_tick = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); 295 296 cur_char = (cur_tick / r->ticks_per_char) % r->total_chars; 297 cur_line = cur_char / r->htotal; 298 299 if (cur_line >= r->vstart && cur_line <= r->vend) { 300 val |= ST01_V_RETRACE | ST01_DISP_ENABLE; 301 } else { 302 cur_line_char = cur_char % r->htotal; 303 if (cur_line_char >= r->hstart && cur_line_char <= r->hend) { 304 val |= ST01_DISP_ENABLE; 305 } 306 } 307 308 return val; 309 } else { 310 return s->st01 ^ (ST01_V_RETRACE | ST01_DISP_ENABLE); 311 } 312 } 313 314 static uint8_t vga_dumb_retrace(VGACommonState *s) 315 { 316 return s->st01 ^ (ST01_V_RETRACE | ST01_DISP_ENABLE); 317 } 318 319 int vga_ioport_invalid(VGACommonState *s, uint32_t addr) 320 { 321 if (s->msr & VGA_MIS_COLOR) { 322 /* Color */ 323 return (addr >= 0x3b0 && addr <= 0x3bf); 324 } else { 325 /* Monochrome */ 326 return (addr >= 0x3d0 && addr <= 0x3df); 327 } 328 } 329 330 uint32_t vga_ioport_read(void *opaque, uint32_t addr) 331 { 332 VGACommonState *s = opaque; 333 int val, index; 334 335 if (vga_ioport_invalid(s, addr)) { 336 val = 0xff; 337 } else { 338 switch(addr) { 339 case VGA_ATT_W: 340 if (s->ar_flip_flop == 0) { 341 val = s->ar_index; 342 } else { 343 val = 0; 344 } 345 break; 346 case VGA_ATT_R: 347 index = s->ar_index & 0x1f; 348 if (index < VGA_ATT_C) { 349 val = s->ar[index]; 350 } else { 351 val = 0; 352 } 353 break; 354 case VGA_MIS_W: 355 val = s->st00; 356 break; 357 case VGA_SEQ_I: 358 val = s->sr_index; 359 break; 360 case VGA_SEQ_D: 361 val = s->sr[s->sr_index]; 362 #ifdef DEBUG_VGA_REG 363 printf("vga: read SR%x = 0x%02x\n", s->sr_index, val); 364 #endif 365 break; 366 case VGA_PEL_IR: 367 val = s->dac_state; 368 break; 369 case VGA_PEL_IW: 370 val = s->dac_write_index; 371 break; 372 case VGA_PEL_D: 373 val = s->palette[s->dac_read_index * 3 + s->dac_sub_index]; 374 if (++s->dac_sub_index == 3) { 375 s->dac_sub_index = 0; 376 s->dac_read_index++; 377 } 378 break; 379 case VGA_FTC_R: 380 val = s->fcr; 381 break; 382 case VGA_MIS_R: 383 val = s->msr; 384 break; 385 case VGA_GFX_I: 386 val = s->gr_index; 387 break; 388 case VGA_GFX_D: 389 val = s->gr[s->gr_index]; 390 #ifdef DEBUG_VGA_REG 391 printf("vga: read GR%x = 0x%02x\n", s->gr_index, val); 392 #endif 393 break; 394 case VGA_CRT_IM: 395 case VGA_CRT_IC: 396 val = s->cr_index; 397 break; 398 case VGA_CRT_DM: 399 case VGA_CRT_DC: 400 val = s->cr[s->cr_index]; 401 #ifdef DEBUG_VGA_REG 402 printf("vga: read CR%x = 0x%02x\n", s->cr_index, val); 403 #endif 404 break; 405 case VGA_IS1_RM: 406 case VGA_IS1_RC: 407 /* just toggle to fool polling */ 408 val = s->st01 = s->retrace(s); 409 s->ar_flip_flop = 0; 410 break; 411 default: 412 val = 0x00; 413 break; 414 } 415 } 416 #if defined(DEBUG_VGA) 417 printf("VGA: read addr=0x%04x data=0x%02x\n", addr, val); 418 #endif 419 return val; 420 } 421 422 void vga_ioport_write(void *opaque, uint32_t addr, uint32_t val) 423 { 424 VGACommonState *s = opaque; 425 int index; 426 427 /* check port range access depending on color/monochrome mode */ 428 if (vga_ioport_invalid(s, addr)) { 429 return; 430 } 431 #ifdef DEBUG_VGA 432 printf("VGA: write addr=0x%04x data=0x%02x\n", addr, val); 433 #endif 434 435 switch(addr) { 436 case VGA_ATT_W: 437 if (s->ar_flip_flop == 0) { 438 val &= 0x3f; 439 s->ar_index = val; 440 } else { 441 index = s->ar_index & 0x1f; 442 switch(index) { 443 case VGA_ATC_PALETTE0 ... VGA_ATC_PALETTEF: 444 s->ar[index] = val & 0x3f; 445 break; 446 case VGA_ATC_MODE: 447 s->ar[index] = val & ~0x10; 448 break; 449 case VGA_ATC_OVERSCAN: 450 s->ar[index] = val; 451 break; 452 case VGA_ATC_PLANE_ENABLE: 453 s->ar[index] = val & ~0xc0; 454 break; 455 case VGA_ATC_PEL: 456 s->ar[index] = val & ~0xf0; 457 break; 458 case VGA_ATC_COLOR_PAGE: 459 s->ar[index] = val & ~0xf0; 460 break; 461 default: 462 break; 463 } 464 } 465 s->ar_flip_flop ^= 1; 466 break; 467 case VGA_MIS_W: 468 s->msr = val & ~0x10; 469 s->update_retrace_info(s); 470 break; 471 case VGA_SEQ_I: 472 s->sr_index = val & 7; 473 break; 474 case VGA_SEQ_D: 475 #ifdef DEBUG_VGA_REG 476 printf("vga: write SR%x = 0x%02x\n", s->sr_index, val); 477 #endif 478 s->sr[s->sr_index] = val & sr_mask[s->sr_index]; 479 if (s->sr_index == VGA_SEQ_CLOCK_MODE) { 480 s->update_retrace_info(s); 481 } 482 vga_update_memory_access(s); 483 break; 484 case VGA_PEL_IR: 485 s->dac_read_index = val; 486 s->dac_sub_index = 0; 487 s->dac_state = 3; 488 break; 489 case VGA_PEL_IW: 490 s->dac_write_index = val; 491 s->dac_sub_index = 0; 492 s->dac_state = 0; 493 break; 494 case VGA_PEL_D: 495 s->dac_cache[s->dac_sub_index] = val; 496 if (++s->dac_sub_index == 3) { 497 memcpy(&s->palette[s->dac_write_index * 3], s->dac_cache, 3); 498 s->dac_sub_index = 0; 499 s->dac_write_index++; 500 } 501 break; 502 case VGA_GFX_I: 503 s->gr_index = val & 0x0f; 504 break; 505 case VGA_GFX_D: 506 #ifdef DEBUG_VGA_REG 507 printf("vga: write GR%x = 0x%02x\n", s->gr_index, val); 508 #endif 509 s->gr[s->gr_index] = val & gr_mask[s->gr_index]; 510 vga_update_memory_access(s); 511 break; 512 case VGA_CRT_IM: 513 case VGA_CRT_IC: 514 s->cr_index = val; 515 break; 516 case VGA_CRT_DM: 517 case VGA_CRT_DC: 518 #ifdef DEBUG_VGA_REG 519 printf("vga: write CR%x = 0x%02x\n", s->cr_index, val); 520 #endif 521 /* handle CR0-7 protection */ 522 if ((s->cr[VGA_CRTC_V_SYNC_END] & VGA_CR11_LOCK_CR0_CR7) && 523 s->cr_index <= VGA_CRTC_OVERFLOW) { 524 /* can always write bit 4 of CR7 */ 525 if (s->cr_index == VGA_CRTC_OVERFLOW) { 526 s->cr[VGA_CRTC_OVERFLOW] = (s->cr[VGA_CRTC_OVERFLOW] & ~0x10) | 527 (val & 0x10); 528 } 529 return; 530 } 531 s->cr[s->cr_index] = val; 532 533 switch(s->cr_index) { 534 case VGA_CRTC_H_TOTAL: 535 case VGA_CRTC_H_SYNC_START: 536 case VGA_CRTC_H_SYNC_END: 537 case VGA_CRTC_V_TOTAL: 538 case VGA_CRTC_OVERFLOW: 539 case VGA_CRTC_V_SYNC_END: 540 case VGA_CRTC_MODE: 541 s->update_retrace_info(s); 542 break; 543 } 544 break; 545 case VGA_IS1_RM: 546 case VGA_IS1_RC: 547 s->fcr = val & 0x10; 548 break; 549 } 550 } 551 552 /* 553 * Sanity check vbe register writes. 554 * 555 * As we don't have a way to signal errors to the guest in the bochs 556 * dispi interface we'll go adjust the registers to the closest valid 557 * value. 558 */ 559 static void vbe_fixup_regs(VGACommonState *s) 560 { 561 uint16_t *r = s->vbe_regs; 562 uint32_t bits, linelength, maxy, offset; 563 564 if (!(r[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED)) { 565 /* vbe is turned off -- nothing to do */ 566 return; 567 } 568 569 /* check depth */ 570 switch (r[VBE_DISPI_INDEX_BPP]) { 571 case 4: 572 case 8: 573 case 16: 574 case 24: 575 case 32: 576 bits = r[VBE_DISPI_INDEX_BPP]; 577 break; 578 case 15: 579 bits = 16; 580 break; 581 default: 582 bits = r[VBE_DISPI_INDEX_BPP] = 8; 583 break; 584 } 585 586 /* check width */ 587 r[VBE_DISPI_INDEX_XRES] &= ~7u; 588 if (r[VBE_DISPI_INDEX_XRES] == 0) { 589 r[VBE_DISPI_INDEX_XRES] = 8; 590 } 591 if (r[VBE_DISPI_INDEX_XRES] > VBE_DISPI_MAX_XRES) { 592 r[VBE_DISPI_INDEX_XRES] = VBE_DISPI_MAX_XRES; 593 } 594 r[VBE_DISPI_INDEX_VIRT_WIDTH] &= ~7u; 595 if (r[VBE_DISPI_INDEX_VIRT_WIDTH] > VBE_DISPI_MAX_XRES) { 596 r[VBE_DISPI_INDEX_VIRT_WIDTH] = VBE_DISPI_MAX_XRES; 597 } 598 if (r[VBE_DISPI_INDEX_VIRT_WIDTH] < r[VBE_DISPI_INDEX_XRES]) { 599 r[VBE_DISPI_INDEX_VIRT_WIDTH] = r[VBE_DISPI_INDEX_XRES]; 600 } 601 602 /* check height */ 603 linelength = r[VBE_DISPI_INDEX_VIRT_WIDTH] * bits / 8; 604 maxy = s->vbe_size / linelength; 605 if (r[VBE_DISPI_INDEX_YRES] == 0) { 606 r[VBE_DISPI_INDEX_YRES] = 1; 607 } 608 if (r[VBE_DISPI_INDEX_YRES] > VBE_DISPI_MAX_YRES) { 609 r[VBE_DISPI_INDEX_YRES] = VBE_DISPI_MAX_YRES; 610 } 611 if (r[VBE_DISPI_INDEX_YRES] > maxy) { 612 r[VBE_DISPI_INDEX_YRES] = maxy; 613 } 614 615 /* check offset */ 616 if (r[VBE_DISPI_INDEX_X_OFFSET] > VBE_DISPI_MAX_XRES) { 617 r[VBE_DISPI_INDEX_X_OFFSET] = VBE_DISPI_MAX_XRES; 618 } 619 if (r[VBE_DISPI_INDEX_Y_OFFSET] > VBE_DISPI_MAX_YRES) { 620 r[VBE_DISPI_INDEX_Y_OFFSET] = VBE_DISPI_MAX_YRES; 621 } 622 offset = r[VBE_DISPI_INDEX_X_OFFSET] * bits / 8; 623 offset += r[VBE_DISPI_INDEX_Y_OFFSET] * linelength; 624 if (offset + r[VBE_DISPI_INDEX_YRES] * linelength > s->vbe_size) { 625 r[VBE_DISPI_INDEX_Y_OFFSET] = 0; 626 offset = r[VBE_DISPI_INDEX_X_OFFSET] * bits / 8; 627 if (offset + r[VBE_DISPI_INDEX_YRES] * linelength > s->vbe_size) { 628 r[VBE_DISPI_INDEX_X_OFFSET] = 0; 629 offset = 0; 630 } 631 } 632 633 /* update vga state */ 634 r[VBE_DISPI_INDEX_VIRT_HEIGHT] = maxy; 635 s->vbe_line_offset = linelength; 636 s->vbe_start_addr = offset / 4; 637 } 638 639 static uint32_t vbe_ioport_read_index(void *opaque, uint32_t addr) 640 { 641 VGACommonState *s = opaque; 642 uint32_t val; 643 val = s->vbe_index; 644 return val; 645 } 646 647 uint32_t vbe_ioport_read_data(void *opaque, uint32_t addr) 648 { 649 VGACommonState *s = opaque; 650 uint32_t val; 651 652 if (s->vbe_index < VBE_DISPI_INDEX_NB) { 653 if (s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_GETCAPS) { 654 switch(s->vbe_index) { 655 /* XXX: do not hardcode ? */ 656 case VBE_DISPI_INDEX_XRES: 657 val = VBE_DISPI_MAX_XRES; 658 break; 659 case VBE_DISPI_INDEX_YRES: 660 val = VBE_DISPI_MAX_YRES; 661 break; 662 case VBE_DISPI_INDEX_BPP: 663 val = VBE_DISPI_MAX_BPP; 664 break; 665 default: 666 val = s->vbe_regs[s->vbe_index]; 667 break; 668 } 669 } else { 670 val = s->vbe_regs[s->vbe_index]; 671 } 672 } else if (s->vbe_index == VBE_DISPI_INDEX_VIDEO_MEMORY_64K) { 673 val = s->vbe_size / (64 * 1024); 674 } else { 675 val = 0; 676 } 677 #ifdef DEBUG_BOCHS_VBE 678 printf("VBE: read index=0x%x val=0x%x\n", s->vbe_index, val); 679 #endif 680 return val; 681 } 682 683 void vbe_ioport_write_index(void *opaque, uint32_t addr, uint32_t val) 684 { 685 VGACommonState *s = opaque; 686 s->vbe_index = val; 687 } 688 689 void vbe_ioport_write_data(void *opaque, uint32_t addr, uint32_t val) 690 { 691 VGACommonState *s = opaque; 692 693 if (s->vbe_index <= VBE_DISPI_INDEX_NB) { 694 #ifdef DEBUG_BOCHS_VBE 695 printf("VBE: write index=0x%x val=0x%x\n", s->vbe_index, val); 696 #endif 697 switch(s->vbe_index) { 698 case VBE_DISPI_INDEX_ID: 699 if (val == VBE_DISPI_ID0 || 700 val == VBE_DISPI_ID1 || 701 val == VBE_DISPI_ID2 || 702 val == VBE_DISPI_ID3 || 703 val == VBE_DISPI_ID4) { 704 s->vbe_regs[s->vbe_index] = val; 705 } 706 break; 707 case VBE_DISPI_INDEX_XRES: 708 case VBE_DISPI_INDEX_YRES: 709 case VBE_DISPI_INDEX_BPP: 710 case VBE_DISPI_INDEX_VIRT_WIDTH: 711 case VBE_DISPI_INDEX_X_OFFSET: 712 case VBE_DISPI_INDEX_Y_OFFSET: 713 s->vbe_regs[s->vbe_index] = val; 714 vbe_fixup_regs(s); 715 break; 716 case VBE_DISPI_INDEX_BANK: 717 if (s->vbe_regs[VBE_DISPI_INDEX_BPP] == 4) { 718 val &= (s->vbe_bank_mask >> 2); 719 } else { 720 val &= s->vbe_bank_mask; 721 } 722 s->vbe_regs[s->vbe_index] = val; 723 s->bank_offset = (val << 16); 724 vga_update_memory_access(s); 725 break; 726 case VBE_DISPI_INDEX_ENABLE: 727 if ((val & VBE_DISPI_ENABLED) && 728 !(s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED)) { 729 int h, shift_control; 730 731 s->vbe_regs[VBE_DISPI_INDEX_VIRT_WIDTH] = 0; 732 s->vbe_regs[VBE_DISPI_INDEX_X_OFFSET] = 0; 733 s->vbe_regs[VBE_DISPI_INDEX_Y_OFFSET] = 0; 734 s->vbe_regs[VBE_DISPI_INDEX_ENABLE] |= VBE_DISPI_ENABLED; 735 vbe_fixup_regs(s); 736 737 /* clear the screen */ 738 if (!(val & VBE_DISPI_NOCLEARMEM)) { 739 memset(s->vram_ptr, 0, 740 s->vbe_regs[VBE_DISPI_INDEX_YRES] * s->vbe_line_offset); 741 } 742 743 /* we initialize the VGA graphic mode */ 744 /* graphic mode + memory map 1 */ 745 s->gr[VGA_GFX_MISC] = (s->gr[VGA_GFX_MISC] & ~0x0c) | 0x04 | 746 VGA_GR06_GRAPHICS_MODE; 747 s->cr[VGA_CRTC_MODE] |= 3; /* no CGA modes */ 748 s->cr[VGA_CRTC_OFFSET] = s->vbe_line_offset >> 3; 749 /* width */ 750 s->cr[VGA_CRTC_H_DISP] = 751 (s->vbe_regs[VBE_DISPI_INDEX_XRES] >> 3) - 1; 752 /* height (only meaningful if < 1024) */ 753 h = s->vbe_regs[VBE_DISPI_INDEX_YRES] - 1; 754 s->cr[VGA_CRTC_V_DISP_END] = h; 755 s->cr[VGA_CRTC_OVERFLOW] = (s->cr[VGA_CRTC_OVERFLOW] & ~0x42) | 756 ((h >> 7) & 0x02) | ((h >> 3) & 0x40); 757 /* line compare to 1023 */ 758 s->cr[VGA_CRTC_LINE_COMPARE] = 0xff; 759 s->cr[VGA_CRTC_OVERFLOW] |= 0x10; 760 s->cr[VGA_CRTC_MAX_SCAN] |= 0x40; 761 762 if (s->vbe_regs[VBE_DISPI_INDEX_BPP] == 4) { 763 shift_control = 0; 764 s->sr[VGA_SEQ_CLOCK_MODE] &= ~8; /* no double line */ 765 } else { 766 shift_control = 2; 767 /* set chain 4 mode */ 768 s->sr[VGA_SEQ_MEMORY_MODE] |= VGA_SR04_CHN_4M; 769 /* activate all planes */ 770 s->sr[VGA_SEQ_PLANE_WRITE] |= VGA_SR02_ALL_PLANES; 771 } 772 s->gr[VGA_GFX_MODE] = (s->gr[VGA_GFX_MODE] & ~0x60) | 773 (shift_control << 5); 774 s->cr[VGA_CRTC_MAX_SCAN] &= ~0x9f; /* no double scan */ 775 } else { 776 s->bank_offset = 0; 777 } 778 s->dac_8bit = (val & VBE_DISPI_8BIT_DAC) > 0; 779 s->vbe_regs[s->vbe_index] = val; 780 vga_update_memory_access(s); 781 break; 782 default: 783 break; 784 } 785 } 786 } 787 788 /* called for accesses between 0xa0000 and 0xc0000 */ 789 uint32_t vga_mem_readb(VGACommonState *s, hwaddr addr) 790 { 791 int memory_map_mode, plane; 792 uint32_t ret; 793 794 /* convert to VGA memory offset */ 795 memory_map_mode = (s->gr[VGA_GFX_MISC] >> 2) & 3; 796 addr &= 0x1ffff; 797 switch(memory_map_mode) { 798 case 0: 799 break; 800 case 1: 801 if (addr >= 0x10000) 802 return 0xff; 803 addr += s->bank_offset; 804 break; 805 case 2: 806 addr -= 0x10000; 807 if (addr >= 0x8000) 808 return 0xff; 809 break; 810 default: 811 case 3: 812 addr -= 0x18000; 813 if (addr >= 0x8000) 814 return 0xff; 815 break; 816 } 817 818 if (s->sr[VGA_SEQ_MEMORY_MODE] & VGA_SR04_CHN_4M) { 819 /* chain 4 mode : simplest access */ 820 ret = s->vram_ptr[addr]; 821 } else if (s->gr[VGA_GFX_MODE] & 0x10) { 822 /* odd/even mode (aka text mode mapping) */ 823 plane = (s->gr[VGA_GFX_PLANE_READ] & 2) | (addr & 1); 824 ret = s->vram_ptr[((addr & ~1) << 1) | plane]; 825 } else { 826 /* standard VGA latched access */ 827 s->latch = ((uint32_t *)s->vram_ptr)[addr]; 828 829 if (!(s->gr[VGA_GFX_MODE] & 0x08)) { 830 /* read mode 0 */ 831 plane = s->gr[VGA_GFX_PLANE_READ]; 832 ret = GET_PLANE(s->latch, plane); 833 } else { 834 /* read mode 1 */ 835 ret = (s->latch ^ mask16[s->gr[VGA_GFX_COMPARE_VALUE]]) & 836 mask16[s->gr[VGA_GFX_COMPARE_MASK]]; 837 ret |= ret >> 16; 838 ret |= ret >> 8; 839 ret = (~ret) & 0xff; 840 } 841 } 842 return ret; 843 } 844 845 /* called for accesses between 0xa0000 and 0xc0000 */ 846 void vga_mem_writeb(VGACommonState *s, hwaddr addr, uint32_t val) 847 { 848 int memory_map_mode, plane, write_mode, b, func_select, mask; 849 uint32_t write_mask, bit_mask, set_mask; 850 851 #ifdef DEBUG_VGA_MEM 852 printf("vga: [0x" TARGET_FMT_plx "] = 0x%02x\n", addr, val); 853 #endif 854 /* convert to VGA memory offset */ 855 memory_map_mode = (s->gr[VGA_GFX_MISC] >> 2) & 3; 856 addr &= 0x1ffff; 857 switch(memory_map_mode) { 858 case 0: 859 break; 860 case 1: 861 if (addr >= 0x10000) 862 return; 863 addr += s->bank_offset; 864 break; 865 case 2: 866 addr -= 0x10000; 867 if (addr >= 0x8000) 868 return; 869 break; 870 default: 871 case 3: 872 addr -= 0x18000; 873 if (addr >= 0x8000) 874 return; 875 break; 876 } 877 878 if (s->sr[VGA_SEQ_MEMORY_MODE] & VGA_SR04_CHN_4M) { 879 /* chain 4 mode : simplest access */ 880 plane = addr & 3; 881 mask = (1 << plane); 882 if (s->sr[VGA_SEQ_PLANE_WRITE] & mask) { 883 s->vram_ptr[addr] = val; 884 #ifdef DEBUG_VGA_MEM 885 printf("vga: chain4: [0x" TARGET_FMT_plx "]\n", addr); 886 #endif 887 s->plane_updated |= mask; /* only used to detect font change */ 888 memory_region_set_dirty(&s->vram, addr, 1); 889 } 890 } else if (s->gr[VGA_GFX_MODE] & 0x10) { 891 /* odd/even mode (aka text mode mapping) */ 892 plane = (s->gr[VGA_GFX_PLANE_READ] & 2) | (addr & 1); 893 mask = (1 << plane); 894 if (s->sr[VGA_SEQ_PLANE_WRITE] & mask) { 895 addr = ((addr & ~1) << 1) | plane; 896 s->vram_ptr[addr] = val; 897 #ifdef DEBUG_VGA_MEM 898 printf("vga: odd/even: [0x" TARGET_FMT_plx "]\n", addr); 899 #endif 900 s->plane_updated |= mask; /* only used to detect font change */ 901 memory_region_set_dirty(&s->vram, addr, 1); 902 } 903 } else { 904 /* standard VGA latched access */ 905 write_mode = s->gr[VGA_GFX_MODE] & 3; 906 switch(write_mode) { 907 default: 908 case 0: 909 /* rotate */ 910 b = s->gr[VGA_GFX_DATA_ROTATE] & 7; 911 val = ((val >> b) | (val << (8 - b))) & 0xff; 912 val |= val << 8; 913 val |= val << 16; 914 915 /* apply set/reset mask */ 916 set_mask = mask16[s->gr[VGA_GFX_SR_ENABLE]]; 917 val = (val & ~set_mask) | 918 (mask16[s->gr[VGA_GFX_SR_VALUE]] & set_mask); 919 bit_mask = s->gr[VGA_GFX_BIT_MASK]; 920 break; 921 case 1: 922 val = s->latch; 923 goto do_write; 924 case 2: 925 val = mask16[val & 0x0f]; 926 bit_mask = s->gr[VGA_GFX_BIT_MASK]; 927 break; 928 case 3: 929 /* rotate */ 930 b = s->gr[VGA_GFX_DATA_ROTATE] & 7; 931 val = (val >> b) | (val << (8 - b)); 932 933 bit_mask = s->gr[VGA_GFX_BIT_MASK] & val; 934 val = mask16[s->gr[VGA_GFX_SR_VALUE]]; 935 break; 936 } 937 938 /* apply logical operation */ 939 func_select = s->gr[VGA_GFX_DATA_ROTATE] >> 3; 940 switch(func_select) { 941 case 0: 942 default: 943 /* nothing to do */ 944 break; 945 case 1: 946 /* and */ 947 val &= s->latch; 948 break; 949 case 2: 950 /* or */ 951 val |= s->latch; 952 break; 953 case 3: 954 /* xor */ 955 val ^= s->latch; 956 break; 957 } 958 959 /* apply bit mask */ 960 bit_mask |= bit_mask << 8; 961 bit_mask |= bit_mask << 16; 962 val = (val & bit_mask) | (s->latch & ~bit_mask); 963 964 do_write: 965 /* mask data according to sr[2] */ 966 mask = s->sr[VGA_SEQ_PLANE_WRITE]; 967 s->plane_updated |= mask; /* only used to detect font change */ 968 write_mask = mask16[mask]; 969 ((uint32_t *)s->vram_ptr)[addr] = 970 (((uint32_t *)s->vram_ptr)[addr] & ~write_mask) | 971 (val & write_mask); 972 #ifdef DEBUG_VGA_MEM 973 printf("vga: latch: [0x" TARGET_FMT_plx "] mask=0x%08x val=0x%08x\n", 974 addr * 4, write_mask, val); 975 #endif 976 memory_region_set_dirty(&s->vram, addr << 2, sizeof(uint32_t)); 977 } 978 } 979 980 typedef void vga_draw_line_func(VGACommonState *s1, uint8_t *d, 981 const uint8_t *s, int width); 982 983 #include "vga-helpers.h" 984 985 /* return true if the palette was modified */ 986 static int update_palette16(VGACommonState *s) 987 { 988 int full_update, i; 989 uint32_t v, col, *palette; 990 991 full_update = 0; 992 palette = s->last_palette; 993 for(i = 0; i < 16; i++) { 994 v = s->ar[i]; 995 if (s->ar[VGA_ATC_MODE] & 0x80) { 996 v = ((s->ar[VGA_ATC_COLOR_PAGE] & 0xf) << 4) | (v & 0xf); 997 } else { 998 v = ((s->ar[VGA_ATC_COLOR_PAGE] & 0xc) << 4) | (v & 0x3f); 999 } 1000 v = v * 3; 1001 col = rgb_to_pixel32(c6_to_8(s->palette[v]), 1002 c6_to_8(s->palette[v + 1]), 1003 c6_to_8(s->palette[v + 2])); 1004 if (col != palette[i]) { 1005 full_update = 1; 1006 palette[i] = col; 1007 } 1008 } 1009 return full_update; 1010 } 1011 1012 /* return true if the palette was modified */ 1013 static int update_palette256(VGACommonState *s) 1014 { 1015 int full_update, i; 1016 uint32_t v, col, *palette; 1017 1018 full_update = 0; 1019 palette = s->last_palette; 1020 v = 0; 1021 for(i = 0; i < 256; i++) { 1022 if (s->dac_8bit) { 1023 col = rgb_to_pixel32(s->palette[v], 1024 s->palette[v + 1], 1025 s->palette[v + 2]); 1026 } else { 1027 col = rgb_to_pixel32(c6_to_8(s->palette[v]), 1028 c6_to_8(s->palette[v + 1]), 1029 c6_to_8(s->palette[v + 2])); 1030 } 1031 if (col != palette[i]) { 1032 full_update = 1; 1033 palette[i] = col; 1034 } 1035 v += 3; 1036 } 1037 return full_update; 1038 } 1039 1040 static void vga_get_offsets(VGACommonState *s, 1041 uint32_t *pline_offset, 1042 uint32_t *pstart_addr, 1043 uint32_t *pline_compare) 1044 { 1045 uint32_t start_addr, line_offset, line_compare; 1046 1047 if (s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED) { 1048 line_offset = s->vbe_line_offset; 1049 start_addr = s->vbe_start_addr; 1050 line_compare = 65535; 1051 } else { 1052 /* compute line_offset in bytes */ 1053 line_offset = s->cr[VGA_CRTC_OFFSET]; 1054 line_offset <<= 3; 1055 1056 /* starting address */ 1057 start_addr = s->cr[VGA_CRTC_START_LO] | 1058 (s->cr[VGA_CRTC_START_HI] << 8); 1059 1060 /* line compare */ 1061 line_compare = s->cr[VGA_CRTC_LINE_COMPARE] | 1062 ((s->cr[VGA_CRTC_OVERFLOW] & 0x10) << 4) | 1063 ((s->cr[VGA_CRTC_MAX_SCAN] & 0x40) << 3); 1064 } 1065 *pline_offset = line_offset; 1066 *pstart_addr = start_addr; 1067 *pline_compare = line_compare; 1068 } 1069 1070 /* update start_addr and line_offset. Return TRUE if modified */ 1071 static int update_basic_params(VGACommonState *s) 1072 { 1073 int full_update; 1074 uint32_t start_addr, line_offset, line_compare; 1075 1076 full_update = 0; 1077 1078 s->get_offsets(s, &line_offset, &start_addr, &line_compare); 1079 1080 if (line_offset != s->line_offset || 1081 start_addr != s->start_addr || 1082 line_compare != s->line_compare) { 1083 s->line_offset = line_offset; 1084 s->start_addr = start_addr; 1085 s->line_compare = line_compare; 1086 full_update = 1; 1087 } 1088 return full_update; 1089 } 1090 1091 1092 static const uint8_t cursor_glyph[32 * 4] = { 1093 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1094 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1095 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1096 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1097 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1098 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1099 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1100 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1101 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1102 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1103 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1104 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1105 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1106 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1107 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1108 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 1109 }; 1110 1111 static void vga_get_text_resolution(VGACommonState *s, int *pwidth, int *pheight, 1112 int *pcwidth, int *pcheight) 1113 { 1114 int width, cwidth, height, cheight; 1115 1116 /* total width & height */ 1117 cheight = (s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1; 1118 cwidth = 8; 1119 if (!(s->sr[VGA_SEQ_CLOCK_MODE] & VGA_SR01_CHAR_CLK_8DOTS)) { 1120 cwidth = 9; 1121 } 1122 if (s->sr[VGA_SEQ_CLOCK_MODE] & 0x08) { 1123 cwidth = 16; /* NOTE: no 18 pixel wide */ 1124 } 1125 width = (s->cr[VGA_CRTC_H_DISP] + 1); 1126 if (s->cr[VGA_CRTC_V_TOTAL] == 100) { 1127 /* ugly hack for CGA 160x100x16 - explain me the logic */ 1128 height = 100; 1129 } else { 1130 height = s->cr[VGA_CRTC_V_DISP_END] | 1131 ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) | 1132 ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3); 1133 height = (height + 1) / cheight; 1134 } 1135 1136 *pwidth = width; 1137 *pheight = height; 1138 *pcwidth = cwidth; 1139 *pcheight = cheight; 1140 } 1141 1142 /* 1143 * Text mode update 1144 * Missing: 1145 * - double scan 1146 * - double width 1147 * - underline 1148 * - flashing 1149 */ 1150 static void vga_draw_text(VGACommonState *s, int full_update) 1151 { 1152 DisplaySurface *surface = qemu_console_surface(s->con); 1153 int cx, cy, cheight, cw, ch, cattr, height, width, ch_attr; 1154 int cx_min, cx_max, linesize, x_incr, line, line1; 1155 uint32_t offset, fgcol, bgcol, v, cursor_offset; 1156 uint8_t *d1, *d, *src, *dest, *cursor_ptr; 1157 const uint8_t *font_ptr, *font_base[2]; 1158 int dup9, line_offset; 1159 uint32_t *palette; 1160 uint32_t *ch_attr_ptr; 1161 int64_t now = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL); 1162 1163 /* compute font data address (in plane 2) */ 1164 v = s->sr[VGA_SEQ_CHARACTER_MAP]; 1165 offset = (((v >> 4) & 1) | ((v << 1) & 6)) * 8192 * 4 + 2; 1166 if (offset != s->font_offsets[0]) { 1167 s->font_offsets[0] = offset; 1168 full_update = 1; 1169 } 1170 font_base[0] = s->vram_ptr + offset; 1171 1172 offset = (((v >> 5) & 1) | ((v >> 1) & 6)) * 8192 * 4 + 2; 1173 font_base[1] = s->vram_ptr + offset; 1174 if (offset != s->font_offsets[1]) { 1175 s->font_offsets[1] = offset; 1176 full_update = 1; 1177 } 1178 if (s->plane_updated & (1 << 2) || s->has_chain4_alias) { 1179 /* if the plane 2 was modified since the last display, it 1180 indicates the font may have been modified */ 1181 s->plane_updated = 0; 1182 full_update = 1; 1183 } 1184 full_update |= update_basic_params(s); 1185 1186 line_offset = s->line_offset; 1187 1188 vga_get_text_resolution(s, &width, &height, &cw, &cheight); 1189 if ((height * width) <= 1) { 1190 /* better than nothing: exit if transient size is too small */ 1191 return; 1192 } 1193 if ((height * width) > CH_ATTR_SIZE) { 1194 /* better than nothing: exit if transient size is too big */ 1195 return; 1196 } 1197 1198 if (width != s->last_width || height != s->last_height || 1199 cw != s->last_cw || cheight != s->last_ch || s->last_depth) { 1200 s->last_scr_width = width * cw; 1201 s->last_scr_height = height * cheight; 1202 qemu_console_resize(s->con, s->last_scr_width, s->last_scr_height); 1203 surface = qemu_console_surface(s->con); 1204 dpy_text_resize(s->con, width, height); 1205 s->last_depth = 0; 1206 s->last_width = width; 1207 s->last_height = height; 1208 s->last_ch = cheight; 1209 s->last_cw = cw; 1210 full_update = 1; 1211 } 1212 full_update |= update_palette16(s); 1213 palette = s->last_palette; 1214 x_incr = cw * surface_bytes_per_pixel(surface); 1215 1216 if (full_update) { 1217 s->full_update_text = 1; 1218 } 1219 if (s->full_update_gfx) { 1220 s->full_update_gfx = 0; 1221 full_update |= 1; 1222 } 1223 1224 cursor_offset = ((s->cr[VGA_CRTC_CURSOR_HI] << 8) | 1225 s->cr[VGA_CRTC_CURSOR_LO]) - s->start_addr; 1226 if (cursor_offset != s->cursor_offset || 1227 s->cr[VGA_CRTC_CURSOR_START] != s->cursor_start || 1228 s->cr[VGA_CRTC_CURSOR_END] != s->cursor_end) { 1229 /* if the cursor position changed, we update the old and new 1230 chars */ 1231 if (s->cursor_offset < CH_ATTR_SIZE) 1232 s->last_ch_attr[s->cursor_offset] = -1; 1233 if (cursor_offset < CH_ATTR_SIZE) 1234 s->last_ch_attr[cursor_offset] = -1; 1235 s->cursor_offset = cursor_offset; 1236 s->cursor_start = s->cr[VGA_CRTC_CURSOR_START]; 1237 s->cursor_end = s->cr[VGA_CRTC_CURSOR_END]; 1238 } 1239 cursor_ptr = s->vram_ptr + (s->start_addr + cursor_offset) * 4; 1240 if (now >= s->cursor_blink_time) { 1241 s->cursor_blink_time = now + VGA_TEXT_CURSOR_PERIOD_MS / 2; 1242 s->cursor_visible_phase = !s->cursor_visible_phase; 1243 } 1244 1245 dest = surface_data(surface); 1246 linesize = surface_stride(surface); 1247 ch_attr_ptr = s->last_ch_attr; 1248 line = 0; 1249 offset = s->start_addr * 4; 1250 for(cy = 0; cy < height; cy++) { 1251 d1 = dest; 1252 src = s->vram_ptr + offset; 1253 cx_min = width; 1254 cx_max = -1; 1255 for(cx = 0; cx < width; cx++) { 1256 ch_attr = *(uint16_t *)src; 1257 if (full_update || ch_attr != *ch_attr_ptr || src == cursor_ptr) { 1258 if (cx < cx_min) 1259 cx_min = cx; 1260 if (cx > cx_max) 1261 cx_max = cx; 1262 *ch_attr_ptr = ch_attr; 1263 #ifdef HOST_WORDS_BIGENDIAN 1264 ch = ch_attr >> 8; 1265 cattr = ch_attr & 0xff; 1266 #else 1267 ch = ch_attr & 0xff; 1268 cattr = ch_attr >> 8; 1269 #endif 1270 font_ptr = font_base[(cattr >> 3) & 1]; 1271 font_ptr += 32 * 4 * ch; 1272 bgcol = palette[cattr >> 4]; 1273 fgcol = palette[cattr & 0x0f]; 1274 if (cw == 16) { 1275 vga_draw_glyph16(d1, linesize, 1276 font_ptr, cheight, fgcol, bgcol); 1277 } else if (cw != 9) { 1278 vga_draw_glyph8(d1, linesize, 1279 font_ptr, cheight, fgcol, bgcol); 1280 } else { 1281 dup9 = 0; 1282 if (ch >= 0xb0 && ch <= 0xdf && 1283 (s->ar[VGA_ATC_MODE] & 0x04)) { 1284 dup9 = 1; 1285 } 1286 vga_draw_glyph9(d1, linesize, 1287 font_ptr, cheight, fgcol, bgcol, dup9); 1288 } 1289 if (src == cursor_ptr && 1290 !(s->cr[VGA_CRTC_CURSOR_START] & 0x20) && 1291 s->cursor_visible_phase) { 1292 int line_start, line_last, h; 1293 /* draw the cursor */ 1294 line_start = s->cr[VGA_CRTC_CURSOR_START] & 0x1f; 1295 line_last = s->cr[VGA_CRTC_CURSOR_END] & 0x1f; 1296 /* XXX: check that */ 1297 if (line_last > cheight - 1) 1298 line_last = cheight - 1; 1299 if (line_last >= line_start && line_start < cheight) { 1300 h = line_last - line_start + 1; 1301 d = d1 + linesize * line_start; 1302 if (cw == 16) { 1303 vga_draw_glyph16(d, linesize, 1304 cursor_glyph, h, fgcol, bgcol); 1305 } else if (cw != 9) { 1306 vga_draw_glyph8(d, linesize, 1307 cursor_glyph, h, fgcol, bgcol); 1308 } else { 1309 vga_draw_glyph9(d, linesize, 1310 cursor_glyph, h, fgcol, bgcol, 1); 1311 } 1312 } 1313 } 1314 } 1315 d1 += x_incr; 1316 src += 4; 1317 ch_attr_ptr++; 1318 } 1319 if (cx_max != -1) { 1320 dpy_gfx_update(s->con, cx_min * cw, cy * cheight, 1321 (cx_max - cx_min + 1) * cw, cheight); 1322 } 1323 dest += linesize * cheight; 1324 line1 = line + cheight; 1325 offset += line_offset; 1326 if (line < s->line_compare && line1 >= s->line_compare) { 1327 offset = 0; 1328 } 1329 line = line1; 1330 } 1331 } 1332 1333 enum { 1334 VGA_DRAW_LINE2, 1335 VGA_DRAW_LINE2D2, 1336 VGA_DRAW_LINE4, 1337 VGA_DRAW_LINE4D2, 1338 VGA_DRAW_LINE8D2, 1339 VGA_DRAW_LINE8, 1340 VGA_DRAW_LINE15_LE, 1341 VGA_DRAW_LINE16_LE, 1342 VGA_DRAW_LINE24_LE, 1343 VGA_DRAW_LINE32_LE, 1344 VGA_DRAW_LINE15_BE, 1345 VGA_DRAW_LINE16_BE, 1346 VGA_DRAW_LINE24_BE, 1347 VGA_DRAW_LINE32_BE, 1348 VGA_DRAW_LINE_NB, 1349 }; 1350 1351 static vga_draw_line_func * const vga_draw_line_table[VGA_DRAW_LINE_NB] = { 1352 vga_draw_line2, 1353 vga_draw_line2d2, 1354 vga_draw_line4, 1355 vga_draw_line4d2, 1356 vga_draw_line8d2, 1357 vga_draw_line8, 1358 vga_draw_line15_le, 1359 vga_draw_line16_le, 1360 vga_draw_line24_le, 1361 vga_draw_line32_le, 1362 vga_draw_line15_be, 1363 vga_draw_line16_be, 1364 vga_draw_line24_be, 1365 vga_draw_line32_be, 1366 }; 1367 1368 static int vga_get_bpp(VGACommonState *s) 1369 { 1370 int ret; 1371 1372 if (s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED) { 1373 ret = s->vbe_regs[VBE_DISPI_INDEX_BPP]; 1374 } else { 1375 ret = 0; 1376 } 1377 return ret; 1378 } 1379 1380 static void vga_get_resolution(VGACommonState *s, int *pwidth, int *pheight) 1381 { 1382 int width, height; 1383 1384 if (s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED) { 1385 width = s->vbe_regs[VBE_DISPI_INDEX_XRES]; 1386 height = s->vbe_regs[VBE_DISPI_INDEX_YRES]; 1387 } else { 1388 width = (s->cr[VGA_CRTC_H_DISP] + 1) * 8; 1389 height = s->cr[VGA_CRTC_V_DISP_END] | 1390 ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) | 1391 ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3); 1392 height = (height + 1); 1393 } 1394 *pwidth = width; 1395 *pheight = height; 1396 } 1397 1398 void vga_invalidate_scanlines(VGACommonState *s, int y1, int y2) 1399 { 1400 int y; 1401 if (y1 >= VGA_MAX_HEIGHT) 1402 return; 1403 if (y2 >= VGA_MAX_HEIGHT) 1404 y2 = VGA_MAX_HEIGHT; 1405 for(y = y1; y < y2; y++) { 1406 s->invalidated_y_table[y >> 5] |= 1 << (y & 0x1f); 1407 } 1408 } 1409 1410 void vga_sync_dirty_bitmap(VGACommonState *s) 1411 { 1412 memory_region_sync_dirty_bitmap(&s->vram); 1413 } 1414 1415 void vga_dirty_log_start(VGACommonState *s) 1416 { 1417 memory_region_set_log(&s->vram, true, DIRTY_MEMORY_VGA); 1418 } 1419 1420 void vga_dirty_log_stop(VGACommonState *s) 1421 { 1422 memory_region_set_log(&s->vram, false, DIRTY_MEMORY_VGA); 1423 } 1424 1425 /* 1426 * graphic modes 1427 */ 1428 static void vga_draw_graphic(VGACommonState *s, int full_update) 1429 { 1430 DisplaySurface *surface = qemu_console_surface(s->con); 1431 int y1, y, update, linesize, y_start, double_scan, mask, depth; 1432 int width, height, shift_control, line_offset, bwidth, bits; 1433 ram_addr_t page0, page1, page_min, page_max; 1434 int disp_width, multi_scan, multi_run; 1435 uint8_t *d; 1436 uint32_t v, addr1, addr; 1437 vga_draw_line_func *vga_draw_line = NULL; 1438 bool share_surface; 1439 pixman_format_code_t format; 1440 #ifdef HOST_WORDS_BIGENDIAN 1441 bool byteswap = !s->big_endian_fb; 1442 #else 1443 bool byteswap = s->big_endian_fb; 1444 #endif 1445 1446 full_update |= update_basic_params(s); 1447 1448 if (!full_update) 1449 vga_sync_dirty_bitmap(s); 1450 1451 s->get_resolution(s, &width, &height); 1452 disp_width = width; 1453 1454 shift_control = (s->gr[VGA_GFX_MODE] >> 5) & 3; 1455 double_scan = (s->cr[VGA_CRTC_MAX_SCAN] >> 7); 1456 if (shift_control != 1) { 1457 multi_scan = (((s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1) << double_scan) 1458 - 1; 1459 } else { 1460 /* in CGA modes, multi_scan is ignored */ 1461 /* XXX: is it correct ? */ 1462 multi_scan = double_scan; 1463 } 1464 multi_run = multi_scan; 1465 if (shift_control != s->shift_control || 1466 double_scan != s->double_scan) { 1467 full_update = 1; 1468 s->shift_control = shift_control; 1469 s->double_scan = double_scan; 1470 } 1471 1472 if (shift_control == 0) { 1473 if (s->sr[VGA_SEQ_CLOCK_MODE] & 8) { 1474 disp_width <<= 1; 1475 } 1476 } else if (shift_control == 1) { 1477 if (s->sr[VGA_SEQ_CLOCK_MODE] & 8) { 1478 disp_width <<= 1; 1479 } 1480 } 1481 1482 depth = s->get_bpp(s); 1483 1484 /* 1485 * Check whether we can share the surface with the backend 1486 * or whether we need a shadow surface. We share native 1487 * endian surfaces for 15bpp and above and byteswapped 1488 * surfaces for 24bpp and above. 1489 */ 1490 format = qemu_default_pixman_format(depth, !byteswap); 1491 if (format) { 1492 share_surface = dpy_gfx_check_format(s->con, format) 1493 && !s->force_shadow; 1494 } else { 1495 share_surface = false; 1496 } 1497 if (s->line_offset != s->last_line_offset || 1498 disp_width != s->last_width || 1499 height != s->last_height || 1500 s->last_depth != depth || 1501 s->last_byteswap != byteswap || 1502 share_surface != is_buffer_shared(surface)) { 1503 if (share_surface) { 1504 surface = qemu_create_displaysurface_from(disp_width, 1505 height, format, s->line_offset, 1506 s->vram_ptr + (s->start_addr * 4)); 1507 dpy_gfx_replace_surface(s->con, surface); 1508 #ifdef DEBUG_VGA 1509 printf("VGA: Using shared surface for depth=%d swap=%d\n", 1510 depth, byteswap); 1511 #endif 1512 } else { 1513 qemu_console_resize(s->con, disp_width, height); 1514 surface = qemu_console_surface(s->con); 1515 #ifdef DEBUG_VGA 1516 printf("VGA: Using shadow surface for depth=%d swap=%d\n", 1517 depth, byteswap); 1518 #endif 1519 } 1520 s->last_scr_width = disp_width; 1521 s->last_scr_height = height; 1522 s->last_width = disp_width; 1523 s->last_height = height; 1524 s->last_line_offset = s->line_offset; 1525 s->last_depth = depth; 1526 s->last_byteswap = byteswap; 1527 full_update = 1; 1528 } else if (is_buffer_shared(surface) && 1529 (full_update || surface_data(surface) != s->vram_ptr 1530 + (s->start_addr * 4))) { 1531 pixman_format_code_t format = 1532 qemu_default_pixman_format(depth, !byteswap); 1533 surface = qemu_create_displaysurface_from(disp_width, 1534 height, format, s->line_offset, 1535 s->vram_ptr + (s->start_addr * 4)); 1536 dpy_gfx_replace_surface(s->con, surface); 1537 } 1538 1539 if (shift_control == 0) { 1540 full_update |= update_palette16(s); 1541 if (s->sr[VGA_SEQ_CLOCK_MODE] & 8) { 1542 v = VGA_DRAW_LINE4D2; 1543 } else { 1544 v = VGA_DRAW_LINE4; 1545 } 1546 bits = 4; 1547 } else if (shift_control == 1) { 1548 full_update |= update_palette16(s); 1549 if (s->sr[VGA_SEQ_CLOCK_MODE] & 8) { 1550 v = VGA_DRAW_LINE2D2; 1551 } else { 1552 v = VGA_DRAW_LINE2; 1553 } 1554 bits = 4; 1555 } else { 1556 switch(s->get_bpp(s)) { 1557 default: 1558 case 0: 1559 full_update |= update_palette256(s); 1560 v = VGA_DRAW_LINE8D2; 1561 bits = 4; 1562 break; 1563 case 8: 1564 full_update |= update_palette256(s); 1565 v = VGA_DRAW_LINE8; 1566 bits = 8; 1567 break; 1568 case 15: 1569 v = s->big_endian_fb ? VGA_DRAW_LINE15_BE : VGA_DRAW_LINE15_LE; 1570 bits = 16; 1571 break; 1572 case 16: 1573 v = s->big_endian_fb ? VGA_DRAW_LINE16_BE : VGA_DRAW_LINE16_LE; 1574 bits = 16; 1575 break; 1576 case 24: 1577 v = s->big_endian_fb ? VGA_DRAW_LINE24_BE : VGA_DRAW_LINE24_LE; 1578 bits = 24; 1579 break; 1580 case 32: 1581 v = s->big_endian_fb ? VGA_DRAW_LINE32_BE : VGA_DRAW_LINE32_LE; 1582 bits = 32; 1583 break; 1584 } 1585 } 1586 vga_draw_line = vga_draw_line_table[v]; 1587 1588 if (!is_buffer_shared(surface) && s->cursor_invalidate) { 1589 s->cursor_invalidate(s); 1590 } 1591 1592 line_offset = s->line_offset; 1593 #if 0 1594 printf("w=%d h=%d v=%d line_offset=%d cr[0x09]=0x%02x cr[0x17]=0x%02x linecmp=%d sr[0x01]=0x%02x\n", 1595 width, height, v, line_offset, s->cr[9], s->cr[VGA_CRTC_MODE], 1596 s->line_compare, s->sr[VGA_SEQ_CLOCK_MODE]); 1597 #endif 1598 addr1 = (s->start_addr * 4); 1599 bwidth = (width * bits + 7) / 8; 1600 y_start = -1; 1601 page_min = -1; 1602 page_max = 0; 1603 d = surface_data(surface); 1604 linesize = surface_stride(surface); 1605 y1 = 0; 1606 for(y = 0; y < height; y++) { 1607 addr = addr1; 1608 if (!(s->cr[VGA_CRTC_MODE] & 1)) { 1609 int shift; 1610 /* CGA compatibility handling */ 1611 shift = 14 + ((s->cr[VGA_CRTC_MODE] >> 6) & 1); 1612 addr = (addr & ~(1 << shift)) | ((y1 & 1) << shift); 1613 } 1614 if (!(s->cr[VGA_CRTC_MODE] & 2)) { 1615 addr = (addr & ~0x8000) | ((y1 & 2) << 14); 1616 } 1617 update = full_update; 1618 page0 = addr; 1619 page1 = addr + bwidth - 1; 1620 update |= memory_region_get_dirty(&s->vram, page0, page1 - page0, 1621 DIRTY_MEMORY_VGA); 1622 /* explicit invalidation for the hardware cursor */ 1623 update |= (s->invalidated_y_table[y >> 5] >> (y & 0x1f)) & 1; 1624 if (update) { 1625 if (y_start < 0) 1626 y_start = y; 1627 if (page0 < page_min) 1628 page_min = page0; 1629 if (page1 > page_max) 1630 page_max = page1; 1631 if (!(is_buffer_shared(surface))) { 1632 vga_draw_line(s, d, s->vram_ptr + addr, width); 1633 if (s->cursor_draw_line) 1634 s->cursor_draw_line(s, d, y); 1635 } 1636 } else { 1637 if (y_start >= 0) { 1638 /* flush to display */ 1639 dpy_gfx_update(s->con, 0, y_start, 1640 disp_width, y - y_start); 1641 y_start = -1; 1642 } 1643 } 1644 if (!multi_run) { 1645 mask = (s->cr[VGA_CRTC_MODE] & 3) ^ 3; 1646 if ((y1 & mask) == mask) 1647 addr1 += line_offset; 1648 y1++; 1649 multi_run = multi_scan; 1650 } else { 1651 multi_run--; 1652 } 1653 /* line compare acts on the displayed lines */ 1654 if (y == s->line_compare) 1655 addr1 = 0; 1656 d += linesize; 1657 } 1658 if (y_start >= 0) { 1659 /* flush to display */ 1660 dpy_gfx_update(s->con, 0, y_start, 1661 disp_width, y - y_start); 1662 } 1663 /* reset modified pages */ 1664 if (page_max >= page_min) { 1665 memory_region_reset_dirty(&s->vram, 1666 page_min, 1667 page_max - page_min, 1668 DIRTY_MEMORY_VGA); 1669 } 1670 memset(s->invalidated_y_table, 0, ((height + 31) >> 5) * 4); 1671 } 1672 1673 static void vga_draw_blank(VGACommonState *s, int full_update) 1674 { 1675 DisplaySurface *surface = qemu_console_surface(s->con); 1676 int i, w; 1677 uint8_t *d; 1678 1679 if (!full_update) 1680 return; 1681 if (s->last_scr_width <= 0 || s->last_scr_height <= 0) 1682 return; 1683 1684 w = s->last_scr_width * surface_bytes_per_pixel(surface); 1685 d = surface_data(surface); 1686 for(i = 0; i < s->last_scr_height; i++) { 1687 memset(d, 0, w); 1688 d += surface_stride(surface); 1689 } 1690 dpy_gfx_update(s->con, 0, 0, 1691 s->last_scr_width, s->last_scr_height); 1692 } 1693 1694 #define GMODE_TEXT 0 1695 #define GMODE_GRAPH 1 1696 #define GMODE_BLANK 2 1697 1698 static void vga_update_display(void *opaque) 1699 { 1700 VGACommonState *s = opaque; 1701 DisplaySurface *surface = qemu_console_surface(s->con); 1702 int full_update, graphic_mode; 1703 1704 qemu_flush_coalesced_mmio_buffer(); 1705 1706 if (surface_bits_per_pixel(surface) == 0) { 1707 /* nothing to do */ 1708 } else { 1709 full_update = 0; 1710 if (!(s->ar_index & 0x20)) { 1711 graphic_mode = GMODE_BLANK; 1712 } else { 1713 graphic_mode = s->gr[VGA_GFX_MISC] & VGA_GR06_GRAPHICS_MODE; 1714 } 1715 if (graphic_mode != s->graphic_mode) { 1716 s->graphic_mode = graphic_mode; 1717 s->cursor_blink_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL); 1718 full_update = 1; 1719 } 1720 switch(graphic_mode) { 1721 case GMODE_TEXT: 1722 vga_draw_text(s, full_update); 1723 break; 1724 case GMODE_GRAPH: 1725 vga_draw_graphic(s, full_update); 1726 break; 1727 case GMODE_BLANK: 1728 default: 1729 vga_draw_blank(s, full_update); 1730 break; 1731 } 1732 } 1733 } 1734 1735 /* force a full display refresh */ 1736 static void vga_invalidate_display(void *opaque) 1737 { 1738 VGACommonState *s = opaque; 1739 1740 s->last_width = -1; 1741 s->last_height = -1; 1742 } 1743 1744 void vga_common_reset(VGACommonState *s) 1745 { 1746 s->sr_index = 0; 1747 memset(s->sr, '\0', sizeof(s->sr)); 1748 s->gr_index = 0; 1749 memset(s->gr, '\0', sizeof(s->gr)); 1750 s->ar_index = 0; 1751 memset(s->ar, '\0', sizeof(s->ar)); 1752 s->ar_flip_flop = 0; 1753 s->cr_index = 0; 1754 memset(s->cr, '\0', sizeof(s->cr)); 1755 s->msr = 0; 1756 s->fcr = 0; 1757 s->st00 = 0; 1758 s->st01 = 0; 1759 s->dac_state = 0; 1760 s->dac_sub_index = 0; 1761 s->dac_read_index = 0; 1762 s->dac_write_index = 0; 1763 memset(s->dac_cache, '\0', sizeof(s->dac_cache)); 1764 s->dac_8bit = 0; 1765 memset(s->palette, '\0', sizeof(s->palette)); 1766 s->bank_offset = 0; 1767 s->vbe_index = 0; 1768 memset(s->vbe_regs, '\0', sizeof(s->vbe_regs)); 1769 s->vbe_regs[VBE_DISPI_INDEX_ID] = VBE_DISPI_ID5; 1770 s->vbe_start_addr = 0; 1771 s->vbe_line_offset = 0; 1772 s->vbe_bank_mask = (s->vram_size >> 16) - 1; 1773 memset(s->font_offsets, '\0', sizeof(s->font_offsets)); 1774 s->graphic_mode = -1; /* force full update */ 1775 s->shift_control = 0; 1776 s->double_scan = 0; 1777 s->line_offset = 0; 1778 s->line_compare = 0; 1779 s->start_addr = 0; 1780 s->plane_updated = 0; 1781 s->last_cw = 0; 1782 s->last_ch = 0; 1783 s->last_width = 0; 1784 s->last_height = 0; 1785 s->last_scr_width = 0; 1786 s->last_scr_height = 0; 1787 s->cursor_start = 0; 1788 s->cursor_end = 0; 1789 s->cursor_offset = 0; 1790 s->big_endian_fb = s->default_endian_fb; 1791 memset(s->invalidated_y_table, '\0', sizeof(s->invalidated_y_table)); 1792 memset(s->last_palette, '\0', sizeof(s->last_palette)); 1793 memset(s->last_ch_attr, '\0', sizeof(s->last_ch_attr)); 1794 switch (vga_retrace_method) { 1795 case VGA_RETRACE_DUMB: 1796 break; 1797 case VGA_RETRACE_PRECISE: 1798 memset(&s->retrace_info, 0, sizeof (s->retrace_info)); 1799 break; 1800 } 1801 vga_update_memory_access(s); 1802 } 1803 1804 static void vga_reset(void *opaque) 1805 { 1806 VGACommonState *s = opaque; 1807 vga_common_reset(s); 1808 } 1809 1810 #define TEXTMODE_X(x) ((x) % width) 1811 #define TEXTMODE_Y(x) ((x) / width) 1812 #define VMEM2CHTYPE(v) ((v & 0xff0007ff) | \ 1813 ((v & 0x00000800) << 10) | ((v & 0x00007000) >> 1)) 1814 /* relay text rendering to the display driver 1815 * instead of doing a full vga_update_display() */ 1816 static void vga_update_text(void *opaque, console_ch_t *chardata) 1817 { 1818 VGACommonState *s = opaque; 1819 int graphic_mode, i, cursor_offset, cursor_visible; 1820 int cw, cheight, width, height, size, c_min, c_max; 1821 uint32_t *src; 1822 console_ch_t *dst, val; 1823 char msg_buffer[80]; 1824 int full_update = 0; 1825 1826 qemu_flush_coalesced_mmio_buffer(); 1827 1828 if (!(s->ar_index & 0x20)) { 1829 graphic_mode = GMODE_BLANK; 1830 } else { 1831 graphic_mode = s->gr[VGA_GFX_MISC] & VGA_GR06_GRAPHICS_MODE; 1832 } 1833 if (graphic_mode != s->graphic_mode) { 1834 s->graphic_mode = graphic_mode; 1835 full_update = 1; 1836 } 1837 if (s->last_width == -1) { 1838 s->last_width = 0; 1839 full_update = 1; 1840 } 1841 1842 switch (graphic_mode) { 1843 case GMODE_TEXT: 1844 /* TODO: update palette */ 1845 full_update |= update_basic_params(s); 1846 1847 /* total width & height */ 1848 cheight = (s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1; 1849 cw = 8; 1850 if (!(s->sr[VGA_SEQ_CLOCK_MODE] & VGA_SR01_CHAR_CLK_8DOTS)) { 1851 cw = 9; 1852 } 1853 if (s->sr[VGA_SEQ_CLOCK_MODE] & 0x08) { 1854 cw = 16; /* NOTE: no 18 pixel wide */ 1855 } 1856 width = (s->cr[VGA_CRTC_H_DISP] + 1); 1857 if (s->cr[VGA_CRTC_V_TOTAL] == 100) { 1858 /* ugly hack for CGA 160x100x16 - explain me the logic */ 1859 height = 100; 1860 } else { 1861 height = s->cr[VGA_CRTC_V_DISP_END] | 1862 ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) | 1863 ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3); 1864 height = (height + 1) / cheight; 1865 } 1866 1867 size = (height * width); 1868 if (size > CH_ATTR_SIZE) { 1869 if (!full_update) 1870 return; 1871 1872 snprintf(msg_buffer, sizeof(msg_buffer), "%i x %i Text mode", 1873 width, height); 1874 break; 1875 } 1876 1877 if (width != s->last_width || height != s->last_height || 1878 cw != s->last_cw || cheight != s->last_ch) { 1879 s->last_scr_width = width * cw; 1880 s->last_scr_height = height * cheight; 1881 qemu_console_resize(s->con, s->last_scr_width, s->last_scr_height); 1882 dpy_text_resize(s->con, width, height); 1883 s->last_depth = 0; 1884 s->last_width = width; 1885 s->last_height = height; 1886 s->last_ch = cheight; 1887 s->last_cw = cw; 1888 full_update = 1; 1889 } 1890 1891 if (full_update) { 1892 s->full_update_gfx = 1; 1893 } 1894 if (s->full_update_text) { 1895 s->full_update_text = 0; 1896 full_update |= 1; 1897 } 1898 1899 /* Update "hardware" cursor */ 1900 cursor_offset = ((s->cr[VGA_CRTC_CURSOR_HI] << 8) | 1901 s->cr[VGA_CRTC_CURSOR_LO]) - s->start_addr; 1902 if (cursor_offset != s->cursor_offset || 1903 s->cr[VGA_CRTC_CURSOR_START] != s->cursor_start || 1904 s->cr[VGA_CRTC_CURSOR_END] != s->cursor_end || full_update) { 1905 cursor_visible = !(s->cr[VGA_CRTC_CURSOR_START] & 0x20); 1906 if (cursor_visible && cursor_offset < size && cursor_offset >= 0) 1907 dpy_text_cursor(s->con, 1908 TEXTMODE_X(cursor_offset), 1909 TEXTMODE_Y(cursor_offset)); 1910 else 1911 dpy_text_cursor(s->con, -1, -1); 1912 s->cursor_offset = cursor_offset; 1913 s->cursor_start = s->cr[VGA_CRTC_CURSOR_START]; 1914 s->cursor_end = s->cr[VGA_CRTC_CURSOR_END]; 1915 } 1916 1917 src = (uint32_t *) s->vram_ptr + s->start_addr; 1918 dst = chardata; 1919 1920 if (full_update) { 1921 for (i = 0; i < size; src ++, dst ++, i ++) 1922 console_write_ch(dst, VMEM2CHTYPE(le32_to_cpu(*src))); 1923 1924 dpy_text_update(s->con, 0, 0, width, height); 1925 } else { 1926 c_max = 0; 1927 1928 for (i = 0; i < size; src ++, dst ++, i ++) { 1929 console_write_ch(&val, VMEM2CHTYPE(le32_to_cpu(*src))); 1930 if (*dst != val) { 1931 *dst = val; 1932 c_max = i; 1933 break; 1934 } 1935 } 1936 c_min = i; 1937 for (; i < size; src ++, dst ++, i ++) { 1938 console_write_ch(&val, VMEM2CHTYPE(le32_to_cpu(*src))); 1939 if (*dst != val) { 1940 *dst = val; 1941 c_max = i; 1942 } 1943 } 1944 1945 if (c_min <= c_max) { 1946 i = TEXTMODE_Y(c_min); 1947 dpy_text_update(s->con, 0, i, width, TEXTMODE_Y(c_max) - i + 1); 1948 } 1949 } 1950 1951 return; 1952 case GMODE_GRAPH: 1953 if (!full_update) 1954 return; 1955 1956 s->get_resolution(s, &width, &height); 1957 snprintf(msg_buffer, sizeof(msg_buffer), "%i x %i Graphic mode", 1958 width, height); 1959 break; 1960 case GMODE_BLANK: 1961 default: 1962 if (!full_update) 1963 return; 1964 1965 snprintf(msg_buffer, sizeof(msg_buffer), "VGA Blank mode"); 1966 break; 1967 } 1968 1969 /* Display a message */ 1970 s->last_width = 60; 1971 s->last_height = height = 3; 1972 dpy_text_cursor(s->con, -1, -1); 1973 dpy_text_resize(s->con, s->last_width, height); 1974 1975 for (dst = chardata, i = 0; i < s->last_width * height; i ++) 1976 console_write_ch(dst ++, ' '); 1977 1978 size = strlen(msg_buffer); 1979 width = (s->last_width - size) / 2; 1980 dst = chardata + s->last_width + width; 1981 for (i = 0; i < size; i ++) 1982 console_write_ch(dst ++, 0x00200100 | msg_buffer[i]); 1983 1984 dpy_text_update(s->con, 0, 0, s->last_width, height); 1985 } 1986 1987 static uint64_t vga_mem_read(void *opaque, hwaddr addr, 1988 unsigned size) 1989 { 1990 VGACommonState *s = opaque; 1991 1992 return vga_mem_readb(s, addr); 1993 } 1994 1995 static void vga_mem_write(void *opaque, hwaddr addr, 1996 uint64_t data, unsigned size) 1997 { 1998 VGACommonState *s = opaque; 1999 2000 vga_mem_writeb(s, addr, data); 2001 } 2002 2003 const MemoryRegionOps vga_mem_ops = { 2004 .read = vga_mem_read, 2005 .write = vga_mem_write, 2006 .endianness = DEVICE_LITTLE_ENDIAN, 2007 .impl = { 2008 .min_access_size = 1, 2009 .max_access_size = 1, 2010 }, 2011 }; 2012 2013 static int vga_common_post_load(void *opaque, int version_id) 2014 { 2015 VGACommonState *s = opaque; 2016 2017 /* force refresh */ 2018 s->graphic_mode = -1; 2019 return 0; 2020 } 2021 2022 static bool vga_endian_state_needed(void *opaque) 2023 { 2024 VGACommonState *s = opaque; 2025 2026 /* 2027 * Only send the endian state if it's different from the 2028 * default one, thus ensuring backward compatibility for 2029 * migration of the common case 2030 */ 2031 return s->default_endian_fb != s->big_endian_fb; 2032 } 2033 2034 static const VMStateDescription vmstate_vga_endian = { 2035 .name = "vga.endian", 2036 .version_id = 1, 2037 .minimum_version_id = 1, 2038 .needed = vga_endian_state_needed, 2039 .fields = (VMStateField[]) { 2040 VMSTATE_BOOL(big_endian_fb, VGACommonState), 2041 VMSTATE_END_OF_LIST() 2042 } 2043 }; 2044 2045 const VMStateDescription vmstate_vga_common = { 2046 .name = "vga", 2047 .version_id = 2, 2048 .minimum_version_id = 2, 2049 .post_load = vga_common_post_load, 2050 .fields = (VMStateField[]) { 2051 VMSTATE_UINT32(latch, VGACommonState), 2052 VMSTATE_UINT8(sr_index, VGACommonState), 2053 VMSTATE_PARTIAL_BUFFER(sr, VGACommonState, 8), 2054 VMSTATE_UINT8(gr_index, VGACommonState), 2055 VMSTATE_PARTIAL_BUFFER(gr, VGACommonState, 16), 2056 VMSTATE_UINT8(ar_index, VGACommonState), 2057 VMSTATE_BUFFER(ar, VGACommonState), 2058 VMSTATE_INT32(ar_flip_flop, VGACommonState), 2059 VMSTATE_UINT8(cr_index, VGACommonState), 2060 VMSTATE_BUFFER(cr, VGACommonState), 2061 VMSTATE_UINT8(msr, VGACommonState), 2062 VMSTATE_UINT8(fcr, VGACommonState), 2063 VMSTATE_UINT8(st00, VGACommonState), 2064 VMSTATE_UINT8(st01, VGACommonState), 2065 2066 VMSTATE_UINT8(dac_state, VGACommonState), 2067 VMSTATE_UINT8(dac_sub_index, VGACommonState), 2068 VMSTATE_UINT8(dac_read_index, VGACommonState), 2069 VMSTATE_UINT8(dac_write_index, VGACommonState), 2070 VMSTATE_BUFFER(dac_cache, VGACommonState), 2071 VMSTATE_BUFFER(palette, VGACommonState), 2072 2073 VMSTATE_INT32(bank_offset, VGACommonState), 2074 VMSTATE_UINT8_EQUAL(is_vbe_vmstate, VGACommonState), 2075 VMSTATE_UINT16(vbe_index, VGACommonState), 2076 VMSTATE_UINT16_ARRAY(vbe_regs, VGACommonState, VBE_DISPI_INDEX_NB), 2077 VMSTATE_UINT32(vbe_start_addr, VGACommonState), 2078 VMSTATE_UINT32(vbe_line_offset, VGACommonState), 2079 VMSTATE_UINT32(vbe_bank_mask, VGACommonState), 2080 VMSTATE_END_OF_LIST() 2081 }, 2082 .subsections = (const VMStateDescription*[]) { 2083 &vmstate_vga_endian, 2084 NULL 2085 } 2086 }; 2087 2088 static const GraphicHwOps vga_ops = { 2089 .invalidate = vga_invalidate_display, 2090 .gfx_update = vga_update_display, 2091 .text_update = vga_update_text, 2092 }; 2093 2094 static inline uint32_t uint_clamp(uint32_t val, uint32_t vmin, uint32_t vmax) 2095 { 2096 if (val < vmin) { 2097 return vmin; 2098 } 2099 if (val > vmax) { 2100 return vmax; 2101 } 2102 return val; 2103 } 2104 2105 void vga_common_init(VGACommonState *s, Object *obj, bool global_vmstate) 2106 { 2107 int i, j, v, b; 2108 2109 for(i = 0;i < 256; i++) { 2110 v = 0; 2111 for(j = 0; j < 8; j++) { 2112 v |= ((i >> j) & 1) << (j * 4); 2113 } 2114 expand4[i] = v; 2115 2116 v = 0; 2117 for(j = 0; j < 4; j++) { 2118 v |= ((i >> (2 * j)) & 3) << (j * 4); 2119 } 2120 expand2[i] = v; 2121 } 2122 for(i = 0; i < 16; i++) { 2123 v = 0; 2124 for(j = 0; j < 4; j++) { 2125 b = ((i >> j) & 1); 2126 v |= b << (2 * j); 2127 v |= b << (2 * j + 1); 2128 } 2129 expand4to8[i] = v; 2130 } 2131 2132 s->vram_size_mb = uint_clamp(s->vram_size_mb, 1, 512); 2133 s->vram_size_mb = pow2ceil(s->vram_size_mb); 2134 s->vram_size = s->vram_size_mb << 20; 2135 2136 if (!s->vbe_size) { 2137 s->vbe_size = s->vram_size; 2138 } 2139 2140 s->is_vbe_vmstate = 1; 2141 memory_region_init_ram(&s->vram, obj, "vga.vram", s->vram_size, 2142 &error_fatal); 2143 vmstate_register_ram(&s->vram, global_vmstate ? NULL : DEVICE(obj)); 2144 xen_register_framebuffer(&s->vram); 2145 s->vram_ptr = memory_region_get_ram_ptr(&s->vram); 2146 s->get_bpp = vga_get_bpp; 2147 s->get_offsets = vga_get_offsets; 2148 s->get_resolution = vga_get_resolution; 2149 s->hw_ops = &vga_ops; 2150 switch (vga_retrace_method) { 2151 case VGA_RETRACE_DUMB: 2152 s->retrace = vga_dumb_retrace; 2153 s->update_retrace_info = vga_dumb_update_retrace_info; 2154 break; 2155 2156 case VGA_RETRACE_PRECISE: 2157 s->retrace = vga_precise_retrace; 2158 s->update_retrace_info = vga_precise_update_retrace_info; 2159 break; 2160 } 2161 2162 /* 2163 * Set default fb endian based on target, could probably be turned 2164 * into a device attribute set by the machine/platform to remove 2165 * all target endian dependencies from this file. 2166 */ 2167 #ifdef TARGET_WORDS_BIGENDIAN 2168 s->default_endian_fb = true; 2169 #else 2170 s->default_endian_fb = false; 2171 #endif 2172 vga_dirty_log_start(s); 2173 } 2174 2175 static const MemoryRegionPortio vga_portio_list[] = { 2176 { 0x04, 2, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3b4 */ 2177 { 0x0a, 1, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3ba */ 2178 { 0x10, 16, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3c0 */ 2179 { 0x24, 2, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3d4 */ 2180 { 0x2a, 1, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3da */ 2181 PORTIO_END_OF_LIST(), 2182 }; 2183 2184 static const MemoryRegionPortio vbe_portio_list[] = { 2185 { 0, 1, 2, .read = vbe_ioport_read_index, .write = vbe_ioport_write_index }, 2186 # ifdef TARGET_I386 2187 { 1, 1, 2, .read = vbe_ioport_read_data, .write = vbe_ioport_write_data }, 2188 # endif 2189 { 2, 1, 2, .read = vbe_ioport_read_data, .write = vbe_ioport_write_data }, 2190 PORTIO_END_OF_LIST(), 2191 }; 2192 2193 /* Used by both ISA and PCI */ 2194 MemoryRegion *vga_init_io(VGACommonState *s, Object *obj, 2195 const MemoryRegionPortio **vga_ports, 2196 const MemoryRegionPortio **vbe_ports) 2197 { 2198 MemoryRegion *vga_mem; 2199 2200 *vga_ports = vga_portio_list; 2201 *vbe_ports = vbe_portio_list; 2202 2203 vga_mem = g_malloc(sizeof(*vga_mem)); 2204 memory_region_init_io(vga_mem, obj, &vga_mem_ops, s, 2205 "vga-lowmem", 0x20000); 2206 memory_region_set_flush_coalesced(vga_mem); 2207 2208 return vga_mem; 2209 } 2210 2211 void vga_init(VGACommonState *s, Object *obj, MemoryRegion *address_space, 2212 MemoryRegion *address_space_io, bool init_vga_ports) 2213 { 2214 MemoryRegion *vga_io_memory; 2215 const MemoryRegionPortio *vga_ports, *vbe_ports; 2216 2217 qemu_register_reset(vga_reset, s); 2218 2219 s->bank_offset = 0; 2220 2221 s->legacy_address_space = address_space; 2222 2223 vga_io_memory = vga_init_io(s, obj, &vga_ports, &vbe_ports); 2224 memory_region_add_subregion_overlap(address_space, 2225 0x000a0000, 2226 vga_io_memory, 2227 1); 2228 memory_region_set_coalescing(vga_io_memory); 2229 if (init_vga_ports) { 2230 portio_list_init(&s->vga_port_list, obj, vga_ports, s, "vga"); 2231 portio_list_set_flush_coalesced(&s->vga_port_list); 2232 portio_list_add(&s->vga_port_list, address_space_io, 0x3b0); 2233 } 2234 if (vbe_ports) { 2235 portio_list_init(&s->vbe_port_list, obj, vbe_ports, s, "vbe"); 2236 portio_list_add(&s->vbe_port_list, address_space_io, 0x1ce); 2237 } 2238 } 2239 2240 void vga_init_vbe(VGACommonState *s, Object *obj, MemoryRegion *system_memory) 2241 { 2242 /* With pc-0.12 and below we map both the PCI BAR and the fixed VBE region, 2243 * so use an alias to avoid double-mapping the same region. 2244 */ 2245 memory_region_init_alias(&s->vram_vbe, obj, "vram.vbe", 2246 &s->vram, 0, memory_region_size(&s->vram)); 2247 /* XXX: use optimized standard vga accesses */ 2248 memory_region_add_subregion(system_memory, 2249 VBE_DISPI_LFB_PHYSICAL_ADDRESS, 2250 &s->vram_vbe); 2251 s->vbe_mapped = 1; 2252 } 2253