hdlcd.cc revision 9939
12330SN/A/* 22330SN/A * Copyright (c) 2010-2013 ARM Limited 32330SN/A * All rights reserved 42330SN/A * 52330SN/A * The license below extends only to copyright in the software and shall 62330SN/A * not be construed as granting a license to any other intellectual 72330SN/A * property including but not limited to intellectual property relating 82330SN/A * to a hardware implementation of the functionality of the software 92330SN/A * licensed hereunder. You may use the software subject to the license 102330SN/A * terms below provided that you ensure that this notice is replicated 112330SN/A * unmodified and in its entirety in all distributions of the software, 122330SN/A * modified or unmodified, in source code or in binary form. 132330SN/A * 142330SN/A * Redistribution and use in source and binary forms, with or without 152330SN/A * modification, are permitted provided that the following conditions are 162330SN/A * met: redistributions of source code must retain the above copyright 172330SN/A * notice, this list of conditions and the following disclaimer; 182330SN/A * redistributions in binary form must reproduce the above copyright 192330SN/A * notice, this list of conditions and the following disclaimer in the 202330SN/A * documentation and/or other materials provided with the distribution; 212330SN/A * neither the name of the copyright holders nor the names of its 222330SN/A * contributors may be used to endorse or promote products derived from 232330SN/A * this software without specific prior written permission. 242330SN/A * 252330SN/A * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 262330SN/A * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 272689Sktlim@umich.edu * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 282689Sktlim@umich.edu * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 292330SN/A * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 302292SN/A * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 312292SN/A * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 322292SN/A * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 332292SN/A * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 342980Sgblack@eecs.umich.edu * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 352362SN/A * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 362680Sktlim@umich.edu * 372292SN/A * Authors: Chris Emmons 382678Sktlim@umich.edu */ 392683Sktlim@umich.edu 402683Sktlim@umich.edu#include "base/vnc/vncinput.hh" 412678Sktlim@umich.edu#include "base/bitmap.hh" 422678Sktlim@umich.edu#include "base/output.hh" 432292SN/A#include "base/trace.hh" 442292SN/A#include "debug/HDLcd.hh" 452292SN/A#include "debug/Uart.hh" 462292SN/A#include "dev/arm/amba_device.hh" 472330SN/A#include "dev/arm/base_gic.hh" 482330SN/A#include "dev/arm/hdlcd.hh" 492330SN/A#include "mem/packet.hh" 502292SN/A#include "mem/packet_access.hh" 512292SN/A#include "sim/system.hh" 523402Sktlim@umich.edu 532862Sktlim@umich.eduusing std::vector; 543486Sktlim@umich.edu 553402Sktlim@umich.edu 562862Sktlim@umich.edu// initialize hdlcd registers 572330SN/AHDLcd::HDLcd(const Params *p) 582330SN/A : AmbaDmaDevice(p), version(VERSION_RESETV), 592330SN/A int_rawstat(0), int_clear(0), int_mask(0), int_status(0), 602330SN/A fb_base(0), fb_line_length(0), fb_line_count(0), fb_line_pitch(0), 612330SN/A bus_options(BUS_OPTIONS_RESETV), 622330SN/A v_sync(0), v_back_porch(0), v_data(0), v_front_porch(0), 632292SN/A h_sync(0), h_back_porch(0), h_data(0), h_front_porch(0), 642683Sktlim@umich.edu polarities(0), command(0), pixel_format(0), 652683Sktlim@umich.edu red_select(0), green_select(0), blue_select(0), 662292SN/A pixelClock(p->pixel_clock), vnc(p->vnc), bmp(NULL), pic(NULL), 673402Sktlim@umich.edu frameReadStartTime(0), 682292SN/A dmaStartAddr(0), dmaCurAddr(0), dmaMaxAddr(0), dmaPendingNum(0), 693402Sktlim@umich.edu frameUnderrun(false), virtualDisplayBuffer(NULL), pixelBufferSize(0), 703402Sktlim@umich.edu pixelIndex(0), doUpdateParams(false), frameUnderway(false), 712292SN/A dmaBytesInFlight(0), 722683Sktlim@umich.edu startFrameEvent(this), endFrameEvent(this), renderPixelEvent(this), 733486Sktlim@umich.edu fillPixelBufferEvent(this), intEvent(this), 743486Sktlim@umich.edu dmaDoneEventAll(MAX_OUTSTANDING_DMA_REQ_CAPACITY, this), 752862Sktlim@umich.edu dmaDoneEventFree(MAX_OUTSTANDING_DMA_REQ_CAPACITY), 762862Sktlim@umich.edu enableCapture(p->enable_capture) 772862Sktlim@umich.edu{ 782862Sktlim@umich.edu pioSize = 0xFFFF; 792683Sktlim@umich.edu 802683Sktlim@umich.edu for (int i = 0; i < MAX_OUTSTANDING_DMA_REQ_CAPACITY; ++i) 812683Sktlim@umich.edu dmaDoneEventFree[i] = &dmaDoneEventAll[i]; 822683Sktlim@umich.edu 832683Sktlim@umich.edu if (vnc) 842683Sktlim@umich.edu vnc->setFramebufferAddr(NULL); 852683Sktlim@umich.edu} 862683Sktlim@umich.edu 872683Sktlim@umich.eduHDLcd::~HDLcd() 882683Sktlim@umich.edu{ 892683Sktlim@umich.edu if (virtualDisplayBuffer) 902683Sktlim@umich.edu delete [] virtualDisplayBuffer; 912683Sktlim@umich.edu} 922683Sktlim@umich.edu 932683Sktlim@umich.edu// read registers and frame buffer 942683Sktlim@umich.eduTick 952683Sktlim@umich.eduHDLcd::read(PacketPtr pkt) 962683Sktlim@umich.edu{ 972683Sktlim@umich.edu uint32_t data = 0; 982683Sktlim@umich.edu const Addr daddr = pkt->getAddr() - pioAddr; 992683Sktlim@umich.edu 1002683Sktlim@umich.edu DPRINTF(HDLcd, "read register BASE+0x%04x size=%d\n", daddr, 1012683Sktlim@umich.edu pkt->getSize()); 1022690Sktlim@umich.edu 1032690Sktlim@umich.edu assert(pkt->getAddr() >= pioAddr && 1042683Sktlim@umich.edu pkt->getAddr() < pioAddr + pioSize && 1052683Sktlim@umich.edu pkt->getSize() == 4); 1062690Sktlim@umich.edu 1072690Sktlim@umich.edu pkt->allocate(); 1082683Sktlim@umich.edu 1092683Sktlim@umich.edu switch (daddr) { 1102683Sktlim@umich.edu case Version: 1112683Sktlim@umich.edu data = version; 1123402Sktlim@umich.edu break; 1132683Sktlim@umich.edu case Int_RawStat: 1142683Sktlim@umich.edu data = int_rawstat; 1152683Sktlim@umich.edu break; 1162683Sktlim@umich.edu case Int_Clear: 1172683Sktlim@umich.edu panic("HDLCD INT_CLEAR register is Write-Only\n"); 1182678Sktlim@umich.edu break; 1192292SN/A case Int_Mask: 1202683Sktlim@umich.edu data = int_mask; 1212683Sktlim@umich.edu break; 1222292SN/A case Int_Status: 1232683Sktlim@umich.edu data = int_status; 1242683Sktlim@umich.edu break; 1252683Sktlim@umich.edu case Fb_Base: 1262683Sktlim@umich.edu data = fb_base; 1272683Sktlim@umich.edu break; 1282683Sktlim@umich.edu case Fb_Line_Length: 1292683Sktlim@umich.edu data = fb_line_length; 1302683Sktlim@umich.edu break; 1312683Sktlim@umich.edu case Fb_Line_Count: 1322683Sktlim@umich.edu data = fb_line_count; 1332683Sktlim@umich.edu break; 1342683Sktlim@umich.edu case Fb_Line_Pitch: 1352683Sktlim@umich.edu data = fb_line_pitch; 1362683Sktlim@umich.edu break; 1372683Sktlim@umich.edu case Bus_Options: 1382683Sktlim@umich.edu data = bus_options; 1392683Sktlim@umich.edu break; 1402683Sktlim@umich.edu case V_Sync: 1412683Sktlim@umich.edu data = v_sync; 1423486Sktlim@umich.edu break; 1433486Sktlim@umich.edu case V_Back_Porch: 1443486Sktlim@umich.edu data = v_back_porch; 1453486Sktlim@umich.edu break; 1463486Sktlim@umich.edu case V_Data: 1473486Sktlim@umich.edu data = v_data; 1482683Sktlim@umich.edu break; 1492683Sktlim@umich.edu case V_Front_Porch: 1502683Sktlim@umich.edu data = v_front_porch; 1512683Sktlim@umich.edu break; 1522683Sktlim@umich.edu case H_Sync: 1532683Sktlim@umich.edu data = h_sync; 1542683Sktlim@umich.edu break; 1552683Sktlim@umich.edu case H_Back_Porch: 1562683Sktlim@umich.edu data = h_back_porch; 1572683Sktlim@umich.edu break; 1582683Sktlim@umich.edu case H_Data: 1592683Sktlim@umich.edu data = h_data; 1602683Sktlim@umich.edu break; 1612683Sktlim@umich.edu case H_Front_Porch: 1622683Sktlim@umich.edu data = h_front_porch; 1632683Sktlim@umich.edu break; 1642683Sktlim@umich.edu case Polarities: 1652683Sktlim@umich.edu data = polarities; 1663402Sktlim@umich.edu break; 1673402Sktlim@umich.edu case Command: 1683402Sktlim@umich.edu data = command; 1692683Sktlim@umich.edu break; 1702683Sktlim@umich.edu case Pixel_Format: 1712292SN/A data = pixel_format; 1722292SN/A break; 1732292SN/A case Red_Select: 1742292SN/A data = red_select; 1752292SN/A break; 1762690Sktlim@umich.edu case Green_Select: 1772683Sktlim@umich.edu data = green_select; 1782683Sktlim@umich.edu break; 1792292SN/A case Blue_Select: 1802683Sktlim@umich.edu data = blue_select; 1812683Sktlim@umich.edu break; 1822292SN/A default: 1832292SN/A panic("Tried to read HDLCD register that doesn't exist\n", daddr); 1842683Sktlim@umich.edu break; 1852292SN/A } 1862292SN/A 1872292SN/A pkt->set<uint32_t>(data); 1882292SN/A pkt->makeAtomicResponse(); 1892292SN/A return pioDelay; 1902330SN/A} 1912683Sktlim@umich.edu 1922683Sktlim@umich.edu// write registers and frame buffer 1932683Sktlim@umich.eduTick 1942683Sktlim@umich.eduHDLcd::write(PacketPtr pkt) 1952683Sktlim@umich.edu{ 1962683Sktlim@umich.edu assert(pkt->getAddr() >= pioAddr && 1972683Sktlim@umich.edu pkt->getAddr() < pioAddr + pioSize && 1982683Sktlim@umich.edu pkt->getSize() == 4); 1992292SN/A 2002678Sktlim@umich.edu const uint32_t data = pkt->get<uint32_t>(); 2012678Sktlim@umich.edu const Addr daddr = pkt->getAddr() - pioAddr; 2022292SN/A 2032292SN/A DPRINTF(HDLcd, "write register BASE+%0x04x <= 0x%08x\n", daddr, 2042292SN/A pkt->get<uint32_t>()); 2052292SN/A 2062292SN/A switch (daddr) { 2072292SN/A case Version: 2082330SN/A panic("HDLCD VERSION register is read-Only\n"); 2092330SN/A break; 2102330SN/A case Int_RawStat: 2112683Sktlim@umich.edu int_rawstat = data; 2122683Sktlim@umich.edu break; 2132683Sktlim@umich.edu case Int_Clear: 2142683Sktlim@umich.edu int_clear = data; 2152292SN/A break; 2163276Sgblack@eecs.umich.edu case Int_Mask: 2173276Sgblack@eecs.umich.edu int_mask = data; 2183276Sgblack@eecs.umich.edu break; 2193276Sgblack@eecs.umich.edu case Int_Status: 2203276Sgblack@eecs.umich.edu panic("HDLCD INT_STATUS register is read-Only\n"); 2213276Sgblack@eecs.umich.edu break; 2223276Sgblack@eecs.umich.edu case Fb_Base: 2233276Sgblack@eecs.umich.edu fb_base = data; 2243276Sgblack@eecs.umich.edu DPRINTF(HDLcd, "HDLCD Frame Buffer located at addr 0x%08x\n", fb_base); 2253276Sgblack@eecs.umich.edu break; 2262690Sktlim@umich.edu case Fb_Line_Length: 2272292SN/A fb_line_length = data; 2282292SN/A DPRINTF(HDLcd, "HDLCD res = %d x %d\n", width(), height()); 2292292SN/A break; 2302292SN/A case Fb_Line_Count: 2312292SN/A fb_line_count = data; 2322292SN/A DPRINTF(HDLcd, "HDLCD res = %d x %d\n", width(), height()); 2332292SN/A break; 2342292SN/A case Fb_Line_Pitch: 2352292SN/A fb_line_pitch = data; 2362292SN/A break; 2372292SN/A case Bus_Options: { 2382292SN/A BusOptsReg old_bus_options; 2392292SN/A old_bus_options = bus_options; 2402292SN/A bus_options = data; 2412292SN/A if (bus_options.max_outstanding != old_bus_options.max_outstanding) 2422292SN/A DPRINTF(HDLcd, 2432292SN/A "Changing HDLcd outstanding dma transactions from %d to %d\n", 2442292SN/A old_bus_options.max_outstanding, bus_options.max_outstanding); 2452292SN/A if (bus_options.burst_len != old_bus_options.burst_len) 2462292SN/A DPRINTF(HDLcd, 2472292SN/A "Changing HDLcd dma burst length from %d bytes to %d bytes\n", 2482292SN/A old_bus_options.burst_len, bus_options.burst_len); } 2492292SN/A break; 2502292SN/A case V_Sync: 2512292SN/A v_sync = data; 252 break; 253 case V_Back_Porch: 254 v_back_porch = data; 255 break; 256 case V_Data: 257 v_data = data; 258 break; 259 case V_Front_Porch: 260 v_front_porch = data; 261 break; 262 case H_Sync: 263 h_sync = data; 264 break; 265 case H_Back_Porch: 266 h_back_porch = data; 267 break; 268 case H_Data: 269 h_data = data; 270 break; 271 case H_Front_Porch: 272 h_front_porch = data; 273 break; 274 case Polarities: 275 polarities = data; 276 break; 277 case Command: { 278 CommandReg new_command; 279 new_command = data; 280 if (new_command.enable != command.enable) { 281 DPRINTF(HDLcd, "HDLCD switched %s\n", 282 new_command.enable==0 ? "off" : "on"); 283 if (new_command.enable) { 284 doUpdateParams = true; 285 if (!frameUnderway) { 286 schedule(startFrameEvent, clockEdge()); 287 } 288 } 289 } 290 command = new_command; } 291 break; 292 case Pixel_Format: 293 pixel_format = data; 294 DPRINTF(HDLcd, "HDLCD res = %d x %d\n", width(), height()); 295 DPRINTF(HDLcd, "HDLCD bytes per pixel = %d\n", bytesPerPixel()); 296 DPRINTF(HDLcd, "HDLCD endianness = %s\n", 297 pixel_format.big_endian ? "big" : "little"); 298 break; 299 case Red_Select: 300 red_select = data; 301 break; 302 case Green_Select: 303 green_select = data; 304 break; 305 case Blue_Select: 306 blue_select = data; 307 break; 308 default: 309 panic("Tried to write HDLCD register that doesn't exist\n", daddr); 310 break; 311 } 312 313 pkt->makeAtomicResponse(); 314 return pioDelay; 315} 316 317void 318HDLcd::updateVideoParams(bool unserializing = false) 319{ 320 const uint16_t bpp = bytesPerPixel() << 3; 321 const size_t buffer_size = bytesPerPixel() * width() * height(); 322 323 // updating these parameters while LCD is enabled is not supported 324 if (frameUnderway && !unserializing) 325 panic("Attempting to change some HDLCD parameters while the controller" 326 " is active is not allowed"); 327 328 // resize the virtualDisplayBuffer unless we are unserializing - it may 329 // have changed size 330 // there must be no outstanding DMA transactions for this to work 331 if (!unserializing) { 332 assert(dmaPendingNum == 0); 333 if (virtualDisplayBuffer) 334 delete [] virtualDisplayBuffer; 335 virtualDisplayBuffer = new uint8_t[buffer_size]; 336 memset(virtualDisplayBuffer, 0, buffer_size); 337 } 338 339 assert(virtualDisplayBuffer); 340 if (vnc) 341 vnc->setFramebufferAddr(virtualDisplayBuffer); 342 343 if (bmp) 344 delete bmp; 345 346 DPRINTF(HDLcd, "bpp = %d\n", bpp); 347 DPRINTF(HDLcd, "display size = %d x %d\n", width(), height()); 348#if TRACING_ON 349 const size_t totalLinesPerFrame = v_back_porch.val + 1 + 350 v_data.val + 1 + 351 v_front_porch.val + 1 + 352 v_sync.val + 1; 353 const double fps = (double)SimClock::Frequency / 354 (double)(PClksPerLine() * totalLinesPerFrame * pixelClock); 355#endif 356 DPRINTF(HDLcd, "simulated refresh rate ~ %.1ffps generating ~ %.1fMB/s " 357 "traffic ([%.1fMHz, T=%d sim clocks] pclk, %d bpp => %.1fMB/s peak requirement)\n", 358 fps, 359 fps * buffer_size / 1024 / 1024, 360 (double)SimClock::Frequency / pixelClock / 1000000.0, 361 pixelClock, 362 bpp, 363 (double)(SimClock::Frequency / pixelClock * (bpp / 8)) / 1024 / 1024); 364 365 if (pixel_format.big_endian) 366 panic("Big Endian pixel format not implemented by HDLcd controller"); 367 368 if (vnc) { 369 if ((bpp == 24) && 370 (red_select.size == 8) && 371 (blue_select.size == 8) && 372 (green_select.size == 8) && 373 (green_select.offset == 8)) { 374 if ((blue_select.offset == 0) && 375 (red_select.offset == 16)) { 376 vnc->setFrameBufferParams(VideoConvert::rgb8888, width(), 377 height()); 378 bmp = new Bitmap(VideoConvert::rgb8888, width(), height(), 379 virtualDisplayBuffer); 380 DPRINTF(HDLcd, "color mode: rgb888\n"); 381 } else if ((red_select.offset == 0) && 382 (blue_select.offset == 16)) { 383 vnc->setFrameBufferParams(VideoConvert::bgr8888, width(), 384 height()); 385 bmp = new Bitmap(VideoConvert::bgr8888, width(), height(), 386 virtualDisplayBuffer); 387 DPRINTF(HDLcd, "color mode: bgr888\n"); 388 } 389 } else if ((bpp == 16) && 390 (red_select.size == 5) && 391 (blue_select.size == 5) && 392 (green_select.size == 6) && 393 (green_select.offset == 5)) { 394 if ((blue_select.offset == 0) && 395 (red_select.offset == 11)) { 396 vnc->setFrameBufferParams(VideoConvert::rgb565, width(), 397 height()); 398 bmp = new Bitmap(VideoConvert::rgb565, width(), height(), 399 virtualDisplayBuffer); 400 DPRINTF(HDLcd, "color mode: rgb565\n"); 401 } else if ((red_select.offset == 0) && 402 (blue_select.offset == 11)) { 403 vnc->setFrameBufferParams(VideoConvert::bgr565, width(), 404 height()); 405 bmp = new Bitmap(VideoConvert::bgr565, width(), height(), 406 virtualDisplayBuffer); 407 DPRINTF(HDLcd, "color mode: bgr565\n"); 408 } 409 } else { 410 DPRINTF(HDLcd, "color mode: undefined\n"); 411 panic("Unimplemented video mode\n"); 412 } 413 } 414} 415 416void 417HDLcd::startFrame() 418{ 419 // 0. Check that we are in the appropriate state 420 assert(!frameUnderway); 421 if (!command.enable) 422 return; 423 DPRINTF(HDLcd, "Frame read started\n"); 424 if (doUpdateParams) { 425 updateVideoParams(); 426 doUpdateParams = false; 427 } 428 frameUnderway = true; 429 assert(virtualDisplayBuffer); 430 assert(pixelBufferSize == 0); 431 assert(dmaBytesInFlight == 0); 432 assert(dmaPendingNum == 0); 433 assert(dmaDoneEventFree.size() == dmaDoneEventAll.size()); 434 assert(!renderPixelEvent.scheduled()); 435 // currently only support positive line pitches equal to the line length 436 assert(width() * bytesPerPixel() == fb_line_pitch); 437 438 // 1. Start DMA'ing the frame; subsequent transactions created as we go 439 dmaCurAddr = dmaStartAddr = fb_base; 440 dmaMaxAddr = static_cast<Addr>(width() * height() * bytesPerPixel()) + 441 dmaCurAddr; 442 frameReadStartTime = curTick(); 443 pixelIndex = 0; 444 frameUnderrun = false; 445 fillPixelBuffer(); 446 447 // 2. Schedule first pixelclock read; subsequent reads generated as we go 448 Tick firstPixelReadTick = curTick() + pixelClock * ( 449 PClksPerLine() * (v_sync.val + 1 + 450 v_back_porch.val + 1) + 451 h_sync.val + 1 + 452 h_back_porch.val + 1); 453 schedule(renderPixelEvent, firstPixelReadTick); 454} 455 456void 457HDLcd::fillPixelBuffer() 458{ 459 // - am I under the LCD dma transaction total? 460 // - do I have more data to transfer? 461 // - have I not yet underrun for this frame? 462 // - is there room to put the data in the pixel buffer including any 463 // outstanding dma transfers in flight? 464 while ((dmaPendingNum < maxOutstandingDma()) && 465 (dmaMaxAddr > dmaCurAddr) && 466 !frameUnderrun && 467 bytesFreeInPixelBuffer() > dmaBurstLength() * AXI_PORT_WIDTH) { 468 // try largest transaction size allowed first but switch to smaller 469 // sizes for trailing bytes 470 size_t transaction_size = dmaBurstLength() * AXI_PORT_WIDTH; 471 while (transaction_size > (dmaMaxAddr - dmaCurAddr)) 472 transaction_size >>= 1; 473 assert(transaction_size > 0); 474 475 // concurrent dma reads need different dma done events 476 // due to assertion in scheduling state 477 ++dmaPendingNum; 478 479 assert(!dmaDoneEventFree.empty()); 480 DmaDoneEvent *event(dmaDoneEventFree.back()); 481 dmaDoneEventFree.pop_back(); 482 assert(event); 483 assert(!event->scheduled()); 484 485 // We use a uncachable request here because the requests from the CPU 486 // will be uncacheable as well. If we have uncacheable and cacheable 487 // requests in the memory system for the same address it won't be 488 // pleased 489 event->setTransactionSize(transaction_size); 490 dmaPort.dmaAction(MemCmd::ReadReq, dmaCurAddr, transaction_size, event, 491 virtualDisplayBuffer + dmaCurAddr - dmaStartAddr, 492 0, Request::UNCACHEABLE); 493 dmaCurAddr += transaction_size; 494 dmaBytesInFlight += transaction_size; 495 } 496} 497 498void 499HDLcd::renderPixel() 500{ 501 // try to handle multiple pixels at a time; doing so reduces the accuracy 502 // of the underrun detection but lowers simulation overhead 503 const size_t count = 32; 504 assert(width() % count == 0); // not set up to handle trailing pixels 505 506 // have we underrun on this frame anytime before? 507 if (frameUnderrun) { 508 // the LCD controller gives up on a frame if an underrun occurs and 509 // resumes regular operation on the next frame 510 pixelBufferSize = 0; 511 } else { 512 // did we underrun on this set of pixels? 513 if (pixelBufferSize < bytesPerPixel() * count) { 514 warn("HDLcd controller buffer underrun\n"); 515 frameUnderrun = true; 516 int_rawstat.underrun = 1; 517 if (!intEvent.scheduled()) 518 schedule(intEvent, clockEdge()); 519 } else { 520 // emulate the pixel read from the internal buffer 521 pixelBufferSize -= bytesPerPixel() * count; 522 } 523 } 524 525 // the DMA may have previously stalled due to the buffer being full; 526 // give it a kick; it knows not to fill if at end of frame, underrun, etc 527 if (!fillPixelBufferEvent.scheduled()) 528 schedule(fillPixelBufferEvent, clockEdge()); 529 530 // schedule the next pixel read according to where it is in the frame 531 pixelIndex += count; 532 assert(pixelIndex <= width() * height()); 533 size_t x = pixelIndex % width(); 534 Tick nextEventTick = curTick(); 535 if (x == 0) { 536 // start of new line 537 nextEventTick += pixelClock * ((h_front_porch.val + 1) + 538 (h_back_porch.val + 1) + 539 (h_sync.val + 1)); 540 if (pixelIndex == width() * height()) { 541 // end of frame 542 nextEventTick += PClksPerLine() * (v_front_porch.val + 1) * 543 pixelClock; 544 schedule(endFrameEvent, nextEventTick); 545 return; 546 } 547 } else { 548 nextEventTick += pixelClock * count; 549 } 550 551 schedule(renderPixelEvent, nextEventTick); 552} 553 554void 555HDLcd::endFrame() { 556 assert(pixelBufferSize == 0); 557 assert(dmaPendingNum == 0); 558 assert(dmaBytesInFlight == 0); 559 assert(dmaDoneEventFree.size() == dmaDoneEventAll.size()); 560 561 if (vnc) 562 vnc->setDirty(); 563 564 if (enableCapture) { 565 if (!pic) 566 pic = simout.create(csprintf("%s.framebuffer.bmp", sys->name()), true); 567 568 assert(bmp); 569 assert(pic); 570 pic->seekp(0); 571 bmp->write(pic); 572 } 573 574 // start the next frame 575 frameUnderway = false; 576 startFrame(); 577} 578 579void 580HDLcd::dmaDone(DmaDoneEvent *event) 581{ 582 const size_t transactionLength = event->getTransactionSize(); 583 assert(pixelBufferSize + transactionLength < PIXEL_BUFFER_CAPACITY); 584 assert(dmaCurAddr <= dmaMaxAddr); 585 586 dmaDoneEventFree.push_back(event); 587 --dmaPendingNum; 588 assert(MAX_OUTSTANDING_DMA_REQ_CAPACITY - dmaDoneEventFree.size() == 589 dmaPendingNum); 590 591 // add the data to the pixel buffer 592 dmaBytesInFlight -= transactionLength; 593 pixelBufferSize += transactionLength; 594 595 // schedule another dma transaction if: 596 // - we're not done reading the frame 597 // - there is sufficient room in the pixel buffer for another transaction 598 // - another fillPixelBufferEvent is not already scheduled 599 const size_t targetTransSize = dmaBurstLength() * AXI_PORT_WIDTH; 600 if ((dmaCurAddr < dmaMaxAddr) && 601 (bytesFreeInPixelBuffer() + targetTransSize < PIXEL_BUFFER_CAPACITY) && 602 !fillPixelBufferEvent.scheduled()) { 603 schedule(fillPixelBufferEvent, clockEdge()); 604 } 605} 606 607void 608HDLcd::serialize(std::ostream &os) 609{ 610 DPRINTF(HDLcd, "Serializing ARM HDLCD\n"); 611 612 const uint32_t version_serial = version; 613 SERIALIZE_SCALAR(version_serial); 614 const uint32_t int_rawstat_serial = int_rawstat; 615 SERIALIZE_SCALAR(int_rawstat_serial); 616 const uint32_t int_clear_serial = int_clear; 617 SERIALIZE_SCALAR(int_clear_serial); 618 const uint32_t int_mask_serial = int_mask; 619 SERIALIZE_SCALAR(int_mask_serial); 620 const uint32_t int_status_serial = int_status; 621 SERIALIZE_SCALAR(int_status_serial); 622 623 SERIALIZE_SCALAR(fb_base); 624 SERIALIZE_SCALAR(fb_line_length); 625 626 const uint32_t fb_line_count_serial = fb_line_count; 627 SERIALIZE_SCALAR(fb_line_count_serial); 628 629 SERIALIZE_SCALAR(fb_line_pitch); 630 631 const uint32_t bus_options_serial = bus_options; 632 SERIALIZE_SCALAR(bus_options_serial); 633 const uint32_t v_sync_serial = v_sync; 634 SERIALIZE_SCALAR(v_sync_serial); 635 const uint32_t v_back_porch_serial = v_back_porch; 636 SERIALIZE_SCALAR(v_back_porch_serial); 637 const uint32_t v_data_serial = v_data; 638 SERIALIZE_SCALAR(v_data_serial); 639 const uint32_t v_front_porch_serial = v_front_porch; 640 SERIALIZE_SCALAR(v_front_porch_serial); 641 const uint32_t h_sync_serial = h_sync; 642 SERIALIZE_SCALAR(h_sync_serial); 643 const uint32_t h_back_porch_serial = h_back_porch; 644 SERIALIZE_SCALAR(h_back_porch_serial); 645 const uint32_t h_data_serial = h_data; 646 SERIALIZE_SCALAR(h_data_serial); 647 const uint32_t h_front_porch_serial = h_front_porch; 648 SERIALIZE_SCALAR(h_front_porch_serial); 649 const uint32_t polarities_serial = polarities; 650 SERIALIZE_SCALAR(polarities_serial); 651 const uint32_t command_serial = command; 652 SERIALIZE_SCALAR(command_serial); 653 const uint32_t pixel_format_serial = pixel_format; 654 SERIALIZE_SCALAR(pixel_format_serial); 655 const uint32_t red_select_serial = red_select; 656 SERIALIZE_SCALAR(red_select_serial); 657 const uint32_t green_select_serial = green_select; 658 SERIALIZE_SCALAR(green_select_serial); 659 const uint32_t blue_select_serial = blue_select; 660 SERIALIZE_SCALAR(blue_select_serial); 661 662 SERIALIZE_SCALAR(frameReadStartTime); 663 SERIALIZE_SCALAR(dmaStartAddr); 664 SERIALIZE_SCALAR(dmaCurAddr); 665 SERIALIZE_SCALAR(dmaMaxAddr); 666 SERIALIZE_SCALAR(dmaPendingNum); 667 SERIALIZE_SCALAR(frameUnderrun); 668 669 const size_t buffer_size = bytesPerPixel() * width() * height(); 670 SERIALIZE_ARRAY(virtualDisplayBuffer, buffer_size); 671 672 SERIALIZE_SCALAR(pixelBufferSize); 673 SERIALIZE_SCALAR(pixelIndex); 674 SERIALIZE_SCALAR(doUpdateParams); 675 SERIALIZE_SCALAR(frameUnderway); 676 SERIALIZE_SCALAR(dmaBytesInFlight); 677 678 Tick start_event_time = 0; 679 Tick end_event_time = 0; 680 Tick render_pixel_event_time = 0; 681 Tick fill_pixel_buffer_event_time = 0; 682 Tick int_event_time = 0; 683 if (startFrameEvent.scheduled()) 684 start_event_time = startFrameEvent.when(); 685 if (endFrameEvent.scheduled()) 686 end_event_time = endFrameEvent.when(); 687 if (renderPixelEvent.scheduled()) 688 render_pixel_event_time = renderPixelEvent.when(); 689 if (fillPixelBufferEvent.scheduled()) 690 fill_pixel_buffer_event_time = fillPixelBufferEvent.when(); 691 if (intEvent.scheduled()) 692 int_event_time = intEvent.when(); 693 SERIALIZE_SCALAR(start_event_time); 694 SERIALIZE_SCALAR(end_event_time); 695 SERIALIZE_SCALAR(render_pixel_event_time); 696 SERIALIZE_SCALAR(fill_pixel_buffer_event_time); 697 SERIALIZE_SCALAR(int_event_time); 698 699 vector<Tick> dma_done_event_tick(MAX_OUTSTANDING_DMA_REQ_CAPACITY); 700 vector<size_t> dma_done_event_burst_len(MAX_OUTSTANDING_DMA_REQ_CAPACITY); 701 for (int x = 0; x < MAX_OUTSTANDING_DMA_REQ_CAPACITY; ++x) { 702 dma_done_event_tick[x] = dmaDoneEventAll[x].scheduled() ? 703 dmaDoneEventAll[x].when() : 0; 704 dma_done_event_burst_len[x] = dmaDoneEventAll[x].scheduled() ? 705 dmaDoneEventAll[x].getTransactionSize() : 0; 706 } 707 arrayParamOut(os, "dma_done_event_tick", dma_done_event_tick); 708 arrayParamOut(os, "dma_done_event_burst_length", dma_done_event_burst_len); 709} 710 711void 712HDLcd::unserialize(Checkpoint *cp, const std::string §ion) 713{ 714 uint32_t version_serial, int_rawstat_serial, int_clear_serial, 715 int_mask_serial, int_status_serial, fb_line_count_serial, 716 bus_options_serial, v_sync_serial, v_back_porch_serial, 717 v_data_serial, v_front_porch_serial, h_sync_serial, 718 h_back_porch_serial, h_data_serial, h_front_porch_serial, 719 polarities_serial, command_serial, pixel_format_serial, 720 red_select_serial, green_select_serial, blue_select_serial; 721 722 DPRINTF(HDLcd, "Unserializing ARM HDLCD\n"); 723 724 UNSERIALIZE_SCALAR(version_serial); 725 version = version_serial; 726 UNSERIALIZE_SCALAR(int_rawstat_serial); 727 int_rawstat = int_rawstat_serial; 728 UNSERIALIZE_SCALAR(int_clear_serial); 729 int_clear = int_clear_serial; 730 UNSERIALIZE_SCALAR(int_mask_serial); 731 int_mask = int_mask_serial; 732 UNSERIALIZE_SCALAR(int_status_serial); 733 int_status = int_status_serial; 734 735 UNSERIALIZE_SCALAR(fb_base); 736 UNSERIALIZE_SCALAR(fb_line_length); 737 738 UNSERIALIZE_SCALAR(fb_line_count_serial); 739 fb_line_count = fb_line_count_serial; 740 741 UNSERIALIZE_SCALAR(fb_line_pitch); 742 743 UNSERIALIZE_SCALAR(bus_options_serial); 744 bus_options = bus_options_serial; 745 UNSERIALIZE_SCALAR(v_sync_serial); 746 v_sync = v_sync_serial; 747 UNSERIALIZE_SCALAR(v_back_porch_serial); 748 v_back_porch = v_back_porch_serial; 749 UNSERIALIZE_SCALAR(v_data_serial); 750 v_data = v_data_serial; 751 UNSERIALIZE_SCALAR(v_front_porch_serial); 752 v_front_porch = v_front_porch_serial; 753 UNSERIALIZE_SCALAR(h_sync_serial); 754 h_sync = h_sync_serial; 755 UNSERIALIZE_SCALAR(h_back_porch_serial); 756 h_back_porch = h_back_porch_serial; 757 UNSERIALIZE_SCALAR(h_data_serial); 758 h_data = h_data_serial; 759 UNSERIALIZE_SCALAR(h_front_porch_serial); 760 h_front_porch = h_front_porch_serial; 761 UNSERIALIZE_SCALAR(polarities_serial); 762 polarities = polarities_serial; 763 UNSERIALIZE_SCALAR(command_serial); 764 command = command_serial; 765 UNSERIALIZE_SCALAR(pixel_format_serial); 766 pixel_format = pixel_format_serial; 767 UNSERIALIZE_SCALAR(red_select_serial); 768 red_select = red_select_serial; 769 UNSERIALIZE_SCALAR(green_select_serial); 770 green_select = green_select_serial; 771 UNSERIALIZE_SCALAR(blue_select_serial); 772 blue_select = blue_select_serial; 773 774 UNSERIALIZE_SCALAR(frameReadStartTime); 775 UNSERIALIZE_SCALAR(dmaStartAddr); 776 UNSERIALIZE_SCALAR(dmaCurAddr); 777 UNSERIALIZE_SCALAR(dmaMaxAddr); 778 UNSERIALIZE_SCALAR(dmaPendingNum); 779 UNSERIALIZE_SCALAR(frameUnderrun); 780 UNSERIALIZE_SCALAR(dmaBytesInFlight); 781 782 const size_t buffer_size = bytesPerPixel() * width() * height(); 783 virtualDisplayBuffer = new uint8_t[buffer_size]; 784 UNSERIALIZE_ARRAY(virtualDisplayBuffer, buffer_size); 785 786 UNSERIALIZE_SCALAR(pixelBufferSize); 787 UNSERIALIZE_SCALAR(pixelIndex); 788 UNSERIALIZE_SCALAR(doUpdateParams); 789 UNSERIALIZE_SCALAR(frameUnderway); 790 791 Tick start_event_time = 0; 792 Tick end_event_time = 0; 793 Tick render_pixel_event_time = 0; 794 Tick fill_pixel_buffer_event_time = 0; 795 Tick int_event_time = 0; 796 UNSERIALIZE_SCALAR(start_event_time); 797 UNSERIALIZE_SCALAR(end_event_time); 798 UNSERIALIZE_SCALAR(render_pixel_event_time); 799 UNSERIALIZE_SCALAR(fill_pixel_buffer_event_time); 800 UNSERIALIZE_SCALAR(int_event_time); 801 if (start_event_time) 802 schedule(startFrameEvent, start_event_time); 803 if (end_event_time) 804 schedule(endFrameEvent, end_event_time); 805 if (render_pixel_event_time) 806 schedule(renderPixelEvent, render_pixel_event_time); 807 if (fill_pixel_buffer_event_time) 808 schedule(fillPixelBufferEvent, fill_pixel_buffer_event_time); 809 if (int_event_time) 810 schedule(intEvent, int_event_time); 811 812 vector<Tick> dma_done_event_tick(MAX_OUTSTANDING_DMA_REQ_CAPACITY); 813 vector<Tick> dma_done_event_burst_len(MAX_OUTSTANDING_DMA_REQ_CAPACITY); 814 arrayParamIn(cp, section, "dma_done_event_tick", dma_done_event_tick); 815 arrayParamIn(cp, section, "dma_done_event_burst_length", dma_done_event_burst_len); 816 dmaDoneEventFree.clear(); 817 for (int x = 0; x < MAX_OUTSTANDING_DMA_REQ_CAPACITY; ++x) { 818 if (dma_done_event_tick[x]) { 819 dmaDoneEventAll[x].setTransactionSize(dma_done_event_burst_len[x]); 820 schedule(dmaDoneEventAll[x], dma_done_event_tick[x]); 821 } else 822 dmaDoneEventFree.push_back(&dmaDoneEventAll[x]); 823 } 824 assert(MAX_OUTSTANDING_DMA_REQ_CAPACITY - dmaDoneEventFree.size() == dmaPendingNum); 825 826 if (frameUnderway) { 827 updateVideoParams(true); 828 if (vnc) 829 vnc->setDirty(); 830 } 831} 832 833void 834HDLcd::generateInterrupt() 835{ 836 int_status = int_rawstat & int_mask; 837 DPRINTF(HDLcd, "Generate Interrupt: int_rawstat=0x%08x int_mask=0x%08x " 838 "int_status=0x%08x\n", 839 (uint32_t)int_rawstat, (uint32_t)int_mask, (uint32_t)int_status); 840 841 if (int_status != 0) { 842 gic->sendInt(intNum); 843 DPRINTF(HDLcd, " -- Generated\n"); 844 } 845} 846 847AddrRangeList 848HDLcd::getAddrRanges() const 849{ 850 AddrRangeList ranges; 851 ranges.push_back(RangeSize(pioAddr, pioSize)); 852 return ranges; 853} 854 855HDLcd * 856HDLcdParams::create() 857{ 858 return new HDLcd(this); 859} 860