mirror of
https://github.com/acidanthera/audk.git
synced 2025-04-08 17:05:09 +02:00
a8a72fc1ff
Normally, DXE driver would add device resource to GCD before start using. But some key resources such as uart used for printing info at very early stage. Those resources should be populated to HOB in SEC phase so they are added to GCD before MMU enabled. Signed-off-by: Tuan Phan <tphan@ventanamicro.com> Reviewed-by: Andrei Warkentin <andrei.warkentin@intel.com> Reviewed-by: Sunil V L <sunilvl@ventanamicro.com>
147 lines
3.8 KiB
C
147 lines
3.8 KiB
C
/** @file
|
|
The library call to pass the device tree to DXE via HOB.
|
|
|
|
Copyright (c) 2021, Hewlett Packard Enterprise Development LP. All rights reserved.<BR>
|
|
|
|
SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
|
|
**/
|
|
|
|
//
|
|
//// The package level header files this module uses
|
|
////
|
|
#include <PiPei.h>
|
|
|
|
#include <Library/DebugLib.h>
|
|
#include <Library/HobLib.h>
|
|
#include <Library/MemoryAllocationLib.h>
|
|
#include <Library/BaseRiscVSbiLib.h>
|
|
#include <Library/PcdLib.h>
|
|
#include <Include/Library/PrePiLib.h>
|
|
#include <libfdt.h>
|
|
#include <Guid/FdtHob.h>
|
|
|
|
/**
|
|
Build memory map I/O range resource HOB using the
|
|
base address and size.
|
|
|
|
@param MemoryBase Memory map I/O base.
|
|
@param MemorySize Memory map I/O size.
|
|
|
|
**/
|
|
STATIC
|
|
VOID
|
|
AddIoMemoryBaseSizeHob (
|
|
EFI_PHYSICAL_ADDRESS MemoryBase,
|
|
UINT64 MemorySize
|
|
)
|
|
{
|
|
/* Align to EFI_PAGE_SIZE */
|
|
MemorySize = ALIGN_VALUE (MemorySize, EFI_PAGE_SIZE);
|
|
BuildResourceDescriptorHob (
|
|
EFI_RESOURCE_MEMORY_MAPPED_IO,
|
|
EFI_RESOURCE_ATTRIBUTE_PRESENT |
|
|
EFI_RESOURCE_ATTRIBUTE_INITIALIZED |
|
|
EFI_RESOURCE_ATTRIBUTE_UNCACHEABLE |
|
|
EFI_RESOURCE_ATTRIBUTE_TESTED,
|
|
MemoryBase,
|
|
MemorySize
|
|
);
|
|
}
|
|
|
|
/**
|
|
Populate IO resources from FDT that not added to GCD by its
|
|
driver in the DXE phase.
|
|
|
|
@param FdtBase Fdt base address
|
|
@param Compatible Compatible string
|
|
|
|
**/
|
|
STATIC
|
|
VOID
|
|
PopulateIoResources (
|
|
VOID *FdtBase,
|
|
CONST CHAR8 *Compatible
|
|
)
|
|
{
|
|
UINT64 *Reg;
|
|
INT32 Node, LenP;
|
|
|
|
Node = fdt_node_offset_by_compatible (FdtBase, -1, Compatible);
|
|
while (Node != -FDT_ERR_NOTFOUND) {
|
|
Reg = (UINT64 *)fdt_getprop (FdtBase, Node, "reg", &LenP);
|
|
if (Reg) {
|
|
ASSERT (LenP == (2 * sizeof (UINT64)));
|
|
AddIoMemoryBaseSizeHob (SwapBytes64 (Reg[0]), SwapBytes64 (Reg[1]));
|
|
}
|
|
|
|
Node = fdt_node_offset_by_compatible (FdtBase, Node, Compatible);
|
|
}
|
|
}
|
|
|
|
/**
|
|
@retval EFI_SUCCESS The address of FDT is passed in HOB.
|
|
EFI_UNSUPPORTED Can't locate FDT.
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
PlatformPeimInitialization (
|
|
VOID
|
|
)
|
|
{
|
|
EFI_RISCV_FIRMWARE_CONTEXT *FirmwareContext;
|
|
VOID *FdtPointer;
|
|
VOID *Base;
|
|
VOID *NewBase;
|
|
UINTN FdtSize;
|
|
UINTN FdtPages;
|
|
UINT64 *FdtHobData;
|
|
|
|
FirmwareContext = NULL;
|
|
GetFirmwareContextPointer (&FirmwareContext);
|
|
|
|
if (FirmwareContext == NULL) {
|
|
DEBUG ((DEBUG_ERROR, "%a: Firmware Context is NULL\n", __func__));
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
FdtPointer = (VOID *)FirmwareContext->FlattenedDeviceTree;
|
|
if (FdtPointer == NULL) {
|
|
DEBUG ((DEBUG_ERROR, "%a: Invalid FDT pointer\n", __func__));
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
DEBUG ((DEBUG_INFO, "%a: Build FDT HOB - FDT at address: 0x%x \n", __func__, FdtPointer));
|
|
Base = FdtPointer;
|
|
if (fdt_check_header (Base) != 0) {
|
|
DEBUG ((DEBUG_ERROR, "%a: Corrupted DTB\n", __func__));
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
FdtSize = fdt_totalsize (Base);
|
|
FdtPages = EFI_SIZE_TO_PAGES (FdtSize);
|
|
NewBase = AllocatePages (FdtPages);
|
|
if (NewBase == NULL) {
|
|
DEBUG ((DEBUG_ERROR, "%a: Could not allocate memory for DTB\n", __func__));
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
fdt_open_into (Base, NewBase, EFI_PAGES_TO_SIZE (FdtPages));
|
|
|
|
FdtHobData = BuildGuidHob (&gFdtHobGuid, sizeof *FdtHobData);
|
|
if (FdtHobData == NULL) {
|
|
DEBUG ((DEBUG_ERROR, "%a: Could not build FDT Hob\n", __func__));
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
*FdtHobData = (UINTN)NewBase;
|
|
|
|
BuildFvHob (PcdGet32 (PcdOvmfDxeMemFvBase), PcdGet32 (PcdOvmfDxeMemFvSize));
|
|
|
|
PopulateIoResources (Base, "ns16550a");
|
|
PopulateIoResources (Base, "qemu,fw-cfg-mmio");
|
|
PopulateIoResources (Base, "virtio,mmio");
|
|
|
|
return EFI_SUCCESS;
|
|
}
|