1 /* 2 * OMAP2 Display Subsystem. 3 * 4 * Copyright (C) 2008 Nokia Corporation 5 * Written by Andrzej Zaborowski <andrew@openedhand.com> 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License as 9 * published by the Free Software Foundation; either version 2 or 10 * (at your option) version 3 of the License. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License along 18 * with this program; if not, see <http://www.gnu.org/licenses/>. 19 */ 20 #include "qemu/osdep.h" 21 #include "hw/hw.h" 22 #include "ui/console.h" 23 #include "hw/arm/omap.h" 24 25 struct omap_dss_s { 26 qemu_irq irq; 27 qemu_irq drq; 28 DisplayState *state; 29 MemoryRegion iomem_diss1, iomem_disc1, iomem_rfbi1, iomem_venc1, iomem_im3; 30 31 int autoidle; 32 int control; 33 int enable; 34 35 struct omap_dss_panel_s { 36 int enable; 37 int nx; 38 int ny; 39 40 int x; 41 int y; 42 } dig, lcd; 43 44 struct { 45 uint32_t idlemode; 46 uint32_t irqst; 47 uint32_t irqen; 48 uint32_t control; 49 uint32_t config; 50 uint32_t capable; 51 uint32_t timing[4]; 52 int line; 53 uint32_t bg[2]; 54 uint32_t trans[2]; 55 56 struct omap_dss_plane_s { 57 int enable; 58 int bpp; 59 int posx; 60 int posy; 61 int nx; 62 int ny; 63 64 hwaddr addr[3]; 65 66 uint32_t attr; 67 uint32_t tresh; 68 int rowinc; 69 int colinc; 70 int wininc; 71 } l[3]; 72 73 int invalidate; 74 uint16_t palette[256]; 75 } dispc; 76 77 struct { 78 int idlemode; 79 uint32_t control; 80 int enable; 81 int pixels; 82 int busy; 83 int skiplines; 84 uint16_t rxbuf; 85 uint32_t config[2]; 86 uint32_t time[4]; 87 uint32_t data[6]; 88 uint16_t vsync; 89 uint16_t hsync; 90 struct rfbi_chip_s *chip[2]; 91 } rfbi; 92 }; 93 94 static void omap_dispc_interrupt_update(struct omap_dss_s *s) 95 { 96 qemu_set_irq(s->irq, s->dispc.irqst & s->dispc.irqen); 97 } 98 99 static void omap_rfbi_reset(struct omap_dss_s *s) 100 { 101 s->rfbi.idlemode = 0; 102 s->rfbi.control = 2; 103 s->rfbi.enable = 0; 104 s->rfbi.pixels = 0; 105 s->rfbi.skiplines = 0; 106 s->rfbi.busy = 0; 107 s->rfbi.config[0] = 0x00310000; 108 s->rfbi.config[1] = 0x00310000; 109 s->rfbi.time[0] = 0; 110 s->rfbi.time[1] = 0; 111 s->rfbi.time[2] = 0; 112 s->rfbi.time[3] = 0; 113 s->rfbi.data[0] = 0; 114 s->rfbi.data[1] = 0; 115 s->rfbi.data[2] = 0; 116 s->rfbi.data[3] = 0; 117 s->rfbi.data[4] = 0; 118 s->rfbi.data[5] = 0; 119 s->rfbi.vsync = 0; 120 s->rfbi.hsync = 0; 121 } 122 123 void omap_dss_reset(struct omap_dss_s *s) 124 { 125 s->autoidle = 0; 126 s->control = 0; 127 s->enable = 0; 128 129 s->dig.enable = 0; 130 s->dig.nx = 1; 131 s->dig.ny = 1; 132 133 s->lcd.enable = 0; 134 s->lcd.nx = 1; 135 s->lcd.ny = 1; 136 137 s->dispc.idlemode = 0; 138 s->dispc.irqst = 0; 139 s->dispc.irqen = 0; 140 s->dispc.control = 0; 141 s->dispc.config = 0; 142 s->dispc.capable = 0x161; 143 s->dispc.timing[0] = 0; 144 s->dispc.timing[1] = 0; 145 s->dispc.timing[2] = 0; 146 s->dispc.timing[3] = 0; 147 s->dispc.line = 0; 148 s->dispc.bg[0] = 0; 149 s->dispc.bg[1] = 0; 150 s->dispc.trans[0] = 0; 151 s->dispc.trans[1] = 0; 152 153 s->dispc.l[0].enable = 0; 154 s->dispc.l[0].bpp = 0; 155 s->dispc.l[0].addr[0] = 0; 156 s->dispc.l[0].addr[1] = 0; 157 s->dispc.l[0].addr[2] = 0; 158 s->dispc.l[0].posx = 0; 159 s->dispc.l[0].posy = 0; 160 s->dispc.l[0].nx = 1; 161 s->dispc.l[0].ny = 1; 162 s->dispc.l[0].attr = 0; 163 s->dispc.l[0].tresh = 0; 164 s->dispc.l[0].rowinc = 1; 165 s->dispc.l[0].colinc = 1; 166 s->dispc.l[0].wininc = 0; 167 168 omap_rfbi_reset(s); 169 omap_dispc_interrupt_update(s); 170 } 171 172 static uint64_t omap_diss_read(void *opaque, hwaddr addr, 173 unsigned size) 174 { 175 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 176 177 if (size != 4) { 178 return omap_badwidth_read32(opaque, addr); 179 } 180 181 switch (addr) { 182 case 0x00: /* DSS_REVISIONNUMBER */ 183 return 0x20; 184 185 case 0x10: /* DSS_SYSCONFIG */ 186 return s->autoidle; 187 188 case 0x14: /* DSS_SYSSTATUS */ 189 return 1; /* RESETDONE */ 190 191 case 0x40: /* DSS_CONTROL */ 192 return s->control; 193 194 case 0x50: /* DSS_PSA_LCD_REG_1 */ 195 case 0x54: /* DSS_PSA_LCD_REG_2 */ 196 case 0x58: /* DSS_PSA_VIDEO_REG */ 197 /* TODO: fake some values when appropriate s->control bits are set */ 198 return 0; 199 200 case 0x5c: /* DSS_STATUS */ 201 return 1 + (s->control & 1); 202 203 default: 204 break; 205 } 206 OMAP_BAD_REG(addr); 207 return 0; 208 } 209 210 static void omap_diss_write(void *opaque, hwaddr addr, 211 uint64_t value, unsigned size) 212 { 213 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 214 215 if (size != 4) { 216 omap_badwidth_write32(opaque, addr, value); 217 return; 218 } 219 220 switch (addr) { 221 case 0x00: /* DSS_REVISIONNUMBER */ 222 case 0x14: /* DSS_SYSSTATUS */ 223 case 0x50: /* DSS_PSA_LCD_REG_1 */ 224 case 0x54: /* DSS_PSA_LCD_REG_2 */ 225 case 0x58: /* DSS_PSA_VIDEO_REG */ 226 case 0x5c: /* DSS_STATUS */ 227 OMAP_RO_REG(addr); 228 break; 229 230 case 0x10: /* DSS_SYSCONFIG */ 231 if (value & 2) /* SOFTRESET */ 232 omap_dss_reset(s); 233 s->autoidle = value & 1; 234 break; 235 236 case 0x40: /* DSS_CONTROL */ 237 s->control = value & 0x3dd; 238 break; 239 240 default: 241 OMAP_BAD_REG(addr); 242 } 243 } 244 245 static const MemoryRegionOps omap_diss_ops = { 246 .read = omap_diss_read, 247 .write = omap_diss_write, 248 .endianness = DEVICE_NATIVE_ENDIAN, 249 }; 250 251 static uint64_t omap_disc_read(void *opaque, hwaddr addr, 252 unsigned size) 253 { 254 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 255 256 if (size != 4) { 257 return omap_badwidth_read32(opaque, addr); 258 } 259 260 switch (addr) { 261 case 0x000: /* DISPC_REVISION */ 262 return 0x20; 263 264 case 0x010: /* DISPC_SYSCONFIG */ 265 return s->dispc.idlemode; 266 267 case 0x014: /* DISPC_SYSSTATUS */ 268 return 1; /* RESETDONE */ 269 270 case 0x018: /* DISPC_IRQSTATUS */ 271 return s->dispc.irqst; 272 273 case 0x01c: /* DISPC_IRQENABLE */ 274 return s->dispc.irqen; 275 276 case 0x040: /* DISPC_CONTROL */ 277 return s->dispc.control; 278 279 case 0x044: /* DISPC_CONFIG */ 280 return s->dispc.config; 281 282 case 0x048: /* DISPC_CAPABLE */ 283 return s->dispc.capable; 284 285 case 0x04c: /* DISPC_DEFAULT_COLOR0 */ 286 return s->dispc.bg[0]; 287 case 0x050: /* DISPC_DEFAULT_COLOR1 */ 288 return s->dispc.bg[1]; 289 case 0x054: /* DISPC_TRANS_COLOR0 */ 290 return s->dispc.trans[0]; 291 case 0x058: /* DISPC_TRANS_COLOR1 */ 292 return s->dispc.trans[1]; 293 294 case 0x05c: /* DISPC_LINE_STATUS */ 295 return 0x7ff; 296 case 0x060: /* DISPC_LINE_NUMBER */ 297 return s->dispc.line; 298 299 case 0x064: /* DISPC_TIMING_H */ 300 return s->dispc.timing[0]; 301 case 0x068: /* DISPC_TIMING_V */ 302 return s->dispc.timing[1]; 303 case 0x06c: /* DISPC_POL_FREQ */ 304 return s->dispc.timing[2]; 305 case 0x070: /* DISPC_DIVISOR */ 306 return s->dispc.timing[3]; 307 308 case 0x078: /* DISPC_SIZE_DIG */ 309 return ((s->dig.ny - 1) << 16) | (s->dig.nx - 1); 310 case 0x07c: /* DISPC_SIZE_LCD */ 311 return ((s->lcd.ny - 1) << 16) | (s->lcd.nx - 1); 312 313 case 0x080: /* DISPC_GFX_BA0 */ 314 return s->dispc.l[0].addr[0]; 315 case 0x084: /* DISPC_GFX_BA1 */ 316 return s->dispc.l[0].addr[1]; 317 case 0x088: /* DISPC_GFX_POSITION */ 318 return (s->dispc.l[0].posy << 16) | s->dispc.l[0].posx; 319 case 0x08c: /* DISPC_GFX_SIZE */ 320 return ((s->dispc.l[0].ny - 1) << 16) | (s->dispc.l[0].nx - 1); 321 case 0x0a0: /* DISPC_GFX_ATTRIBUTES */ 322 return s->dispc.l[0].attr; 323 case 0x0a4: /* DISPC_GFX_FIFO_TRESHOLD */ 324 return s->dispc.l[0].tresh; 325 case 0x0a8: /* DISPC_GFX_FIFO_SIZE_STATUS */ 326 return 256; 327 case 0x0ac: /* DISPC_GFX_ROW_INC */ 328 return s->dispc.l[0].rowinc; 329 case 0x0b0: /* DISPC_GFX_PIXEL_INC */ 330 return s->dispc.l[0].colinc; 331 case 0x0b4: /* DISPC_GFX_WINDOW_SKIP */ 332 return s->dispc.l[0].wininc; 333 case 0x0b8: /* DISPC_GFX_TABLE_BA */ 334 return s->dispc.l[0].addr[2]; 335 336 case 0x0bc: /* DISPC_VID1_BA0 */ 337 case 0x0c0: /* DISPC_VID1_BA1 */ 338 case 0x0c4: /* DISPC_VID1_POSITION */ 339 case 0x0c8: /* DISPC_VID1_SIZE */ 340 case 0x0cc: /* DISPC_VID1_ATTRIBUTES */ 341 case 0x0d0: /* DISPC_VID1_FIFO_TRESHOLD */ 342 case 0x0d4: /* DISPC_VID1_FIFO_SIZE_STATUS */ 343 case 0x0d8: /* DISPC_VID1_ROW_INC */ 344 case 0x0dc: /* DISPC_VID1_PIXEL_INC */ 345 case 0x0e0: /* DISPC_VID1_FIR */ 346 case 0x0e4: /* DISPC_VID1_PICTURE_SIZE */ 347 case 0x0e8: /* DISPC_VID1_ACCU0 */ 348 case 0x0ec: /* DISPC_VID1_ACCU1 */ 349 case 0x0f0 ... 0x140: /* DISPC_VID1_FIR_COEF, DISPC_VID1_CONV_COEF */ 350 case 0x14c: /* DISPC_VID2_BA0 */ 351 case 0x150: /* DISPC_VID2_BA1 */ 352 case 0x154: /* DISPC_VID2_POSITION */ 353 case 0x158: /* DISPC_VID2_SIZE */ 354 case 0x15c: /* DISPC_VID2_ATTRIBUTES */ 355 case 0x160: /* DISPC_VID2_FIFO_TRESHOLD */ 356 case 0x164: /* DISPC_VID2_FIFO_SIZE_STATUS */ 357 case 0x168: /* DISPC_VID2_ROW_INC */ 358 case 0x16c: /* DISPC_VID2_PIXEL_INC */ 359 case 0x170: /* DISPC_VID2_FIR */ 360 case 0x174: /* DISPC_VID2_PICTURE_SIZE */ 361 case 0x178: /* DISPC_VID2_ACCU0 */ 362 case 0x17c: /* DISPC_VID2_ACCU1 */ 363 case 0x180 ... 0x1d0: /* DISPC_VID2_FIR_COEF, DISPC_VID2_CONV_COEF */ 364 case 0x1d4: /* DISPC_DATA_CYCLE1 */ 365 case 0x1d8: /* DISPC_DATA_CYCLE2 */ 366 case 0x1dc: /* DISPC_DATA_CYCLE3 */ 367 return 0; 368 369 default: 370 break; 371 } 372 OMAP_BAD_REG(addr); 373 return 0; 374 } 375 376 static void omap_disc_write(void *opaque, hwaddr addr, 377 uint64_t value, unsigned size) 378 { 379 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 380 381 if (size != 4) { 382 omap_badwidth_write32(opaque, addr, value); 383 return; 384 } 385 386 switch (addr) { 387 case 0x010: /* DISPC_SYSCONFIG */ 388 if (value & 2) /* SOFTRESET */ 389 omap_dss_reset(s); 390 s->dispc.idlemode = value & 0x301b; 391 break; 392 393 case 0x018: /* DISPC_IRQSTATUS */ 394 s->dispc.irqst &= ~value; 395 omap_dispc_interrupt_update(s); 396 break; 397 398 case 0x01c: /* DISPC_IRQENABLE */ 399 s->dispc.irqen = value & 0xffff; 400 omap_dispc_interrupt_update(s); 401 break; 402 403 case 0x040: /* DISPC_CONTROL */ 404 s->dispc.control = value & 0x07ff9fff; 405 s->dig.enable = (value >> 1) & 1; 406 s->lcd.enable = (value >> 0) & 1; 407 if (value & (1 << 12)) /* OVERLAY_OPTIMIZATION */ 408 if (!((s->dispc.l[1].attr | s->dispc.l[2].attr) & 1)) { 409 fprintf(stderr, "%s: Overlay Optimization when no overlay " 410 "region effectively exists leads to " 411 "unpredictable behaviour!\n", __func__); 412 } 413 if (value & (1 << 6)) { /* GODIGITAL */ 414 /* XXX: Shadowed fields are: 415 * s->dispc.config 416 * s->dispc.capable 417 * s->dispc.bg[0] 418 * s->dispc.bg[1] 419 * s->dispc.trans[0] 420 * s->dispc.trans[1] 421 * s->dispc.line 422 * s->dispc.timing[0] 423 * s->dispc.timing[1] 424 * s->dispc.timing[2] 425 * s->dispc.timing[3] 426 * s->lcd.nx 427 * s->lcd.ny 428 * s->dig.nx 429 * s->dig.ny 430 * s->dispc.l[0].addr[0] 431 * s->dispc.l[0].addr[1] 432 * s->dispc.l[0].addr[2] 433 * s->dispc.l[0].posx 434 * s->dispc.l[0].posy 435 * s->dispc.l[0].nx 436 * s->dispc.l[0].ny 437 * s->dispc.l[0].tresh 438 * s->dispc.l[0].rowinc 439 * s->dispc.l[0].colinc 440 * s->dispc.l[0].wininc 441 * All they need to be loaded here from their shadow registers. 442 */ 443 } 444 if (value & (1 << 5)) { /* GOLCD */ 445 /* XXX: Likewise for LCD here. */ 446 } 447 s->dispc.invalidate = 1; 448 break; 449 450 case 0x044: /* DISPC_CONFIG */ 451 s->dispc.config = value & 0x3fff; 452 /* XXX: 453 * bits 2:1 (LOADMODE) reset to 0 after set to 1 and palette loaded 454 * bits 2:1 (LOADMODE) reset to 2 after set to 3 and palette loaded 455 */ 456 s->dispc.invalidate = 1; 457 break; 458 459 case 0x048: /* DISPC_CAPABLE */ 460 s->dispc.capable = value & 0x3ff; 461 break; 462 463 case 0x04c: /* DISPC_DEFAULT_COLOR0 */ 464 s->dispc.bg[0] = value & 0xffffff; 465 s->dispc.invalidate = 1; 466 break; 467 case 0x050: /* DISPC_DEFAULT_COLOR1 */ 468 s->dispc.bg[1] = value & 0xffffff; 469 s->dispc.invalidate = 1; 470 break; 471 case 0x054: /* DISPC_TRANS_COLOR0 */ 472 s->dispc.trans[0] = value & 0xffffff; 473 s->dispc.invalidate = 1; 474 break; 475 case 0x058: /* DISPC_TRANS_COLOR1 */ 476 s->dispc.trans[1] = value & 0xffffff; 477 s->dispc.invalidate = 1; 478 break; 479 480 case 0x060: /* DISPC_LINE_NUMBER */ 481 s->dispc.line = value & 0x7ff; 482 break; 483 484 case 0x064: /* DISPC_TIMING_H */ 485 s->dispc.timing[0] = value & 0x0ff0ff3f; 486 break; 487 case 0x068: /* DISPC_TIMING_V */ 488 s->dispc.timing[1] = value & 0x0ff0ff3f; 489 break; 490 case 0x06c: /* DISPC_POL_FREQ */ 491 s->dispc.timing[2] = value & 0x0003ffff; 492 break; 493 case 0x070: /* DISPC_DIVISOR */ 494 s->dispc.timing[3] = value & 0x00ff00ff; 495 break; 496 497 case 0x078: /* DISPC_SIZE_DIG */ 498 s->dig.nx = ((value >> 0) & 0x7ff) + 1; /* PPL */ 499 s->dig.ny = ((value >> 16) & 0x7ff) + 1; /* LPP */ 500 s->dispc.invalidate = 1; 501 break; 502 case 0x07c: /* DISPC_SIZE_LCD */ 503 s->lcd.nx = ((value >> 0) & 0x7ff) + 1; /* PPL */ 504 s->lcd.ny = ((value >> 16) & 0x7ff) + 1; /* LPP */ 505 s->dispc.invalidate = 1; 506 break; 507 case 0x080: /* DISPC_GFX_BA0 */ 508 s->dispc.l[0].addr[0] = (hwaddr) value; 509 s->dispc.invalidate = 1; 510 break; 511 case 0x084: /* DISPC_GFX_BA1 */ 512 s->dispc.l[0].addr[1] = (hwaddr) value; 513 s->dispc.invalidate = 1; 514 break; 515 case 0x088: /* DISPC_GFX_POSITION */ 516 s->dispc.l[0].posx = ((value >> 0) & 0x7ff); /* GFXPOSX */ 517 s->dispc.l[0].posy = ((value >> 16) & 0x7ff); /* GFXPOSY */ 518 s->dispc.invalidate = 1; 519 break; 520 case 0x08c: /* DISPC_GFX_SIZE */ 521 s->dispc.l[0].nx = ((value >> 0) & 0x7ff) + 1; /* GFXSIZEX */ 522 s->dispc.l[0].ny = ((value >> 16) & 0x7ff) + 1; /* GFXSIZEY */ 523 s->dispc.invalidate = 1; 524 break; 525 case 0x0a0: /* DISPC_GFX_ATTRIBUTES */ 526 s->dispc.l[0].attr = value & 0x7ff; 527 if (value & (3 << 9)) 528 fprintf(stderr, "%s: Big-endian pixel format not supported\n", 529 __FUNCTION__); 530 s->dispc.l[0].enable = value & 1; 531 s->dispc.l[0].bpp = (value >> 1) & 0xf; 532 s->dispc.invalidate = 1; 533 break; 534 case 0x0a4: /* DISPC_GFX_FIFO_TRESHOLD */ 535 s->dispc.l[0].tresh = value & 0x01ff01ff; 536 break; 537 case 0x0ac: /* DISPC_GFX_ROW_INC */ 538 s->dispc.l[0].rowinc = value; 539 s->dispc.invalidate = 1; 540 break; 541 case 0x0b0: /* DISPC_GFX_PIXEL_INC */ 542 s->dispc.l[0].colinc = value; 543 s->dispc.invalidate = 1; 544 break; 545 case 0x0b4: /* DISPC_GFX_WINDOW_SKIP */ 546 s->dispc.l[0].wininc = value; 547 break; 548 case 0x0b8: /* DISPC_GFX_TABLE_BA */ 549 s->dispc.l[0].addr[2] = (hwaddr) value; 550 s->dispc.invalidate = 1; 551 break; 552 553 case 0x0bc: /* DISPC_VID1_BA0 */ 554 case 0x0c0: /* DISPC_VID1_BA1 */ 555 case 0x0c4: /* DISPC_VID1_POSITION */ 556 case 0x0c8: /* DISPC_VID1_SIZE */ 557 case 0x0cc: /* DISPC_VID1_ATTRIBUTES */ 558 case 0x0d0: /* DISPC_VID1_FIFO_TRESHOLD */ 559 case 0x0d8: /* DISPC_VID1_ROW_INC */ 560 case 0x0dc: /* DISPC_VID1_PIXEL_INC */ 561 case 0x0e0: /* DISPC_VID1_FIR */ 562 case 0x0e4: /* DISPC_VID1_PICTURE_SIZE */ 563 case 0x0e8: /* DISPC_VID1_ACCU0 */ 564 case 0x0ec: /* DISPC_VID1_ACCU1 */ 565 case 0x0f0 ... 0x140: /* DISPC_VID1_FIR_COEF, DISPC_VID1_CONV_COEF */ 566 case 0x14c: /* DISPC_VID2_BA0 */ 567 case 0x150: /* DISPC_VID2_BA1 */ 568 case 0x154: /* DISPC_VID2_POSITION */ 569 case 0x158: /* DISPC_VID2_SIZE */ 570 case 0x15c: /* DISPC_VID2_ATTRIBUTES */ 571 case 0x160: /* DISPC_VID2_FIFO_TRESHOLD */ 572 case 0x168: /* DISPC_VID2_ROW_INC */ 573 case 0x16c: /* DISPC_VID2_PIXEL_INC */ 574 case 0x170: /* DISPC_VID2_FIR */ 575 case 0x174: /* DISPC_VID2_PICTURE_SIZE */ 576 case 0x178: /* DISPC_VID2_ACCU0 */ 577 case 0x17c: /* DISPC_VID2_ACCU1 */ 578 case 0x180 ... 0x1d0: /* DISPC_VID2_FIR_COEF, DISPC_VID2_CONV_COEF */ 579 case 0x1d4: /* DISPC_DATA_CYCLE1 */ 580 case 0x1d8: /* DISPC_DATA_CYCLE2 */ 581 case 0x1dc: /* DISPC_DATA_CYCLE3 */ 582 break; 583 584 default: 585 OMAP_BAD_REG(addr); 586 } 587 } 588 589 static const MemoryRegionOps omap_disc_ops = { 590 .read = omap_disc_read, 591 .write = omap_disc_write, 592 .endianness = DEVICE_NATIVE_ENDIAN, 593 }; 594 595 static void omap_rfbi_transfer_stop(struct omap_dss_s *s) 596 { 597 if (!s->rfbi.busy) 598 return; 599 600 /* TODO: in non-Bypass mode we probably need to just deassert the DRQ. */ 601 602 s->rfbi.busy = 0; 603 } 604 605 static void omap_rfbi_transfer_start(struct omap_dss_s *s) 606 { 607 void *data; 608 hwaddr len; 609 hwaddr data_addr; 610 int pitch; 611 static void *bounce_buffer; 612 static hwaddr bounce_len; 613 614 if (!s->rfbi.enable || s->rfbi.busy) 615 return; 616 617 if (s->rfbi.control & (1 << 1)) { /* BYPASS */ 618 /* TODO: in non-Bypass mode we probably need to just assert the 619 * DRQ and wait for DMA to write the pixels. */ 620 fprintf(stderr, "%s: Bypass mode unimplemented\n", __FUNCTION__); 621 return; 622 } 623 624 if (!(s->dispc.control & (1 << 11))) /* RFBIMODE */ 625 return; 626 /* TODO: check that LCD output is enabled in DISPC. */ 627 628 s->rfbi.busy = 1; 629 630 len = s->rfbi.pixels * 2; 631 632 data_addr = s->dispc.l[0].addr[0]; 633 data = cpu_physical_memory_map(data_addr, &len, 0); 634 if (data && len != s->rfbi.pixels * 2) { 635 cpu_physical_memory_unmap(data, len, 0, 0); 636 data = NULL; 637 len = s->rfbi.pixels * 2; 638 } 639 if (!data) { 640 if (len > bounce_len) { 641 bounce_buffer = g_realloc(bounce_buffer, len); 642 } 643 data = bounce_buffer; 644 cpu_physical_memory_read(data_addr, data, len); 645 } 646 647 /* TODO bpp */ 648 s->rfbi.pixels = 0; 649 650 /* TODO: negative values */ 651 pitch = s->dispc.l[0].nx + (s->dispc.l[0].rowinc - 1) / 2; 652 653 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) 654 s->rfbi.chip[0]->block(s->rfbi.chip[0]->opaque, 1, data, len, pitch); 655 if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) 656 s->rfbi.chip[1]->block(s->rfbi.chip[1]->opaque, 1, data, len, pitch); 657 658 if (data != bounce_buffer) { 659 cpu_physical_memory_unmap(data, len, 0, len); 660 } 661 662 omap_rfbi_transfer_stop(s); 663 664 /* TODO */ 665 s->dispc.irqst |= 1; /* FRAMEDONE */ 666 omap_dispc_interrupt_update(s); 667 } 668 669 static uint64_t omap_rfbi_read(void *opaque, hwaddr addr, 670 unsigned size) 671 { 672 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 673 674 if (size != 4) { 675 return omap_badwidth_read32(opaque, addr); 676 } 677 678 switch (addr) { 679 case 0x00: /* RFBI_REVISION */ 680 return 0x10; 681 682 case 0x10: /* RFBI_SYSCONFIG */ 683 return s->rfbi.idlemode; 684 685 case 0x14: /* RFBI_SYSSTATUS */ 686 return 1 | (s->rfbi.busy << 8); /* RESETDONE */ 687 688 case 0x40: /* RFBI_CONTROL */ 689 return s->rfbi.control; 690 691 case 0x44: /* RFBI_PIXELCNT */ 692 return s->rfbi.pixels; 693 694 case 0x48: /* RFBI_LINE_NUMBER */ 695 return s->rfbi.skiplines; 696 697 case 0x58: /* RFBI_READ */ 698 case 0x5c: /* RFBI_STATUS */ 699 return s->rfbi.rxbuf; 700 701 case 0x60: /* RFBI_CONFIG0 */ 702 return s->rfbi.config[0]; 703 case 0x64: /* RFBI_ONOFF_TIME0 */ 704 return s->rfbi.time[0]; 705 case 0x68: /* RFBI_CYCLE_TIME0 */ 706 return s->rfbi.time[1]; 707 case 0x6c: /* RFBI_DATA_CYCLE1_0 */ 708 return s->rfbi.data[0]; 709 case 0x70: /* RFBI_DATA_CYCLE2_0 */ 710 return s->rfbi.data[1]; 711 case 0x74: /* RFBI_DATA_CYCLE3_0 */ 712 return s->rfbi.data[2]; 713 714 case 0x78: /* RFBI_CONFIG1 */ 715 return s->rfbi.config[1]; 716 case 0x7c: /* RFBI_ONOFF_TIME1 */ 717 return s->rfbi.time[2]; 718 case 0x80: /* RFBI_CYCLE_TIME1 */ 719 return s->rfbi.time[3]; 720 case 0x84: /* RFBI_DATA_CYCLE1_1 */ 721 return s->rfbi.data[3]; 722 case 0x88: /* RFBI_DATA_CYCLE2_1 */ 723 return s->rfbi.data[4]; 724 case 0x8c: /* RFBI_DATA_CYCLE3_1 */ 725 return s->rfbi.data[5]; 726 727 case 0x90: /* RFBI_VSYNC_WIDTH */ 728 return s->rfbi.vsync; 729 case 0x94: /* RFBI_HSYNC_WIDTH */ 730 return s->rfbi.hsync; 731 } 732 OMAP_BAD_REG(addr); 733 return 0; 734 } 735 736 static void omap_rfbi_write(void *opaque, hwaddr addr, 737 uint64_t value, unsigned size) 738 { 739 struct omap_dss_s *s = (struct omap_dss_s *) opaque; 740 741 if (size != 4) { 742 omap_badwidth_write32(opaque, addr, value); 743 return; 744 } 745 746 switch (addr) { 747 case 0x10: /* RFBI_SYSCONFIG */ 748 if (value & 2) /* SOFTRESET */ 749 omap_rfbi_reset(s); 750 s->rfbi.idlemode = value & 0x19; 751 break; 752 753 case 0x40: /* RFBI_CONTROL */ 754 s->rfbi.control = value & 0xf; 755 s->rfbi.enable = value & 1; 756 if (value & (1 << 4) && /* ITE */ 757 !(s->rfbi.config[0] & s->rfbi.config[1] & 0xc)) 758 omap_rfbi_transfer_start(s); 759 break; 760 761 case 0x44: /* RFBI_PIXELCNT */ 762 s->rfbi.pixels = value; 763 break; 764 765 case 0x48: /* RFBI_LINE_NUMBER */ 766 s->rfbi.skiplines = value & 0x7ff; 767 break; 768 769 case 0x4c: /* RFBI_CMD */ 770 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) 771 s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 0, value & 0xffff); 772 if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) 773 s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 0, value & 0xffff); 774 break; 775 case 0x50: /* RFBI_PARAM */ 776 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) 777 s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff); 778 if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) 779 s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff); 780 break; 781 case 0x54: /* RFBI_DATA */ 782 /* TODO: take into account the format set up in s->rfbi.config[?] and 783 * s->rfbi.data[?], but special-case the most usual scenario so that 784 * speed doesn't suffer. */ 785 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) { 786 s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value & 0xffff); 787 s->rfbi.chip[0]->write(s->rfbi.chip[0]->opaque, 1, value >> 16); 788 } 789 if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) { 790 s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value & 0xffff); 791 s->rfbi.chip[1]->write(s->rfbi.chip[1]->opaque, 1, value >> 16); 792 } 793 if (!-- s->rfbi.pixels) 794 omap_rfbi_transfer_stop(s); 795 break; 796 case 0x58: /* RFBI_READ */ 797 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) 798 s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 1); 799 else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) 800 s->rfbi.rxbuf = s->rfbi.chip[1]->read(s->rfbi.chip[1]->opaque, 1); 801 if (!-- s->rfbi.pixels) 802 omap_rfbi_transfer_stop(s); 803 break; 804 805 case 0x5c: /* RFBI_STATUS */ 806 if ((s->rfbi.control & (1 << 2)) && s->rfbi.chip[0]) 807 s->rfbi.rxbuf = s->rfbi.chip[0]->read(s->rfbi.chip[0]->opaque, 0); 808 else if ((s->rfbi.control & (1 << 3)) && s->rfbi.chip[1]) 809 s->rfbi.rxbuf = s->rfbi.chip[1]->read(s->rfbi.chip[1]->opaque, 0); 810 if (!-- s->rfbi.pixels) 811 omap_rfbi_transfer_stop(s); 812 break; 813 814 case 0x60: /* RFBI_CONFIG0 */ 815 s->rfbi.config[0] = value & 0x003f1fff; 816 break; 817 818 case 0x64: /* RFBI_ONOFF_TIME0 */ 819 s->rfbi.time[0] = value & 0x3fffffff; 820 break; 821 case 0x68: /* RFBI_CYCLE_TIME0 */ 822 s->rfbi.time[1] = value & 0x0fffffff; 823 break; 824 case 0x6c: /* RFBI_DATA_CYCLE1_0 */ 825 s->rfbi.data[0] = value & 0x0f1f0f1f; 826 break; 827 case 0x70: /* RFBI_DATA_CYCLE2_0 */ 828 s->rfbi.data[1] = value & 0x0f1f0f1f; 829 break; 830 case 0x74: /* RFBI_DATA_CYCLE3_0 */ 831 s->rfbi.data[2] = value & 0x0f1f0f1f; 832 break; 833 case 0x78: /* RFBI_CONFIG1 */ 834 s->rfbi.config[1] = value & 0x003f1fff; 835 break; 836 837 case 0x7c: /* RFBI_ONOFF_TIME1 */ 838 s->rfbi.time[2] = value & 0x3fffffff; 839 break; 840 case 0x80: /* RFBI_CYCLE_TIME1 */ 841 s->rfbi.time[3] = value & 0x0fffffff; 842 break; 843 case 0x84: /* RFBI_DATA_CYCLE1_1 */ 844 s->rfbi.data[3] = value & 0x0f1f0f1f; 845 break; 846 case 0x88: /* RFBI_DATA_CYCLE2_1 */ 847 s->rfbi.data[4] = value & 0x0f1f0f1f; 848 break; 849 case 0x8c: /* RFBI_DATA_CYCLE3_1 */ 850 s->rfbi.data[5] = value & 0x0f1f0f1f; 851 break; 852 853 case 0x90: /* RFBI_VSYNC_WIDTH */ 854 s->rfbi.vsync = value & 0xffff; 855 break; 856 case 0x94: /* RFBI_HSYNC_WIDTH */ 857 s->rfbi.hsync = value & 0xffff; 858 break; 859 860 default: 861 OMAP_BAD_REG(addr); 862 } 863 } 864 865 static const MemoryRegionOps omap_rfbi_ops = { 866 .read = omap_rfbi_read, 867 .write = omap_rfbi_write, 868 .endianness = DEVICE_NATIVE_ENDIAN, 869 }; 870 871 static uint64_t omap_venc_read(void *opaque, hwaddr addr, 872 unsigned size) 873 { 874 if (size != 4) { 875 return omap_badwidth_read32(opaque, addr); 876 } 877 878 switch (addr) { 879 case 0x00: /* REV_ID */ 880 case 0x04: /* STATUS */ 881 case 0x08: /* F_CONTROL */ 882 case 0x10: /* VIDOUT_CTRL */ 883 case 0x14: /* SYNC_CTRL */ 884 case 0x1c: /* LLEN */ 885 case 0x20: /* FLENS */ 886 case 0x24: /* HFLTR_CTRL */ 887 case 0x28: /* CC_CARR_WSS_CARR */ 888 case 0x2c: /* C_PHASE */ 889 case 0x30: /* GAIN_U */ 890 case 0x34: /* GAIN_V */ 891 case 0x38: /* GAIN_Y */ 892 case 0x3c: /* BLACK_LEVEL */ 893 case 0x40: /* BLANK_LEVEL */ 894 case 0x44: /* X_COLOR */ 895 case 0x48: /* M_CONTROL */ 896 case 0x4c: /* BSTAMP_WSS_DATA */ 897 case 0x50: /* S_CARR */ 898 case 0x54: /* LINE21 */ 899 case 0x58: /* LN_SEL */ 900 case 0x5c: /* L21__WC_CTL */ 901 case 0x60: /* HTRIGGER_VTRIGGER */ 902 case 0x64: /* SAVID__EAVID */ 903 case 0x68: /* FLEN__FAL */ 904 case 0x6c: /* LAL__PHASE_RESET */ 905 case 0x70: /* HS_INT_START_STOP_X */ 906 case 0x74: /* HS_EXT_START_STOP_X */ 907 case 0x78: /* VS_INT_START_X */ 908 case 0x7c: /* VS_INT_STOP_X__VS_INT_START_Y */ 909 case 0x80: /* VS_INT_STOP_Y__VS_INT_START_X */ 910 case 0x84: /* VS_EXT_STOP_X__VS_EXT_START_Y */ 911 case 0x88: /* VS_EXT_STOP_Y */ 912 case 0x90: /* AVID_START_STOP_X */ 913 case 0x94: /* AVID_START_STOP_Y */ 914 case 0xa0: /* FID_INT_START_X__FID_INT_START_Y */ 915 case 0xa4: /* FID_INT_OFFSET_Y__FID_EXT_START_X */ 916 case 0xa8: /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */ 917 case 0xb0: /* TVDETGP_INT_START_STOP_X */ 918 case 0xb4: /* TVDETGP_INT_START_STOP_Y */ 919 case 0xb8: /* GEN_CTRL */ 920 case 0xc4: /* DAC_TST__DAC_A */ 921 case 0xc8: /* DAC_B__DAC_C */ 922 return 0; 923 924 default: 925 break; 926 } 927 OMAP_BAD_REG(addr); 928 return 0; 929 } 930 931 static void omap_venc_write(void *opaque, hwaddr addr, 932 uint64_t value, unsigned size) 933 { 934 if (size != 4) { 935 omap_badwidth_write32(opaque, addr, size); 936 return; 937 } 938 939 switch (addr) { 940 case 0x08: /* F_CONTROL */ 941 case 0x10: /* VIDOUT_CTRL */ 942 case 0x14: /* SYNC_CTRL */ 943 case 0x1c: /* LLEN */ 944 case 0x20: /* FLENS */ 945 case 0x24: /* HFLTR_CTRL */ 946 case 0x28: /* CC_CARR_WSS_CARR */ 947 case 0x2c: /* C_PHASE */ 948 case 0x30: /* GAIN_U */ 949 case 0x34: /* GAIN_V */ 950 case 0x38: /* GAIN_Y */ 951 case 0x3c: /* BLACK_LEVEL */ 952 case 0x40: /* BLANK_LEVEL */ 953 case 0x44: /* X_COLOR */ 954 case 0x48: /* M_CONTROL */ 955 case 0x4c: /* BSTAMP_WSS_DATA */ 956 case 0x50: /* S_CARR */ 957 case 0x54: /* LINE21 */ 958 case 0x58: /* LN_SEL */ 959 case 0x5c: /* L21__WC_CTL */ 960 case 0x60: /* HTRIGGER_VTRIGGER */ 961 case 0x64: /* SAVID__EAVID */ 962 case 0x68: /* FLEN__FAL */ 963 case 0x6c: /* LAL__PHASE_RESET */ 964 case 0x70: /* HS_INT_START_STOP_X */ 965 case 0x74: /* HS_EXT_START_STOP_X */ 966 case 0x78: /* VS_INT_START_X */ 967 case 0x7c: /* VS_INT_STOP_X__VS_INT_START_Y */ 968 case 0x80: /* VS_INT_STOP_Y__VS_INT_START_X */ 969 case 0x84: /* VS_EXT_STOP_X__VS_EXT_START_Y */ 970 case 0x88: /* VS_EXT_STOP_Y */ 971 case 0x90: /* AVID_START_STOP_X */ 972 case 0x94: /* AVID_START_STOP_Y */ 973 case 0xa0: /* FID_INT_START_X__FID_INT_START_Y */ 974 case 0xa4: /* FID_INT_OFFSET_Y__FID_EXT_START_X */ 975 case 0xa8: /* FID_EXT_START_Y__FID_EXT_OFFSET_Y */ 976 case 0xb0: /* TVDETGP_INT_START_STOP_X */ 977 case 0xb4: /* TVDETGP_INT_START_STOP_Y */ 978 case 0xb8: /* GEN_CTRL */ 979 case 0xc4: /* DAC_TST__DAC_A */ 980 case 0xc8: /* DAC_B__DAC_C */ 981 break; 982 983 default: 984 OMAP_BAD_REG(addr); 985 } 986 } 987 988 static const MemoryRegionOps omap_venc_ops = { 989 .read = omap_venc_read, 990 .write = omap_venc_write, 991 .endianness = DEVICE_NATIVE_ENDIAN, 992 }; 993 994 static uint64_t omap_im3_read(void *opaque, hwaddr addr, 995 unsigned size) 996 { 997 if (size != 4) { 998 return omap_badwidth_read32(opaque, addr); 999 } 1000 1001 switch (addr) { 1002 case 0x0a8: /* SBIMERRLOGA */ 1003 case 0x0b0: /* SBIMERRLOG */ 1004 case 0x190: /* SBIMSTATE */ 1005 case 0x198: /* SBTMSTATE_L */ 1006 case 0x19c: /* SBTMSTATE_H */ 1007 case 0x1a8: /* SBIMCONFIG_L */ 1008 case 0x1ac: /* SBIMCONFIG_H */ 1009 case 0x1f8: /* SBID_L */ 1010 case 0x1fc: /* SBID_H */ 1011 return 0; 1012 1013 default: 1014 break; 1015 } 1016 OMAP_BAD_REG(addr); 1017 return 0; 1018 } 1019 1020 static void omap_im3_write(void *opaque, hwaddr addr, 1021 uint64_t value, unsigned size) 1022 { 1023 if (size != 4) { 1024 omap_badwidth_write32(opaque, addr, value); 1025 return; 1026 } 1027 1028 switch (addr) { 1029 case 0x0b0: /* SBIMERRLOG */ 1030 case 0x190: /* SBIMSTATE */ 1031 case 0x198: /* SBTMSTATE_L */ 1032 case 0x19c: /* SBTMSTATE_H */ 1033 case 0x1a8: /* SBIMCONFIG_L */ 1034 case 0x1ac: /* SBIMCONFIG_H */ 1035 break; 1036 1037 default: 1038 OMAP_BAD_REG(addr); 1039 } 1040 } 1041 1042 static const MemoryRegionOps omap_im3_ops = { 1043 .read = omap_im3_read, 1044 .write = omap_im3_write, 1045 .endianness = DEVICE_NATIVE_ENDIAN, 1046 }; 1047 1048 struct omap_dss_s *omap_dss_init(struct omap_target_agent_s *ta, 1049 MemoryRegion *sysmem, 1050 hwaddr l3_base, 1051 qemu_irq irq, qemu_irq drq, 1052 omap_clk fck1, omap_clk fck2, omap_clk ck54m, 1053 omap_clk ick1, omap_clk ick2) 1054 { 1055 struct omap_dss_s *s = g_new0(struct omap_dss_s, 1); 1056 1057 s->irq = irq; 1058 s->drq = drq; 1059 omap_dss_reset(s); 1060 1061 memory_region_init_io(&s->iomem_diss1, NULL, &omap_diss_ops, s, "omap.diss1", 1062 omap_l4_region_size(ta, 0)); 1063 memory_region_init_io(&s->iomem_disc1, NULL, &omap_disc_ops, s, "omap.disc1", 1064 omap_l4_region_size(ta, 1)); 1065 memory_region_init_io(&s->iomem_rfbi1, NULL, &omap_rfbi_ops, s, "omap.rfbi1", 1066 omap_l4_region_size(ta, 2)); 1067 memory_region_init_io(&s->iomem_venc1, NULL, &omap_venc_ops, s, "omap.venc1", 1068 omap_l4_region_size(ta, 3)); 1069 memory_region_init_io(&s->iomem_im3, NULL, &omap_im3_ops, s, 1070 "omap.im3", 0x1000); 1071 1072 omap_l4_attach(ta, 0, &s->iomem_diss1); 1073 omap_l4_attach(ta, 1, &s->iomem_disc1); 1074 omap_l4_attach(ta, 2, &s->iomem_rfbi1); 1075 omap_l4_attach(ta, 3, &s->iomem_venc1); 1076 memory_region_add_subregion(sysmem, l3_base, &s->iomem_im3); 1077 1078 #if 0 1079 s->state = graphic_console_init(omap_update_display, 1080 omap_invalidate_display, omap_screen_dump, s); 1081 #endif 1082 1083 return s; 1084 } 1085 1086 void omap_rfbi_attach(struct omap_dss_s *s, int cs, struct rfbi_chip_s *chip) 1087 { 1088 if (cs < 0 || cs > 1) 1089 hw_error("%s: wrong CS %i\n", __FUNCTION__, cs); 1090 s->rfbi.chip[cs] = chip; 1091 } 1092