WebSVN – HelenOS – Diff – /branches/network/boot/arch/ia64/loader/gefi/HelenOS/hello.c

 #include <efi.h>
 #include <efilib.h>
+#include <../../../../../../kernel/arch/ia64/include/bootinfo.h>
 #define KERNEL_LOAD_ADDRESS 0x4400000
+#define MEM_MAP_DESCRIPTOR_OFFSET_TYPE 0
+#define MEM_MAP_DESCRIPTOR_OFFSET_BASE 8
+#define MEM_MAP_DESCRIPTOR_OFFSET_PAGES 24
+//Link image as a data array into hello - usefull with network boot
+//#define IMAGE_LINKED
+bootinfo_t *bootinfo=(bootinfo_t *)BOOTINFO_ADDRESS;
+#ifdef IMAGE_LINKED
+extern char HOSimage[];
+extern int HOSimagesize;
+#endif
 static CHAR16 *
 a2u (char *str)
+{
     static CHAR16 mem[2048];
     for (i = 0; str[i]; ++i)
         mem[i] = (CHAR16) str[i];
     mem[i] = 0;
     return mem;
+}
-char HEX[256];
-char hexs[]="0123456789ABCDEF";
-/*
-void to_hex(unsigned long long num)
-{
-    int a;
-    for(a=15;a>=0;a--)
-    {
-    char c=num - (num & 0xfffffffffffffff0LL);
-    num/=16;
-    c=hexs[c];
-    HEX[a]=c;
-    }
-}
-*/
 EFI_STATUS
 efi_main (EFI_HANDLE image, EFI_SYSTEM_TABLE *systab)
+{
     SIMPLE_TEXT_OUTPUT_INTERFACE *conout;
     EFI_FILE *CurDir;
     EFI_FILE *FileHandle;
     BS->HandleProtocol(LoadedImage->DeviceHandle, &FileSystemProtocol, &Vol);
-    Vol->OpenVolume (Vol, &CurDir);
     char FileName[1024];
     char *OsKernelBuffer;
     int i;
+    int defaultLoad;
+    int imageLoad;
     UINTN Size;
     StrCpy(FileName,DevicePathToStr(LoadedImage->FilePath));
     for(i=StrLen(FileName);i>=0 && FileName[i]!='\\';i--);
     FileName[i] = 0;
+    FileName[0] = 0;
     Print(L"%s\n",LoadedImage->LoadOptions);
     i=0;
     CHAR16 *LoadOptions = LoadedImage->LoadOptions;
         if(LoadOptions[i]==0) break;
         i++;
+    }
     while(LoadOptions[i]==L' ') if(LoadOptions[i++]==0) break;
