ArmPlatformPkg/ArmVExpressPkg/ArmVExpressDxe/Arm/ArmFvpDxeArm.c

   1 /** @file
   2
   3   Copyright (c) 2014, ARM Ltd. All rights reserved.
   4
   5   This program and the accompanying materials are licensed and made available
   6   under the terms and conditions of the BSD License which accompanies this
   7   distribution.  The full text of the license may be found at
   8   http://opensource.org/licenses/bsd-license.php
   9
  10   THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, WITHOUT
  11   WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  12
  13 **/
  14
  15 #include "ArmVExpressInternal.h"
  16 #include <Library/ArmPlatformLib.h>  // To get Core Count
  17
  18 //
  19 // Description of the four ARM model platforms :
  20 // just the platform id for the time being.
  21 // Platform ids are defined in ArmVExpressInternal.h for
  22 // all "ArmVExpress-like" platforms (AARCH64 or ARM architecture,
  23 // model or hardware platforms).
  24 //
  25 CONST ARM_VEXPRESS_PLATFORM ArmVExpressPlatforms[] = {
  26   { ARM_FVP_VEXPRESS_A9x4 },
  27   { ARM_FVP_VEXPRESS_A15x1 },
  28   { ARM_FVP_VEXPRESS_A15x2 },
  29   { ARM_FVP_VEXPRESS_A15x4 },
  30   { ARM_FVP_VEXPRESS_UNKNOWN }
  31 };
  32
  33 /**
  34   Get information about the VExpress platform the firmware is running on.
  35
  36   @param[out]  Platform   Address where the pointer to the platform information
  37                           (type ARM_VEXPRESS_PLATFORM*) should be stored.
  38                           The returned pointer does not point to an allocated
  39                           memory area.
  40
  41   @retval  EFI_SUCCESS    The platform information was returned.
  42   @retval  EFI_NOT_FOUND  The platform was not recognised.
  43
  44 **/
  45 EFI_STATUS
  46 ArmVExpressGetPlatform (
  47   OUT CONST ARM_VEXPRESS_PLATFORM** Platform
  48   )
  49 {
  50   UINT32                SysId;
  51   UINTN                 CpuType;
  52   EFI_STATUS            Status;
  53   UINTN                 CoreCount;
  54
  55   ASSERT (Platform != NULL);
  56
  57   CpuType   = 0;
  58   Status    = EFI_NOT_FOUND;
  59   *Platform = NULL;
  60
  61   SysId = MmioRead32 (ARM_VE_SYS_ID_REG);
  62   if (SysId == ARM_RTSM_SYS_ID) {
  63     // Get the Cortex-A version
  64     CpuType = (ArmReadMidr () >> 4) & ARM_CPU_TYPE_MASK;
  65     if (CpuType == ARM_CPU_TYPE_A9) {
  66       Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A9x4, Platform);
  67     } else if (CpuType == ARM_CPU_TYPE_A15) {
  68       CoreCount = ArmGetCpuCountPerCluster ();
  69       if (CoreCount == 1) {
  70         Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x1, Platform);
  71       } else if (CoreCount == 2) {
  72         Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x2, Platform);
  73       } else if (CoreCount == 4) {
  74         Status = ArmVExpressGetPlatformFromId (ARM_FVP_VEXPRESS_A15x4, Platform);
  75       }
  76     }
  77   }
  78
  79   if (EFI_ERROR (Status)) {
  80     DEBUG ((EFI_D_ERROR, "Unsupported platform (SysId:0x%X, CpuType:0x%X)\n", SysId, CpuType));
  81     ASSERT_EFI_ERROR (Status);
  82   }
  83
  84   return Status;
  85 }