Subversion Repositories HelenOS

Rev

Rev 2726 | Rev 3583 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2726 Rev 3578
Line 1... Line 1...
1 
#include <efi.h>
 1 
#include <efi.h>
2 
#include <efilib.h>
 2 
#include <efilib.h>
3 
 
 3 
 
- 
 
 4 
#include <../../../../../../kernel/arch/ia64/include/bootinfo.h>
- 
 
 5 
 
4 
#define KERNEL_LOAD_ADDRESS 0x4400000
 6 
#define KERNEL_LOAD_ADDRESS 0x4400000
5 
 
 7 
 
- 
 
 8 
//Link image as a data array into hello - usefull with network boot
- 
 
 9 
//#define IMAGE_LINKED
- 
 
 10 
 
- 
 
 11 
bootinfo_t *bootinfo=(bootinfo_t *)BOOTINFO_ADDRESS;
- 
 
 12 
 
- 
 
 13 
 
- 
 
 14 
#ifdef IMAGE_LINKED
- 
 
 15 
extern char HOSimage[];
- 
 
 16 
extern int HOSimagesize;
- 
 
 17 
#endif
- 
 
 18 
 
- 
 
 19 
 
6 
 
 20 
 
7 
static CHAR16 *
 21 
static CHAR16 *
8 
a2u (char *str)
 22 
a2u (char *str)
9 
{
 23 
{
10 
    static CHAR16 mem[2048];
 24 
    static CHAR16 mem[2048];
Line 13... Line 27...
13 
    for (i = 0; str[i]; ++i)
 27 
    for (i = 0; str[i]; ++i)
14 
        mem[i] = (CHAR16) str[i];
 28 
        mem[i] = (CHAR16) str[i];
15 
    mem[i] = 0;
 29 
    mem[i] = 0;
16 
    return mem;
 30 
    return mem;
17 
}
 31 
}
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 
 
 32 
 
36 
EFI_STATUS
 33 
EFI_STATUS
37 
efi_main (EFI_HANDLE image, EFI_SYSTEM_TABLE *systab)
 34 
efi_main (EFI_HANDLE image, EFI_SYSTEM_TABLE *systab)
38 
{
 35 
{
39 
    SIMPLE_TEXT_OUTPUT_INTERFACE *conout;
 36 
    SIMPLE_TEXT_OUTPUT_INTERFACE *conout;
Line 70... Line 67...
70 
 
 67 
 
71 
    EFI_FILE *CurDir;
 68 
    EFI_FILE *CurDir;
72 
    EFI_FILE *FileHandle;
 69 
    EFI_FILE *FileHandle;
73 
 
 70 
 
74 
    BS->HandleProtocol(LoadedImage->DeviceHandle, &FileSystemProtocol, &Vol);
 71 
    BS->HandleProtocol(LoadedImage->DeviceHandle, &FileSystemProtocol, &Vol);
75 
    Vol->OpenVolume (Vol, &CurDir);
 - 
 
76 
 
 72 
 
77 
    char FileName[1024];
 73 
    char FileName[1024];
78 
    char *OsKernelBuffer;
 74 
    char *OsKernelBuffer;
79 
    int i;
 75 
    int i;
- 
 
 76 
    int defaultLoad;
- 
 
 77 
    int imageLoad;
80 
    UINTN Size;
 78 
    UINTN Size;
81 
 
 79 
 
82 
    StrCpy(FileName,DevicePathToStr(LoadedImage->FilePath));
 80 
    StrCpy(FileName,DevicePathToStr(LoadedImage->FilePath));
83 
    for(i=StrLen(FileName);i>=0 && FileName[i]!='\\';i--);
 81 
    for(i=StrLen(FileName);i>=0 && FileName[i]!='\\';i--);
84 
    FileName[i] = 0;
 82 
    FileName[i] = 0;
Line 95... Line 93...
95 
        if(LoadOptions[i]==0) break;
 93 
        if(LoadOptions[i]==0) break;
96 
        i++;
 94 
        i++;
97 
    }
 95 
    }
98 
    while(LoadOptions[i]==L' ') if(LoadOptions[i++]==0) break;
 96 
    while(LoadOptions[i]==L' ') if(LoadOptions[i++]==0) break;
99 
   
 97 
   
100 
    if(LoadOptions[i++]==0)
 98 
    if(LoadOptions[i++]==0){
101 
        StrCat(FileName,L"\\image.bin");
 99 
        StrCat(FileName,L"\\image.bin");
- 
 
 100 
        defaultLoad=1;
- 
 
 101 
    }  
102 
    else{
 102 
    else{
103 
        CHAR16 buf[1024];
 103 
        CHAR16 buf[1024];
104 
        buf[0]='\\';
 104 
        buf[0]='\\';
105 
        i--;
 105 
        i--;
106 
        int j;
 106 
        int j;
107 
        for(j=0;LoadOptions[i+j]!=L' '&&LoadOptions[i+j]!=0;j++)
 107 
        for(j=0;LoadOptions[i+j]!=L' '&&LoadOptions[i+j]!=0;j++)
108 
            buf[j+1]=LoadOptions[i+j];
 108 
            buf[j+1]=LoadOptions[i+j];
109 
        buf[j+1]=0;
 109 
        buf[j+1]=0;
110 
        StrCat(FileName,buf);
 110 
        StrCat(FileName,buf);
- 
 
 111 
        defaultLoad=0;
111 
    }
 112 
    }
112 
   
 - 
 
113 
    //Print(L"%s\n",FileName);
 - 
 
114 
 
 113 
 
115 
    EFI_STATUS stat;
 114 
    imageLoad=1;
