[mirror_edk2.git] / Omap35xxPkg / LcdGraphicsOutputDxe / LcdGraphicsOutputDxe.c

/** @file\r
\r
 Copyright (c) 2011-2014, ARM Ltd. All rights reserved.<BR>\r
 This program and the accompanying materials\r
 are licensed and made available under the terms and conditions of the BSD License\r
 which accompanies this distribution.  The full text of the license may be found at\r
 http://opensource.org/licenses/bsd-license.php\r
\r
 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
\r
#include "LcdGraphicsOutputDxe.h"\r
\r
BOOLEAN mDisplayInitialized = FALSE;\r
\r
LCD_MODE LcdModes[] = {\r
  {\r
    0, 640, 480,\r
    9, 4,\r
    96, 16, 48,\r
    2, 10, 33\r
  },\r
  {\r
    1, 800, 600,\r
    11, 2,\r
    120, 56, 64,\r
    5, 37, 22\r
  },\r
  {\r
    2, 1024, 768,\r
    6, 2,\r
    96, 16, 48,\r
    2, 10, 33\r
  },\r
};\r
\r
LCD_INSTANCE mLcdTemplate = {\r
  LCD_INSTANCE_SIGNATURE,\r
  NULL, // Handle\r
  { // ModeInfo\r
    0, // Version\r
    0, // HorizontalResolution\r
    0, // VerticalResolution\r
    PixelBltOnly, // PixelFormat\r
    {\r
      0xF800, //RedMask;\r
      0x7E0, //GreenMask;\r
      0x1F, //BlueMask;\r
      0x0//ReservedMask\r
    }, // PixelInformation\r
    0, // PixelsPerScanLine\r
  },\r
  { // Mode\r
    3, // MaxMode;\r
    0, // Mode;\r
    NULL, // Info;\r
    0, // SizeOfInfo;\r
    0, // FrameBufferBase;\r
    0 // FrameBufferSize;\r
  },\r
  { // Gop\r
    LcdGraphicsQueryMode,  // QueryMode\r
    LcdGraphicsSetMode,    // SetMode\r
    LcdGraphicsBlt,        // Blt\r
    NULL                     // *Mode\r
  },\r
  { // DevicePath\r
    {\r
      {\r
        HARDWARE_DEVICE_PATH, HW_VENDOR_DP,\r
        { (UINT8) (sizeof(VENDOR_DEVICE_PATH)), (UINT8) ((sizeof(VENDOR_DEVICE_PATH)) >> 8) },\r
      },\r
      // Hardware Device Path for Lcd\r
      EFI_CALLER_ID_GUID // Use the driver's GUID\r
    },\r
    {\r
      END_DEVICE_PATH_TYPE,\r
      END_ENTIRE_DEVICE_PATH_SUBTYPE,\r
      { sizeof(EFI_DEVICE_PATH_PROTOCOL), 0}\r
    }\r
  }\r
};\r
\r
EFI_STATUS\r
LcdInstanceContructor (\r
  OUT LCD_INSTANCE** NewInstance\r
  )\r
{\r
  LCD_INSTANCE* Instance;\r
\r
  Instance = AllocateCopyPool (sizeof(LCD_INSTANCE), &mLcdTemplate);\r
  if (Instance == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Instance->Gop.Mode          = &Instance->Mode;\r
  Instance->Mode.Info         = &Instance->ModeInfo;\r
\r
  *NewInstance = Instance;\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
LcdPlatformGetVram (\r
  OUT EFI_PHYSICAL_ADDRESS*  VramBaseAddress,\r
  OUT UINTN*                 VramSize\r
  )\r
{\r
  EFI_STATUS             Status;\r
  EFI_CPU_ARCH_PROTOCOL  *Cpu;\r
  UINTN                  MaxSize;\r
\r
  MaxSize = 0x500000;\r
  *VramSize = MaxSize;\r
\r
  // Allocate VRAM from DRAM\r
  Status = gBS->AllocatePages (AllocateAnyPages, EfiBootServicesData, EFI_SIZE_TO_PAGES((MaxSize)), VramBaseAddress);\r
  if (EFI_ERROR(Status)) {\r
    return Status;\r
  }\r
\r
  // Ensure the Cpu architectural protocol is already installed\r
  Status = gBS->LocateProtocol (&gEfiCpuArchProtocolGuid, NULL, (VOID **)&Cpu);\r
  ASSERT_EFI_ERROR(Status);\r
\r
  // Mark the VRAM as un-cacheable. The VRAM is inside the DRAM, which is cacheable.\r
  Status = Cpu->SetMemoryAttributes (Cpu, *VramBaseAddress, *VramSize, EFI_MEMORY_UC);\r
  if (EFI_ERROR(Status)) {\r
    gBS->FreePool (VramBaseAddress);\r
    return Status;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
DssSetMode (\r
  UINT32 VramBaseAddress,\r
  UINTN  ModeNumber\r
  )\r
{\r
  // Make sure the interface clock is running\r
  MmioWrite32 (CM_ICLKEN_DSS, EN_DSS);\r
\r
  // Stop the functional clocks\r
  MmioAnd32 (CM_FCLKEN_DSS, ~(EN_DSS1 | EN_DSS2 | EN_TV));\r
\r
  // Program the DSS clock divisor\r
  MmioWrite32 (CM_CLKSEL_DSS, 0x1000 | (LcdModes[ModeNumber].DssDivisor));\r
\r
  // Start the functional clocks\r
  MmioOr32 (CM_FCLKEN_DSS, (EN_DSS1 | EN_DSS2 | EN_TV));\r
\r
  // Wait for DSS to stabilize\r
  gBS->Stall(1);\r
\r
  // Reset the subsystem\r
  MmioWrite32(DSS_SYSCONFIG, DSS_SOFTRESET);\r
  while (!(MmioRead32 (DSS_SYSSTATUS) & DSS_RESETDONE));\r
\r
  // Configure LCD parameters\r
  MmioWrite32 (DISPC_SIZE_LCD,\r
               ((LcdModes[ModeNumber].HorizontalResolution - 1)\r
               | ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))\r
              );\r
  MmioWrite32 (DISPC_TIMING_H,\r
               ( (LcdModes[ModeNumber].HSync - 1)\r
               | ((LcdModes[ModeNumber].HFrontPorch - 1) << 8)\r
               | ((LcdModes[ModeNumber].HBackPorch - 1) << 20))\r
              );\r
  MmioWrite32 (DISPC_TIMING_V,\r
               ( (LcdModes[ModeNumber].VSync - 1)\r
               | ((LcdModes[ModeNumber].VFrontPorch - 1) << 8)\r
               | ((LcdModes[ModeNumber].VBackPorch - 1) << 20))\r
              );\r
\r
  // Set the framebuffer to only load frames (no gamma tables)\r
  MmioAnd32 (DISPC_CONFIG, CLEARLOADMODE);\r
  MmioOr32  (DISPC_CONFIG, LOAD_FRAME_ONLY);\r
\r
  // Divisor for the pixel clock\r
  MmioWrite32(DISPC_DIVISOR, ((1 << 16) | LcdModes[ModeNumber].DispcDivisor) );\r
\r
  // Set up the graphics layer\r
  MmioWrite32 (DISPC_GFX_PRELD, 0x2D8);\r
  MmioWrite32 (DISPC_GFX_BA0, VramBaseAddress);\r
  MmioWrite32 (DISPC_GFX_SIZE,\r
               ((LcdModes[ModeNumber].HorizontalResolution - 1)\r
               | ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))\r
              );\r
\r
  MmioWrite32(DISPC_GFX_ATTR, (GFXENABLE | RGB16 | BURSTSIZE16));\r
\r
  // Start it all\r
  MmioOr32 (DISPC_CONTROL, (LCDENABLE | ACTIVEMATRIX | DATALINES24 | BYPASS_MODE | LCDENABLESIGNAL));\r
  MmioOr32 (DISPC_CONTROL, GOLCD);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
HwInitializeDisplay (\r
  UINTN VramBaseAddress,\r
  UINTN VramSize\r
  )\r
{\r
  EFI_STATUS    Status;\r
  UINT8         Data;\r
  EFI_TPL       OldTpl;\r
  EMBEDDED_EXTERNAL_DEVICE   *gTPS65950;\r
\r
  // Enable power lines used by TFP410\r
  Status = gBS->LocateProtocol (&gEmbeddedExternalDeviceProtocolGuid, NULL, (VOID **)&gTPS65950);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  OldTpl = gBS->RaiseTPL(TPL_NOTIFY);\r
  Data = VAUX_DEV_GRP_P1;\r
  Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEV_GRP), 1, &Data);\r
  ASSERT_EFI_ERROR(Status);\r
\r
  Data = VAUX_DEDICATED_18V;\r
  Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEDICATED), 1, &Data);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  // Power up TFP410 (set GPIO2 on TPS - for BeagleBoard-xM)\r
  Status = gTPS65950->Read (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);\r
  ASSERT_EFI_ERROR (Status);\r
  Data |= BIT2;\r
  Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Data = BIT2;\r
  Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, SETGPIODATAOUT1), 1, &Data);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  gBS->RestoreTPL(OldTpl);\r
\r
  // Power up TFP410 (set GPIO 170 - for older BeagleBoards)\r
  MmioAnd32 (GPIO6_BASE + GPIO_OE, ~BIT10);\r
  MmioOr32  (GPIO6_BASE + GPIO_SETDATAOUT, BIT10);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
InitializeDisplay (\r
  IN LCD_INSTANCE* Instance\r
  )\r
{\r
  EFI_STATUS           Status;\r
  UINTN                VramSize;\r
  EFI_PHYSICAL_ADDRESS VramBaseAddress;\r
\r
  Status = LcdPlatformGetVram (&VramBaseAddress, &VramSize);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Instance->Mode.FrameBufferBase = VramBaseAddress;\r
  Instance->Mode.FrameBufferSize = VramSize;\r
\r
  Status = HwInitializeDisplay((UINTN)VramBaseAddress, VramSize);\r
  if (!EFI_ERROR (Status)) {\r
    mDisplayInitialized = TRUE;\r
  }\r
\r
  return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
LcdGraphicsQueryMode (\r
  IN EFI_GRAPHICS_OUTPUT_PROTOCOL            *This,\r
  IN UINT32                                  ModeNumber,\r
  OUT UINTN                                  *SizeOfInfo,\r
  OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION   **Info\r
  )\r
{\r
  LCD_INSTANCE  *Instance;\r
\r
  Instance = LCD_INSTANCE_FROM_GOP_THIS(This);\r
\r
  if (!mDisplayInitialized) {\r
    InitializeDisplay (Instance);\r
  }\r
\r
  // Error checking\r
  if ( (This == NULL) || (Info == NULL) || (SizeOfInfo == NULL) || (ModeNumber >= This->Mode->MaxMode) ) {\r
    DEBUG((DEBUG_ERROR, "LcdGraphicsQueryMode: ERROR - For mode number %d : Invalid Parameter.\n", ModeNumber ));\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  *Info = AllocateCopyPool(sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), &Instance->ModeInfo);\r
  if (*Info == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  *SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);\r
\r
  (*Info)->Version = 0;\r
  (*Info)->HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;\r
  (*Info)->VerticalResolution = LcdModes[ModeNumber].VerticalResolution;\r
  (*Info)->PixelFormat = PixelBltOnly;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
LcdGraphicsSetMode (\r
  IN EFI_GRAPHICS_OUTPUT_PROTOCOL   *This,\r
  IN UINT32                         ModeNumber\r
  )\r
{\r
  LCD_INSTANCE  *Instance;\r
\r
  Instance = LCD_INSTANCE_FROM_GOP_THIS(This);\r
\r
  if (ModeNumber >= Instance->Mode.MaxMode) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  if (!mDisplayInitialized) {\r
    InitializeDisplay (Instance);\r
  }\r
\r
  DssSetMode((UINT32)Instance->Mode.FrameBufferBase, ModeNumber);\r
\r
  Instance->Mode.Mode = ModeNumber;\r
  Instance->ModeInfo.HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;\r
  Instance->ModeInfo.VerticalResolution = LcdModes[ModeNumber].VerticalResolution;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
LcdGraphicsOutputDxeInitialize (\r
  IN EFI_HANDLE         ImageHandle,\r
  IN EFI_SYSTEM_TABLE   *SystemTable\r
  )\r
{\r
  EFI_STATUS Status = EFI_SUCCESS;\r
  LCD_INSTANCE* Instance;\r
\r
  Status = LcdInstanceContructor (&Instance);\r
  if (EFI_ERROR(Status)) {\r
    goto EXIT;\r
  }\r
\r
  // Install the Graphics Output Protocol and the Device Path\r
  Status = gBS->InstallMultipleProtocolInterfaces(\r
             &Instance->Handle,\r
             &gEfiGraphicsOutputProtocolGuid, &Instance->Gop,\r
             &gEfiDevicePathProtocolGuid,     &Instance->DevicePath,\r
             NULL\r
             );\r
\r
  if (EFI_ERROR(Status)) {\r
    DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the protocol. Exit Status=%r\n", Status));\r
    goto EXIT;\r
  }\r
\r
  // Register for an ExitBootServicesEvent\r
  // When ExitBootServices starts, this function here will make sure that the graphics driver will shut down properly,\r
  // i.e. it will free up all allocated memory and perform any necessary hardware re-configuration.\r
  /*Status = gBS->CreateEvent (\r
               EVT_SIGNAL_EXIT_BOOT_SERVICES,\r
               TPL_NOTIFY,\r
               LcdGraphicsExitBootServicesEvent, NULL,\r
               &Instance->ExitBootServicesEvent\r
               );\r
\r
  if (EFI_ERROR(Status)) {\r
    DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the ExitBootServicesEvent handler. Exit Status=%r\n", Status));\r
    goto EXIT_ERROR_UNINSTALL_PROTOCOL;\r
  }*/\r
