123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245 |
- /** @file
- *
- * Copyright (c) 2017, Linaro, Ltd. All rights reserved.
- *
- * SPDX-License-Identifier: BSD-2-Clause-Patent
- *
- **/
- #include <Library/BaseLib.h>
- #include <Library/DebugLib.h>
- #include <Library/DevicePathLib.h>
- #include <Library/DtPlatformDtbLoaderLib.h>
- #include <Library/HiiLib.h>
- #include <Library/MemoryAllocationLib.h>
- #include <Library/UefiBootServicesTableLib.h>
- #include <Library/UefiDriverEntryPoint.h>
- #include <Library/UefiRuntimeServicesTableLib.h>
- #include "DtPlatformDxe.h"
- extern UINT8 DtPlatformHiiBin[];
- extern UINT8 DtPlatformDxeStrings[];
- typedef struct {
- VENDOR_DEVICE_PATH VendorDevicePath;
- EFI_DEVICE_PATH_PROTOCOL End;
- } HII_VENDOR_DEVICE_PATH;
- STATIC HII_VENDOR_DEVICE_PATH mDtPlatformDxeVendorDevicePath = {
- {
- {
- HARDWARE_DEVICE_PATH,
- HW_VENDOR_DP,
- {
- (UINT8)(sizeof (VENDOR_DEVICE_PATH)),
- (UINT8)((sizeof (VENDOR_DEVICE_PATH)) >> 8)
- }
- },
- DT_PLATFORM_FORMSET_GUID
- },
- {
- END_DEVICE_PATH_TYPE,
- END_ENTIRE_DEVICE_PATH_SUBTYPE,
- {
- (UINT8)(END_DEVICE_PATH_LENGTH),
- (UINT8)((END_DEVICE_PATH_LENGTH) >> 8)
- }
- }
- };
- STATIC
- EFI_STATUS
- InstallHiiPages (
- VOID
- )
- {
- EFI_STATUS Status;
- EFI_HII_HANDLE HiiHandle;
- EFI_HANDLE DriverHandle;
- DriverHandle = NULL;
- Status = gBS->InstallMultipleProtocolInterfaces (
- &DriverHandle,
- &gEfiDevicePathProtocolGuid,
- &mDtPlatformDxeVendorDevicePath,
- NULL
- );
- if (EFI_ERROR (Status)) {
- return Status;
- }
- HiiHandle = HiiAddPackages (
- &gDtPlatformFormSetGuid,
- DriverHandle,
- DtPlatformDxeStrings,
- DtPlatformHiiBin,
- NULL
- );
- if (HiiHandle == NULL) {
- gBS->UninstallMultipleProtocolInterfaces (
- DriverHandle,
- &gEfiDevicePathProtocolGuid,
- &mDtPlatformDxeVendorDevicePath,
- NULL
- );
- return EFI_OUT_OF_RESOURCES;
- }
- return EFI_SUCCESS;
- }
- /**
- The entry point for DtPlatformDxe driver.
- @param[in] ImageHandle The image handle of the driver.
- @param[in] SystemTable The system table.
- @retval EFI_ALREADY_STARTED The driver already exists in system.
- @retval EFI_OUT_OF_RESOURCES Fail to execute entry point due to lack of
- resources.
- @retval EFI_SUCCESS All the related protocols are installed on
- the driver.
- **/
- EFI_STATUS
- EFIAPI
- DtPlatformDxeEntryPoint (
- IN EFI_HANDLE ImageHandle,
- IN EFI_SYSTEM_TABLE *SystemTable
- )
- {
- EFI_STATUS Status;
- DT_ACPI_VARSTORE_DATA DtAcpiPref;
- UINTN BufferSize;
- VOID *Dtb;
- UINTN DtbSize;
- Dtb = NULL;
- Status = DtPlatformLoadDtb (&Dtb, &DtbSize);
- if (EFI_ERROR (Status)) {
- DEBUG ((
- DEBUG_WARN,
- "%a: no DTB blob could be loaded, defaulting to ACPI (Status == %r)\n",
- __FUNCTION__,
- Status
- ));
- DtAcpiPref.Pref = DT_ACPI_SELECT_ACPI;
- } else {
- //
- // Get the current DT/ACPI preference from the DtAcpiPref variable.
- //
- BufferSize = sizeof (DtAcpiPref);
- Status = gRT->GetVariable (
- DT_ACPI_VARIABLE_NAME,
- &gDtPlatformFormSetGuid,
- NULL,
- &BufferSize,
- &DtAcpiPref
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((
- DEBUG_WARN,
- "%a: no DT/ACPI preference found, defaulting to %a\n",
- __FUNCTION__,
- PcdGetBool (PcdDefaultDtPref) ? "DT" : "ACPI"
- ));
- DtAcpiPref.Pref = PcdGetBool (PcdDefaultDtPref) ? DT_ACPI_SELECT_DT
- : DT_ACPI_SELECT_ACPI;
- }
- }
- if (!EFI_ERROR (Status) &&
- (DtAcpiPref.Pref != DT_ACPI_SELECT_ACPI) &&
- (DtAcpiPref.Pref != DT_ACPI_SELECT_DT))
- {
- DEBUG ((
- DEBUG_WARN,
- "%a: invalid value for %s, defaulting to %a\n",
- __FUNCTION__,
- DT_ACPI_VARIABLE_NAME,
- PcdGetBool (PcdDefaultDtPref) ? "DT" : "ACPI"
- ));
- DtAcpiPref.Pref = PcdGetBool (PcdDefaultDtPref) ? DT_ACPI_SELECT_DT
- : DT_ACPI_SELECT_ACPI;
- Status = EFI_INVALID_PARAMETER; // trigger setvar below
- }
- //
- // Write the newly selected default value back to the variable store.
- //
- if (EFI_ERROR (Status)) {
- Status = gRT->SetVariable (
- DT_ACPI_VARIABLE_NAME,
- &gDtPlatformFormSetGuid,
- EFI_VARIABLE_NON_VOLATILE | EFI_VARIABLE_BOOTSERVICE_ACCESS,
- sizeof (DtAcpiPref),
- &DtAcpiPref
- );
- if (EFI_ERROR (Status)) {
- goto FreeDtb;
- }
- }
- if (DtAcpiPref.Pref == DT_ACPI_SELECT_ACPI) {
- //
- // ACPI was selected: install the gEdkiiPlatformHasAcpiGuid GUID as a
- // NULL protocol to unlock dispatch of ACPI related drivers.
- //
- Status = gBS->InstallMultipleProtocolInterfaces (
- &ImageHandle,
- &gEdkiiPlatformHasAcpiGuid,
- NULL,
- NULL
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((
- DEBUG_ERROR,
- "%a: failed to install gEdkiiPlatformHasAcpiGuid as a protocol\n",
- __FUNCTION__
- ));
- goto FreeDtb;
- }
- } else if (DtAcpiPref.Pref == DT_ACPI_SELECT_DT) {
- //
- // DT was selected: copy the blob into newly allocated memory and install
- // a reference to it as the FDT configuration table.
- //
- Status = gBS->InstallConfigurationTable (&gFdtTableGuid, Dtb);
- if (EFI_ERROR (Status)) {
- DEBUG ((
- DEBUG_ERROR,
- "%a: failed to install FDT configuration table\n",
- __FUNCTION__
- ));
- goto FreeDtb;
- }
- } else {
- ASSERT (FALSE);
- }
- //
- // No point in installing the HII pages if ACPI is the only description
- // we have
- //
- if (Dtb == NULL) {
- return EFI_SUCCESS;
- }
- //
- // Note that we don't uninstall the gEdkiiPlatformHasAcpiGuid protocol nor
- // the FDT configuration table if the following call fails. While that will
- // cause loading of this driver to fail, proceeding with ACPI and DT both
- // disabled will guarantee a failed boot, and so it is better to leave them
- // installed in that case.
- //
- return InstallHiiPages ();
- FreeDtb:
- if (Dtb != NULL) {
- FreePool (Dtb);
- }
- return Status;
- }
|