116 
    stat=CurDir->Open(CurDir, &FileHandle, FileName, EFI_FILE_MODE_READ, 0);
 115 
#ifdef IMAGE_LINKED
117 
    if(EFI_ERROR(stat)){
 116 
    if(defaultLoad) {
118 
        Print(L"Error Opening Image %s\n",FileName);
 117 
        Print(L"Using Linked Image\n");
119 
        return 0;
 118 
        imageLoad=0;
120 
    }    
 119 
    }    
121 
    Size = 0x00400000;
 120 
#endif 
122 
    BS->AllocatePool(EfiLoaderData, Size, &OsKernelBuffer);
 - 
 
123 
    FileHandle->Read(FileHandle, &Size, OsKernelBuffer);
 - 
 
124 
    FileHandle->Close(FileHandle);
 - 
 
- 
 
 121 
   
125 
 
 122 
 
- 
 
 123 
    char *  HOS;
- 
 
 124 
    if(imageLoad)
- 
 
 125 
    {
126 
    if(Size<1) return 0;
 126 
        Size = 0x00400000;
127 
 
 127 
 
- 
 
 128 
            Vol->OpenVolume (Vol, &CurDir);
128 
 
 129 
 
- 
 
 130 
        EFI_STATUS stat;
- 
 
 131 
        stat=CurDir->Open(CurDir, &FileHandle, FileName, EFI_FILE_MODE_READ, 0);
- 
 
 132 
        if(EFI_ERROR(stat)){
- 
 
 133 
            Print(L"Error Opening Image %s\n",FileName);
- 
 
 134 
            return 0;
- 
 
 135 
        }
- 
 
 136 
            BS->AllocatePool(EfiLoaderData, Size, &OsKernelBuffer);
- 
 
 137 
        FileHandle->Read(FileHandle, &Size, OsKernelBuffer);
- 
 
 138 
        FileHandle->Close(FileHandle);
129 
    char *  HOS = OsKernelBuffer;  
 139 
        HOS = OsKernelBuffer;  
- 
 
 140 
            if(Size<1) return 0;
- 
 
 141 
 
- 
 
 142 
    }      
- 
 
 143 
#ifdef IMAGE_LINKED
- 
 
 144 
    else {
- 
 
 145 
        HOS = HOSimage;  
- 
 
 146 
        Size = HOSimagesize;
- 
 
 147 
        Print(L"Image start %llX\n",(long long)HOS);
- 
 
 148 
        Print(L"Image size %llX\n",(long long)Size);
- 
 
 149 
        Print(L"Image &size %llX\n",(long long)&Size);
- 
 
 150 
    }
- 
 
 151 
#endif 
130 
    int HOSSize = Size;  
 152 
    int HOSSize = Size;  
131 
 
 153 
 
132 
 
 154 
 
- 
 
 155 
    rArg rSAL;
- 
 
 156 
    //Setup AP's wake up address
- 
 
 157 
 
- 
 
 158 
    LibSalProc(0x01000000,2,0x4400200,0,0,0,0,0,&rSAL);
- 
 
 159 
 
- 
 
 160 
 
- 
 
 161 
        UINT64 sapic;
- 
 
 162 
        LibGetSalIpiBlock(&sapic);
- 
 
 163 
        Print (L"SAPIC:%X\n", sapic);
- 
 
 164 
    bootinfo->sapic=sapic;
- 
 
 165 
 
- 
 
 166 
 
- 
 
 167 
        int wakeup_intno;
- 
 
 168 
        wakeup_intno=0xf0;
- 
 
 169 
        Print (L"WAKEUP INTNO:%X\n", wakeup_intno);
- 
 
 170 
    bootinfo->wakeup_intno=wakeup_intno;
- 
 
 171 
 
- 
 
 172 
 
- 
 
 173 
 
- 
 
 174 
 
- 
 
 175 
 
133 
    {
 176 
    {
134 
        UINTN cookie;
 177 
        UINTN cookie;
135 
        void *p=(void *)KERNEL_LOAD_ADDRESS;
 178 
        void *p=(void *)KERNEL_LOAD_ADDRESS;
136 
        UINTN mapsize,descsize;
 179 
        UINTN mapsize,descsize;
137 
        UINT32 desver;
 180 
        UINT32 desver;
Line 165... Line 208...
165 
    int a;
 208 
    int a;
166 
   
 209 
   
167 
    for(a=0;a<HOSSize;a++){
 210 
    for(a=0;a<HOSSize;a++){
168 
        ((char *)(0x4400000))[a]=HOS[a];
 211 
        ((char *)(0x4400000))[a]=HOS[a];
169 
    }
 212 
    }
- 
 
 213 
    bootinfo->sapic=(unsigned long *)sapic;
- 
 
 214 
    bootinfo->wakeup_intno=wakeup_intno;
170 
   
 215 
   
171 
    //Run Kernel
 216 
    //Run Kernel
172 
    asm volatile(  
 217 
    asm volatile(  
173 
        "nop.i 0x00 ;;\n"
 218 
        "nop.i 0x00 ;;\n"
174 
        "movl r15 = 0x4400000 ;;\n"
 219 
        "movl r15 = 0x4400000 ;;\n"
175 
        "mov b0 = r15;;"
 220 
        "mov b0 = r15;;"
176 
        "br.few b0;;\n"
 221 
        "br.few b0;;\n"
177 
    );
 222 
    );
178 
       
 223 
       
179 
   
 224 
   
180 
    while(1){
 225 
    //Not reached      
181 
        ((volatile int *)(0x80000000000b8000))[0]++;
 - 
 
182 
    }
 - 
 
183 
    return EFI_SUCCESS;
 226 
    return EFI_SUCCESS;
184 
}
 227 
}