\r
  // To get here, everything must be fine, so just exit\r
  goto EXIT;\r
\r
//EXIT_ERROR_UNINSTALL_PROTOCOL:\r
  /* The following function could return an error message,\r
   * however, to get here something must have gone wrong already,\r
   * so preserve the original error, i.e. don't change\r
   * the Status variable, even it fails to uninstall the protocol.\r
   */\r
  /*  gBS->UninstallMultipleProtocolInterfaces (\r
        Instance->Handle,\r
        &gEfiGraphicsOutputProtocolGuid, &Instance->Gop, // Uninstall Graphics Output protocol\r
        &gEfiDevicePathProtocolGuid,     &Instance->DevicePath,     // Uninstall device path\r
        NULL\r
        );*/\r
\r
EXIT:\r
  return Status;\r
\r
}\r
Commit	Line	Data
1e57a462	1	/** @file\r
1e57a462	2	\r
b0fdce95	3	Copyright (c) 2011-2014, ARM Ltd. All rights reserved.<BR>\r
1e57a462	4	This program and the accompanying materials\r
	5	are licensed and made available under the terms and conditions of the BSD License\r
	6	which accompanies this distribution. The full text of the license may be found at\r
	7	http://opensource.org/licenses/bsd-license.php\r
	8	\r
	9	THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
	10	WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
	11	\r
	12	**/\r
	13	\r
	14	#include "LcdGraphicsOutputDxe.h"\r
	15	\r
	16	BOOLEAN mDisplayInitialized = FALSE;\r
	17	\r
	18	LCD_MODE LcdModes[] = {\r
	19	{\r
	20	0, 640, 480,\r
	21	9, 4,\r
	22	96, 16, 48,\r
	23	2, 10, 33\r
	24	},\r
	25	{\r
	26	1, 800, 600,\r
	27	11, 2,\r
	28	120, 56, 64,\r
	29	5, 37, 22\r
	30	},\r
	31	{\r
	32	2, 1024, 768,\r
	33	6, 2,\r
	34	96, 16, 48,\r
	35	2, 10, 33\r
	36	},\r
	37	};\r
	38	\r
	39	LCD_INSTANCE mLcdTemplate = {\r
	40	LCD_INSTANCE_SIGNATURE,\r
	41	NULL, // Handle\r
	42	{ // ModeInfo\r
	43	0, // Version\r
	44	0, // HorizontalResolution\r
	45	0, // VerticalResolution\r
	46	PixelBltOnly, // PixelFormat\r
	47	{\r
	48	0xF800, //RedMask;\r
	49	0x7E0, //GreenMask;\r
	50	0x1F, //BlueMask;\r
	51	0x0//ReservedMask\r
	52	}, // PixelInformation\r
	53	0, // PixelsPerScanLine\r
	54	},\r
	55	{ // Mode\r
	56	3, // MaxMode;\r
	57	0, // Mode;\r
	58	NULL, // Info;\r
	59	0, // SizeOfInfo;\r
	60	0, // FrameBufferBase;\r
	61	0 // FrameBufferSize;\r
	62	},\r
	63	{ // Gop\r
	64	LcdGraphicsQueryMode, // QueryMode\r
	65	LcdGraphicsSetMode, // SetMode\r
	66	LcdGraphicsBlt, // Blt\r
	67	NULL // *Mode\r
68	},\r
69	{ // DevicePath\r
70	{\r
71	{\r
72	HARDWARE_DEVICE_PATH, HW_VENDOR_DP,\r
b0fdce95	73	{ (UINT8) (sizeof(VENDOR_DEVICE_PATH)), (UINT8) ((sizeof(VENDOR_DEVICE_PATH)) >> 8) },\r
1e57a462	74	},\r
	75	// Hardware Device Path for Lcd\r
	76	EFI_CALLER_ID_GUID // Use the driver's GUID\r
	77	},\r
1e57a462	78	{\r
	79	END_DEVICE_PATH_TYPE,\r
	80	END_ENTIRE_DEVICE_PATH_SUBTYPE,\r
b0fdce95	81	{ sizeof(EFI_DEVICE_PATH_PROTOCOL), 0}\r
1e57a462	82	}\r
	83	}\r
	84	};\r
	85	\r
	86	EFI_STATUS\r
	87	LcdInstanceContructor (\r
	88	OUT LCD_INSTANCE** NewInstance\r
	89	)\r
	90	{\r
	91	LCD_INSTANCE* Instance;\r
	92	\r
	93	Instance = AllocateCopyPool (sizeof(LCD_INSTANCE), &mLcdTemplate);\r
	94	if (Instance == NULL) {\r
	95	return EFI_OUT_OF_RESOURCES;\r
	96	}\r
	97	\r
	98	Instance->Gop.Mode = &Instance->Mode;\r
	99	Instance->Mode.Info = &Instance->ModeInfo;\r
	100	\r
	101	*NewInstance = Instance;\r
	102	return EFI_SUCCESS;\r
	103	}\r
	104	\r
	105	EFI_STATUS\r
	106	LcdPlatformGetVram (\r
	107	OUT EFI_PHYSICAL_ADDRESS* VramBaseAddress,\r
	108	OUT UINTN* VramSize\r
	109	)\r
	110	{\r
	111	EFI_STATUS Status;\r
	112	EFI_CPU_ARCH_PROTOCOL *Cpu;\r
	113	UINTN MaxSize;\r
	114	\r
	115	MaxSize = 0x500000;\r
	116	*VramSize = MaxSize;\r
	117	\r
	118	// Allocate VRAM from DRAM\r
	119	Status = gBS->AllocatePages (AllocateAnyPages, EfiBootServicesData, EFI_SIZE_TO_PAGES((MaxSize)), VramBaseAddress);\r
	120	if (EFI_ERROR(Status)) {\r
	121	return Status;\r
	122	}\r
	123	\r
	124	// Ensure the Cpu architectural protocol is already installed\r
	125	Status = gBS->LocateProtocol (&gEfiCpuArchProtocolGuid, NULL, (VOID **)&Cpu);\r
	126	ASSERT_EFI_ERROR(Status);\r
	127	\r
	128	// Mark the VRAM as un-cacheable. The VRAM is inside the DRAM, which is cacheable.\r
	129	Status = Cpu->SetMemoryAttributes (Cpu, VramBaseAddress, VramSize, EFI_MEMORY_UC);\r
	130	if (EFI_ERROR(Status)) {\r
	131	gBS->FreePool (VramBaseAddress);\r
	132	return Status;\r
	133	}\r
	134	\r
	135	return EFI_SUCCESS;\r
	136	}\r
	137	\r
	138	EFI_STATUS\r
	139	DssSetMode (\r
	140	UINT32 VramBaseAddress,\r
	141	UINTN ModeNumber\r
	142	)\r
	143	{\r
	144	// Make sure the interface clock is running\r
3402aac7	145	MmioWrite32 (CM_ICLKEN_DSS, EN_DSS);\r
1e57a462	146	\r
	147	// Stop the functional clocks\r
	148	MmioAnd32 (CM_FCLKEN_DSS, ~(EN_DSS1 \| EN_DSS2 \| EN_TV));\r
	149	\r
	150	// Program the DSS clock divisor\r
	151	MmioWrite32 (CM_CLKSEL_DSS, 0x1000 \| (LcdModes[ModeNumber].DssDivisor));\r
3402aac7	152	\r
1e57a462	153	// Start the functional clocks\r
	154	MmioOr32 (CM_FCLKEN_DSS, (EN_DSS1 \| EN_DSS2 \| EN_TV));\r
	155	\r
	156	// Wait for DSS to stabilize\r
	157	gBS->Stall(1);\r
	158	\r
	159	// Reset the subsystem\r
	160	MmioWrite32(DSS_SYSCONFIG, DSS_SOFTRESET);\r
	161	while (!(MmioRead32 (DSS_SYSSTATUS) & DSS_RESETDONE));\r
3402aac7	162	\r
1e57a462	163	// Configure LCD parameters\r
1e57a462	164	MmioWrite32 (DISPC_SIZE_LCD,\r
3402aac7	165	((LcdModes[ModeNumber].HorizontalResolution - 1)\r
1e57a462	166	\| ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))\r
	167	);\r
	168	MmioWrite32 (DISPC_TIMING_H,\r
	169	( (LcdModes[ModeNumber].HSync - 1)\r
	170	\| ((LcdModes[ModeNumber].HFrontPorch - 1) << 8)\r
	171	\| ((LcdModes[ModeNumber].HBackPorch - 1) << 20))\r
	172	);\r
	173	MmioWrite32 (DISPC_TIMING_V,\r
	174	( (LcdModes[ModeNumber].VSync - 1)\r
	175	\| ((LcdModes[ModeNumber].VFrontPorch - 1) << 8)\r
	176	\| ((LcdModes[ModeNumber].VBackPorch - 1) << 20))\r
	177	);\r
	178	\r
	179	// Set the framebuffer to only load frames (no gamma tables)\r
	180	MmioAnd32 (DISPC_CONFIG, CLEARLOADMODE);\r
	181	MmioOr32 (DISPC_CONFIG, LOAD_FRAME_ONLY);\r
	182	\r
	183	// Divisor for the pixel clock\r
	184	MmioWrite32(DISPC_DIVISOR, ((1 << 16) \| LcdModes[ModeNumber].DispcDivisor) );\r
	185	\r
	186	// Set up the graphics layer\r
	187	MmioWrite32 (DISPC_GFX_PRELD, 0x2D8);\r
	188	MmioWrite32 (DISPC_GFX_BA0, VramBaseAddress);\r
	189	MmioWrite32 (DISPC_GFX_SIZE,\r
3402aac7	190	((LcdModes[ModeNumber].HorizontalResolution - 1)\r
1e57a462	191	\| ((LcdModes[ModeNumber].VerticalResolution - 1) << 16))\r
	192	);\r
	193	\r
	194	MmioWrite32(DISPC_GFX_ATTR, (GFXENABLE \| RGB16 \| BURSTSIZE16));\r
	195	\r
	196	// Start it all\r
	197	MmioOr32 (DISPC_CONTROL, (LCDENABLE \| ACTIVEMATRIX \| DATALINES24 \| BYPASS_MODE \| LCDENABLESIGNAL));\r
	198	MmioOr32 (DISPC_CONTROL, GOLCD);\r
	199	\r
	200	return EFI_SUCCESS;\r
	201	}\r
	202	\r
	203	EFI_STATUS\r
	204	HwInitializeDisplay (\r
	205	UINTN VramBaseAddress,\r
	206	UINTN VramSize\r
	207	)\r
	208	{\r
	209	EFI_STATUS Status;\r
	210	UINT8 Data;\r
	211	EFI_TPL OldTpl;\r
	212	EMBEDDED_EXTERNAL_DEVICE *gTPS65950;\r
	213	\r
	214	// Enable power lines used by TFP410\r
	215	Status = gBS->LocateProtocol (&gEmbeddedExternalDeviceProtocolGuid, NULL, (VOID **)&gTPS65950);\r
3402aac7	216	ASSERT_EFI_ERROR (Status);\r
1e57a462	217	\r
	218	OldTpl = gBS->RaiseTPL(TPL_NOTIFY);\r
	219	Data = VAUX_DEV_GRP_P1;\r
	220	Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEV_GRP), 1, &Data);\r
	221	ASSERT_EFI_ERROR(Status);\r
	222	\r
	223	Data = VAUX_DEDICATED_18V;\r
	224	Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID4, VPLL2_DEDICATED), 1, &Data);\r
