EdkModulePkg/Bus/Pci/CirrusLogic/Dxe/CirrusLogic5430UgaDraw.c

   1 /*++
   2
   3 Copyright (c) 2006, Intel Corporation
   4 All rights reserved. This program and the accompanying materials
   5 are licensed and made available under the terms and conditions of the BSD License
   6 which accompanies this distribution.  The full text of the license may be found at
   7 http://opensource.org/licenses/bsd-license.php
   8
   9 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  10 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  11
  12 Module Name:
  13
  14   CirrusLogic5430UgaDraw.c
  15
  16 Abstract:
  17
  18   This file produces the graphics abstration of UGA Draw. It is called by
  19   CirrusLogic5430.c file which deals with the EFI 1.1 driver model.
  20   This file just does graphics.
  21
  22 --*/
  23
  24 #include "CirrusLogic5430.h"
  25
  26 //
  27 // Video Mode structure
  28 //
  29 typedef struct {
  30   UINT32  Width;
  31   UINT32  Height;
  32   UINT32  ColorDepth;
  33   UINT32  RefreshRate;
  34   UINT8   *CrtcSettings;
  35   UINT16  *SeqSettings;
  36   UINT8   MiscSetting;
  37 } CIRRUS_LOGIC_5430_VIDEO_MODES;
  38
  39 //
  40 // Generic Attribute Controller Register Settings
  41 //
  42 static UINT8                          AttributeController[21] = {
  43   0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
  44   0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
  45   0x41, 0x00, 0x0F, 0x00, 0x00
  46 };
  47
  48 //
  49 // Generic Graphics Controller Register Settings
  50 //
  51 static UINT8 GraphicsController[9] = {
  52   0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F, 0xFF
  53 };
  54
  55 //
  56 // 640 x 480 x 256 color @ 60 Hertz
  57 //
  58 static UINT8                          Crtc_640_480_256_60[28] = {
  59   0x5d, 0x4f, 0x50, 0x82, 0x53, 0x9f, 0x00, 0x3e,
  60   0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  61   0xe1, 0x83, 0xdf, 0x50, 0x00, 0xe7, 0x04, 0xe3,
  62   0xff, 0x00, 0x00, 0x22
  63 };
  64
  65 static UINT16                         Seq_640_480_256_60[15] = {
  66   0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,
  67   0x5b0c, 0x450d, 0x7e0e, 0x2b1b, 0x2f1c, 0x301d, 0x331e
  68 };
  69
  70 //
  71 // 800 x 600 x 256 color @ 60 Hertz
  72 //
  73 static UINT8                          Crtc_800_600_256_60[28] = {
  74   0x7F, 0x63, 0x64, 0x80, 0x6B, 0x1B, 0x72, 0xF0,
  75   0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  76   0x58, 0x8C, 0x57, 0x64, 0x00, 0x5F, 0x91, 0xE3,
  77   0xFF, 0x00, 0x00, 0x22
  78 };
  79
  80 static UINT16                         Seq_800_600_256_60[15] = {
  81   0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,
  82   0x5b0c, 0x450d, 0x510e, 0x2b1b, 0x2f1c, 0x301d, 0x3a1e
  83 };
  84
  85 //
  86 // 1024 x 768 x 256 color @ 60 Hertz
  87 //
  88 static UINT8                          Crtc_1024_768_256_60[28] = {
  89   0xA3, 0x7F, 0x80, 0x86, 0x85, 0x96, 0x24, 0xFD,
  90   0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  91   0x02, 0x88, 0xFF, 0x80, 0x00, 0x00, 0x24, 0xE3,
  92   0xFF, 0x4A, 0x00, 0x22
  93 };
  94
  95 static UINT16                         Seq_1024_768_256_60[15] = {
  96   0x0100, 0x0101, 0x0f02, 0x0003, 0x0e04, 0x1107, 0x0008, 0x4a0b,
  97   0x5b0c, 0x450d, 0x760e, 0x2b1b, 0x2f1c, 0x301d, 0x341e
  98 };
  99
 100 //
 101 // Table of supported video modes
 102 //
 103 static CIRRUS_LOGIC_5430_VIDEO_MODES  CirrusLogic5430VideoModes[] = {
 104   {  640, 480, 8, 60, Crtc_640_480_256_60,  Seq_640_480_256_60,  0xe3 },
 105   {  800, 600, 8, 60, Crtc_800_600_256_60,  Seq_800_600_256_60,  0xef },
 106   { 1024, 768, 8, 60, Crtc_1024_768_256_60, Seq_1024_768_256_60, 0xef }
 107 };
 108
 109 //
 110 // Local Function Prototypes
 111 //
 112 VOID
 113 InitializeGraphicsMode (
 114   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 115   CIRRUS_LOGIC_5430_VIDEO_MODES   *ModeData
 116   );
 117
 118 VOID
 119 SetPaletteColor (
 120   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 121   UINTN                           Index,
 122   UINT8                           Red,
 123   UINT8                           Green,
 124   UINT8                           Blue
 125   );
 126
 127 VOID
 128 SetDefaultPalette (
 129   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 130   );
 131
 132 STATIC
 133 VOID
 134 ClearScreen (
 135   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 136   );
 137
 138 VOID
 139 DrawLogo (
 140   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 141   );
 142
 143 VOID
 144 outb (
 145   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 146   UINTN                           Address,
 147   UINT8                           Data
 148   );
 149
 150 VOID
 151 outw (
 152   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 153   UINTN                           Address,
 154   UINT16                          Data
 155   );
 156
 157 UINT8
 158 inb (
 159   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 160   UINTN                           Address
 161   );
 162
 163 UINT16
 164 inw (
 165   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 166   UINTN                           Address
 167   );
 168
 169 //
 170 // UGA Draw Protocol Member Functions
 171 //
 172 EFI_STATUS
 173 EFIAPI
 174 CirrusLogic5430UgaDrawGetMode (
 175   IN  EFI_UGA_DRAW_PROTOCOL *This,
 176   OUT UINT32                *HorizontalResolution,
 177   OUT UINT32                *VerticalResolution,
 178   OUT UINT32                *ColorDepth,
 179   OUT UINT32                *RefreshRate
 180   )
 181 /*++
 182
 183 Routine Description:
 184
 185   TODO: Add function description
 186
 187 Arguments:
 188
 189   This                  - TODO: add argument description
 190   HorizontalResolution  - TODO: add argument description
 191   VerticalResolution    - TODO: add argument description
 192   ColorDepth            - TODO: add argument description
 193   RefreshRate           - TODO: add argument description
 194
 195 Returns:
 196
 197   EFI_NOT_STARTED - TODO: Add description for return value
 198   EFI_INVALID_PARAMETER - TODO: Add description for return value
 199   EFI_SUCCESS - TODO: Add description for return value
 200
 201 --*/
 202 {
 203   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private;
 204
 205   Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);
 206
 207   if (Private->HardwareNeedsStarting) {
 208     return EFI_NOT_STARTED;
 209   }
 210
 211   if ((HorizontalResolution == NULL) ||
 212       (VerticalResolution == NULL)   ||
 213       (ColorDepth == NULL)           ||
 214       (RefreshRate == NULL)) {
 215     return EFI_INVALID_PARAMETER;
 216   }
 217
 218   *HorizontalResolution = Private->ModeData[Private->CurrentMode].HorizontalResolution;
 219   *VerticalResolution   = Private->ModeData[Private->CurrentMode].VerticalResolution;
 220   *ColorDepth           = Private->ModeData[Private->CurrentMode].ColorDepth;
 221   *RefreshRate          = Private->ModeData[Private->CurrentMode].RefreshRate;
 222
 223   return EFI_SUCCESS;
 224 }
 225
 226 EFI_STATUS
 227 EFIAPI
 228 CirrusLogic5430UgaDrawSetMode (
 229   IN  EFI_UGA_DRAW_PROTOCOL *This,
 230   IN  UINT32                HorizontalResolution,
 231   IN  UINT32                VerticalResolution,
 232   IN  UINT32                ColorDepth,
 233   IN  UINT32                RefreshRate
 234   )
 235 /*++
 236
 237 Routine Description:
 238
 239   TODO: Add function description
 240
 241 Arguments:
 242
 243   This                  - TODO: add argument description
 244   HorizontalResolution  - TODO: add argument description
 245   VerticalResolution    - TODO: add argument description
 246   ColorDepth            - TODO: add argument description
 247   RefreshRate           - TODO: add argument description
 248
 249 Returns:
 250
 251   EFI_OUT_OF_RESOURCES - TODO: Add description for return value
 252   EFI_SUCCESS - TODO: Add description for return value
 253   EFI_NOT_FOUND - TODO: Add description for return value
 254
 255 --*/
 256 {
 257   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private;
 258   UINTN                           Index;
 259
 260   Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);
 261
 262   for (Index = 0; Index < Private->MaxMode; Index++) {
 263
 264     if (HorizontalResolution != Private->ModeData[Index].HorizontalResolution) {
 265       continue;
 266     }
 267
 268     if (VerticalResolution != Private->ModeData[Index].VerticalResolution) {
 269       continue;
 270     }
 271
 272     if (ColorDepth != Private->ModeData[Index].ColorDepth) {
 273       continue;
 274     }
 275
 276     if (RefreshRate != Private->ModeData[Index].RefreshRate) {
 277       continue;
 278     }
 279
 280     if (Private->LineBuffer) {
 281       gBS->FreePool (Private->LineBuffer);
 282     }
 283
 284     Private->LineBuffer = NULL;
 285     Private->LineBuffer = AllocatePool (HorizontalResolution);
 286     if (Private->LineBuffer == NULL) {
 287       return EFI_OUT_OF_RESOURCES;
 288     }
 289
 290     InitializeGraphicsMode (Private, &CirrusLogic5430VideoModes[Index]);
 291
 292     Private->CurrentMode            = Index;
 293
 294     Private->HardwareNeedsStarting  = FALSE;
 295
 296     return EFI_SUCCESS;
 297   }
 298
 299   return EFI_NOT_FOUND;
 300 }
 301
 302 EFI_STATUS
 303 EFIAPI
 304 CirrusLogic5430UgaDrawBlt (
 305   IN  EFI_UGA_DRAW_PROTOCOL     *This,
 306   IN  EFI_UGA_PIXEL             *BltBuffer, OPTIONAL
 307   IN  EFI_UGA_BLT_OPERATION     BltOperation,
 308   IN  UINTN                     SourceX,
 309   IN  UINTN                     SourceY,
 310   IN  UINTN                     DestinationX,
 311   IN  UINTN                     DestinationY,
 312   IN  UINTN                     Width,
 313   IN  UINTN                     Height,
 314   IN  UINTN                     Delta
 315   )
 316 /*++
 317
 318 Routine Description:
 319
 320   TODO: Add function description
 321
 322 Arguments:
 323
 324   This          - TODO: add argument description
 325   BltBuffer     - TODO: add argument description
 326   BltOperation  - TODO: add argument description
 327   SourceX       - TODO: add argument description
 328   SourceY       - TODO: add argument description
 329   DestinationX  - TODO: add argument description
 330   DestinationY  - TODO: add argument description
 331   Width         - TODO: add argument description
 332   Height        - TODO: add argument description
 333   Delta         - TODO: add argument description
 334
 335 Returns:
 336
 337   EFI_INVALID_PARAMETER - TODO: Add description for return value
 338   EFI_INVALID_PARAMETER - TODO: Add description for return value
 339   EFI_INVALID_PARAMETER - TODO: Add description for return value
 340   EFI_INVALID_PARAMETER - TODO: Add description for return value
 341   EFI_INVALID_PARAMETER - TODO: Add description for return value
 342   EFI_INVALID_PARAMETER - TODO: Add description for return value
 343   EFI_SUCCESS - TODO: Add description for return value
 344
 345 --*/
 346 {
 347   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private;
 348   EFI_TPL                         OriginalTPL;
 349   UINTN                           DstY;
 350   UINTN                           SrcY;
 351   EFI_UGA_PIXEL                   *Blt;
 352   UINTN                           X;
 353   UINT8                           Pixel;
 354   UINT32                          WidePixel;
 355   UINTN                           ScreenWidth;
 356   UINTN                           Offset;
 357   UINTN                           SourceOffset;
 358
 359   Private = CIRRUS_LOGIC_5430_PRIVATE_DATA_FROM_UGA_DRAW_THIS (This);
 360
 361   if ((BltOperation < 0) || (BltOperation >= EfiUgaBltMax)) {
 362     return EFI_INVALID_PARAMETER;
 363   }
 364
 365   if (Width == 0 || Height == 0) {
 366     return EFI_INVALID_PARAMETER;
 367   }
 368
 369   //
 370   // If Delta is zero, then the entire BltBuffer is being used, so Delta
 371   // is the number of bytes in each row of BltBuffer.  Since BltBuffer is Width pixels size,
 372   // the number of bytes in each row can be computed.
 373   //
 374   if (Delta == 0) {
 375     Delta = Width * sizeof (EFI_UGA_PIXEL);
 376   }
 377
 378   //
 379   // We need to fill the Virtual Screen buffer with the blt data.
 380   // The virtual screen is upside down, as the first row is the bootom row of
 381   // the image.
 382   //
 383
 384   //
 385   // Make sure the SourceX, SourceY, DestinationX, DestinationY, Width, and Height parameters
 386   // are valid for the operation and the current screen geometry.
 387   //
 388   if (BltOperation == EfiUgaVideoToBltBuffer) {
 389     //
 390     // Video to BltBuffer: Source is Video, destination is BltBuffer
 391     //
 392     if (SourceY + Height > Private->ModeData[Private->CurrentMode].VerticalResolution) {
 393       return EFI_INVALID_PARAMETER;
 394     }
 395
 396     if (SourceX + Width > Private->ModeData[Private->CurrentMode].HorizontalResolution) {
 397       return EFI_INVALID_PARAMETER;
 398     }
 399   } else {
 400     //
 401     // BltBuffer to Video: Source is BltBuffer, destination is Video
 402     //
 403     if (DestinationY + Height > Private->ModeData[Private->CurrentMode].VerticalResolution) {
 404       return EFI_INVALID_PARAMETER;
 405     }
 406
 407     if (DestinationX + Width > Private->ModeData[Private->CurrentMode].HorizontalResolution) {
 408       return EFI_INVALID_PARAMETER;
 409     }
 410   }
 411   //
 412   // We have to raise to TPL Notify, so we make an atomic write the frame buffer.
 413   // We would not want a timer based event (Cursor, ...) to come in while we are
 414   // doing this operation.
 415   //
 416   OriginalTPL = gBS->RaiseTPL (EFI_TPL_NOTIFY);
 417
 418   switch (BltOperation) {
 419   case EfiUgaVideoToBltBuffer:
 420     //
 421     // Video to BltBuffer: Source is Video, destination is BltBuffer
 422     //
 423     for (SrcY = SourceY, DstY = DestinationY; DstY < (Height + DestinationY); SrcY++, DstY++) {
 424
 425       Offset = (SrcY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + SourceX;
 426       if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {
 427         Private->PciIo->Mem.Read (
 428                               Private->PciIo,
 429                               EfiPciIoWidthUint32,
 430                               0,
 431                               Offset,
 432                               Width >> 2,
 433                               Private->LineBuffer
 434                               );
 435       } else {
 436         Private->PciIo->Mem.Read (
 437                               Private->PciIo,
 438                               EfiPciIoWidthUint8,
 439                               0,
 440                               Offset,
 441                               Width,
 442                               Private->LineBuffer
 443                               );
 444       }
 445
 446       for (X = 0; X < Width; X++) {
 447         Blt         = (EFI_UGA_PIXEL *) ((UINT8 *) BltBuffer + (DstY * Delta) + (DestinationX + X) * sizeof (EFI_UGA_PIXEL));
 448
 449         Blt->Red    = (UINT8) (Private->LineBuffer[X] & 0xe0);
 450         Blt->Green  = (UINT8) ((Private->LineBuffer[X] & 0x1c) << 3);
 451         Blt->Blue   = (UINT8) ((Private->LineBuffer[X] & 0x03) << 6);
 452       }
 453     }
 454     break;
 455
 456   case EfiUgaVideoToVideo:
 457     //
 458     // Perform hardware acceleration for Video to Video operations
 459     //
 460     ScreenWidth   = Private->ModeData[Private->CurrentMode].HorizontalResolution;
 461     SourceOffset  = (SourceY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + (SourceX);
 462     Offset        = (DestinationY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + (DestinationX);
 463
 464     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0000);
 465     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0010);
 466     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0012);
 467     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0014);
 468
 469     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0001);
 470     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0011);
 471     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0013);
 472     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0015);
 473
 474     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((Width << 8) & 0xff00) | 0x20));
 475     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((Width & 0xff00) | 0x21));
 476     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((Height << 8) & 0xff00) | 0x22));
 477     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((Height & 0xff00) | 0x23));
 478     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((ScreenWidth << 8) & 0xff00) | 0x24));
 479     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((ScreenWidth & 0xff00) | 0x25));
 480     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) (((ScreenWidth << 8) & 0xff00) | 0x26));
 481     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((ScreenWidth & 0xff00) | 0x27));
 482     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) << 8) & 0xff00) | 0x28));
 483     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) >> 0) & 0xff00) | 0x29));
 484     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((Offset) >> 8) & 0xff00) | 0x2a));
 485     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) << 8) & 0xff00) | 0x2c));
 486     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) >> 0) & 0xff00) | 0x2d));
 487     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((((SourceOffset) >> 8) & 0xff00) | 0x2e));
 488     outw (Private, GRAPH_ADDRESS_REGISTER, 0x002f);
 489     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0030);
 490     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0d32);
 491     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0033);
 492     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0034);
 493     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0035);
 494
 495     outw (Private, GRAPH_ADDRESS_REGISTER, 0x0231);
 496
 497     outb (Private, GRAPH_ADDRESS_REGISTER, 0x31);
 498     while ((inb (Private, GRAPH_DATA_REGISTER) & 0x01) == 0x01)
 499       ;
 500     break;
 501
 502   case EfiUgaVideoFill:
 503     Blt       = BltBuffer;
 504     Pixel     = (UINT8) ((Blt->Red & 0xe0) | ((Blt->Green >> 3) & 0x1c) | ((Blt->Blue >> 6) & 0x03));
 505     WidePixel = (Pixel << 8) | Pixel;
 506     WidePixel = (WidePixel << 16) | WidePixel;
 507
 508     if (DestinationX == 0 && Width == Private->ModeData[Private->CurrentMode].HorizontalResolution) {
 509       Offset = DestinationY * Private->ModeData[Private->CurrentMode].HorizontalResolution;
 510       if (((Offset & 0x03) == 0) && (((Width * Height) & 0x03) == 0)) {
 511         Private->PciIo->Mem.Write (
 512                               Private->PciIo,
 513                               EfiPciIoWidthFillUint32,
 514                               0,
 515                               Offset,
 516                               (Width * Height) >> 2,
 517                               &WidePixel
 518                               );
 519       } else {
 520         Private->PciIo->Mem.Write (
 521                               Private->PciIo,
 522                               EfiPciIoWidthFillUint8,
 523                               0,
 524                               Offset,
 525                               Width * Height,
 526                               &Pixel
 527                               );
 528       }
 529     } else {
 530       for (SrcY = SourceY, DstY = DestinationY; SrcY < (Height + SourceY); SrcY++, DstY++) {
 531         Offset = (DstY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + DestinationX;
 532         if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {
 533           Private->PciIo->Mem.Write (
 534                                 Private->PciIo,
 535                                 EfiPciIoWidthFillUint32,
 536                                 0,
 537                                 Offset,
 538                                 Width >> 2,
 539                                 &WidePixel
 540                                 );
 541         } else {
 542           Private->PciIo->Mem.Write (
 543                                 Private->PciIo,
 544                                 EfiPciIoWidthFillUint8,
 545                                 0,
 546                                 Offset,
 547                                 Width,
 548                                 &Pixel
 549                                 );
 550         }
 551       }
 552     }
 553     break;
 554
 555   case EfiUgaBltBufferToVideo:
 556     for (SrcY = SourceY, DstY = DestinationY; SrcY < (Height + SourceY); SrcY++, DstY++) {
 557
 558       for (X = 0; X < Width; X++) {
 559         Blt                     = (EFI_UGA_PIXEL *) ((UINT8 *) BltBuffer + (SrcY * Delta) + (SourceX + X) * sizeof (EFI_UGA_PIXEL));
 560         Private->LineBuffer[X]  = (UINT8) ((Blt->Red & 0xe0) | ((Blt->Green >> 3) & 0x1c) | ((Blt->Blue >> 6) & 0x03));
 561       }
 562
 563       Offset = (DstY * Private->ModeData[Private->CurrentMode].HorizontalResolution) + DestinationX;
 564
 565       if (((Offset & 0x03) == 0) && ((Width & 0x03) == 0)) {
 566         Private->PciIo->Mem.Write (
 567                               Private->PciIo,
 568                               EfiPciIoWidthUint32,
 569                               0,
 570                               Offset,
 571                               Width >> 2,
 572                               Private->LineBuffer
 573                               );
 574       } else {
 575         Private->PciIo->Mem.Write (
 576                               Private->PciIo,
 577                               EfiPciIoWidthUint8,
 578                               0,
 579                               Offset,
 580                               Width,
 581                               Private->LineBuffer
 582                               );
 583       }
 584     }
 585     break;
 586
 587   default:
 588     break;
 589   }
 590
 591   gBS->RestoreTPL (OriginalTPL);
 592
 593   return EFI_SUCCESS;
 594 }
 595
 596 //
 597 // Construction and Destruction functions
 598 //
 599
 600 EFI_STATUS
 601 CirrusLogic5430UgaDrawConstructor (
 602   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 603   )
 604 /*++
 605
 606 Routine Description:
 607
 608 Arguments:
 609
 610 Returns:
 611
 612   None
 613
 614 --*/
 615 // TODO:    Private - add argument and description to function comment
 616 // TODO:    EFI_SUCCESS - add return value to function comment
 617 {
 618   EFI_UGA_DRAW_PROTOCOL *UgaDraw;
 619   UINTN                 Index;
 620
 621   //
 622   // Fill in Private->UgaDraw protocol
 623   //
 624   UgaDraw           = &Private->UgaDraw;
 625
 626   UgaDraw->GetMode  = CirrusLogic5430UgaDrawGetMode;
 627   UgaDraw->SetMode  = CirrusLogic5430UgaDrawSetMode;
 628   UgaDraw->Blt      = CirrusLogic5430UgaDrawBlt;
 629
 630   //
 631   // Initialize the private data
 632   //
 633   Private->MaxMode      = CIRRUS_LOGIC_5430_UGA_DRAW_MODE_COUNT;
 634   Private->CurrentMode  = 0;
 635   for (Index = 0; Index < Private->MaxMode; Index++) {
 636     Private->ModeData[Index].HorizontalResolution = CirrusLogic5430VideoModes[Index].Width;
 637     Private->ModeData[Index].VerticalResolution   = CirrusLogic5430VideoModes[Index].Height;
 638     Private->ModeData[Index].ColorDepth           = 32;
 639     Private->ModeData[Index].RefreshRate          = CirrusLogic5430VideoModes[Index].RefreshRate;
 640   }
 641
 642   Private->HardwareNeedsStarting  = TRUE;
 643   Private->LineBuffer             = NULL;
 644
 645   //
 646   // Initialize the hardware
 647   //
 648   UgaDraw->SetMode (
 649             UgaDraw,
 650             Private->ModeData[Private->CurrentMode].HorizontalResolution,
 651             Private->ModeData[Private->CurrentMode].VerticalResolution,
 652             Private->ModeData[Private->CurrentMode].ColorDepth,
 653             Private->ModeData[Private->CurrentMode].RefreshRate
 654             );
 655   DrawLogo (Private);
 656
 657   return EFI_SUCCESS;
 658 }
 659
 660 EFI_STATUS
 661 CirrusLogic5430UgaDrawDestructor (
 662   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 663   )
 664 /*++
 665
 666 Routine Description:
 667
 668 Arguments:
 669
 670 Returns:
 671
 672   None
 673
 674 --*/
 675 // TODO:    Private - add argument and description to function comment
 676 // TODO:    EFI_SUCCESS - add return value to function comment
 677 {
 678   return EFI_SUCCESS;
 679 }
 680
 681 VOID
 682 outb (
 683   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 684   UINTN                           Address,
 685   UINT8                           Data
 686   )
 687 /*++
 688
 689 Routine Description:
 690
 691   TODO: Add function description
 692
 693 Arguments:
 694
 695   Private - TODO: add argument description
 696   Address - TODO: add argument description
 697   Data    - TODO: add argument description
 698
 699 Returns:
 700
 701   TODO: add return values
 702
 703 --*/
 704 {
 705   Private->PciIo->Io.Write (
 706                       Private->PciIo,
 707                       EfiPciIoWidthUint8,
 708                       EFI_PCI_IO_PASS_THROUGH_BAR,
 709                       Address,
 710                       1,
 711                       &Data
 712                       );
 713 }
 714
 715 VOID
 716 outw (
 717   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 718   UINTN                           Address,
 719   UINT16                          Data
 720   )
 721 /*++
 722
 723 Routine Description:
 724
 725   TODO: Add function description
 726
 727 Arguments:
 728
 729   Private - TODO: add argument description
 730   Address - TODO: add argument description
 731   Data    - TODO: add argument description
 732
 733 Returns:
 734
 735   TODO: add return values
 736
 737 --*/
 738 {
 739   Private->PciIo->Io.Write (
 740                       Private->PciIo,
 741                       EfiPciIoWidthUint16,
 742                       EFI_PCI_IO_PASS_THROUGH_BAR,
 743                       Address,
 744                       1,
 745                       &Data
 746                       );
 747 }
 748
 749 UINT8
 750 inb (
 751   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 752   UINTN                           Address
 753   )
 754 /*++
 755
 756 Routine Description:
 757
 758   TODO: Add function description
 759
 760 Arguments:
 761
 762   Private - TODO: add argument description
 763   Address - TODO: add argument description
 764
 765 Returns:
 766
 767   TODO: add return values
 768
 769 --*/
 770 {
 771   UINT8 Data;
 772
 773   Private->PciIo->Io.Read (
 774                       Private->PciIo,
 775                       EfiPciIoWidthUint8,
 776                       EFI_PCI_IO_PASS_THROUGH_BAR,
 777                       Address,
 778                       1,
 779                       &Data
 780                       );
 781   return Data;
 782 }
 783
 784 UINT16
 785 inw (
 786   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 787   UINTN                           Address
 788   )
 789 /*++
 790
 791 Routine Description:
 792
 793   TODO: Add function description
 794
 795 Arguments:
 796
 797   Private - TODO: add argument description
 798   Address - TODO: add argument description
 799
 800 Returns:
 801
 802   TODO: add return values
 803
 804 --*/
 805 {
 806   UINT16  Data;
 807
 808   Private->PciIo->Io.Read (
 809                       Private->PciIo,
 810                       EfiPciIoWidthUint16,
 811                       EFI_PCI_IO_PASS_THROUGH_BAR,
 812                       Address,
 813                       1,
 814                       &Data
 815                       );
 816   return Data;
 817 }
 818
 819 VOID
 820 SetPaletteColor (
 821   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 822   UINTN                           Index,
 823   UINT8                           Red,
 824   UINT8                           Green,
 825   UINT8                           Blue
 826   )
 827 /*++
 828
 829 Routine Description:
 830
 831   TODO: Add function description
 832
 833 Arguments:
 834
 835   Private - TODO: add argument description
 836   Index   - TODO: add argument description
 837   Red     - TODO: add argument description
 838   Green   - TODO: add argument description
 839   Blue    - TODO: add argument description
 840
 841 Returns:
 842
 843   TODO: add return values
 844
 845 --*/
 846 {
 847   outb (Private, PALETTE_INDEX_REGISTER, (UINT8) Index);
 848   outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Red >> 2));
 849   outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Green >> 2));
 850   outb (Private, PALETTE_DATA_REGISTER, (UINT8) (Blue >> 2));
 851 }
 852
 853 VOID
 854 SetDefaultPalette (
 855   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 856   )
 857 /*++
 858
 859 Routine Description:
 860
 861   TODO: Add function description
 862
 863 Arguments:
 864
 865   Private - TODO: add argument description
 866
 867 Returns:
 868
 869   TODO: add return values
 870
 871 --*/
 872 {
 873   UINTN Index;
 874   UINTN RedIndex;
 875   UINTN GreenIndex;
 876   UINTN BlueIndex;
 877
 878   Index = 0;
 879   for (RedIndex = 0; RedIndex < 8; RedIndex++) {
 880     for (GreenIndex = 0; GreenIndex < 8; GreenIndex++) {
 881       for (BlueIndex = 0; BlueIndex < 4; BlueIndex++) {
 882         SetPaletteColor (Private, Index, (UINT8) (RedIndex << 5), (UINT8) (GreenIndex << 5), (UINT8) (BlueIndex << 6));
 883         Index++;
 884       }
 885     }
 886   }
 887 }
 888
 889 STATIC
 890 VOID
 891 ClearScreen (
 892   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 893   )
 894 /*++
 895
 896 Routine Description:
 897
 898   TODO: Add function description
 899
 900 Arguments:
 901
 902   Private - TODO: add argument description
 903
 904 Returns:
 905
 906   TODO: add return values
 907
 908 --*/
 909 {
 910   UINT32  Color;
 911
 912   Color = 0;
 913   Private->PciIo->Mem.Write (
 914                         Private->PciIo,
 915                         EfiPciIoWidthFillUint32,
 916                         0,
 917                         0,
 918                         0x100000 >> 2,
 919                         &Color
 920                         );
 921 }
 922
 923 VOID
 924 DrawLogo (
 925   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private
 926   )
 927 /*++
 928
 929 Routine Description:
 930
 931   TODO: Add function description
 932
 933 Arguments:
 934
 935   Private - TODO: add argument description
 936
 937 Returns:
 938
 939   TODO: add return values
 940
 941 --*/
 942 {
 943   UINTN Offset;
 944   UINTN X;
 945   UINTN Y;
 946   UINTN ScreenWidth;
 947   UINTN ScreenHeight;
 948   UINT8 Color;
 949
 950   ScreenWidth   = Private->ModeData[Private->CurrentMode].HorizontalResolution;
 951   ScreenHeight  = Private->ModeData[Private->CurrentMode].VerticalResolution;
 952
 953   Offset        = 0;
 954   for (Y = 0; Y < ScreenHeight; Y++) {
 955     for (X = 0; X < ScreenWidth; X++) {
 956       Color                   = (UINT8) (256 * (X + Y) / (ScreenWidth + ScreenHeight));
 957       Private->LineBuffer[X]  = Color;
 958     }
 959
 960     Private->PciIo->Mem.Write (
 961                           Private->PciIo,
 962                           EfiPciIoWidthUint32,
 963                           0,
 964                           Offset + (Y * ScreenWidth),
 965                           ScreenWidth >> 2,
 966                           Private->LineBuffer
 967                           );
 968   }
 969 }
 970
 971 VOID
 972 InitializeGraphicsMode (
 973   CIRRUS_LOGIC_5430_PRIVATE_DATA  *Private,
 974   CIRRUS_LOGIC_5430_VIDEO_MODES   *ModeData
 975   )
 976 /*++
 977
 978 Routine Description:
 979
 980   TODO: Add function description
 981
 982 Arguments:
 983
 984   Private   - TODO: add argument description
 985   ModeData  - TODO: add argument description
 986
 987 Returns:
 988
 989   TODO: add return values
 990
 991 --*/
 992 {
 993   UINT8 Byte;
 994   UINTN Index;
 995
 996   outw (Private, SEQ_ADDRESS_REGISTER, 0x1206);
 997   outw (Private, SEQ_ADDRESS_REGISTER, 0x0012);
 998
 999   for (Index = 0; Index < 15; Index++) {
1000     outw (Private, SEQ_ADDRESS_REGISTER, ModeData->SeqSettings[Index]);
1001   }
1002
1003   outb (Private, SEQ_ADDRESS_REGISTER, 0x0f);
1004   Byte = (UINT8) ((inb (Private, SEQ_DATA_REGISTER) & 0xc7) ^ 0x30);
1005   outb (Private, SEQ_DATA_REGISTER, Byte);
1006
1007   outb (Private, MISC_OUTPUT_REGISTER, ModeData->MiscSetting);
1008   outw (Private, GRAPH_ADDRESS_REGISTER, 0x0506);
1009   outw (Private, SEQ_ADDRESS_REGISTER, 0x0300);
1010   outw (Private, CRTC_ADDRESS_REGISTER, 0x2011);
1011
1012   for (Index = 0; Index < 28; Index++) {
1013     outw (Private, CRTC_ADDRESS_REGISTER, (UINT16) ((ModeData->CrtcSettings[Index] << 8) | Index));
1014   }
1015
1016   for (Index = 0; Index < 9; Index++) {
1017     outw (Private, GRAPH_ADDRESS_REGISTER, (UINT16) ((GraphicsController[Index] << 8) | Index));
1018   }
1019
1020   inb (Private, INPUT_STATUS_1_REGISTER);
1021
1022   for (Index = 0; Index < 21; Index++) {
1023     outb (Private, ATT_ADDRESS_REGISTER, (UINT8) Index);
1024     outb (Private, ATT_ADDRESS_REGISTER, AttributeController[Index]);
1025   }
1026
1027   outb (Private, ATT_ADDRESS_REGISTER, 0x20);
1028
1029   outw (Private, GRAPH_ADDRESS_REGISTER, 0x0009);
1030   outw (Private, GRAPH_ADDRESS_REGISTER, 0x000a);
1031   outw (Private, GRAPH_ADDRESS_REGISTER, 0x000b);
1032   outb (Private, DAC_PIXEL_MASK_REGISTER, 0xff);
1033
1034   SetDefaultPalette (Private);
1035   ClearScreen (Private);
1036 }