EFI_STATUS
EFIAPI
EarlyConfigEntry (
IN EFI_PEI_FILE_HANDLE FileHandle,
IN CONST EFI_PEI_SERVICES **PeiServices
)
{
DEBUG((EFI_D_ERROR,"SMMU CONFIG........."));
SmmuConfigForOS();
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"ITS CONFIG........."));
ITSCONFIG();
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"AP CONFIG........."));
MmioWrite64(FixedPcdGet64(PcdMailBoxAddress), 0x0);
(void)WriteBackInvalidateDataCacheRange((VOID *) FixedPcdGet64(PcdMailBoxAddress), 8);
asm("DSB SY");
asm("ISB");
CoreSelectBoot();
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"MN CONFIG........."));
MN_CONFIG ();
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"RTC CONFIG........."));
MmioWrite32(0xA00021F0, 0xF);
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"Tsensor CONFIG........."));
MmioWrite32(0x80010000 + 0x5000, 0x1);
*(volatile UINT32*)0xA0000A8C = 0x1f;
DEBUG((EFI_D_ERROR,"Done\n"));
DEBUG((EFI_D_ERROR,"Timer CONFIG........."));
PlatformTimerStart ();
DEBUG((EFI_D_ERROR,"Done\n"));
return EFI_SUCCESS;
}
VOID
ESL_Start_OS (
)
{
EFI_STATUS Status;
UINTN Reg_Value;
ESL_LINUX LinuxKernel = (ESL_LINUX)(0x80000);
if(!PcdGet32(PcdIsMPBoot))
{
DEBUG((EFI_D_ERROR,"Update FDT\n"));
Status = EFIFdtUpdate(0x06000000);
if(EFI_ERROR(Status))
{
DEBUG((EFI_D_ERROR,"EFIFdtUpdate ERROR\n"));
goto Exit;
}
}
DEBUG((EFI_D_ERROR, "[%a]:[%dL] Start to boot Linux\n", __FUNCTION__, __LINE__));
SmmuConfigForLinux();
ITSCONFIG();
if(PcdGet32(PcdIsMPBoot))
{
*(volatile UINT32 *)(0x60016220) = 0x7;
*(volatile UINT32 *)(0x60016230) = 0x40016260;
*(volatile UINT32 *)(0x60016234) = 0X0;
*(volatile UINT32 *)(0x60016238) = 0x60016260;
*(volatile UINT32 *)(0x6001623C) = 0x400;
*(volatile UINT32 *)(0x60016240) = 0x40016260;
*(volatile UINT32 *)(0x60016244) = 0x400;
*(volatile UINT32 *)(0x40016220) = 0x7;
*(volatile UINT32 *)(0x40016230) = 0x60016260;
*(volatile UINT32 *)(0x40016234) = 0X0;
*(volatile UINT32 *)(0x40016238) = 0x60016260;
*(volatile UINT32 *)(0x4001623C) = 0x400;
*(volatile UINT32 *)(0x40016240) = 0x40016260;
*(volatile UINT32 *)(0x40016244) = 0x400;
*(volatile UINT32 *)(0x60016220 + S1_BASE) = 0x7;
*(volatile UINT32 *)(0x60016230 + S1_BASE) = 0x40016260;
*(volatile UINT32 *)(0x60016234 + S1_BASE) = 0X0;
*(volatile UINT32 *)(0x60016238 + S1_BASE) = 0x60016260;
*(volatile UINT32 *)(0x6001623C + S1_BASE) = 0x0;
*(volatile UINT32 *)(0x60016240 + S1_BASE) = 0x40016260;
*(volatile UINT32 *)(0x60016244 + S1_BASE) = 0x400;
*(volatile UINT32 *)(0x40016220 + S1_BASE) = 0x7;
*(volatile UINT32 *)(0x40016230 + S1_BASE) = 0x60016260;
*(volatile UINT32 *)(0x40016234 + S1_BASE) = 0X0;
*(volatile UINT32 *)(0x40016238 + S1_BASE) = 0x60016260;
*(volatile UINT32 *)(0x4001623C + S1_BASE) = 0x400;
*(volatile UINT32 *)(0x40016240 + S1_BASE) = 0x40016260;
*(volatile UINT32 *)(0x40016244 + S1_BASE) = 0x0;
}
Status = ShutdownUefiBootServices ();
if(EFI_ERROR(Status))
{
DEBUG((EFI_D_ERROR,"ERROR: Can not shutdown UEFI boot services. Status=0x%X\n", Status));
goto Exit;
}
//
// Switch off interrupts, caches, mmu, etc
//
Status = PreparePlatformHardware ();
ASSERT_EFI_ERROR(Status);
*(volatile UINT32*)0xFFF8 = 0x0;
*(volatile UINT32*)0xFFFC = 0x0;
asm("DSB SY");
asm("ISB");
if (!PcdGet64 (PcdTrustedFirmwareEnable))
{
StartupAp();
}
Reg_Value = asm_read_reg();
DEBUG((EFI_D_ERROR,"CPUECTLR_EL1 = 0x%llx\n",Reg_Value));
MN_CONFIG ();
DEBUG((EFI_D_ERROR, "[%a]:[%dL] Start to jump Linux kernel\n", __FUNCTION__, __LINE__));
LinuxKernel (0x06000000,0,0,0);
// Kernel should never exit
// After Life services are not provided
ASSERT(FALSE);
Exit:
// Only be here if we fail to start Linux
Print (L"ERROR : Can not start the kernel. Status=0x%X\n", Status);
// Free Runtimee Memory (kernel and FDT)
return ;
}
