Subversion Repositories HelenOS

Rev

Rev 3578 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  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. }
  185.