ArmPlatformPkg/ArmVExpressDxe: Load FDT into the EFI Configuration Table

[mirror_edk2.git] / ArmPlatformPkg / ArmVExpressPkg / ArmVExpressDxe / Arm / ArmFvpDxeArm.c

/** @file\r
\r
  Copyright (c) 2014, ARM Ltd. All rights reserved.\r
\r
  This program and the accompanying materials are licensed and made available\r
  under the terms and conditions of the BSD License which accompanies this\r
  distribution.  The full text of the license may be found at\r
  http://opensource.org/licenses/bsd-license.php\r
\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, WITHOUT\r
  WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
\r
#include "ArmVExpressInternal.h"\r
#include <Library/ArmPlatformLib.h>  // To get Core Count\r
\r
//\r
// Description of the four ARM model platforms :\r
// just the platform id for the time being.\r
// Platform ids are defined in ArmVExpressInternal.h for\r
// all "ArmVExpress-like" platforms (AARCH64 or ARM architecture,\r
// model or hardware platforms).\r
//\r
CONST ARM_VEXPRESS_PLATFORM ArmVExpressPlatforms[] = {\r
  { ARM_FVP_VEXPRESS_A9x4, { 0x943f2ae9, 0x51b2, 0x48b2, { 0x82, 0xc4, 0x9a, 0xeb, 0x2c, 0x21, 0xd8, 0xe1 } }, L"rtsm_ve-cortex_a9x4.dtb" },\r
  { ARM_FVP_VEXPRESS_A15x1, { 0x581930c3, 0x9f53, 0x4c53, { 0x91, 0x23, 0x43, 0xb8, 0x65, 0xdf, 0x3f, 0x23} }, L"rtsm_ve-cortex_a15x1.dtb" },\r
  { ARM_FVP_VEXPRESS_A15x2, { 0x3f10b34a, 0xa310, 0x472c, { 0xac, 0xb9, 0x36, 0x0b, 0x1d, 0xb5, 0x7a, 0x8b} }, L"rtsm_ve-cortex_a15x2.dtb" },\r
  { ARM_FVP_VEXPRESS_A15x4, { 0x9a783838, 0x8a77, 0x4cdb, { 0x82, 0xa4, 0x35, 0x91, 0x2c, 0x08, 0x8a, 0x2e} }, L"rtsm_ve-cortex_a15x4.dtb" },\r
  { ARM_FVP_VEXPRESS_UNKNOWN, { 0x0, 0x0, 0x0, { 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0 } } }\r
};\r
\r
/**\r
  Get information about the VExpress platform the firmware is running on.\r
\r
  @param[out]  Platform   Address where the pointer to the platform information\r
                          (type ARM_VEXPRESS_PLATFORM*) should be stored.\r
                          The returned pointer does not point to an allocated\r
                          memory area.\r
\r
  @retval  EFI_SUCCESS    The platform information was returned.\r
  @retval  EFI_NOT_FOUND  The platform was not recognised.\r
\r
**/\r
EFI_STATUS\r
ArmVExpressGetPlatform (\r
  OUT CONST ARM_VEXPRESS_PLATFORM** Platform\r
  )\r
{\r
  UINT32                SysId;\r
  UINTN                 CpuType;\r
  EFI_STATUS            Status;\r
  UINTN                 CoreCount;\r
\r
  ASSERT (Platform != NULL);\r
\r
  CpuType   = 0;\r
  Status    = EFI_NOT_FOUND;\r
  *Platform = NULL;\r
\r
  SysId = MmioRead32 (ARM_VE_SYS_ID_REG);\r
  if (SysId == ARM_RTSM_SYS_ID) {\r
    // Get the Cortex-A version\r
    CpuType = (ArmReadMidr () >> 4) & ARM_CPU_TYPE_MASK;\r
    if (CpuType == ARM_CPU_TYPE_A9) {\r
      Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A9x4, Platform);\r
    } else if (CpuType == ARM_CPU_TYPE_A15) {\r
      CoreCount = ArmGetCpuCountPerCluster ();\r
      if (CoreCount == 1) {\r
        Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x1, Platform);\r
      } else if (CoreCount == 2) {\r
        Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x2, Platform);\r
      } else if (CoreCount == 4) {\r
        Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x4, Platform);\r
      }\r
    }\r
  }\r
\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "Unsupported platform (SysId:0x%X, CpuType:0x%X)\n", SysId, CpuType));\r
    ASSERT_EFI_ERROR (Status);\r
  }\r
\r
  return Status;\r
}\r