-    if(LoadOptions[i++]==0)
+    if(LoadOptions[i++]==0){
         StrCat(FileName,L"\\image.bin");
+        defaultLoad=1;
+    }
-    else{
+/*  else{
         CHAR16 buf[1024];
-        buf[0]='\\';
+        //buf[0]='\\';
         i--;
         int j;
         for(j=0;LoadOptions[i+j]!=L' '&&LoadOptions[i+j]!=0;j++)
             buf[j+1]=LoadOptions[i+j];
         buf[j+1]=0;
         StrCat(FileName,buf);
+        defaultLoad=0;
+    }*/
+    else{
+        CHAR16 buf[1024];
+        //buf[0]='\\';
+        i--;
+        int j;
+        for(j=0;LoadOptions[i+j]!=L' '&&LoadOptions[i+j]!=0;j++)
+            buf[j]=LoadOptions[i+j];
+        buf[j+1]=0;
+        StrCat(FileName,buf);
+        defaultLoad=0;
+    }
-    //Print(L"%s\n",FileName);
-    EFI_STATUS stat;
+    imageLoad=1;
-    stat=CurDir->Open(CurDir, &FileHandle, FileName, EFI_FILE_MODE_READ, 0);
+#ifdef IMAGE_LINKED
-    if(EFI_ERROR(stat)){
+    if(defaultLoad) {
-        Print(L"Error Opening Image %s\n",FileName);
+        Print(L"Using Linked Image\n");
-        return 0;
+        imageLoad=0;
+    }
-    Size = 0x00400000;
+#endif
-    BS->AllocatePool(EfiLoaderData, Size, &OsKernelBuffer);
-    FileHandle->Read(FileHandle, &Size, OsKernelBuffer);
-    FileHandle->Close(FileHandle);
+    char *  HOS;
+    if(imageLoad)
+    {
-    if(Size<1) return 0;
+        Size = 0x00400000;
+            Vol->OpenVolume (Vol, &CurDir);
+        EFI_STATUS stat;
+        stat=CurDir->Open(CurDir, &FileHandle, FileName, EFI_FILE_MODE_READ, 0);
+        if(EFI_ERROR(stat)){
+            Print(L"Error Opening Image %s\n",FileName);
+            return 0;
+        }
+            BS->AllocatePool(EfiLoaderData, Size, &OsKernelBuffer);
+        FileHandle->Read(FileHandle, &Size, OsKernelBuffer);
+        FileHandle->Close(FileHandle);
-    char *  HOS = OsKernelBuffer;
+        HOS = OsKernelBuffer;
+            if(Size<1) return 0;
+    }
+#ifdef IMAGE_LINKED
+    else {
+        HOS = HOSimage;
+        Size = HOSimagesize;
+        Print(L"Image start %llX\n",(long long)HOS);
+        Print(L"Image size %llX\n",(long long)Size);
+        Print(L"Image &size %llX\n",(long long)&Size);
+    }
+#endif
     int HOSSize = Size;
+    rArg rSAL;
+    rArg rPAL;
+    //Setup AP's wake up address
+    LibSalProc(0x01000000,2,0x4400200,0,0,0,0,0,&rSAL);
+    //Get System Frequency
+    UINT64 sys_freq;
+    LibSalProc(0x01000012,0,0,0,0,0,0,0,&rSAL);
+    sys_freq=rSAL.p1;
-    {
+    UINT64 freq_scale;
+    //Get CPU Frequency to System Frequency ratio
+    LibPalProc(14,0,0,0,&rPAL);
+    freq_scale=rPAL.p1;
+        UINT64 sapic;
+        LibGetSalIpiBlock(&sapic);
+        Print (L"SAPIC:%X\n", sapic);
+    //bootinfo->sapic=sapic;
+        UINT64 wakeup_intno;
+        LibGetSalWakeupVector(&wakeup_intno);
+        Print (L"WAKEUP INTNO:%X\n", wakeup_intno);
         UINTN cookie;
         void *p=(void *)KERNEL_LOAD_ADDRESS;
         UINTN mapsize,descsize;
         UINT32 desver;
         EFI_STATUS status;
-        EFI_MEMORY_DESCRIPTOR emd[1024];
-        mapsize=1024*sizeof(emd);
         status=BS->AllocatePages(AllocateAnyPages,EfiLoaderData,/*(HOSSize>>12)+1*/ 1,p);
         if(EFI_ERROR(status)){
         Print(L"Error 0\n");
         if(status == EFI_OUT_OF_RESOURCES) Print(L"EFI_OUT_OF_RESOURCES\n");
         if(status == EFI_INVALID_PARAMETER) Print(L"EFI_INVALID_PARAMETER\n");
         if(status == EFI_NOT_FOUND) Print(L"EFI_NOT_FOUND\n");
         return EFI_SUCCESS;
+        }
+        UINTN no_entryes;
+        void * mds;
-        status=BS->GetMemoryMap(&mapsize,emd,&cookie,&descsize,&desver);
+        mds=LibMemoryMap(&no_entryes,&cookie,&descsize,&desver);
-        if(EFI_ERROR(status)){
+        for(i=0;i<no_entryes;i++)
-        Print(L"Error 1\n");
+        {
+            unsigned int type=*((unsigned int *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_TYPE));
+            unsigned long long base=*((unsigned long long *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_BASE));
+            unsigned long long pages=*((unsigned long long *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_PAGES));
-        return EFI_SUCCESS;
+            Print(L"T:%02d %016llX %016llX\n",type,base,pages*EFI_PAGE_SIZE);
+        }
         status=BS->ExitBootServices(image,cookie);
         if(EFI_ERROR(status)){
         Print(L"Error 2\n");
         return EFI_SUCCESS;
+        }
-    }
     int a;
     for(a=0;a<HOSSize;a++){
         ((char *)(0x4400000))[a]=HOS[a];
+    }
+    bootinfo->sapic=(unsigned long *)sapic;
+    bootinfo->wakeup_intno=wakeup_intno;
+    bootinfo->sys_freq=sys_freq;
+    bootinfo->freq_scale=freq_scale;
+    bootinfo->hello_configured=1;
+        bootinfo->memmap_items=0;
+        for(i=0;i<no_entryes;i++)
+        {
+            unsigned int type=*((unsigned int *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_TYPE));
+            unsigned long long base=*((unsigned long long *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_BASE));
+            unsigned long long pages=*((unsigned long long *)(mds+i*descsize+MEM_MAP_DESCRIPTOR_OFFSET_PAGES));
+            switch (type)
+            {
+                case EfiConventionalMemory:
+                bootinfo->memmap[bootinfo->memmap_items].type=EFI_MEMMAP_FREE_MEM;
+                bootinfo->memmap[bootinfo->memmap_items].base=base;
+                bootinfo->memmap[bootinfo->memmap_items].size=pages*EFI_PAGE_SIZE;
+                    bootinfo->memmap_items++;
+                    break;
+                case EfiMemoryMappedIO:
+                bootinfo->memmap[bootinfo->memmap_items].type=EFI_MEMMAP_IO;
+                bootinfo->memmap[bootinfo->memmap_items].base=base;
+                bootinfo->memmap[bootinfo->memmap_items].size=pages*EFI_PAGE_SIZE;
+                    bootinfo->memmap_items++;
+                    break;
+                case EfiMemoryMappedIOPortSpace:
+                bootinfo->memmap[bootinfo->memmap_items].type=EFI_MEMMAP_IO_PORTS;
+                bootinfo->memmap[bootinfo->memmap_items].base=base;
+                bootinfo->memmap[bootinfo->memmap_items].size=pages*EFI_PAGE_SIZE;
+                    bootinfo->memmap_items++;
+                    break;
+                default :
+                    break;
+            }
+        }
     //Run Kernel
     asm volatile(
         "nop.i 0x00 ;;\n"
         "movl r15 = 0x4400000 ;;\n"
         "mov b0 = r15;;"
         "br.few b0;;\n"
     );
-    while(1){
+    //Not reached
-        ((volatile int *)(0x80000000000b8000))[0]++;
-    }
     return EFI_SUCCESS;
+}

Subversion Repositories HelenOS

(root)/branches/network/boot/arch/ia64/loader/gefi/HelenOS/hello.c – Rev 3386 → 4153