3402aac7	225	ASSERT_EFI_ERROR (Status);\r
1e57a462	226	\r
	227	// Power up TFP410 (set GPIO2 on TPS - for BeagleBoard-xM)\r
	228	Status = gTPS65950->Read (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);\r
	229	ASSERT_EFI_ERROR (Status);\r
	230	Data \|= BIT2;\r
	231	Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, GPIODATADIR1), 1, &Data);\r
	232	ASSERT_EFI_ERROR (Status);\r
	233	\r
	234	Data = BIT2;\r
	235	Status = gTPS65950->Write (gTPS65950, EXTERNAL_DEVICE_REGISTER(I2C_ADDR_GRP_ID2, SETGPIODATAOUT1), 1, &Data);\r
	236	ASSERT_EFI_ERROR (Status);\r
	237	\r
	238	gBS->RestoreTPL(OldTpl);\r
	239	\r
	240	// Power up TFP410 (set GPIO 170 - for older BeagleBoards)\r
	241	MmioAnd32 (GPIO6_BASE + GPIO_OE, ~BIT10);\r
3402aac7	242	MmioOr32 (GPIO6_BASE + GPIO_SETDATAOUT, BIT10);\r
1e57a462	243	\r
	244	return EFI_SUCCESS;\r
	245	}\r
	246	\r
	247	EFI_STATUS\r
	248	InitializeDisplay (\r
	249	IN LCD_INSTANCE* Instance\r
	250	)\r
	251	{\r
3402aac7	252	EFI_STATUS Status;\r
1e57a462	253	UINTN VramSize;\r
	254	EFI_PHYSICAL_ADDRESS VramBaseAddress;\r
	255	\r
	256	Status = LcdPlatformGetVram (&VramBaseAddress, &VramSize);\r
	257	if (EFI_ERROR (Status)) {\r
	258	return Status;\r
	259	}\r
	260	\r
	261	Instance->Mode.FrameBufferBase = VramBaseAddress;\r
	262	Instance->Mode.FrameBufferSize = VramSize;\r
	263	\r
	264	Status = HwInitializeDisplay((UINTN)VramBaseAddress, VramSize);\r
	265	if (!EFI_ERROR (Status)) {\r
	266	mDisplayInitialized = TRUE;\r
	267	}\r
	268	\r
	269	return Status;\r
	270	}\r
	271	\r
	272	EFI_STATUS\r
	273	EFIAPI\r
	274	LcdGraphicsQueryMode (\r
	275	IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r
91c38d4e RC	276	IN UINT32 ModeNumber,\r
	277	OUT UINTN *SizeOfInfo,\r
	278	OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION **Info\r
	279	)\r
