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 AROS_INTH1(static ResetHandler, struct EFIBase *, EFIBase)
  22 {
  23     AROS_INTFUNC_INIT
  24
  25     UBYTE action = EFIBase->reset_handler.is_Node.ln_Type;
  26     IPTR efiAction;
  27
  28     switch (action)
  29     {
  30     case SD_ACTION_COLDREBOOT:
  31         efiAction = EFI_Reset_Cold;
  32         break;
  33
  34     case SD_ACTION_POWEROFF:
  35         efiAction = EFI_Reset_Shutdown;
  36         break;
  37
  38     default:
  39         /* Unknown action */
  40         return FALSE;
  41     }
  42
  43     /* Use EFI runtime services to perform the action */
  44     EFIBase->Runtime->ResetSystem(efiAction, 0, 0, NULL);
  45
  46     /* Shut up the compiler, we should never reach this. */
  47     return FALSE;
  48
  49     AROS_INTFUNC_EXIT
  50 }
  51
  52 static int efi_Init(struct EFIBase *EFIBase)
  53 {
  54     APTR KernelBase;
  55     struct TagItem *tag;
  56
  57     D(bug("[EFI] Entered efi_Init() at 0x%p\n", efi_Init));
  58
  59     KernelBase = OpenResource("kernel.resource");
  60     if (!KernelBase)
  61     {
  62         return FALSE;
  63     }
  64
  65     tag = LibFindTagItem(KRN_EFISystemTable, KrnGetBootInfo());
  66     if (!tag)
  67     {
  68         D(bug("[EFI] No EFI system table from the bootstrap!\n"));
  69
  70         return FALSE;
  71     }
  72
  73     EFIBase->System = (struct EFI_SystemTable *)tag->ti_Data;
  74     D(bug("Found EFI system table at 0x%p\n", EFIBase->System));
  75
  76     if (!CheckTable(&EFIBase->System->Hdr, EFI_SYSTEM_TABLE_SIGNATURE))
  77     {
  78         D(bug("[EFI] System table broken\n"));
  79         return FALSE;
  80     }
  81
  82     if (CheckTable(&EFIBase->System->RuntimeServices->Hdr, EFI_RUNTIME_SERVICES_SIGNATURE))
  83     {
  84         EFIBase->Runtime = EFIBase->System->RuntimeServices;
  85         D(bug("[EFI] Valid runtime services table at 0x%p\n", EFIBase->Runtime));
  86
  87         /* Install EFI reset/power-off mechanism */
  88         EFIBase->reset_handler.is_Node.ln_Pri = -56;
  89         EFIBase->reset_handler.is_Code = (VOID_FUNC)ResetHandler;
  90         EFIBase->reset_handler.is_Data = EFIBase;
  91         AddResetCallback(&EFIBase->reset_handler);
  92     }
  93
  94     return TRUE;
  95 }
  96
  97 ADD2INITLIB(efi_Init, 0);