Rev 3578 | Go to most recent revision | Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 2726 | vana | 1 | #include <efi.h> |
| 2 | #include <efilib.h> |
||
| 3 | |||
| 4 | #define KERNEL_LOAD_ADDRESS 0x4400000 |
||
| 5 | |||
| 6 | |||
| 7 | static CHAR16 * |
||
| 8 | a2u (char *str) |
||
| 9 | { |
||
| 10 | static CHAR16 mem[2048]; |
||
| 11 | int i; |
||
| 12 | |||
| 13 | for (i = 0; str[i]; ++i) |
||
| 14 | mem[i] = (CHAR16) str[i]; |
||
| 15 | mem[i] = 0; |
||
| 16 | return mem; |
||
| 17 | } |
||
| 18 | char HEX[256]; |
||
| 19 | |||
| 20 | char hexs[]="0123456789ABCDEF"; |
||
| 21 | /* |
||
| 22 | void to_hex(unsigned long long num) |
||
| 23 | { |
||
| 24 | int a; |
||
| 25 | for(a=15;a>=0;a--) |
||
| 26 | { |
||
| 27 | char c=num - (num & 0xfffffffffffffff0LL); |
||
| 28 | num/=16; |
||
| 29 | c=hexs[c]; |
||
| 30 | HEX[a]=c; |
||
| 31 | } |
||
| 32 | |||
| 33 | } |
||
| 34 | */ |
||
| 35 | |||
| 36 | EFI_STATUS |
||
| 37 | efi_main (EFI_HANDLE image, EFI_SYSTEM_TABLE *systab) |
||
| 38 | { |
||
| 39 | SIMPLE_TEXT_OUTPUT_INTERFACE *conout; |
||
| 40 | |||
| 41 | EFI_INPUT_KEY efi_input_key; |
||
| 42 | EFI_STATUS efi_status; |
||
| 43 | |||
| 44 | InitializeLib(image, systab); |
||
| 45 | |||
| 46 | Print(L"HelloLib application started\n"); |
||
| 47 | |||
| 48 | EFI_GUID LoadedImageProtocol=LOADED_IMAGE_PROTOCOL; |
||
| 49 | EFI_GUID DevicePathProtocol=DEVICE_PATH_PROTOCOL; |
||
| 50 | EFI_GUID FileSystemProtocol=SIMPLE_FILE_SYSTEM_PROTOCOL; |
||
| 51 | |||
| 52 | |||
| 53 | EFI_LOADED_IMAGE *LoadedImage; |
||
| 54 | EFI_DEVICE_PATH *DevicePath; |
||
| 55 | |||
| 56 | BS->HandleProtocol(image, |
||
| 57 | &LoadedImageProtocol, |
||
| 58 | &LoadedImage); |
||
| 59 | BS->HandleProtocol(LoadedImage->DeviceHandle, |
||
| 60 | &DevicePathProtocol, |
||
| 61 | &DevicePath); |
||
| 62 | Print (L"Image device : %s\n", DevicePathToStr (DevicePath)); |
||
| 63 | Print (L"Image file : %s\n", DevicePathToStr (LoadedImage->FilePath)); |
||
| 64 | Print (L"Image Base : %X\n", LoadedImage->ImageBase); |
||
| 65 | Print (L"Image Size : %X\n", LoadedImage->ImageSize); |
||
| 66 | |||
| 67 | |||
| 68 | |||
| 69 | EFI_FILE_IO_INTERFACE *Vol; |
||
| 70 | |||
| 71 | EFI_FILE *CurDir; |
||
| 72 | EFI_FILE *FileHandle; |
||
| 73 | |||
| 74 | BS->HandleProtocol(LoadedImage->DeviceHandle, &FileSystemProtocol, &Vol); |
||
| 75 | Vol->OpenVolume (Vol, &CurDir); |
||
| 76 | |||
| 77 | char FileName[1024]; |
||
| 78 | char *OsKernelBuffer; |
||
| 79 | int i; |
||
| 80 | UINTN Size; |
||
| 81 | |||
| 82 | StrCpy(FileName,DevicePathToStr(LoadedImage->FilePath)); |
||
| 83 | for(i=StrLen(FileName);i>=0 && FileName[i]!='\\';i--); |
||
| 84 | FileName[i] = 0; |
||
| 85 | |||
| 86 | Print(L"%s\n",LoadedImage->LoadOptions); |
||
| 87 | |||
| 88 | i=0; |
||
| 89 | CHAR16 *LoadOptions = LoadedImage->LoadOptions; |
||
| 90 | |||
| 91 | |||
| 92 | |||
| 93 | while(1) if(LoadOptions[i++]!=L' ') break; |
||
| 94 | while(LoadOptions[i]!=L' '){ |
||
| 95 | if(LoadOptions[i]==0) break; |
||
| 96 | i++; |
||
| 97 | } |
||
| 98 | while(LoadOptions[i]==L' ') if(LoadOptions[i++]==0) break; |
||
| 99 | |||
| 100 | if(LoadOptions[i++]==0) |
||
| 101 | StrCat(FileName,L"\\image.bin"); |
||
| 102 | else{ |
||
| 103 | CHAR16 buf[1024]; |
||
| 104 | buf[0]='\\'; |
||
| 105 | i--; |
||
| 106 | int j; |
||
| 107 | for(j=0;LoadOptions[i+j]!=L' '&&LoadOptions[i+j]!=0;j++) |
||
| 108 | buf[j+1]=LoadOptions[i+j]; |
||
| 109 | buf[j+1]=0; |
||
| 110 | StrCat(FileName,buf); |
||
| 111 | } |
||
| 112 | |||
| 113 | //Print(L"%s\n",FileName); |
||
| 114 | |||
| 115 | EFI_STATUS stat; |
||
| 116 | stat=CurDir->Open(CurDir, &FileHandle, FileName, EFI_FILE_MODE_READ, 0); |
||
| 117 | if(EFI_ERROR(stat)){ |
||
| 118 | Print(L"Error Opening Image %s\n",FileName); |
||
| 119 | return 0; |
||
| 120 | } |
||
| 121 | Size = 0x00400000; |
||
| 122 | BS->AllocatePool(EfiLoaderData, Size, &OsKernelBuffer); |
||
| 123 | FileHandle->Read(FileHandle, &Size, OsKernelBuffer); |
||
| 124 | FileHandle->Close(FileHandle); |
||
| 125 | |||
| 126 | if(Size<1) return 0; |
||
| 127 | |||
| 128 | |||
| 129 | char * HOS = OsKernelBuffer; |
||
| 130 | int HOSSize = Size; |
||
| 131 | |||
| 132 | |||
| 133 | { |
||
| 134 | UINTN cookie; |
||
| 135 | void *p=(void *)KERNEL_LOAD_ADDRESS; |
||
| 136 | UINTN mapsize,descsize; |
||
| 137 | UINT32 desver; |
||
| 138 | EFI_STATUS status; |
||
| 139 | EFI_MEMORY_DESCRIPTOR emd[1024]; |
||
| 140 | |||
| 141 | |||
| 142 | mapsize=1024*sizeof(emd); |
||
| 143 | |||
| 144 | status=BS->AllocatePages(AllocateAnyPages,EfiLoaderData,/*(HOSSize>>12)+1*/ 1,p); |
||
| 145 | if(EFI_ERROR(status)){ |
||
| 146 | Print(L"Error 0\n"); |
||
| 147 | if(status == EFI_OUT_OF_RESOURCES) Print(L"EFI_OUT_OF_RESOURCES\n"); |
||
| 148 | if(status == EFI_INVALID_PARAMETER) Print(L"EFI_INVALID_PARAMETER\n"); |
||
| 149 | if(status == EFI_NOT_FOUND) Print(L"EFI_NOT_FOUND\n"); |
||
| 150 | return EFI_SUCCESS; |
||
| 151 | } |
||
| 152 | |||
| 153 | status=BS->GetMemoryMap(&mapsize,emd,&cookie,&descsize,&desver); |
||
| 154 | if(EFI_ERROR(status)){ |
||
| 155 | Print(L"Error 1\n"); |
||
| 156 | return EFI_SUCCESS; |
||
| 157 | } |
||
| 158 | status=BS->ExitBootServices(image,cookie); |
||
| 159 | if(EFI_ERROR(status)){ |
||
| 160 | Print(L"Error 2\n"); |
||
| 161 | return EFI_SUCCESS; |
||
| 162 | } |
||
| 163 | |||
| 164 | } |
||
| 165 | int a; |
||
| 166 | |||
| 167 | for(a=0;a<HOSSize;a++){ |
||
| 168 | ((char *)(0x4400000))[a]=HOS[a]; |
||
| 169 | } |
||
| 170 | |||
| 171 | //Run Kernel |
||
| 172 | asm volatile( |
||
| 173 | "nop.i 0x00 ;;\n" |
||
| 174 | "movl r15 = 0x4400000 ;;\n" |
||
| 175 | "mov b0 = r15;;" |
||
| 176 | "br.few b0;;\n" |
||
| 177 | ); |
||
| 178 | |||
| 179 | |||
| 180 | while(1){ |
||
| 181 | ((volatile int *)(0x80000000000b8000))[0]++; |
||
| 182 | } |
||
| 183 | return EFI_SUCCESS; |
||
| 184 | } |