1e57a462	280	{\r
91c38d4e	281	LCD_INSTANCE *Instance;\r
1e57a462	282	\r
91c38d4e	283	Instance = LCD_INSTANCE_FROM_GOP_THIS(This);\r
1e57a462	284	\r
	285	if (!mDisplayInitialized) {\r
	286	InitializeDisplay (Instance);\r
	287	}\r
	288	\r
	289	// Error checking\r
91c38d4e RC	290	if ( (This == NULL) \|\| (Info == NULL) \|\| (SizeOfInfo == NULL) \|\| (ModeNumber >= This->Mode->MaxMode) ) {\r
	291	DEBUG((DEBUG_ERROR, "LcdGraphicsQueryMode: ERROR - For mode number %d : Invalid Parameter.\n", ModeNumber ));\r
	292	return EFI_INVALID_PARAMETER;\r
	293	}\r
1e57a462	294	\r
	295	*Info = AllocateCopyPool(sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), &Instance->ModeInfo);\r
	296	if (*Info == NULL) {\r
	297	return EFI_OUT_OF_RESOURCES;\r
	298	}\r
	299	\r
	300	*SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);\r
	301	\r
	302	(*Info)->Version = 0;\r
	303	(*Info)->HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;\r
	304	(*Info)->VerticalResolution = LcdModes[ModeNumber].VerticalResolution;\r
	305	(*Info)->PixelFormat = PixelBltOnly;\r
	306	\r
	307	return EFI_SUCCESS;\r
	308	}\r
	309	\r
	310	EFI_STATUS\r
	311	EFIAPI\r
	312	LcdGraphicsSetMode (\r
	313	IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r
91c38d4e RC	314	IN UINT32 ModeNumber\r
91c38d4e RC	315	)\r
1e57a462	316	{\r
91c38d4e	317	LCD_INSTANCE *Instance;\r
1e57a462	318	\r
91c38d4e	319	Instance = LCD_INSTANCE_FROM_GOP_THIS(This);\r
1e57a462	320	\r
	321	if (ModeNumber >= Instance->Mode.MaxMode) {\r
	322	return EFI_UNSUPPORTED;\r
	323	}\r
	324	\r
	325	if (!mDisplayInitialized) {\r
	326	InitializeDisplay (Instance);\r
	327	}\r
	328	\r
	329	DssSetMode((UINT32)Instance->Mode.FrameBufferBase, ModeNumber);\r
	330	\r
	331	Instance->Mode.Mode = ModeNumber;\r
	332	Instance->ModeInfo.HorizontalResolution = LcdModes[ModeNumber].HorizontalResolution;\r
	333	Instance->ModeInfo.VerticalResolution = LcdModes[ModeNumber].VerticalResolution;\r
	334	\r
	335	return EFI_SUCCESS;\r
	336	}\r
	337	\r
	338	EFI_STATUS\r
	339	EFIAPI\r
	340	LcdGraphicsOutputDxeInitialize (\r
	341	IN EFI_HANDLE ImageHandle,\r
	342	IN EFI_SYSTEM_TABLE *SystemTable\r
	343	)\r
	344	{\r
	345	EFI_STATUS Status = EFI_SUCCESS;\r
	346	LCD_INSTANCE* Instance;\r
	347	\r
	348	Status = LcdInstanceContructor (&Instance);\r
	349	if (EFI_ERROR(Status)) {\r
	350	goto EXIT;\r
	351	}\r
	352	\r
91c38d4e RC	353	// Install the Graphics Output Protocol and the Device Path\r
	354	Status = gBS->InstallMultipleProtocolInterfaces(\r
	355	&Instance->Handle,\r
	356	&gEfiGraphicsOutputProtocolGuid, &Instance->Gop,\r
	357	&gEfiDevicePathProtocolGuid, &Instance->DevicePath,\r
	358	NULL\r
	359	);\r
1e57a462	360	\r
91c38d4e RC	361	if (EFI_ERROR(Status)) {\r
	362	DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the protocol. Exit Status=%r\n", Status));\r
	363	goto EXIT;\r
	364	}\r
1e57a462	365	\r
1e57a462	366	// Register for an ExitBootServicesEvent\r
91c38d4e RC	367	// When ExitBootServices starts, this function here will make sure that the graphics driver will shut down properly,\r
	368	// i.e. it will free up all allocated memory and perform any necessary hardware re-configuration.\r
	369	/*Status = gBS->CreateEvent (\r
	370	EVT_SIGNAL_EXIT_BOOT_SERVICES,\r
	371	TPL_NOTIFY,\r
	372	LcdGraphicsExitBootServicesEvent, NULL,\r
	373	&Instance->ExitBootServicesEvent\r
	374	);\r
	375	\r
	376	if (EFI_ERROR(Status)) {\r
	377	DEBUG((DEBUG_ERROR, "GraphicsOutputDxeInitialize: Can not install the ExitBootServicesEvent handler. Exit Status=%r\n", Status));\r
	378	goto EXIT_ERROR_UNINSTALL_PROTOCOL;\r
	379	}*/\r
	380	\r
	381	// To get here, everything must be fine, so just exit\r
	382	goto EXIT;\r
1e57a462	383	\r
1e57a462	384	//EXIT_ERROR_UNINSTALL_PROTOCOL:\r
91c38d4e RC	385	/* The following function could return an error message,\r
	386	* however, to get here something must have gone wrong already,\r
	387	* so preserve the original error, i.e. don't change\r
	388	* the Status variable, even it fails to uninstall the protocol.\r
	389	*/\r
	390	/* gBS->UninstallMultipleProtocolInterfaces (\r
	391	Instance->Handle,\r
	392	&gEfiGraphicsOutputProtocolGuid, &Instance->Gop, // Uninstall Graphics Output protocol\r
	393	&gEfiDevicePathProtocolGuid, &Instance->DevicePath, // Uninstall device path\r
	394	NULL\r
	395	);*/\r
1e57a462	396	\r
1e57a462	397	EXIT:\r
91c38d4e	398	return Status;\r
1e57a462	399	\r
1e57a462	400	}\r