ArmVirtPkg/HighMemDxe/HighMemDxe.c

   1 /** @file
   2 *  High memory node enumeration DXE driver for ARM Virtual Machines
   3 *
   4 *  Copyright (c) 2015-2016, Linaro Ltd. All rights reserved.
   5 *
   6 *  This program and the accompanying materials are licensed and made available
   7 *  under the terms and conditions of the BSD License which accompanies this
   8 *  distribution.  The full text of the license may be found at
   9 *  http://opensource.org/licenses/bsd-license.php
  10 *
  11 *  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  12 *  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR
  13 *  IMPLIED.
  14 *
  15 **/
  16
  17 #include <Library/BaseLib.h>
  18 #include <Library/DebugLib.h>
  19 #include <Library/DxeServicesTableLib.h>
  20 #include <Library/PcdLib.h>
  21 #include <Library/UefiBootServicesTableLib.h>
  22
  23 #include <Protocol/FdtClient.h>
  24
  25 EFI_STATUS
  26 EFIAPI
  27 InitializeHighMemDxe (
  28   IN EFI_HANDLE           ImageHandle,
  29   IN EFI_SYSTEM_TABLE     *SystemTable
  30   )
  31 {
  32   FDT_CLIENT_PROTOCOL   *FdtClient;
  33   EFI_STATUS            Status, FindNodeStatus;
  34   INT32                 Node;
  35   CONST UINT32          *Reg;
  36   UINT32                RegSize;
  37   UINTN                 AddressCells, SizeCells;
  38   UINT64                CurBase;
  39   UINT64                CurSize;
  40
  41   Status = gBS->LocateProtocol (&gFdtClientProtocolGuid, NULL,
  42                   (VOID **)&FdtClient);
  43   ASSERT_EFI_ERROR (Status);
  44
  45   //
  46   // Check for memory node and add the memory spaces except the lowest one
  47   //
  48   for (FindNodeStatus = FdtClient->FindMemoryNodeReg (FdtClient, &Node,
  49                                      (CONST VOID **) &Reg, &AddressCells,
  50                                      &SizeCells, &RegSize);
  51        !EFI_ERROR (FindNodeStatus);
  52        FindNodeStatus = FdtClient->FindNextMemoryNodeReg (FdtClient, Node,
  53                                      &Node, (CONST VOID **) &Reg, &AddressCells,
  54                                      &SizeCells, &RegSize)) {
  55     ASSERT (AddressCells <= 2);
  56     ASSERT (SizeCells <= 2);
  57
  58     while (RegSize > 0) {
  59       CurBase = SwapBytes32 (*Reg++);
  60       if (AddressCells > 1) {
  61         CurBase = (CurBase << 32) | SwapBytes32 (*Reg++);
  62       }
  63       CurSize = SwapBytes32 (*Reg++);
  64       if (SizeCells > 1) {
  65         CurSize = (CurSize << 32) | SwapBytes32 (*Reg++);
  66       }
  67       RegSize -= (AddressCells + SizeCells) * sizeof (UINT32);
  68
  69       if (PcdGet64 (PcdSystemMemoryBase) != CurBase) {
  70         Status = gDS->AddMemorySpace (EfiGcdMemoryTypeSystemMemory, CurBase,
  71                         CurSize, EFI_MEMORY_WB);
  72
  73         if (EFI_ERROR (Status)) {
  74           DEBUG ((EFI_D_ERROR,
  75             "%a: Failed to add System RAM @ 0x%lx - 0x%lx (%r)\n",
  76             __FUNCTION__, CurBase, CurBase + CurSize - 1, Status));
  77           continue;
  78         }
  79
  80         Status = gDS->SetMemorySpaceAttributes (CurBase, CurSize,
  81                         EFI_MEMORY_WB);
  82
  83         if (EFI_ERROR (Status)) {
  84           DEBUG ((EFI_D_ERROR,
  85             "%a: Failed to set System RAM @ 0x%lx - 0x%lx attribute (%r)\n",
  86             __FUNCTION__, CurBase, CurBase + CurSize - 1, Status));
  87         } else {
  88           DEBUG ((EFI_D_INFO, "%a: Add System RAM @ 0x%lx - 0x%lx\n",
  89             __FUNCTION__, CurBase, CurBase + CurSize - 1));
  90         }
  91       }
  92     }
  93   }
  94
  95   return EFI_SUCCESS;
  96 }