213 lines
4.2 KiB
C
213 lines
4.2 KiB
C
|
#include <efi.h>
|
||
|
#include <efilib.h>
|
||
|
|
||
|
|
||
|
//
|
||
|
// Prototype
|
||
|
//
|
||
|
void TrimNonPrint(CHAR16 * str);
|
||
|
void Launch (CHAR16 *exePath);
|
||
|
|
||
|
//
|
||
|
//Globals
|
||
|
//
|
||
|
EFI_HANDLE ExeHdl;
|
||
|
EFI_LOADED_IMAGE *ExeImage;
|
||
|
|
||
|
//
|
||
|
// Defines
|
||
|
//
|
||
|
#define REGISTER1 L"*register"
|
||
|
#define REGISTER2 L"*register*"
|
||
|
#define STARTFILE L"startup.nsh"
|
||
|
#define BOOTOFILE L"boot.nvr"
|
||
|
#define OSLOADOPT L"OSLOADER"
|
||
|
#define PARTENT L"partition"
|
||
|
#define PARTENTRE L"*partition*"
|
||
|
|
||
|
#define APPNAME_TOLAUNCH L"setupldr.efi"
|
||
|
|
||
|
EFI_STATUS
|
||
|
EfiMain ( IN EFI_HANDLE ImageHandle,
|
||
|
IN EFI_SYSTEM_TABLE *SystemTable)
|
||
|
{
|
||
|
|
||
|
EFI_STATUS Status;
|
||
|
EFI_FILE_HANDLE bootFile;
|
||
|
UINTN Count;
|
||
|
BOOLEAN LaunchTheApplication;
|
||
|
CHAR16 App[30];
|
||
|
|
||
|
InitializeLib (ImageHandle, SystemTable);
|
||
|
|
||
|
ExeHdl = ImageHandle;
|
||
|
BS->HandleProtocol (ImageHandle, &LoadedImageProtocol, &ExeImage);
|
||
|
|
||
|
LaunchTheApplication = FALSE;
|
||
|
|
||
|
ST->ConOut->ClearScreen(ST->ConOut);
|
||
|
|
||
|
Print (L"Press any key to boot from CD-ROM...");
|
||
|
for (Count = 0; Count < 3; Count++) {
|
||
|
Status = WaitForSingleEvent (ST->ConIn->WaitForKey,1*10000000);
|
||
|
|
||
|
if (Status != EFI_TIMEOUT){
|
||
|
LaunchTheApplication = TRUE;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
Print(L".");
|
||
|
|
||
|
}
|
||
|
|
||
|
if (!LaunchTheApplication) {
|
||
|
|
||
|
BS->Exit(ExeHdl,EFI_TIMEOUT,0,NULL);
|
||
|
|
||
|
}
|
||
|
|
||
|
StrCpy(App, APPNAME_TOLAUNCH);
|
||
|
|
||
|
Launch( App );
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
//
|
||
|
// If we get here, we failed to load the OS
|
||
|
//
|
||
|
Print(L"Failed to launch SetupLDR.");
|
||
|
|
||
|
return EFI_SUCCESS;
|
||
|
}
|
||
|
|
||
|
void
|
||
|
Launch (CHAR16 *exePath)
|
||
|
{
|
||
|
EFI_HANDLE exeHdl=NULL;
|
||
|
UINTN i;
|
||
|
EFI_DEVICE_PATH *ldrDevPath;
|
||
|
EFI_STATUS Status;
|
||
|
EFI_FILE_IO_INTERFACE *Vol;
|
||
|
EFI_FILE_HANDLE RootFs;
|
||
|
EFI_FILE_HANDLE CurDir;
|
||
|
EFI_FILE_HANDLE FileHandle;
|
||
|
CHAR16 FileName[100],*DevicePathAsString;
|
||
|
|
||
|
|
||
|
//
|
||
|
// Open the volume for the device where the exe was loaded from.
|
||
|
//
|
||
|
Status = BS->HandleProtocol (ExeImage->DeviceHandle,
|
||
|
&FileSystemProtocol,
|
||
|
&Vol
|
||
|
);
|
||
|
|
||
|
if (EFI_ERROR(Status)) {
|
||
|
Print(L"Can not get a FileSystem handle for ExeImage->DeviceHandle\n");
|
||
|
BS->Exit(ExeHdl,EFI_SUCCESS,0,NULL);
|
||
|
}
|
||
|
Status = Vol->OpenVolume (Vol, &RootFs);
|
||
|
|
||
|
if (EFI_ERROR(Status)) {
|
||
|
Print(L"Can not open the volume for the file system\n");
|
||
|
BS->Exit(ExeHdl,EFI_SUCCESS,0,NULL);
|
||
|
}
|
||
|
|
||
|
CurDir = RootFs;
|
||
|
|
||
|
//
|
||
|
// Open the file relative to the root.
|
||
|
//
|
||
|
|
||
|
DevicePathAsString = DevicePathToStr(ExeImage->FilePath);
|
||
|
|
||
|
if (DevicePathAsString!=NULL) {
|
||
|
StrCpy(FileName,DevicePathAsString);
|
||
|
FreePool(DevicePathAsString);
|
||
|
}
|
||
|
|
||
|
FileName[0] = 0;
|
||
|
StrCat(FileName,exePath);
|
||
|
|
||
|
// size = StrLen(FileName);
|
||
|
// Print(L"Length of filename is %d\n", size);
|
||
|
// DumpHex(4, 0, 10, &FileName[size - 4]);
|
||
|
|
||
|
//
|
||
|
// Get rid of trailing spaces, new lines, whatever
|
||
|
//
|
||
|
TrimNonPrint(FileName);
|
||
|
|
||
|
|
||
|
Status = CurDir->Open (CurDir,
|
||
|
&FileHandle,
|
||
|
FileName,
|
||
|
EFI_FILE_MODE_READ,
|
||
|
0
|
||
|
);
|
||
|
|
||
|
if (EFI_ERROR(Status)) {
|
||
|
Print(L"Can not open the file ->%s<-, error was %X\n",FileName, Status);
|
||
|
BS->Exit(ExeHdl,EFI_SUCCESS,0,NULL);
|
||
|
} else {
|
||
|
// Print(L"Opened %s\n",FileName);
|
||
|
}
|
||
|
|
||
|
ldrDevPath = FileDevicePath (ExeImage->DeviceHandle,FileName);
|
||
|
|
||
|
/*
|
||
|
if (ldrDevPath) {
|
||
|
Print (L"Type: %d\nSub-Type: %d\nLength[0][1]: [%d][%d]\n",ldrDevPath->Type,
|
||
|
ldrDevPath->SubType,ldrDevPath->Length[0],ldrDevPath->Length[1]);
|
||
|
}else {
|
||
|
Print (L"bad dev path\n");
|
||
|
}
|
||
|
*/
|
||
|
// DumpHex (4,0,ldrDevPath->Length[0],ldrDevPath);
|
||
|
|
||
|
Status = BS->LoadImage (FALSE,ExeHdl,ldrDevPath,NULL,0,&exeHdl);
|
||
|
if (!(EFI_ERROR (Status))) {
|
||
|
// Print (L"Image loaded!\n");
|
||
|
|
||
|
}else {
|
||
|
Print (L"Load Error: %X\n",Status);
|
||
|
BS->Exit(ExeHdl,EFI_SUCCESS,0,NULL);
|
||
|
}
|
||
|
FreePool (ldrDevPath);
|
||
|
|
||
|
BS->StartImage (exeHdl,&i,NULL);
|
||
|
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
|
||
|
void
|
||
|
TrimNonPrint(
|
||
|
CHAR16 * str
|
||
|
)
|
||
|
{
|
||
|
INTN i,size;
|
||
|
|
||
|
|
||
|
if ((NULL == str) || (L'\0' == *str)) {
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
size = (INTN) StrLen(str);
|
||
|
|
||
|
// Print(L"Size is %d\n", size);
|
||
|
// DumpHex(4, 0, 2, &str[size]);
|
||
|
|
||
|
for (i = size; i > 0; i--) {
|
||
|
|
||
|
if (str[i] <= 0x20) {
|
||
|
str[i] = L'\0';
|
||
|
}
|
||
|
else {
|
||
|
// Leave when we hit a legit character
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|