UefiCpuPkg: Change complex DEBUG_CODE() to DEBUG_CODE_BEGIN/END()

[mirror_edk2.git] / ArmPkg / Library / ArmCacheMaintenanceLib / ArmCacheMaintenanceLib.c

/** @file\r
\r
  Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.<BR>\r
  Copyright (c) 2011 - 2021, ARM Limited. All rights reserved.\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
#include <Base.h>\r
#include <Library/ArmLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/PcdLib.h>\r
\r
STATIC\r
VOID\r
CacheRangeOperation (\r
  IN  VOID            *Start,\r
  IN  UINTN           Length,\r
  IN  LINE_OPERATION  LineOperation,\r
  IN  UINTN           LineLength\r
  )\r
{\r
  UINTN ArmCacheLineAlignmentMask;\r
  // Align address (rounding down)\r
  UINTN AlignedAddress;\r
  UINTN EndAddress;\r
\r
  ArmCacheLineAlignmentMask = LineLength - 1;\r
  AlignedAddress = (UINTN)Start - ((UINTN)Start & ArmCacheLineAlignmentMask);\r
  EndAddress     = (UINTN)Start + Length;\r
\r
  // Perform the line operation on an address in each cache line\r
  while (AlignedAddress < EndAddress) {\r
    LineOperation(AlignedAddress);\r
    AlignedAddress += LineLength;\r
  }\r
  ArmDataSynchronizationBarrier ();\r
}\r
\r
VOID\r
EFIAPI\r
InvalidateInstructionCache (\r
  VOID\r
  )\r
{\r
  ASSERT (FALSE);\r
}\r
\r
VOID\r
EFIAPI\r
InvalidateDataCache (\r
  VOID\r
  )\r
{\r
  ASSERT (FALSE);\r
}\r
\r
VOID *\r
EFIAPI\r
InvalidateInstructionCacheRange (\r
  IN      VOID                      *Address,\r
  IN      UINTN                     Length\r
  )\r
{\r
  CacheRangeOperation (Address, Length, ArmCleanDataCacheEntryToPoUByMVA,\r
    ArmDataCacheLineLength ());\r
  CacheRangeOperation (Address, Length,\r
    ArmInvalidateInstructionCacheEntryToPoUByMVA,\r
    ArmInstructionCacheLineLength ());\r
\r
  ArmInstructionSynchronizationBarrier ();\r
\r
  return Address;\r
}\r
\r
VOID\r
EFIAPI\r
WriteBackInvalidateDataCache (\r
  VOID\r
  )\r
{\r
  ASSERT (FALSE);\r
}\r
\r
VOID *\r
EFIAPI\r
WriteBackInvalidateDataCacheRange (\r
  IN      VOID                      *Address,\r
  IN      UINTN                     Length\r
  )\r
{\r
  CacheRangeOperation(Address, Length, ArmCleanInvalidateDataCacheEntryByMVA,\r
    ArmDataCacheLineLength ());\r
  return Address;\r
}\r
\r
VOID\r
EFIAPI\r
WriteBackDataCache (\r
  VOID\r
  )\r
{\r
  ASSERT (FALSE);\r
}\r
\r
VOID *\r
EFIAPI\r
WriteBackDataCacheRange (\r
  IN      VOID                      *Address,\r
  IN      UINTN                     Length\r
  )\r
{\r
  CacheRangeOperation(Address, Length, ArmCleanDataCacheEntryByMVA,\r
    ArmDataCacheLineLength ());\r
  return Address;\r
}\r
\r
VOID *\r
EFIAPI\r
InvalidateDataCacheRange (\r
  IN      VOID                      *Address,\r
  IN      UINTN                     Length\r
  )\r
{\r
  CacheRangeOperation(Address, Length, ArmInvalidateDataCacheEntryByMVA,\r
    ArmDataCacheLineLength ());\r
  return Address;\r
}\r