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
|
# Specify list of source code files
|
||||||
list(APPEND XTLDR_SOURCE
|
list(APPEND XTLDR_SOURCE
|
||||||
${XTLDR_SOURCE_DIR}/console.c
|
${XTLDR_SOURCE_DIR}/console.c
|
||||||
|
${XTLDR_SOURCE_DIR}/efiutil.c
|
||||||
|
${XTLDR_SOURCE_DIR}/string.c
|
||||||
${XTLDR_SOURCE_DIR}/xtldr.c)
|
${XTLDR_SOURCE_DIR}/xtldr.c)
|
||||||
|
|
||||||
# Add executable
|
# 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
|
VOID
|
||||||
BlConsolePutChar(IN USHORT Character);
|
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
|
EFI_STATUS
|
||||||
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
||||||
IN PEFI_SYSTEM_TABLE SystemTable);
|
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.
|
* @return This routine returns status code.
|
||||||
*
|
*
|
||||||
* @since XT 1.0
|
* @since XT 1.0
|
||||||
|
*
|
||||||
*/
|
*/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
XtLoaderStartup(IN EFI_HANDLE ImageHandle,
|
||||||
|
Loading…
Reference in New Issue
Block a user