mirror of https://github.com/acidanthera/audk.git
1008 lines
28 KiB
C
1008 lines
28 KiB
C
/** @file
|
|
BDS Lib functions which contain all the code to connect console device
|
|
|
|
Copyright (c) 2004 - 2010, Intel Corporation. All rights reserved.<BR>
|
|
This program and the accompanying materials
|
|
are licensed and made available under the terms and conditions of the BSD License
|
|
which accompanies this distribution. The full text of the license may be found at
|
|
http://opensource.org/licenses/bsd-license.php
|
|
|
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
|
|
|
**/
|
|
|
|
#include "InternalBdsLib.h"
|
|
#include "Bmp.h"
|
|
|
|
/**
|
|
Check if we need to save the EFI variable with "ConVarName" as name
|
|
as NV type
|
|
If ConVarName is NULL, then ASSERT().
|
|
|
|
@param ConVarName The name of the EFI variable.
|
|
|
|
@retval TRUE Set the EFI variable as NV type.
|
|
@retval FALSE EFI variable as NV type can be set NonNV.
|
|
**/
|
|
BOOLEAN
|
|
IsNvNeed (
|
|
IN CHAR16 *ConVarName
|
|
)
|
|
{
|
|
CHAR16 *Ptr;
|
|
|
|
ASSERT (ConVarName != NULL);
|
|
|
|
Ptr = ConVarName;
|
|
|
|
//
|
|
// If the variable includes "Dev" at last, we consider
|
|
// it does not support NV attribute.
|
|
//
|
|
while (*Ptr != L'\0') {
|
|
Ptr++;
|
|
}
|
|
|
|
if (((INTN)((UINTN)Ptr - (UINTN)ConVarName) / sizeof (CHAR16)) <= 3) {
|
|
return TRUE;
|
|
}
|
|
|
|
if ((*(Ptr - 3) == 'D') && (*(Ptr - 2) == 'e') && (*(Ptr - 1) == 'v')) {
|
|
return FALSE;
|
|
} else {
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
/**
|
|
Fill console handle in System Table if there are no valid console handle in.
|
|
|
|
Firstly, check the validation of console handle in System Table. If it is invalid,
|
|
update it by the first console device handle from EFI console variable.
|
|
|
|
@param VarName The name of the EFI console variable.
|
|
@param ConsoleGuid Specified Console protocol GUID.
|
|
@param ConsoleHandle On IN, console handle in System Table to be checked.
|
|
On OUT, new console hanlde in system table.
|
|
@param ProtocolInterface On IN, console protocol on console handle in System Table to be checked.
|
|
On OUT, new console protocol on new console hanlde in system table.
|
|
|
|
@retval TRUE System Table has been updated.
|
|
@retval FALSE System Table hasn't been updated.
|
|
|
|
**/
|
|
BOOLEAN
|
|
UpdateSystemTableConsole (
|
|
IN CHAR16 *VarName,
|
|
IN EFI_GUID *ConsoleGuid,
|
|
IN OUT EFI_HANDLE *ConsoleHandle,
|
|
IN OUT VOID **ProtocolInterface
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
UINTN DevicePathSize;
|
|
EFI_DEVICE_PATH_PROTOCOL *FullDevicePath;
|
|
EFI_DEVICE_PATH_PROTOCOL *VarConsole;
|
|
EFI_DEVICE_PATH_PROTOCOL *Instance;
|
|
VOID *Interface;
|
|
EFI_HANDLE NewHandle;
|
|
|
|
ASSERT (VarName != NULL);
|
|
ASSERT (ConsoleHandle != NULL);
|
|
ASSERT (ConsoleGuid != NULL);
|
|
ASSERT (ProtocolInterface != NULL);
|
|
|
|
if (*ConsoleHandle != NULL) {
|
|
Status = gBS->HandleProtocol (
|
|
*ConsoleHandle,
|
|
ConsoleGuid,
|
|
&Interface
|
|
);
|
|
if (Status == EFI_SUCCESS && Interface == *ProtocolInterface) {
|
|
//
|
|
// If ConsoleHandle is valid and console protocol on this handle also
|
|
// also matched, just return.
|
|
//
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
//
|
|
// Get all possible consoles device path from EFI variable
|
|
//
|
|
VarConsole = BdsLibGetVariableAndSize (
|
|
VarName,
|
|
&gEfiGlobalVariableGuid,
|
|
&DevicePathSize
|
|
);
|
|
if (VarConsole == NULL) {
|
|
//
|
|
// If there is no any console device, just return.
|
|
//
|
|
return FALSE;
|
|
}
|
|
|
|
FullDevicePath = VarConsole;
|
|
|
|
do {
|
|
//
|
|
// Check every instance of the console variable
|
|
//
|
|
Instance = GetNextDevicePathInstance (&VarConsole, &DevicePathSize);
|
|
if (Instance == NULL) {
|
|
FreePool (FullDevicePath);
|
|
ASSERT (FALSE);
|
|
}
|
|
|
|
//
|
|
// Find console device handle by device path instance
|
|
//
|
|
Status = gBS->LocateDevicePath (
|
|
ConsoleGuid,
|
|
&Instance,
|
|
&NewHandle
|
|
);
|
|
if (!EFI_ERROR (Status)) {
|
|
//
|
|
// Get the console protocol on this console device handle
|
|
//
|
|
Status = gBS->HandleProtocol (
|
|
NewHandle,
|
|
ConsoleGuid,
|
|
&Interface
|
|
);
|
|
if (!EFI_ERROR (Status)) {
|
|
//
|
|
// Update new console handle in System Table.
|
|
//
|
|
*ConsoleHandle = NewHandle;
|
|
*ProtocolInterface = Interface;
|
|
return TRUE;
|
|
}
|
|
}
|
|
|
|
} while (Instance != NULL);
|
|
|
|
//
|
|
// No any available console devcie found.
|
|
//
|
|
return FALSE;
|
|
}
|
|
|
|
/**
|
|
This function update console variable based on ConVarName, it can
|
|
add or remove one specific console device path from the variable
|
|
|
|
@param ConVarName Console related variable name, ConIn, ConOut,
|
|
ErrOut.
|
|
@param CustomizedConDevicePath The console device path which will be added to
|
|
the console variable ConVarName, this parameter
|
|
can not be multi-instance.
|
|
@param ExclusiveDevicePath The console device path which will be removed
|
|
from the console variable ConVarName, this
|
|
parameter can not be multi-instance.
|
|
|
|
@retval EFI_UNSUPPORTED The added device path is same to the removed one.
|
|
@retval EFI_SUCCESS Success add or remove the device path from the
|
|
console variable.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
BdsLibUpdateConsoleVariable (
|
|
IN CHAR16 *ConVarName,
|
|
IN EFI_DEVICE_PATH_PROTOCOL *CustomizedConDevicePath,
|
|
IN EFI_DEVICE_PATH_PROTOCOL *ExclusiveDevicePath
|
|
)
|
|
{
|
|
EFI_DEVICE_PATH_PROTOCOL *VarConsole;
|
|
UINTN DevicePathSize;
|
|
EFI_DEVICE_PATH_PROTOCOL *NewDevicePath;
|
|
EFI_DEVICE_PATH_PROTOCOL *TempNewDevicePath;
|
|
UINT32 Attributes;
|
|
|
|
VarConsole = NULL;
|
|
DevicePathSize = 0;
|
|
|
|
//
|
|
// Notes: check the device path point, here should check
|
|
// with compare memory
|
|
//
|
|
if (CustomizedConDevicePath == ExclusiveDevicePath) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
//
|
|
// Delete the ExclusiveDevicePath from current default console
|
|
//
|
|
VarConsole = BdsLibGetVariableAndSize (
|
|
ConVarName,
|
|
&gEfiGlobalVariableGuid,
|
|
&DevicePathSize
|
|
);
|
|
|
|
//
|
|
// Initialize NewDevicePath
|
|
//
|
|
NewDevicePath = VarConsole;
|
|
|
|
//
|
|
// If ExclusiveDevicePath is even the part of the instance in VarConsole, delete it.
|
|
// In the end, NewDevicePath is the final device path.
|
|
//
|
|
if (ExclusiveDevicePath != NULL && VarConsole != NULL) {
|
|
NewDevicePath = BdsLibDelPartMatchInstance (VarConsole, ExclusiveDevicePath);
|
|
}
|
|
//
|
|
// Try to append customized device path to NewDevicePath.
|
|
//
|
|
if (CustomizedConDevicePath != NULL) {
|
|
if (!BdsLibMatchDevicePaths (NewDevicePath, CustomizedConDevicePath)) {
|
|
//
|
|
// Check if there is part of CustomizedConDevicePath in NewDevicePath, delete it.
|
|
//
|
|
NewDevicePath = BdsLibDelPartMatchInstance (NewDevicePath, CustomizedConDevicePath);
|
|
//
|
|
// In the first check, the default console variable will be _ModuleEntryPoint,
|
|
// just append current customized device path
|
|
//
|
|
TempNewDevicePath = NewDevicePath;
|
|
NewDevicePath = AppendDevicePathInstance (NewDevicePath, CustomizedConDevicePath);
|
|
if (TempNewDevicePath != NULL) {
|
|
FreePool(TempNewDevicePath);
|
|
}
|
|
}
|
|
}
|
|
|
|
//
|
|
// The attribute for ConInDev, ConOutDev and ErrOutDev does not include NV.
|
|
//
|
|
if (IsNvNeed(ConVarName)) {
|
|
//
|
|
// ConVarName has NV attribute.
|
|
//
|
|
Attributes = EFI_VARIABLE_BOOTSERVICE_ACCESS | EFI_VARIABLE_RUNTIME_ACCESS | EFI_VARIABLE_NON_VOLATILE;
|
|
} else {
|
|
//
|
|
// ConVarName does not have NV attribute.
|
|
//
|
|
Attributes = EFI_VARIABLE_BOOTSERVICE_ACCESS | EFI_VARIABLE_RUNTIME_ACCESS;
|
|
}
|
|
|
|
//
|
|
// Finally, Update the variable of the default console by NewDevicePath
|
|
//
|
|
gRT->SetVariable (
|
|
ConVarName,
|
|
&gEfiGlobalVariableGuid,
|
|
Attributes,
|
|
GetDevicePathSize (NewDevicePath),
|
|
NewDevicePath
|
|
);
|
|
|
|
if (VarConsole == NewDevicePath) {
|
|
if (VarConsole != NULL) {
|
|
FreePool(VarConsole);
|
|
}
|
|
} else {
|
|
if (VarConsole != NULL) {
|
|
FreePool(VarConsole);
|
|
}
|
|
if (NewDevicePath != NULL) {
|
|
FreePool(NewDevicePath);
|
|
}
|
|
}
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
/**
|
|
Connect the console device base on the variable ConVarName, if
|
|
device path of the ConVarName is multi-instance device path, if
|
|
anyone of the instances is connected success, then this function
|
|
will return success.
|
|
|
|
@param ConVarName Console related variable name, ConIn, ConOut,
|
|
ErrOut.
|
|
|
|
@retval EFI_NOT_FOUND There is not any console devices connected
|
|
success
|
|
@retval EFI_SUCCESS Success connect any one instance of the console
|
|
device path base on the variable ConVarName.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
BdsLibConnectConsoleVariable (
|
|
IN CHAR16 *ConVarName
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EFI_DEVICE_PATH_PROTOCOL *StartDevicePath;
|
|
UINTN VariableSize;
|
|
EFI_DEVICE_PATH_PROTOCOL *Instance;
|
|
EFI_DEVICE_PATH_PROTOCOL *Next;
|
|
EFI_DEVICE_PATH_PROTOCOL *CopyOfDevicePath;
|
|
UINTN Size;
|
|
BOOLEAN DeviceExist;
|
|
|
|
Status = EFI_SUCCESS;
|
|
DeviceExist = FALSE;
|
|
|
|
//
|
|
// Check if the console variable exist
|
|
//
|
|
StartDevicePath = BdsLibGetVariableAndSize (
|
|
ConVarName,
|
|
&gEfiGlobalVariableGuid,
|
|
&VariableSize
|
|
);
|
|
if (StartDevicePath == NULL) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
CopyOfDevicePath = StartDevicePath;
|
|
do {
|
|
//
|
|
// Check every instance of the console variable
|
|
//
|
|
Instance = GetNextDevicePathInstance (&CopyOfDevicePath, &Size);
|
|
if (Instance == NULL) {
|
|
FreePool (StartDevicePath);
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
Next = Instance;
|
|
while (!IsDevicePathEndType (Next)) {
|
|
Next = NextDevicePathNode (Next);
|
|
}
|
|
|
|
SetDevicePathEndNode (Next);
|
|
//
|
|
// Connect the USB console
|
|
// USB console device path is a short-form device path that
|
|
// starts with the first element being a USB WWID
|
|
// or a USB Class device path
|
|
//
|
|
if ((DevicePathType (Instance) == MESSAGING_DEVICE_PATH) &&
|
|
((DevicePathSubType (Instance) == MSG_USB_CLASS_DP)
|
|
|| (DevicePathSubType (Instance) == MSG_USB_WWID_DP)
|
|
)) {
|
|
Status = BdsLibConnectUsbDevByShortFormDP (0xFF, Instance);
|
|
if (!EFI_ERROR (Status)) {
|
|
DeviceExist = TRUE;
|
|
}
|
|
} else {
|
|
//
|
|
// Connect the instance device path
|
|
//
|
|
Status = BdsLibConnectDevicePath (Instance);
|
|
if (EFI_ERROR (Status)) {
|
|
//
|
|
// Delete the instance from the console varialbe
|
|
//
|
|
BdsLibUpdateConsoleVariable (ConVarName, NULL, Instance);
|
|
} else {
|
|
DeviceExist = TRUE;
|
|
}
|
|
}
|
|
FreePool(Instance);
|
|
} while (CopyOfDevicePath != NULL);
|
|
|
|
FreePool (StartDevicePath);
|
|
|
|
if (!DeviceExist) {
|
|
return EFI_NOT_FOUND;
|
|
}
|
|
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
|
|
/**
|
|
This function will search every simpletext device in current system,
|
|
and make every simpletext device as pertantial console device.
|
|
|
|
**/
|
|
VOID
|
|
EFIAPI
|
|
BdsLibConnectAllConsoles (
|
|
VOID
|
|
)
|
|
{
|
|
UINTN Index;
|
|
EFI_DEVICE_PATH_PROTOCOL *ConDevicePath;
|
|
UINTN HandleCount;
|
|
EFI_HANDLE *HandleBuffer;
|
|
|
|
Index = 0;
|
|
HandleCount = 0;
|
|
HandleBuffer = NULL;
|
|
ConDevicePath = NULL;
|
|
|
|
//
|
|
// Update all the console variables
|
|
//
|
|
gBS->LocateHandleBuffer (
|
|
ByProtocol,
|
|
&gEfiSimpleTextInProtocolGuid,
|
|
NULL,
|
|
&HandleCount,
|
|
&HandleBuffer
|
|
);
|
|
|
|
for (Index = 0; Index < HandleCount; Index++) {
|
|
gBS->HandleProtocol (
|
|
HandleBuffer[Index],
|
|
&gEfiDevicePathProtocolGuid,
|
|
(VOID **) &ConDevicePath
|
|
);
|
|
BdsLibUpdateConsoleVariable (L"ConIn", ConDevicePath, NULL);
|
|
}
|
|
|
|
if (HandleBuffer != NULL) {
|
|
FreePool(HandleBuffer);
|
|
HandleBuffer = NULL;
|
|
}
|
|
|
|
gBS->LocateHandleBuffer (
|
|
ByProtocol,
|
|
&gEfiSimpleTextOutProtocolGuid,
|
|
NULL,
|
|
&HandleCount,
|
|
&HandleBuffer
|
|
);
|
|
for (Index = 0; Index < HandleCount; Index++) {
|
|
gBS->HandleProtocol (
|
|
HandleBuffer[Index],
|
|
&gEfiDevicePathProtocolGuid,
|
|
(VOID **) &ConDevicePath
|
|
);
|
|
BdsLibUpdateConsoleVariable (L"ConOut", ConDevicePath, NULL);
|
|
BdsLibUpdateConsoleVariable (L"ErrOut", ConDevicePath, NULL);
|
|
}
|
|
|
|
if (HandleBuffer != NULL) {
|
|
FreePool(HandleBuffer);
|
|
}
|
|
|
|
//
|
|
// Connect all console variables
|
|
//
|
|
BdsLibConnectAllDefaultConsoles ();
|
|
|
|
}
|
|
|
|
/**
|
|
This function will connect console device base on the console
|
|
device variable ConIn, ConOut and ErrOut.
|
|
|
|
@retval EFI_SUCCESS At least one of the ConIn and ConOut device have
|
|
been connected success.
|
|
@retval EFI_STATUS Return the status of BdsLibConnectConsoleVariable ().
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
BdsLibConnectAllDefaultConsoles (
|
|
VOID
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
BOOLEAN SystemTableUpdated;
|
|
|
|
//
|
|
// Connect all default console variables
|
|
//
|
|
|
|
//
|
|
// It seems impossible not to have any ConOut device on platform,
|
|
// so we check the status here.
|
|
//
|
|
Status = BdsLibConnectConsoleVariable (L"ConOut");
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
//
|
|
// Insert the performance probe for Console Out
|
|
//
|
|
PERF_START (NULL, "ConOut", "BDS", 1);
|
|
PERF_END (NULL, "ConOut", "BDS", 0);
|
|
|
|
//
|
|
// Because possibly the platform is legacy free, in such case,
|
|
// ConIn devices (Serial Port and PS2 Keyboard ) does not exist,
|
|
// so we need not check the status.
|
|
//
|
|
BdsLibConnectConsoleVariable (L"ConIn");
|
|
|
|
//
|
|
// The _ModuleEntryPoint err out var is legal.
|
|
//
|
|
BdsLibConnectConsoleVariable (L"ErrOut");
|
|
|
|
SystemTableUpdated = FALSE;
|
|
//
|
|
// Fill console handles in System Table if no console device assignd.
|
|
//
|
|
if (UpdateSystemTableConsole (L"ConIn", &gEfiSimpleTextInProtocolGuid, &gST->ConsoleInHandle, (VOID **) &gST->ConIn)) {
|
|
SystemTableUpdated = TRUE;
|
|
}
|
|
if (UpdateSystemTableConsole (L"ConOut", &gEfiSimpleTextOutProtocolGuid, &gST->ConsoleOutHandle, (VOID **) &gST->ConOut)) {
|
|
SystemTableUpdated = TRUE;
|
|
}
|
|
if (UpdateSystemTableConsole (L"ErrOut", &gEfiSimpleTextOutProtocolGuid, &gST->StandardErrorHandle, (VOID **) &gST->StdErr)) {
|
|
SystemTableUpdated = TRUE;
|
|
}
|
|
|
|
if (SystemTableUpdated) {
|
|
//
|
|
// Update the CRC32 in the EFI System Table header
|
|
//
|
|
gST->Hdr.CRC32 = 0;
|
|
gBS->CalculateCrc32 (
|
|
(UINT8 *) &gST->Hdr,
|
|
gST->Hdr.HeaderSize,
|
|
&gST->Hdr.CRC32
|
|
);
|
|
}
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
/**
|
|
Convert a *.BMP graphics image to a GOP blt buffer. If a NULL Blt buffer
|
|
is passed in a GopBlt buffer will be allocated by this routine. If a GopBlt
|
|
buffer is passed in it will be used if it is big enough.
|
|
|
|
@param BmpImage Pointer to BMP file
|
|
@param BmpImageSize Number of bytes in BmpImage
|
|
@param GopBlt Buffer containing GOP version of BmpImage.
|
|
@param GopBltSize Size of GopBlt in bytes.
|
|
@param PixelHeight Height of GopBlt/BmpImage in pixels
|
|
@param PixelWidth Width of GopBlt/BmpImage in pixels
|
|
|
|
@retval EFI_SUCCESS GopBlt and GopBltSize are returned.
|
|
@retval EFI_UNSUPPORTED BmpImage is not a valid *.BMP image
|
|
@retval EFI_BUFFER_TOO_SMALL The passed in GopBlt buffer is not big enough.
|
|
GopBltSize will contain the required size.
|
|
@retval EFI_OUT_OF_RESOURCES No enough buffer to allocate.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
ConvertBmpToGopBlt (
|
|
IN VOID *BmpImage,
|
|
IN UINTN BmpImageSize,
|
|
IN OUT VOID **GopBlt,
|
|
IN OUT UINTN *GopBltSize,
|
|
OUT UINTN *PixelHeight,
|
|
OUT UINTN *PixelWidth
|
|
)
|
|
{
|
|
UINT8 *Image;
|
|
UINT8 *ImageHeader;
|
|
BMP_IMAGE_HEADER *BmpHeader;
|
|
BMP_COLOR_MAP *BmpColorMap;
|
|
EFI_GRAPHICS_OUTPUT_BLT_PIXEL *BltBuffer;
|
|
EFI_GRAPHICS_OUTPUT_BLT_PIXEL *Blt;
|
|
UINT64 BltBufferSize;
|
|
UINTN Index;
|
|
UINTN Height;
|
|
UINTN Width;
|
|
UINTN ImageIndex;
|
|
BOOLEAN IsAllocated;
|
|
|
|
BmpHeader = (BMP_IMAGE_HEADER *) BmpImage;
|
|
|
|
if (BmpHeader->CharB != 'B' || BmpHeader->CharM != 'M') {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
//
|
|
// Doesn't support compress.
|
|
//
|
|
if (BmpHeader->CompressionType != 0) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
//
|
|
// Calculate Color Map offset in the image.
|
|
//
|
|
Image = BmpImage;
|
|
BmpColorMap = (BMP_COLOR_MAP *) (Image + sizeof (BMP_IMAGE_HEADER));
|
|
|
|
//
|
|
// Calculate graphics image data address in the image
|
|
//
|
|
Image = ((UINT8 *) BmpImage) + BmpHeader->ImageOffset;
|
|
ImageHeader = Image;
|
|
|
|
//
|
|
// Calculate the BltBuffer needed size.
|
|
//
|
|
BltBufferSize = MultU64x32 ((UINT64) BmpHeader->PixelWidth, BmpHeader->PixelHeight);
|
|
//
|
|
// Ensure the BltBufferSize * sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL) doesn't overflow
|
|
//
|
|
if (BltBufferSize > DivU64x32 ((UINTN) ~0, sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL))) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
BltBufferSize = MultU64x32 (BltBufferSize, sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL));
|
|
|
|
IsAllocated = FALSE;
|
|
if (*GopBlt == NULL) {
|
|
//
|
|
// GopBlt is not allocated by caller.
|
|
//
|
|
*GopBltSize = (UINTN) BltBufferSize;
|
|
*GopBlt = AllocatePool (*GopBltSize);
|
|
IsAllocated = TRUE;
|
|
if (*GopBlt == NULL) {
|
|
return EFI_OUT_OF_RESOURCES;
|
|
}
|
|
} else {
|
|
//
|
|
// GopBlt has been allocated by caller.
|
|
//
|
|
if (*GopBltSize < (UINTN) BltBufferSize) {
|
|
*GopBltSize = (UINTN) BltBufferSize;
|
|
return EFI_BUFFER_TOO_SMALL;
|
|
}
|
|
}
|
|
|
|
*PixelWidth = BmpHeader->PixelWidth;
|
|
*PixelHeight = BmpHeader->PixelHeight;
|
|
|
|
//
|
|
// Convert image from BMP to Blt buffer format
|
|
//
|
|
BltBuffer = *GopBlt;
|
|
for (Height = 0; Height < BmpHeader->PixelHeight; Height++) {
|
|
Blt = &BltBuffer[(BmpHeader->PixelHeight - Height - 1) * BmpHeader->PixelWidth];
|
|
for (Width = 0; Width < BmpHeader->PixelWidth; Width++, Image++, Blt++) {
|
|
switch (BmpHeader->BitPerPixel) {
|
|
case 1:
|
|
//
|
|
// Convert 1-bit (2 colors) BMP to 24-bit color
|
|
//
|
|
for (Index = 0; Index < 8 && Width < BmpHeader->PixelWidth; Index++) {
|
|
Blt->Red = BmpColorMap[((*Image) >> (7 - Index)) & 0x1].Red;
|
|
Blt->Green = BmpColorMap[((*Image) >> (7 - Index)) & 0x1].Green;
|
|
Blt->Blue = BmpColorMap[((*Image) >> (7 - Index)) & 0x1].Blue;
|
|
Blt++;
|
|
Width++;
|
|
}
|
|
|
|
Blt--;
|
|
Width--;
|
|
break;
|
|
|
|
case 4:
|
|
//
|
|
// Convert 4-bit (16 colors) BMP Palette to 24-bit color
|
|
//
|
|
Index = (*Image) >> 4;
|
|
Blt->Red = BmpColorMap[Index].Red;
|
|
Blt->Green = BmpColorMap[Index].Green;
|
|
Blt->Blue = BmpColorMap[Index].Blue;
|
|
if (Width < (BmpHeader->PixelWidth - 1)) {
|
|
Blt++;
|
|
Width++;
|
|
Index = (*Image) & 0x0f;
|
|
Blt->Red = BmpColorMap[Index].Red;
|
|
Blt->Green = BmpColorMap[Index].Green;
|
|
Blt->Blue = BmpColorMap[Index].Blue;
|
|
}
|
|
break;
|
|
|
|
case 8:
|
|
//
|
|
// Convert 8-bit (256 colors) BMP Palette to 24-bit color
|
|
//
|
|
Blt->Red = BmpColorMap[*Image].Red;
|
|
Blt->Green = BmpColorMap[*Image].Green;
|
|
Blt->Blue = BmpColorMap[*Image].Blue;
|
|
break;
|
|
|
|
case 24:
|
|
//
|
|
// It is 24-bit BMP.
|
|
//
|
|
Blt->Blue = *Image++;
|
|
Blt->Green = *Image++;
|
|
Blt->Red = *Image;
|
|
break;
|
|
|
|
default:
|
|
//
|
|
// Other bit format BMP is not supported.
|
|
//
|
|
if (IsAllocated) {
|
|
FreePool (*GopBlt);
|
|
*GopBlt = NULL;
|
|
}
|
|
return EFI_UNSUPPORTED;
|
|
break;
|
|
};
|
|
|
|
}
|
|
|
|
ImageIndex = (UINTN) (Image - ImageHeader);
|
|
if ((ImageIndex % 4) != 0) {
|
|
//
|
|
// Bmp Image starts each row on a 32-bit boundary!
|
|
//
|
|
Image = Image + (4 - (ImageIndex % 4));
|
|
}
|
|
}
|
|
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Use SystemTable Conout to stop video based Simple Text Out consoles from going
|
|
to the video device. Put up LogoFile on every video device that is a console.
|
|
|
|
@param[in] LogoFile File name of logo to display on the center of the screen.
|
|
|
|
@retval EFI_SUCCESS ConsoleControl has been flipped to graphics and logo displayed.
|
|
@retval EFI_UNSUPPORTED Logo not found
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EnableQuietBoot (
|
|
IN EFI_GUID *LogoFile
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EFI_OEM_BADGING_PROTOCOL *Badging;
|
|
UINT32 SizeOfX;
|
|
UINT32 SizeOfY;
|
|
INTN DestX;
|
|
INTN DestY;
|
|
UINT8 *ImageData;
|
|
UINTN ImageSize;
|
|
UINTN BltSize;
|
|
UINT32 Instance;
|
|
EFI_BADGING_FORMAT Format;
|
|
EFI_BADGING_DISPLAY_ATTRIBUTE Attribute;
|
|
UINTN CoordinateX;
|
|
UINTN CoordinateY;
|
|
UINTN Height;
|
|
UINTN Width;
|
|
EFI_GRAPHICS_OUTPUT_BLT_PIXEL *Blt;
|
|
EFI_UGA_DRAW_PROTOCOL *UgaDraw;
|
|
UINT32 ColorDepth;
|
|
UINT32 RefreshRate;
|
|
EFI_GRAPHICS_OUTPUT_PROTOCOL *GraphicsOutput;
|
|
|
|
UgaDraw = NULL;
|
|
//
|
|
// Try to open GOP first
|
|
//
|
|
Status = gBS->HandleProtocol (gST->ConsoleOutHandle, &gEfiGraphicsOutputProtocolGuid, (VOID **) &GraphicsOutput);
|
|
if (EFI_ERROR (Status) && FeaturePcdGet (PcdUgaConsumeSupport)) {
|
|
GraphicsOutput = NULL;
|
|
//
|
|
// Open GOP failed, try to open UGA
|
|
//
|
|
Status = gBS->HandleProtocol (gST->ConsoleOutHandle, &gEfiUgaDrawProtocolGuid, (VOID **) &UgaDraw);
|
|
}
|
|
if (EFI_ERROR (Status)) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
//
|
|
// Erase Cursor from screen
|
|
//
|
|
gST->ConOut->EnableCursor (gST->ConOut, FALSE);
|
|
|
|
Badging = NULL;
|
|
Status = gBS->LocateProtocol (&gEfiOEMBadgingProtocolGuid, NULL, (VOID **) &Badging);
|
|
|
|
if (GraphicsOutput != NULL) {
|
|
SizeOfX = GraphicsOutput->Mode->Info->HorizontalResolution;
|
|
SizeOfY = GraphicsOutput->Mode->Info->VerticalResolution;
|
|
|
|
} else if (UgaDraw != NULL && FeaturePcdGet (PcdUgaConsumeSupport)) {
|
|
Status = UgaDraw->GetMode (UgaDraw, &SizeOfX, &SizeOfY, &ColorDepth, &RefreshRate);
|
|
if (EFI_ERROR (Status)) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
} else {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
Instance = 0;
|
|
while (1) {
|
|
ImageData = NULL;
|
|
ImageSize = 0;
|
|
|
|
if (Badging != NULL) {
|
|
//
|
|
// Get image from OEMBadging protocol.
|
|
//
|
|
Status = Badging->GetImage (
|
|
Badging,
|
|
&Instance,
|
|
&Format,
|
|
&ImageData,
|
|
&ImageSize,
|
|
&Attribute,
|
|
&CoordinateX,
|
|
&CoordinateY
|
|
);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
//
|
|
// Currently only support BMP format.
|
|
//
|
|
if (Format != EfiBadgingFormatBMP) {
|
|
if (ImageData != NULL) {
|
|
FreePool (ImageData);
|
|
}
|
|
continue;
|
|
}
|
|
} else {
|
|
//
|
|
// Get the specified image from FV.
|
|
//
|
|
Status = GetSectionFromAnyFv (LogoFile, EFI_SECTION_RAW, 0, (VOID **) &ImageData, &ImageSize);
|
|
if (EFI_ERROR (Status)) {
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
CoordinateX = 0;
|
|
CoordinateY = 0;
|
|
Attribute = EfiBadgingDisplayAttributeCenter;
|
|
}
|
|
|
|
Blt = NULL;
|
|
Status = ConvertBmpToGopBlt (
|
|
ImageData,
|
|
ImageSize,
|
|
(VOID **) &Blt,
|
|
&BltSize,
|
|
&Height,
|
|
&Width
|
|
);
|
|
if (EFI_ERROR (Status)) {
|
|
FreePool (ImageData);
|
|
|
|
if (Badging == NULL) {
|
|
return Status;
|
|
} else {
|
|
continue;
|
|
}
|
|
}
|
|
|
|
//
|
|
// Calculate the display position according to Attribute.
|
|
//
|
|
switch (Attribute) {
|
|
case EfiBadgingDisplayAttributeLeftTop:
|
|
DestX = CoordinateX;
|
|
DestY = CoordinateY;
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeCenterTop:
|
|
DestX = (SizeOfX - Width) / 2;
|
|
DestY = CoordinateY;
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeRightTop:
|
|
DestX = (SizeOfX - Width - CoordinateX);
|
|
DestY = CoordinateY;;
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeCenterRight:
|
|
DestX = (SizeOfX - Width - CoordinateX);
|
|
DestY = (SizeOfY - Height) / 2;
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeRightBottom:
|
|
DestX = (SizeOfX - Width - CoordinateX);
|
|
DestY = (SizeOfY - Height - CoordinateY);
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeCenterBottom:
|
|
DestX = (SizeOfX - Width) / 2;
|
|
DestY = (SizeOfY - Height - CoordinateY);
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeLeftBottom:
|
|
DestX = CoordinateX;
|
|
DestY = (SizeOfY - Height - CoordinateY);
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeCenterLeft:
|
|
DestX = CoordinateX;
|
|
DestY = (SizeOfY - Height) / 2;
|
|
break;
|
|
|
|
case EfiBadgingDisplayAttributeCenter:
|
|
DestX = (SizeOfX - Width) / 2;
|
|
DestY = (SizeOfY - Height) / 2;
|
|
break;
|
|
|
|
default:
|
|
DestX = CoordinateX;
|
|
DestY = CoordinateY;
|
|
break;
|
|
}
|
|
|
|
if ((DestX >= 0) && (DestY >= 0)) {
|
|
if (GraphicsOutput != NULL) {
|
|
Status = GraphicsOutput->Blt (
|
|
GraphicsOutput,
|
|
Blt,
|
|
EfiBltBufferToVideo,
|
|
0,
|
|
0,
|
|
(UINTN) DestX,
|
|
(UINTN) DestY,
|
|
Width,
|
|
Height,
|
|
Width * sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL)
|
|
);
|
|
} else if (UgaDraw != NULL && FeaturePcdGet (PcdUgaConsumeSupport)) {
|
|
Status = UgaDraw->Blt (
|
|
UgaDraw,
|
|
(EFI_UGA_PIXEL *) Blt,
|
|
EfiUgaBltBufferToVideo,
|
|
0,
|
|
0,
|
|
(UINTN) DestX,
|
|
(UINTN) DestY,
|
|
Width,
|
|
Height,
|
|
Width * sizeof (EFI_UGA_PIXEL)
|
|
);
|
|
} else {
|
|
Status = EFI_UNSUPPORTED;
|
|
}
|
|
}
|
|
|
|
FreePool (ImageData);
|
|
|
|
if (Blt != NULL) {
|
|
FreePool (Blt);
|
|
}
|
|
|
|
if (Badging == NULL) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return Status;
|
|
}
|
|
|
|
/**
|
|
Use SystemTable Conout to turn on video based Simple Text Out consoles. The
|
|
Simple Text Out screens will now be synced up with all non video output devices
|
|
|
|
@retval EFI_SUCCESS UGA devices are back in text mode and synced up.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
DisableQuietBoot (
|
|
VOID
|
|
)
|
|
{
|
|
|
|
//
|
|
// Enable Cursor on Screen
|
|
//
|
|
gST->ConOut->EnableCursor (gST->ConOut, TRUE);
|
|
return EFI_SUCCESS;
|
|
}
|
|
|