Add support for formatting and printing strings
All checks were successful
ci/woodpecker/push/build Pipeline was successful
All checks were successful
ci/woodpecker/push/build Pipeline was successful
This commit is contained in:
parent
93fde419a3
commit
3e4f0b8aff
@ -9,6 +9,8 @@ include_directories(
|
||||
# Specify list of source code files
|
||||
list(APPEND XTLDR_SOURCE
|
||||
${XTLDR_SOURCE_DIR}/console.c
|
||||
${XTLDR_SOURCE_DIR}/efiutil.c
|
||||
${XTLDR_SOURCE_DIR}/string.c
|
||||
${XTLDR_SOURCE_DIR}/xtldr.c)
|
||||
|
||||
# Add executable
|
||||
|
41
xtldr/efiutil.c
Normal file
41
xtldr/efiutil.c
Normal file
@ -0,0 +1,41 @@
|
||||
/**
|
||||
* PROJECT: ExectOS
|
||||
* COPYRIGHT: See COPYING.md in the top level directory
|
||||
* FILE: xtldr/efiutil.c
|
||||
* DESCRIPTION: EFI utilities
|
||||
* DEVELOPERS: Rafal Kupiec <belliash@codingworkshop.eu.org>
|
||||
*/
|
||||
|
||||
#include <xtbl.h>
|
||||
|
||||
|
||||
/**
|
||||
* This routine formats the input string and prints it out to the stdout and serial console.
|
||||
*
|
||||
* @param Format
|
||||
* The formatted string that is to be written to the output.
|
||||
*
|
||||
* @param ...
|
||||
* Depending on the format string, this routine might expect a sequence of additional arguments.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*
|
||||
* @todo Check if GOP is active and use it instead of default conout protocol; duplicate output to serial console.
|
||||
*/
|
||||
VOID
|
||||
BlEfiPrint(IN PUINT16 Format,
|
||||
IN ...)
|
||||
{
|
||||
VA_LIST Arguments;
|
||||
|
||||
/* Initialise the va_list */
|
||||
VA_START(Arguments, Format);
|
||||
|
||||
/* Format and print the string to the stdout */
|
||||
BlStringPrint(BlConsolePutChar, Format, Arguments);
|
||||
|
||||
/* Clean up the va_list */
|
||||
VA_END(Arguments);
|
||||
}
|
@ -27,6 +27,45 @@ BlConsoleInitialize();
|
||||
VOID
|
||||
BlConsolePutChar(IN USHORT Character);
|
||||
|
||||
VOID
|
||||
BlEfiPrint(IN PUINT16 Format,
|
||||
IN ...);
|
||||
|
||||
VOID
|
||||
BlStringPrint(IN VOID PutChar(IN USHORT Character),
|
||||
IN PUINT16 Format,
|
||||
IN VA_LIST Arguments);
|
||||
|
||||
VOID
|
||||
BlpStringFormat(IN VOID PutChar(IN USHORT Character),
|
||||
IN PUINT16 Format,
|
||||
IN ...);
|
||||
|
||||
VOID
|
||||
BlpStringPrintSigned32(IN VOID PutChar(IN USHORT Character),
|
||||
IN INT32 Number,
|
||||
IN UINT32 Base);
|
||||
|
||||
VOID
|
||||
BlpStringPrintSigned64(IN VOID PutChar(IN USHORT Character),
|
||||
IN INT_PTR Number,
|
||||
IN UINT_PTR Base);
|
||||
|
||||
VOID
|
||||
BlpStringPrintUnsigned32(IN VOID PutChar(IN USHORT Character),
|
||||
IN UINT32 Number,
|
||||
IN UINT32 Base,
|
||||
IN UINT32 Padding);
|
||||
|
||||
VOID
|
||||
BlpStringPrintUnsigned64(IN VOID PutChar(IN USHORT Character),
|
||||
IN UINT_PTR Number,
|
||||
IN UINT_PTR Base,
|
||||
IN UINT_PTR Padding);
|
||||
|
||||
UINT64
|
||||
BlpStringReadPadding(IN PUINT16 *Format);
|
||||
|
||||
EFI_STATUS
|
||||
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
||||
IN PEFI_SYSTEM_TABLE SystemTable);
|
||||
|
423
xtldr/string.c
Normal file
423
xtldr/string.c
Normal file
@ -0,0 +1,423 @@
|
||||
/**
|
||||
* PROJECT: ExectOS
|
||||
* COPYRIGHT: See COPYING.md in the top level directory
|
||||
* FILE: xtldr/string.c
|
||||
* DESCRIPTION: EFI string operations support
|
||||
* DEVELOPERS: Rafal Kupiec <belliash@codingworkshop.eu.org>
|
||||
*/
|
||||
|
||||
#include <xtbl.h>
|
||||
|
||||
|
||||
STATIC PUINT16 HexTable = L"0123456789abcdef";
|
||||
|
||||
/**
|
||||
* This routine formats the input string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Format
|
||||
* The formatted string that is to be written to the specified device.
|
||||
*
|
||||
* @param Arguments
|
||||
* A value identifying a variable arguments list initialized with VA_START.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlStringPrint(IN VOID PutChar(IN USHORT Character),
|
||||
IN PUINT16 Format,
|
||||
IN VA_LIST Arguments)
|
||||
{
|
||||
PEFI_GUID Guid;
|
||||
PUCHAR String;
|
||||
ULONG PaddingCount;
|
||||
|
||||
/* Read the variable arguments */
|
||||
for(; *Format; ++Format)
|
||||
{
|
||||
switch(*Format)
|
||||
{
|
||||
case L'%':
|
||||
switch(*++Format)
|
||||
{
|
||||
case L'b':
|
||||
/* Boolean */
|
||||
BlpStringFormat(PutChar, L"%s", VA_ARG(Arguments, INT32) ? "TRUE" : "FALSE");
|
||||
break;
|
||||
case L'c':
|
||||
/* Character */
|
||||
PutChar(VA_ARG(Arguments, INT));
|
||||
break;
|
||||
case L'd':
|
||||
/* Signed 32-bit integer */
|
||||
BlpStringPrintSigned32(PutChar, VA_ARG(Arguments, INT32), 10);
|
||||
break;
|
||||
case L'g':
|
||||
/* EFI GUID */
|
||||
Guid = VA_ARG(Arguments, PEFI_GUID);
|
||||
BlpStringFormat(PutChar, L"%08x-%04x-%04x-%02x%02x-%02x%02x%02x%02x%02x%02x", Guid->Data1,
|
||||
Guid->Data2, Guid->Data3, Guid->Data4[0], Guid->Data4[1], Guid->Data4[2],
|
||||
Guid->Data4[3], Guid->Data4[4], Guid->Data4[5], Guid->Data4[6], Guid->Data4[7]);
|
||||
break;
|
||||
case L'l':
|
||||
/* 64-bit numbers */
|
||||
switch(*++Format)
|
||||
{
|
||||
case L'd':
|
||||
/* Signed 64-bit integer */
|
||||
BlpStringPrintSigned64(PutChar, VA_ARG(Arguments, INT_PTR), 10);
|
||||
break;
|
||||
case L'u':
|
||||
/* Unsigned 64-bit integer */
|
||||
BlpStringPrintUnsigned64(PutChar, VA_ARG(Arguments, UINT_PTR), 10, 0);
|
||||
break;
|
||||
case L'x':
|
||||
/* Unsigned 64-bit hexadecimal integer */
|
||||
BlpStringPrintUnsigned64(PutChar, VA_ARG(Arguments, UINT_PTR), 16, 0);
|
||||
break;
|
||||
default:
|
||||
/* Unknown by default */
|
||||
PutChar(L'?');
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case L'p':
|
||||
/* Pointer address */
|
||||
BlpStringPrintUnsigned64(PutChar, VA_ARG(Arguments, UINT_PTR), 16, 0);
|
||||
break;
|
||||
case L's':
|
||||
/* String of characters */
|
||||
String = VA_ARG(Arguments, PUCHAR);
|
||||
while(*String)
|
||||
{
|
||||
PutChar(*String++);
|
||||
}
|
||||
break;
|
||||
case L'u':
|
||||
/* Unsigned 32-bit integer */
|
||||
BlpStringPrintUnsigned32(PutChar, VA_ARG(Arguments, UINT32), 10, 0);
|
||||
break;
|
||||
case L'x':
|
||||
/* Unsigned 32-bit hexadecimal integer */
|
||||
BlpStringPrintUnsigned32(PutChar, VA_ARG(Arguments, UINT32), 16, 0);
|
||||
break;
|
||||
case L'0':
|
||||
/* Zero padded numbers */
|
||||
++Format;
|
||||
PaddingCount = BlpStringReadPadding(&Format);
|
||||
switch(*Format)
|
||||
{
|
||||
case L'd':
|
||||
/* Zero-padded, signed 32-bit integer */
|
||||
BlpStringPrintSigned32(PutChar, VA_ARG(Arguments, INT32), 10);
|
||||
break;
|
||||
case L'l':
|
||||
/* 64-bit numbers */
|
||||
switch(*++Format)
|
||||
{
|
||||
case L'd':
|
||||
/* Zero-padded, signed 64-bit integer */
|
||||
BlpStringPrintSigned64(PutChar, VA_ARG(Arguments, INT_PTR), 10);
|
||||
break;
|
||||
case L'u':
|
||||
/* Zero-padded, unsigned 64-bit integer */
|
||||
BlpStringPrintUnsigned64(PutChar, VA_ARG(Arguments, UINT_PTR), 10, PaddingCount);
|
||||
break;
|
||||
case L'x':
|
||||
/* Zero-padded, unsigned 64-bit hexadecimal integer */
|
||||
BlpStringPrintUnsigned64(PutChar, VA_ARG(Arguments, UINT_PTR), 16, PaddingCount);
|
||||
break;
|
||||
default:
|
||||
/* Unknown by default */
|
||||
PutChar(L'?');
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case L'u':
|
||||
/* Zero-padded, unsigned 32-bit integer */
|
||||
BlpStringPrintUnsigned32(PutChar, VA_ARG(Arguments, UINT32), 10, PaddingCount);
|
||||
break;
|
||||
case L'x':
|
||||
/* Zero-padded, unsigned 32-bit hexadecimal integer */
|
||||
BlpStringPrintUnsigned32(PutChar, VA_ARG(Arguments, UINT32), 16, PaddingCount);
|
||||
break;
|
||||
default:
|
||||
/* Unknown by default */
|
||||
PutChar(L'?');
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case L'%':
|
||||
/* Percent character */
|
||||
PutChar(L'%');
|
||||
break;
|
||||
default:
|
||||
/* Unknown by default */
|
||||
PutChar(L'?');
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case L'\r':
|
||||
/* Carriage return is ignored */
|
||||
break;
|
||||
case L'\n':
|
||||
/* New line together with carriage return */
|
||||
PutChar(L'\r');
|
||||
PutChar(L'\n');
|
||||
break;
|
||||
default:
|
||||
/* Put character by default */
|
||||
PutChar(*Format);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* This routine formats the input string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Format
|
||||
* The formatted string that is to be written to the specified device.
|
||||
*
|
||||
* @param ...
|
||||
* Depending on the format string, this routine might expect a sequence of additional arguments.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlpStringFormat(IN VOID PutChar(IN USHORT Character),
|
||||
IN PUINT16 Format,
|
||||
IN ...)
|
||||
{
|
||||
VA_LIST Arguments;
|
||||
|
||||
/* Initialise the va_list */
|
||||
VA_START(Arguments, Format);
|
||||
|
||||
/* Format and print the string to the desired output */
|
||||
BlStringPrint(PutChar, Format, Arguments);
|
||||
|
||||
/* Clean up the va_list */
|
||||
VA_END(Arguments);
|
||||
}
|
||||
|
||||
/**
|
||||
* This routine converts 32-bit integer as string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Number
|
||||
* 32-bit integer value.
|
||||
*
|
||||
* @param Base
|
||||
* Specifies the number base system representation.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlpStringPrintSigned32(IN VOID PutChar(IN USHORT Character),
|
||||
IN INT32 Number,
|
||||
IN UINT32 Base)
|
||||
{
|
||||
/* Print - (minus) if this is negative value */
|
||||
if(Number < 0)
|
||||
{
|
||||
PutChar(L'-');
|
||||
Number *= -1;
|
||||
}
|
||||
|
||||
/* Print the integer value */
|
||||
BlpStringPrintUnsigned32(PutChar, Number, Base, 0);
|
||||
}
|
||||
|
||||
/**
|
||||
* This routine converts 64-bit integer as string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Number
|
||||
* 64-bit integer value.
|
||||
*
|
||||
* @param Base
|
||||
* Specifies the number base system representation.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlpStringPrintSigned64(IN VOID PutChar(IN USHORT Character),
|
||||
IN INT_PTR Number,
|
||||
IN UINT_PTR Base)
|
||||
{
|
||||
/* Print - (minus) if this is negative value */
|
||||
if(Number < 0)
|
||||
{
|
||||
PutChar(L'-');
|
||||
Number *= -1;
|
||||
}
|
||||
|
||||
/* Print the integer value */
|
||||
BlpStringPrintUnsigned64(PutChar, Number, Base, 0);
|
||||
}
|
||||
|
||||
/**
|
||||
* This routine converts 32-bit unsigned integer as string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Number
|
||||
* 32-bit integer value.
|
||||
*
|
||||
* @param Base
|
||||
* Specifies the number base system representation.
|
||||
*
|
||||
* @param Padding
|
||||
* Specifies the number of leading zeros to complete the field width.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlpStringPrintUnsigned32(IN VOID PutChar(IN USHORT Character),
|
||||
IN UINT32 Number,
|
||||
IN UINT32 Base,
|
||||
IN UINT32 Padding)
|
||||
{
|
||||
UINT32 Buffer[20];
|
||||
PUINT32 Pointer = Buffer + ARRAY_SIZE(Buffer);
|
||||
|
||||
/* Convert value to specified base system */
|
||||
*--Pointer = 0;
|
||||
do
|
||||
{
|
||||
*--Pointer = HexTable[Number % Base];
|
||||
} while(Pointer >= Buffer && (Number /= Base));
|
||||
|
||||
/* Calculate number length */
|
||||
UINT32 NumberLength = ARRAY_SIZE(Buffer) - (Pointer - Buffer) - 1;
|
||||
|
||||
/* Check if leading zeros are needed */
|
||||
if(NumberLength < Padding)
|
||||
{
|
||||
Padding -= NumberLength;
|
||||
while(Padding--)
|
||||
{
|
||||
/* Write leading zeroes */
|
||||
PutChar(L'0');
|
||||
}
|
||||
}
|
||||
|
||||
/* Print value to the console */
|
||||
for(; *Pointer; ++Pointer)
|
||||
{
|
||||
PutChar(*Pointer);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* This routine converts 64-bit unsigned integer as string and prints it using specified routine.
|
||||
*
|
||||
* @param PutChar
|
||||
* Pointer to the routine that writes an input data to specific device.
|
||||
*
|
||||
* @param Number
|
||||
* 64-bit integer value.
|
||||
*
|
||||
* @param Base
|
||||
* Specifies the number base system representation.
|
||||
*
|
||||
* @param Padding
|
||||
* Specifies the number of leading zeros to complete the field width.
|
||||
*
|
||||
* @return This routine does not return any value.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
VOID
|
||||
BlpStringPrintUnsigned64(IN VOID PutChar(IN USHORT Character),
|
||||
IN UINT_PTR Number,
|
||||
IN UINT_PTR Base,
|
||||
IN UINT_PTR Padding)
|
||||
{
|
||||
UINT16 Buffer[20];
|
||||
PUINT16 Pointer = Buffer + ARRAY_SIZE(Buffer);
|
||||
|
||||
/* Convert value to specified base system */
|
||||
*--Pointer = 0;
|
||||
do
|
||||
{
|
||||
*--Pointer = HexTable[Number % Base];
|
||||
} while(Pointer >= Buffer && (Number /= Base));
|
||||
|
||||
/* Calculate number length */
|
||||
UINT_PTR NumberLength = ARRAY_SIZE(Buffer) - (Pointer - Buffer) - 1;
|
||||
|
||||
/* Check if leading zeros are needed */
|
||||
if(NumberLength < Padding)
|
||||
{
|
||||
Padding -= NumberLength;
|
||||
while(Padding--)
|
||||
{
|
||||
/* Write leading zeroes */
|
||||
PutChar(L'0');
|
||||
}
|
||||
}
|
||||
|
||||
/* Print value to the console */
|
||||
for(; *Pointer; ++Pointer)
|
||||
{
|
||||
PutChar(*Pointer);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Reads the number of padding characters from the format string.
|
||||
*
|
||||
* @param Format
|
||||
* The format string.
|
||||
*
|
||||
* @return Number of padding characters.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*/
|
||||
UINT64
|
||||
BlpStringReadPadding(IN PUINT16 *Format)
|
||||
{
|
||||
ULONG Count = 0;
|
||||
PUINT16 Fmt = *Format;
|
||||
|
||||
/* Read the padding */
|
||||
for(;; ++Fmt)
|
||||
{
|
||||
switch(*Fmt)
|
||||
{
|
||||
case L'0' ... L'9':
|
||||
/* Check the number of leading zeroes */
|
||||
Count = Count * 10 + *Fmt - L'0';
|
||||
break;
|
||||
default:
|
||||
/* No padding by default */
|
||||
*Format = Fmt;
|
||||
return Count;
|
||||
}
|
||||
}
|
||||
|
||||
/* No padding by default */
|
||||
return 0;
|
||||
}
|
@ -27,6 +27,7 @@ PEFI_SYSTEM_TABLE EfiSystemTable;
|
||||
* @return This routine returns status code.
|
||||
*
|
||||
* @since XT 1.0
|
||||
*
|
||||
*/
|
||||
EFI_STATUS
|
||||
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
||||
|
Loading…
Reference in New Issue
Block a user