mirror of https://github.com/acidanthera/audk.git
130 lines
2.8 KiB
C
130 lines
2.8 KiB
C
/** @file
|
|
|
|
Copyright (c) 2008-2009, Apple Inc. All rights reserved.
|
|
|
|
All rights reserved. This program and the accompanying materials
|
|
are licensed and made available under the terms and conditions of the BSD License
|
|
which accompanies this distribution. The full text of the license may be found at
|
|
http://opensource.org/licenses/bsd-license.php
|
|
|
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
|
|
|
**/
|
|
#include <Base.h>
|
|
#include <Library/ArmLib.h>
|
|
#include <Library/PcdLib.h>
|
|
|
|
VOID
|
|
CacheRangeOperation (
|
|
IN VOID *Start,
|
|
IN UINTN Length,
|
|
IN CACHE_OPERATION CacheOperation,
|
|
IN LINE_OPERATION LineOperation
|
|
)
|
|
{
|
|
UINTN ArmCacheLineLength = ArmDataCacheLineLength();
|
|
UINTN ArmCacheLineAlignmentMask = ArmCacheLineLength - 1;
|
|
UINTN ArmCacheOperationThreshold = PcdGet32(PcdArmCacheOperationThreshold);
|
|
|
|
if ((CacheOperation != NULL) && (Length >= ArmCacheOperationThreshold))
|
|
{
|
|
CacheOperation();
|
|
}
|
|
else
|
|
{
|
|
// Align address (rounding down)
|
|
UINTN AlignedAddress = (UINTN)Start - ((UINTN)Start & ArmCacheLineAlignmentMask);
|
|
UINTN EndAddress = (UINTN)Start + Length;
|
|
|
|
// Perform the line operation on an address in each cache line
|
|
while (AlignedAddress < EndAddress)
|
|
{
|
|
LineOperation(AlignedAddress);
|
|
AlignedAddress += ArmCacheLineLength;
|
|
}
|
|
}
|
|
}
|
|
|
|
VOID
|
|
EFIAPI
|
|
InvalidateInstructionCache (
|
|
VOID
|
|
)
|
|
{
|
|
ArmCleanDataCache();
|
|
ArmInvalidateInstructionCache();
|
|
}
|
|
|
|
VOID
|
|
EFIAPI
|
|
InvalidateDataCache (
|
|
VOID
|
|
)
|
|
{
|
|
ArmInvalidateDataCache();
|
|
}
|
|
|
|
VOID *
|
|
EFIAPI
|
|
InvalidateInstructionCacheRange (
|
|
IN VOID *Address,
|
|
IN UINTN Length
|
|
)
|
|
{
|
|
CacheRangeOperation(Address, Length, ArmCleanDataCache, ArmCleanDataCacheEntryByMVA);
|
|
ArmInvalidateInstructionCache();
|
|
return Address;
|
|
}
|
|
|
|
VOID
|
|
EFIAPI
|
|
WriteBackInvalidateDataCache (
|
|
VOID
|
|
)
|
|
{
|
|
ArmCleanInvalidateDataCache();
|
|
}
|
|
|
|
VOID *
|
|
EFIAPI
|
|
WriteBackInvalidateDataCacheRange (
|
|
IN VOID *Address,
|
|
IN UINTN Length
|
|
)
|
|
{
|
|
CacheRangeOperation(Address, Length, ArmCleanInvalidateDataCache, ArmCleanInvalidateDataCacheEntryByMVA);
|
|
return Address;
|
|
}
|
|
|
|
VOID
|
|
EFIAPI
|
|
WriteBackDataCache (
|
|
VOID
|
|
)
|
|
{
|
|
ArmCleanDataCache();
|
|
}
|
|
|
|
VOID *
|
|
EFIAPI
|
|
WriteBackDataCacheRange (
|
|
IN VOID *Address,
|
|
IN UINTN Length
|
|
)
|
|
{
|
|
CacheRangeOperation(Address, Length, ArmCleanDataCache, ArmCleanDataCacheEntryByMVA);
|
|
return Address;
|
|
}
|
|
|
|
VOID *
|
|
EFIAPI
|
|
InvalidateDataCacheRange (
|
|
IN VOID *Address,
|
|
IN UINTN Length
|
|
)
|
|
{
|
|
CacheRangeOperation(Address, Length, NULL, ArmInvalidateDataCacheEntryByMVA);
|
|
return Address;
|
|
}
|