rom/efi/efi_init.c

   1 #include <aros/debug.h>
   2 #include <resources/efi.h>
   3 #include <proto/arossupport.h>
   4 #include <proto/kernel.h>
   5
   6 #include "efi_intern.h"
   7
   8 static BOOL CheckTable(struct EFI_TableHeader *t, UQUAD sig)
   9 {
  10     if (t->Signature != sig)
  11     {
  12         D(bug("[EFI] Table 0x%p bad signature (has 0x%016llX, wanted 0x%016llX)\n", t, t->Signature, sig));
  13         return FALSE;
  14     }
  15
  16     /* TODO: Check CRC */
  17
  18     return TRUE;
  19 }
  20
  21 static int efi_Init(struct EFIBase *EFIBase)
  22 {
  23     APTR KernelBase;
  24     struct TagItem *tag;
  25
  26     D(bug("[EFI] Entered efi_Init() at 0x%p\n", efi_Init));
  27
  28     KernelBase = OpenResource("kernel.resource");
  29     if (!KernelBase)
  30     {
  31         return FALSE;
  32     }
  33
  34     tag = LibFindTagItem(KRN_EFISystemTable, KrnGetBootInfo());
  35     if (!tag)
  36     {
  37         D(bug("[EFI] No EFI system table from the bootstrap!\n"));
  38
  39         return FALSE;
  40     }
  41
  42     EFIBase->System = (struct EFI_SystemTable *)tag->ti_Data;
  43     D(bug("Found EFI system table at 0x%p\n", EFIBase->System));
  44
  45     if (!CheckTable(&EFIBase->System->Hdr, EFI_SYSTEM_TABLE_SIGNATURE))
  46     {
  47         D(bug("[EFI] System table broken\n"));
  48         return FALSE;
  49     }
  50
  51     if (CheckTable(&EFIBase->System->RuntimeServices->Hdr, EFI_RUNTIME_SERVICES_SIGNATURE))
  52     {
  53         EFIBase->Runtime = EFIBase->System->RuntimeServices;
  54         D(bug("[EFI] Valid runtime services table at 0x%p\n", EFIBase->Runtime));
  55
  56         /* Install ShutdownA() replacement */
  57         SetFunction(&SysBase->LibNode, -173 * LIB_VECTSIZE,
  58                     AROS_SLIB_ENTRY(ShutdownA, Efi, 173));
  59     }
  60
  61     return TRUE;
  62 }
  63
  64 ADD2INITLIB(efi_Init, 0);