mirror of https://github.com/acidanthera/audk.git
995 lines
26 KiB
C
995 lines
26 KiB
C
/*++
|
|
|
|
Copyright (c) 2004 - 2007, Intel Corporation
|
|
All rights reserved. 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.
|
|
|
|
Module Name:
|
|
|
|
Print.c
|
|
|
|
Abstract:
|
|
|
|
Basic Ascii AvSPrintf() function named VSPrint(). VSPrint() enables very
|
|
simple implemenation of SPrint() and Print() to support debug.
|
|
|
|
You can not Print more than EFI_DRIVER_LIB_MAX_PRINT_BUFFER characters at a
|
|
time. This makes the implementation very simple.
|
|
|
|
VSPrint, Print, SPrint format specification has the follwoing form
|
|
|
|
%[flags][width]type
|
|
|
|
flags:
|
|
'-' - Left justify
|
|
'+' - Prefix a sign
|
|
' ' - Prefix a blank
|
|
',' - Place commas in numberss
|
|
'0' - Prefix for width with zeros
|
|
'l' - UINT64
|
|
'L' - UINT64
|
|
|
|
width:
|
|
'*' - Get width from a UINTN argumnet from the argument list
|
|
Decimal number that represents width of print
|
|
|
|
type:
|
|
'X' - argument is a UINTN hex number, prefix '0'
|
|
'x' - argument is a hex number
|
|
'd' - argument is a decimal number
|
|
'a' - argument is an ascii string
|
|
'S','s' - argument is an Unicode string
|
|
'g' - argument is a pointer to an EFI_GUID
|
|
't' - argument is a pointer to an EFI_TIME structure
|
|
'c' - argument is an ascii character
|
|
'r' - argument is EFI_STATUS
|
|
'%' - Print a %
|
|
|
|
--*/
|
|
|
|
#include "Tiano.h"
|
|
#include "EfiDriverLib.h"
|
|
#include "TianoCommon.h"
|
|
#include "EfiCommonLib.h"
|
|
#include "PrintWidth.h"
|
|
#include "EfiPrintLib.h"
|
|
#include "Print.h"
|
|
#if (EFI_SPECIFICATION_VERSION >= 0x0002000A)
|
|
#include EFI_PROTOCOL_DEFINITION (HiiFont)
|
|
#else
|
|
#include EFI_PROTOCOL_DEFINITION (Hii)
|
|
#endif
|
|
|
|
STATIC
|
|
CHAR_W *
|
|
GetFlagsAndWidth (
|
|
IN CHAR_W *Format,
|
|
OUT UINTN *Flags,
|
|
OUT UINTN *Width,
|
|
IN OUT VA_LIST *Marker
|
|
);
|
|
|
|
STATIC
|
|
UINTN
|
|
GuidToString (
|
|
IN EFI_GUID *Guid,
|
|
IN OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
);
|
|
|
|
STATIC
|
|
UINTN
|
|
TimeToString (
|
|
IN EFI_TIME *Time,
|
|
IN OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
);
|
|
|
|
STATIC
|
|
UINTN
|
|
EfiStatusToString (
|
|
IN EFI_STATUS Status,
|
|
OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
);
|
|
|
|
static EFI_GRAPHICS_OUTPUT_BLT_PIXEL mEfiColors[16] = {
|
|
{0x00, 0x00, 0x00, 0x00},
|
|
{0x98, 0x00, 0x00, 0x00},
|
|
{0x00, 0x98, 0x00, 0x00},
|
|
{0x98, 0x98, 0x00, 0x00},
|
|
{0x00, 0x00, 0x98, 0x00},
|
|
{0x98, 0x00, 0x98, 0x00},
|
|
{0x00, 0x98, 0x98, 0x00},
|
|
{0x98, 0x98, 0x98, 0x00},
|
|
{0x10, 0x10, 0x10, 0x00},
|
|
{0xff, 0x10, 0x10, 0x00},
|
|
{0x10, 0xff, 0x10, 0x00},
|
|
{0xff, 0xff, 0x10, 0x00},
|
|
{0x10, 0x10, 0xff, 0x00},
|
|
{0xf0, 0x10, 0xff, 0x00},
|
|
{0x10, 0xff, 0xff, 0x00},
|
|
{0xff, 0xff, 0xff, 0x00},
|
|
};
|
|
|
|
|
|
UINTN
|
|
_IPrint (
|
|
IN EFI_GRAPHICS_OUTPUT_PROTOCOL *GraphicsOutput,
|
|
IN EFI_UGA_DRAW_PROTOCOL *UgaDraw,
|
|
IN EFI_SIMPLE_TEXT_OUT_PROTOCOL *Sto,
|
|
IN UINTN X,
|
|
IN UINTN Y,
|
|
IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *Foreground,
|
|
IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *Background,
|
|
IN CHAR16 *fmt,
|
|
IN VA_LIST args
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
Display string worker for: Print, PrintAt, IPrint, IPrintAt
|
|
|
|
Arguments:
|
|
|
|
GraphicsOutput - Graphics output protocol interface
|
|
|
|
UgaDraw - UGA draw protocol interface
|
|
|
|
Sto - Simple text out protocol interface
|
|
|
|
X - X coordinate to start printing
|
|
|
|
Y - Y coordinate to start printing
|
|
|
|
Foreground - Foreground color
|
|
|
|
Background - Background color
|
|
|
|
fmt - Format string
|
|
|
|
args - Print arguments
|
|
|
|
Returns:
|
|
|
|
EFI_SUCCESS - success
|
|
EFI_OUT_OF_RESOURCES - out of resources
|
|
|
|
--*/
|
|
{
|
|
VOID *Buffer;
|
|
EFI_STATUS Status;
|
|
UINTN Index;
|
|
CHAR16 *UnicodeWeight;
|
|
UINT32 HorizontalResolution;
|
|
UINT32 VerticalResolution;
|
|
UINT32 ColorDepth;
|
|
UINT32 RefreshRate;
|
|
UINTN BufferLen;
|
|
UINTN LineBufferLen;
|
|
#if (EFI_SPECIFICATION_VERSION >= 0x0002000A)
|
|
EFI_HII_FONT_PROTOCOL *HiiFont;
|
|
EFI_IMAGE_OUTPUT *Blt;
|
|
EFI_FONT_DISPLAY_INFO *FontInfo;
|
|
#else
|
|
EFI_HII_PROTOCOL *Hii;
|
|
UINT16 GlyphWidth;
|
|
UINT32 GlyphStatus;
|
|
UINT16 StringIndex;
|
|
EFI_NARROW_GLYPH *Glyph;
|
|
EFI_GRAPHICS_OUTPUT_BLT_PIXEL *LineBuffer;
|
|
#endif
|
|
|
|
//
|
|
// For now, allocate an arbitrarily long buffer
|
|
//
|
|
Buffer = EfiLibAllocateZeroPool (0x10000);
|
|
if (Buffer == NULL) {
|
|
return EFI_OUT_OF_RESOURCES;
|
|
}
|
|
|
|
if (GraphicsOutput != NULL) {
|
|
HorizontalResolution = GraphicsOutput->Mode->Info->HorizontalResolution;
|
|
VerticalResolution = GraphicsOutput->Mode->Info->VerticalResolution;
|
|
} else {
|
|
UgaDraw->GetMode (UgaDraw, &HorizontalResolution, &VerticalResolution, &ColorDepth, &RefreshRate);
|
|
}
|
|
ASSERT ((HorizontalResolution != 0) && (VerticalResolution !=0));
|
|
|
|
#if (EFI_SPECIFICATION_VERSION >= 0x0002000A)
|
|
Blt = NULL;
|
|
FontInfo = NULL;
|
|
ASSERT (GraphicsOutput != NULL);
|
|
Status = gBS->LocateProtocol (&gEfiHiiFontProtocolGuid, NULL, (VOID **) &HiiFont);
|
|
if (EFI_ERROR (Status)) {
|
|
goto Error;
|
|
}
|
|
#else
|
|
LineBuffer = NULL;
|
|
Status = gBS->LocateProtocol (&gEfiHiiProtocolGuid, NULL, (VOID**)&Hii);
|
|
if (EFI_ERROR (Status)) {
|
|
goto Error;
|
|
}
|
|
LineBufferLen = sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL) * HorizontalResolution * GLYPH_HEIGHT;
|
|
LineBuffer = EfiLibAllocatePool (LineBufferLen);
|
|
if (LineBuffer == NULL) {
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
goto Error;
|
|
}
|
|
#endif
|
|
|
|
VSPrint (Buffer, 0x10000, fmt, args);
|
|
|
|
UnicodeWeight = (CHAR16 *) Buffer;
|
|
|
|
for (Index = 0; UnicodeWeight[Index] != 0; Index++) {
|
|
if (UnicodeWeight[Index] == CHAR_BACKSPACE ||
|
|
UnicodeWeight[Index] == CHAR_LINEFEED ||
|
|
UnicodeWeight[Index] == CHAR_CARRIAGE_RETURN) {
|
|
UnicodeWeight[Index] = 0;
|
|
}
|
|
}
|
|
|
|
BufferLen = EfiStrLen (Buffer);
|
|
|
|
|
|
#if (EFI_SPECIFICATION_VERSION >= 0x0002000A)
|
|
LineBufferLen = sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL) * HorizontalResolution * EFI_GLYPH_HEIGHT;
|
|
if (EFI_GLYPH_WIDTH * EFI_GLYPH_HEIGHT * sizeof(EFI_GRAPHICS_OUTPUT_BLT_PIXEL) * BufferLen > LineBufferLen) {
|
|
Status = EFI_INVALID_PARAMETER;
|
|
goto Error;
|
|
}
|
|
|
|
Blt = (EFI_IMAGE_OUTPUT *) EfiLibAllocateZeroPool (sizeof (EFI_IMAGE_OUTPUT));
|
|
if (Blt == NULL) {
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
goto Error;
|
|
}
|
|
|
|
Blt->Width = (UINT16) (HorizontalResolution);
|
|
Blt->Height = (UINT16) (VerticalResolution);
|
|
Blt->Image.Screen = GraphicsOutput;
|
|
|
|
FontInfo = (EFI_FONT_DISPLAY_INFO *) EfiLibAllocateZeroPool (sizeof (EFI_FONT_DISPLAY_INFO));
|
|
if (FontInfo == NULL) {
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
goto Error;
|
|
}
|
|
if (Foreground != NULL) {
|
|
EfiCopyMem (&FontInfo->ForegroundColor, Foreground, sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL));
|
|
} else {
|
|
EfiCopyMem (
|
|
&FontInfo->ForegroundColor,
|
|
&mEfiColors[Sto->Mode->Attribute & 0x0f],
|
|
sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL)
|
|
);
|
|
}
|
|
if (Background != NULL) {
|
|
EfiCopyMem (&FontInfo->BackgroundColor, Background, sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL));
|
|
} else {
|
|
EfiCopyMem (
|
|
&FontInfo->BackgroundColor,
|
|
&mEfiColors[Sto->Mode->Attribute >> 4],
|
|
sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL)
|
|
);
|
|
}
|
|
|
|
Status = HiiFont->StringToImage (
|
|
HiiFont,
|
|
EFI_HII_IGNORE_IF_NO_GLYPH | EFI_HII_DIRECT_TO_SCREEN,
|
|
Buffer,
|
|
FontInfo,
|
|
&Blt,
|
|
X,
|
|
Y,
|
|
NULL,
|
|
NULL,
|
|
NULL
|
|
);
|
|
|
|
#else
|
|
GlyphStatus = 0;
|
|
|
|
if (GLYPH_WIDTH * GLYPH_HEIGHT * sizeof(EFI_GRAPHICS_OUTPUT_BLT_PIXEL) * BufferLen > LineBufferLen) {
|
|
Status = EFI_INVALID_PARAMETER;
|
|
goto Error;
|
|
}
|
|
|
|
for (Index = 0; Index < BufferLen; Index++) {
|
|
StringIndex = (UINT16) Index;
|
|
Status = Hii->GetGlyph (Hii, UnicodeWeight, &StringIndex, (UINT8 **) &Glyph, &GlyphWidth, &GlyphStatus);
|
|
if (EFI_ERROR (Status)) {
|
|
goto Error;
|
|
}
|
|
|
|
if (Foreground == NULL || Background == NULL) {
|
|
Status = Hii->GlyphToBlt (
|
|
Hii,
|
|
(UINT8 *) Glyph,
|
|
mEfiColors[Sto->Mode->Attribute & 0x0f],
|
|
mEfiColors[Sto->Mode->Attribute >> 4],
|
|
BufferLen,
|
|
GlyphWidth,
|
|
GLYPH_HEIGHT,
|
|
&LineBuffer[Index * GLYPH_WIDTH]
|
|
);
|
|
} else {
|
|
Status = Hii->GlyphToBlt (
|
|
Hii,
|
|
(UINT8 *) Glyph,
|
|
*Foreground,
|
|
*Background,
|
|
BufferLen,
|
|
GlyphWidth,
|
|
GLYPH_HEIGHT,
|
|
&LineBuffer[Index * GLYPH_WIDTH]
|
|
);
|
|
}
|
|
}
|
|
|
|
//
|
|
// Blt a character to the screen
|
|
//
|
|
if (GraphicsOutput != NULL) {
|
|
Status = GraphicsOutput->Blt (
|
|
GraphicsOutput,
|
|
LineBuffer,
|
|
EfiBltBufferToVideo,
|
|
0,
|
|
0,
|
|
X,
|
|
Y,
|
|
GLYPH_WIDTH * BufferLen,
|
|
GLYPH_HEIGHT,
|
|
GLYPH_WIDTH * BufferLen * sizeof (EFI_GRAPHICS_OUTPUT_BLT_PIXEL)
|
|
);
|
|
} else {
|
|
Status = UgaDraw->Blt (
|
|
UgaDraw,
|
|
(EFI_UGA_PIXEL *) LineBuffer,
|
|
EfiUgaBltBufferToVideo,
|
|
0,
|
|
0,
|
|
X,
|
|
Y,
|
|
GLYPH_WIDTH * BufferLen,
|
|
GLYPH_HEIGHT,
|
|
GLYPH_WIDTH * BufferLen * sizeof (EFI_UGA_PIXEL)
|
|
);
|
|
}
|
|
|
|
#endif
|
|
|
|
Error:
|
|
#if (EFI_SPECIFICATION_VERSION >= 0x0002000A)
|
|
EfiLibSafeFreePool (Blt);
|
|
EfiLibSafeFreePool (FontInfo);
|
|
#else
|
|
gBS->FreePool (LineBuffer);
|
|
#endif
|
|
gBS->FreePool (Buffer);
|
|
return Status;
|
|
}
|
|
|
|
|
|
UINTN
|
|
PrintXY (
|
|
IN UINTN X,
|
|
IN UINTN Y,
|
|
IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *ForeGround, OPTIONAL
|
|
IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *BackGround, OPTIONAL
|
|
IN CHAR_W *Fmt,
|
|
...
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
Prints a formatted unicode string to the default console
|
|
|
|
Arguments:
|
|
|
|
X - X coordinate to start printing
|
|
|
|
Y - Y coordinate to start printing
|
|
|
|
ForeGround - Foreground color
|
|
|
|
BackGround - Background color
|
|
|
|
Fmt - Format string
|
|
|
|
... - Print arguments
|
|
|
|
Returns:
|
|
|
|
Length of string printed to the console
|
|
|
|
--*/
|
|
{
|
|
EFI_HANDLE Handle;
|
|
EFI_GRAPHICS_OUTPUT_PROTOCOL *GraphicsOutput;
|
|
EFI_UGA_DRAW_PROTOCOL *UgaDraw;
|
|
EFI_SIMPLE_TEXT_OUT_PROTOCOL *Sto;
|
|
EFI_STATUS Status;
|
|
VA_LIST Args;
|
|
|
|
VA_START (Args, Fmt);
|
|
|
|
Handle = gST->ConsoleOutHandle;
|
|
|
|
Status = gBS->HandleProtocol (
|
|
Handle,
|
|
&gEfiGraphicsOutputProtocolGuid,
|
|
(VOID**)&GraphicsOutput
|
|
);
|
|
|
|
UgaDraw = NULL;
|
|
if (EFI_ERROR (Status)) {
|
|
GraphicsOutput = NULL;
|
|
|
|
Status = gBS->HandleProtocol (
|
|
Handle,
|
|
&gEfiUgaDrawProtocolGuid,
|
|
(VOID**)&UgaDraw
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
}
|
|
|
|
Status = gBS->HandleProtocol (
|
|
Handle,
|
|
&gEfiSimpleTextOutProtocolGuid,
|
|
(VOID**)&Sto
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
return _IPrint (GraphicsOutput, UgaDraw, Sto, X, Y, ForeGround, BackGround, Fmt, Args);
|
|
}
|
|
|
|
|
|
UINTN
|
|
SPrint (
|
|
OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize,
|
|
IN CONST CHAR_W *Format,
|
|
...
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
SPrint function to process format and place the results in Buffer.
|
|
|
|
Arguments:
|
|
|
|
Buffer - Wide char buffer to print the results of the parsing of Format into.
|
|
|
|
BufferSize - Maximum number of characters to put into buffer. Zero means no
|
|
limit.
|
|
|
|
Format - Format string see file header for more details.
|
|
|
|
... - Vararg list consumed by processing Format.
|
|
|
|
Returns:
|
|
|
|
Number of characters printed.
|
|
|
|
--*/
|
|
{
|
|
UINTN Return;
|
|
VA_LIST Marker;
|
|
|
|
VA_START (Marker, Format);
|
|
Return = VSPrint (Buffer, BufferSize, Format, Marker);
|
|
VA_END (Marker);
|
|
|
|
return Return;
|
|
}
|
|
|
|
UINTN
|
|
EFIAPI
|
|
VSPrint (
|
|
OUT CHAR_W *StartOfBuffer,
|
|
IN UINTN BufferSize,
|
|
IN CONST CHAR_W *FormatString,
|
|
IN VA_LIST Marker
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
VSPrint function to process format and place the results in Buffer. Since a
|
|
VA_LIST is used this rountine allows the nesting of Vararg routines. Thus
|
|
this is the main print working routine
|
|
|
|
Arguments:
|
|
|
|
StartOfBuffer - Unicode buffer to print the results of the parsing of Format into.
|
|
|
|
BufferSize - Maximum number of characters to put into buffer. Zero means
|
|
no limit.
|
|
|
|
FormatString - Unicode format string see file header for more details.
|
|
|
|
Marker - Vararg list consumed by processing Format.
|
|
|
|
Returns:
|
|
|
|
Number of characters printed.
|
|
|
|
--*/
|
|
{
|
|
CHAR16 TempBuffer[CHARACTER_NUMBER_FOR_VALUE];
|
|
CHAR_W *Buffer;
|
|
CHAR8 *AsciiStr;
|
|
CHAR16 *UnicodeStr;
|
|
CHAR_W *Format;
|
|
UINTN Index;
|
|
UINTN Flags;
|
|
UINTN Width;
|
|
UINTN Count;
|
|
UINTN NumberOfCharacters;
|
|
UINTN BufferLeft;
|
|
UINT64 Value;
|
|
EFI_GUID *TmpGUID;
|
|
|
|
//
|
|
// Process the format string. Stop if Buffer is over run.
|
|
//
|
|
|
|
Buffer = StartOfBuffer;
|
|
Format = (CHAR_W *) FormatString;
|
|
NumberOfCharacters = BufferSize / sizeof (CHAR_W);
|
|
BufferLeft = BufferSize;
|
|
for (Index = 0; (*Format != '\0') && (Index < NumberOfCharacters - 1); Format++) {
|
|
if (*Format != '%') {
|
|
if ((*Format == '\n') && (Index < NumberOfCharacters - 2)) {
|
|
//
|
|
// If carage return add line feed
|
|
//
|
|
Buffer[Index++] = '\r';
|
|
BufferLeft -= sizeof (CHAR_W);
|
|
}
|
|
|
|
Buffer[Index++] = *Format;
|
|
BufferLeft -= sizeof (CHAR_W);
|
|
} else {
|
|
|
|
//
|
|
// Now it's time to parse what follows after %
|
|
//
|
|
Format = GetFlagsAndWidth (Format, &Flags, &Width, &Marker);
|
|
switch (*Format) {
|
|
case 'p':
|
|
//
|
|
// Flag space, +, 0, L & l are invalid for type p.
|
|
//
|
|
Flags &= ~(PREFIX_BLANK| PREFIX_SIGN | LONG_TYPE);
|
|
if (sizeof (VOID *) > 4) {
|
|
Flags |= LONG_TYPE;
|
|
Value = VA_ARG (Marker, UINT64);
|
|
} else {
|
|
Value = VA_ARG (Marker, UINTN);
|
|
}
|
|
Flags |= PREFIX_ZERO;
|
|
|
|
EfiValueToHexStr (TempBuffer, Value, Flags, Width);
|
|
UnicodeStr = TempBuffer;
|
|
|
|
for ( ;(*UnicodeStr != '\0') && (Index < NumberOfCharacters - 1); UnicodeStr++) {
|
|
Buffer[Index++] = *UnicodeStr;
|
|
}
|
|
break;
|
|
|
|
case 'X':
|
|
Flags |= PREFIX_ZERO;
|
|
Width = sizeof (UINT64) * 2;
|
|
|
|
//
|
|
// break skiped on purpose
|
|
//
|
|
case 'x':
|
|
if ((Flags & LONG_TYPE) == LONG_TYPE) {
|
|
Value = VA_ARG (Marker, UINT64);
|
|
} else {
|
|
Value = VA_ARG (Marker, UINTN);
|
|
}
|
|
|
|
EfiValueToHexStr (TempBuffer, Value, Flags, Width);
|
|
UnicodeStr = TempBuffer;
|
|
|
|
for (; (*UnicodeStr != '\0') && (Index < NumberOfCharacters - 1); UnicodeStr++) {
|
|
Buffer[Index++] = *UnicodeStr;
|
|
}
|
|
break;
|
|
|
|
case 'd':
|
|
if ((Flags & LONG_TYPE) == LONG_TYPE) {
|
|
Value = VA_ARG (Marker, UINT64);
|
|
} else {
|
|
Value = (UINTN) VA_ARG (Marker, UINTN);
|
|
}
|
|
|
|
EfiValueToString (TempBuffer, Value, Flags, Width);
|
|
UnicodeStr = TempBuffer;
|
|
|
|
for (; (*UnicodeStr != '\0') && (Index < NumberOfCharacters - 1); UnicodeStr++) {
|
|
Buffer[Index++] = *UnicodeStr;
|
|
}
|
|
break;
|
|
|
|
case 's':
|
|
case 'S':
|
|
UnicodeStr = (CHAR16 *) VA_ARG (Marker, CHAR_W *);
|
|
if (UnicodeStr == NULL) {
|
|
UnicodeStr = L"<null string>";
|
|
}
|
|
|
|
for (Count = 0; (*UnicodeStr != '\0') && (Index < NumberOfCharacters - 1); UnicodeStr++, Count++) {
|
|
Buffer[Index++] = *UnicodeStr;
|
|
}
|
|
//
|
|
// Add padding if needed
|
|
//
|
|
for (; (Count < Width) && (Index < NumberOfCharacters - 1); Count++) {
|
|
Buffer[Index++] = ' ';
|
|
}
|
|
|
|
break;
|
|
|
|
case 'a':
|
|
AsciiStr = (CHAR8 *) VA_ARG (Marker, CHAR8 *);
|
|
if (AsciiStr == NULL) {
|
|
AsciiStr = (CHAR8 *) "<null string>";
|
|
}
|
|
|
|
for (Count = 0; (*AsciiStr != '\0') && (Index < NumberOfCharacters - 1); AsciiStr++, Count++) {
|
|
Buffer[Index++] = (CHAR_W) * AsciiStr;
|
|
}
|
|
//
|
|
// Add padding if needed
|
|
//
|
|
for (; (Count < Width) && (Index < NumberOfCharacters - 1); Count++) {
|
|
Buffer[Index++] = ' ';
|
|
}
|
|
break;
|
|
|
|
case 'c':
|
|
Buffer[Index++] = (CHAR_W) VA_ARG (Marker, UINTN);
|
|
break;
|
|
|
|
case 'g':
|
|
TmpGUID = VA_ARG (Marker, EFI_GUID *);
|
|
if (TmpGUID != NULL) {
|
|
Index += GuidToString (
|
|
TmpGUID,
|
|
&Buffer[Index],
|
|
BufferLeft
|
|
);
|
|
}
|
|
break;
|
|
|
|
case 't':
|
|
Index += TimeToString (
|
|
VA_ARG (Marker, EFI_TIME *),
|
|
&Buffer[Index],
|
|
BufferLeft
|
|
);
|
|
break;
|
|
|
|
case 'r':
|
|
Index += EfiStatusToString (
|
|
VA_ARG (Marker, EFI_STATUS),
|
|
&Buffer[Index],
|
|
BufferLeft
|
|
);
|
|
break;
|
|
|
|
case '%':
|
|
Buffer[Index++] = *Format;
|
|
break;
|
|
|
|
default:
|
|
//
|
|
// if the type is unknown print it to the screen
|
|
//
|
|
Buffer[Index++] = *Format;
|
|
}
|
|
|
|
BufferLeft = BufferSize - Index * sizeof (CHAR_W);
|
|
}
|
|
}
|
|
|
|
Buffer[Index++] = '\0';
|
|
|
|
return &Buffer[Index] - StartOfBuffer;
|
|
}
|
|
|
|
STATIC
|
|
CHAR_W *
|
|
GetFlagsAndWidth (
|
|
IN CHAR_W *Format,
|
|
OUT UINTN *Flags,
|
|
OUT UINTN *Width,
|
|
IN OUT VA_LIST *Marker
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
VSPrint worker function that parses flag and width information from the
|
|
Format string and returns the next index into the Format string that needs
|
|
to be parsed. See file headed for details of Flag and Width.
|
|
|
|
Arguments:
|
|
|
|
Format - Current location in the VSPrint format string.
|
|
|
|
Flags - Returns flags
|
|
|
|
Width - Returns width of element
|
|
|
|
Marker - Vararg list that may be paritally consumed and returned.
|
|
|
|
Returns:
|
|
|
|
Pointer indexed into the Format string for all the information parsed
|
|
by this routine.
|
|
|
|
--*/
|
|
{
|
|
UINTN Count;
|
|
BOOLEAN Done;
|
|
|
|
*Flags = 0;
|
|
*Width = 0;
|
|
for (Done = FALSE; !Done;) {
|
|
Format++;
|
|
|
|
switch (*Format) {
|
|
|
|
case '-':
|
|
*Flags |= LEFT_JUSTIFY;
|
|
break;
|
|
|
|
case '+':
|
|
*Flags |= PREFIX_SIGN;
|
|
break;
|
|
|
|
case ' ':
|
|
*Flags |= PREFIX_BLANK;
|
|
break;
|
|
|
|
case ',':
|
|
*Flags |= COMMA_TYPE;
|
|
break;
|
|
|
|
case 'L':
|
|
case 'l':
|
|
*Flags |= LONG_TYPE;
|
|
break;
|
|
|
|
case '*':
|
|
*Width = VA_ARG (*Marker, UINTN);
|
|
break;
|
|
|
|
case '0':
|
|
*Flags |= PREFIX_ZERO;
|
|
|
|
case '1':
|
|
case '2':
|
|
case '3':
|
|
case '4':
|
|
case '5':
|
|
case '6':
|
|
case '7':
|
|
case '8':
|
|
case '9':
|
|
Count = 0;
|
|
do {
|
|
Count = (Count * 10) +*Format - '0';
|
|
Format++;
|
|
} while ((*Format >= '0') && (*Format <= '9'));
|
|
Format--;
|
|
*Width = Count;
|
|
break;
|
|
|
|
default:
|
|
Done = TRUE;
|
|
}
|
|
}
|
|
|
|
return Format;
|
|
}
|
|
|
|
STATIC
|
|
UINTN
|
|
GuidToString (
|
|
IN EFI_GUID *Guid,
|
|
IN CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
VSPrint worker function that prints an EFI_GUID.
|
|
|
|
Arguments:
|
|
|
|
Guid - Pointer to GUID to print.
|
|
|
|
Buffer - Buffe to print Guid into.
|
|
|
|
BufferSize - Size of Buffer.
|
|
|
|
Returns:
|
|
|
|
Number of characters printed.
|
|
|
|
--*/
|
|
{
|
|
UINTN Size;
|
|
|
|
Size = SPrint (
|
|
Buffer,
|
|
BufferSize,
|
|
STRING_W ("%08x-%04x-%04x-%02x%02x-%02x%02x%02x%02x%02x%02x"),
|
|
(UINTN)Guid->Data1,
|
|
(UINTN)Guid->Data2,
|
|
(UINTN)Guid->Data3,
|
|
(UINTN)Guid->Data4[0],
|
|
(UINTN)Guid->Data4[1],
|
|
(UINTN)Guid->Data4[2],
|
|
(UINTN)Guid->Data4[3],
|
|
(UINTN)Guid->Data4[4],
|
|
(UINTN)Guid->Data4[5],
|
|
(UINTN)Guid->Data4[6],
|
|
(UINTN)Guid->Data4[7]
|
|
);
|
|
|
|
//
|
|
// SPrint will null terminate the string. The -1 skips the null
|
|
//
|
|
return Size - 1;
|
|
}
|
|
|
|
|
|
STATIC
|
|
UINTN
|
|
TimeToString (
|
|
IN EFI_TIME *Time,
|
|
OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
VSPrint worker function that prints EFI_TIME.
|
|
|
|
Arguments:
|
|
|
|
Time - Pointer to EFI_TIME sturcture to print.
|
|
|
|
Buffer - Buffer to print Time into.
|
|
|
|
BufferSize - Size of Buffer.
|
|
|
|
Returns:
|
|
|
|
Number of characters printed.
|
|
|
|
--*/
|
|
{
|
|
UINTN Size;
|
|
|
|
Size = SPrint (
|
|
Buffer,
|
|
BufferSize,
|
|
STRING_W ("%02d/%02d/%04d %02d:%02d"),
|
|
(UINTN)Time->Month,
|
|
(UINTN)Time->Day,
|
|
(UINTN)Time->Year,
|
|
(UINTN)Time->Hour,
|
|
(UINTN)Time->Minute
|
|
);
|
|
|
|
//
|
|
// SPrint will null terminate the string. The -1 skips the null
|
|
//
|
|
return Size - 1;
|
|
}
|
|
|
|
STATIC
|
|
UINTN
|
|
EfiStatusToString (
|
|
IN EFI_STATUS Status,
|
|
OUT CHAR_W *Buffer,
|
|
IN UINTN BufferSize
|
|
)
|
|
/*++
|
|
|
|
Routine Description:
|
|
|
|
VSPrint worker function that prints EFI_STATUS as a string. If string is
|
|
not known a hex value will be printed.
|
|
|
|
Arguments:
|
|
|
|
Status - EFI_STATUS sturcture to print.
|
|
|
|
Buffer - Buffer to print EFI_STATUS message string into.
|
|
|
|
BufferSize - Size of Buffer.
|
|
|
|
Returns:
|
|
|
|
Number of characters printed.
|
|
|
|
--*/
|
|
{
|
|
UINTN Size;
|
|
CHAR8 *Desc;
|
|
|
|
Desc = NULL;
|
|
|
|
//
|
|
// Can't use global Status String Array as UINTN is not constant for EBC
|
|
//
|
|
if (Status == EFI_SUCCESS) { Desc = (CHAR8 *) "Success"; } else
|
|
if (Status == EFI_LOAD_ERROR) { Desc = (CHAR8 *) "Load Error"; } else
|
|
if (Status == EFI_INVALID_PARAMETER) { Desc = (CHAR8 *) "Invalid Parameter"; } else
|
|
if (Status == EFI_UNSUPPORTED) { Desc = (CHAR8 *) "Unsupported"; } else
|
|
if (Status == EFI_BAD_BUFFER_SIZE) { Desc = (CHAR8 *) "Bad Buffer Size"; } else
|
|
if (Status == EFI_BUFFER_TOO_SMALL) { Desc = (CHAR8 *) "Buffer Too Small"; } else
|
|
if (Status == EFI_NOT_READY) { Desc = (CHAR8 *) "Not Ready"; } else
|
|
if (Status == EFI_DEVICE_ERROR) { Desc = (CHAR8 *) "Device Error"; } else
|
|
if (Status == EFI_WRITE_PROTECTED) { Desc = (CHAR8 *) "Write Protected"; } else
|
|
if (Status == EFI_OUT_OF_RESOURCES) { Desc = (CHAR8 *) "Out of Resources"; } else
|
|
if (Status == EFI_VOLUME_CORRUPTED) { Desc = (CHAR8 *) "Volume Corrupt"; } else
|
|
if (Status == EFI_VOLUME_FULL) { Desc = (CHAR8 *) "Volume Full"; } else
|
|
if (Status == EFI_NO_MEDIA) { Desc = (CHAR8 *) "No Media"; } else
|
|
if (Status == EFI_MEDIA_CHANGED) { Desc = (CHAR8 *) "Media changed"; } else
|
|
if (Status == EFI_NOT_FOUND) { Desc = (CHAR8 *) "Not Found"; } else
|
|
if (Status == EFI_ACCESS_DENIED) { Desc = (CHAR8 *) "Access Denied"; } else
|
|
if (Status == EFI_NO_RESPONSE) { Desc = (CHAR8 *) "No Response"; } else
|
|
if (Status == EFI_NO_MAPPING) { Desc = (CHAR8 *) "No mapping"; } else
|
|
if (Status == EFI_TIMEOUT) { Desc = (CHAR8 *) "Time out"; } else
|
|
if (Status == EFI_NOT_STARTED) { Desc = (CHAR8 *) "Not started"; } else
|
|
if (Status == EFI_ALREADY_STARTED) { Desc = (CHAR8 *) "Already started"; } else
|
|
if (Status == EFI_ABORTED) { Desc = (CHAR8 *) "Aborted"; } else
|
|
if (Status == EFI_ICMP_ERROR) { Desc = (CHAR8 *) "ICMP Error"; } else
|
|
if (Status == EFI_TFTP_ERROR) { Desc = (CHAR8 *) "TFTP Error"; } else
|
|
if (Status == EFI_PROTOCOL_ERROR) { Desc = (CHAR8 *) "Protocol Error"; } else
|
|
if (Status == EFI_WARN_UNKNOWN_GLYPH) { Desc = (CHAR8 *) "Warning Unknown Glyph"; } else
|
|
if (Status == EFI_WARN_DELETE_FAILURE) { Desc = (CHAR8 *) "Warning Delete Failure"; } else
|
|
if (Status == EFI_WARN_WRITE_FAILURE) { Desc = (CHAR8 *) "Warning Write Failure"; } else
|
|
if (Status == EFI_WARN_BUFFER_TOO_SMALL) { Desc = (CHAR8 *) "Warning Buffer Too Small"; }
|
|
|
|
//
|
|
// If we found a match, copy the message to the user's buffer. Otherwise
|
|
// sprint the hex status code to their buffer.
|
|
//
|
|
if (Desc != NULL) {
|
|
Size = SPrint (Buffer, BufferSize, STRING_W ("%a"), Desc);
|
|
} else {
|
|
Size = SPrint (Buffer, BufferSize, STRING_W ("%X"), Status);
|
|
}
|
|
|
|
return Size - 1;
|
|
}
|