123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269 |
- /** @file
- Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.<BR>
- Copyright (c) 2011 - 2014, ARM Limited. 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 <Uefi.h>
- #include <Chipset/ArmV7.h>
- #include <Library/ArmLib.h>
- #include <Library/BaseLib.h>
- #include <Library/IoLib.h>
- #include "ArmV7Lib.h"
- #include "ArmLibPrivate.h"
- ARM_CACHE_TYPE
- EFIAPI
- ArmCacheType (
- VOID
- )
- {
- return ARM_CACHE_TYPE_WRITE_BACK;
- }
- ARM_CACHE_ARCHITECTURE
- EFIAPI
- ArmCacheArchitecture (
- VOID
- )
- {
- UINT32 CLIDR = ReadCLIDR ();
- return (ARM_CACHE_ARCHITECTURE)CLIDR; // BugBug Fix Me
- }
- BOOLEAN
- EFIAPI
- ArmDataCachePresent (
- VOID
- )
- {
- UINT32 CLIDR = ReadCLIDR ();
- if ((CLIDR & 0x2) == 0x2) {
- // Instruction cache exists
- return TRUE;
- }
- if ((CLIDR & 0x7) == 0x4) {
- // Unified cache
- return TRUE;
- }
- return FALSE;
- }
- UINTN
- EFIAPI
- ArmDataCacheSize (
- VOID
- )
- {
- UINT32 NumSets;
- UINT32 Associativity;
- UINT32 LineSize;
- UINT32 CCSIDR = ReadCCSIDR (0);
- LineSize = (1 << ((CCSIDR & 0x7) + 2));
- Associativity = ((CCSIDR >> 3) & 0x3ff) + 1;
- NumSets = ((CCSIDR >> 13) & 0x7fff) + 1;
- // LineSize is in words (4 byte chunks)
- return NumSets * Associativity * LineSize * 4;
- }
- UINTN
- EFIAPI
- ArmDataCacheAssociativity (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (0);
- return ((CCSIDR >> 3) & 0x3ff) + 1;
- }
- UINTN
- ArmDataCacheSets (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (0);
- return ((CCSIDR >> 13) & 0x7fff) + 1;
- }
- UINTN
- EFIAPI
- ArmDataCacheLineLength (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (0) & 7;
- // * 4 converts to bytes
- return (1 << (CCSIDR + 2)) * 4;
- }
- BOOLEAN
- EFIAPI
- ArmInstructionCachePresent (
- VOID
- )
- {
- UINT32 CLIDR = ReadCLIDR ();
- if ((CLIDR & 1) == 1) {
- // Instruction cache exists
- return TRUE;
- }
- if ((CLIDR & 0x7) == 0x4) {
- // Unified cache
- return TRUE;
- }
- return FALSE;
- }
- UINTN
- EFIAPI
- ArmInstructionCacheSize (
- VOID
- )
- {
- UINT32 NumSets;
- UINT32 Associativity;
- UINT32 LineSize;
- UINT32 CCSIDR = ReadCCSIDR (1);
- LineSize = (1 << ((CCSIDR & 0x7) + 2));
- Associativity = ((CCSIDR >> 3) & 0x3ff) + 1;
- NumSets = ((CCSIDR >> 13) & 0x7fff) + 1;
- // LineSize is in words (4 byte chunks)
- return NumSets * Associativity * LineSize * 4;
- }
- UINTN
- EFIAPI
- ArmInstructionCacheAssociativity (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (1);
- return ((CCSIDR >> 3) & 0x3ff) + 1;
- // return 4;
- }
- UINTN
- EFIAPI
- ArmInstructionCacheSets (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (1);
- return ((CCSIDR >> 13) & 0x7fff) + 1;
- }
- UINTN
- EFIAPI
- ArmInstructionCacheLineLength (
- VOID
- )
- {
- UINT32 CCSIDR = ReadCCSIDR (1) & 7;
- // * 4 converts to bytes
- return (1 << (CCSIDR + 2)) * 4;
- // return 64;
- }
- VOID
- ArmV7DataCacheOperation (
- IN ARM_V7_CACHE_OPERATION DataCacheOperation
- )
- {
- UINTN SavedInterruptState;
- SavedInterruptState = ArmGetInterruptState ();
- ArmDisableInterrupts ();
- ArmV7AllDataCachesOperation (DataCacheOperation);
- ArmDrainWriteBuffer ();
- if (SavedInterruptState) {
- ArmEnableInterrupts ();
- }
- }
- VOID
- ArmV7PoUDataCacheOperation (
- IN ARM_V7_CACHE_OPERATION DataCacheOperation
- )
- {
- UINTN SavedInterruptState;
- SavedInterruptState = ArmGetInterruptState ();
- ArmDisableInterrupts ();
- ArmV7PerformPoUDataCacheOperation (DataCacheOperation);
- ArmDrainWriteBuffer ();
- if (SavedInterruptState) {
- ArmEnableInterrupts ();
- }
- }
- VOID
- EFIAPI
- ArmInvalidateDataCache (
- VOID
- )
- {
- ArmDrainWriteBuffer ();
- ArmV7DataCacheOperation (ArmInvalidateDataCacheEntryBySetWay);
- }
- VOID
- EFIAPI
- ArmCleanInvalidateDataCache (
- VOID
- )
- {
- ArmDrainWriteBuffer ();
- ArmV7DataCacheOperation (ArmCleanInvalidateDataCacheEntryBySetWay);
- }
- VOID
- EFIAPI
- ArmCleanDataCache (
- VOID
- )
- {
- ArmDrainWriteBuffer ();
- ArmV7DataCacheOperation (ArmCleanDataCacheEntryBySetWay);
- }
- VOID
- EFIAPI
- ArmCleanDataCacheToPoU (
- VOID
- )
- {
- ArmDrainWriteBuffer ();
- ArmV7PoUDataCacheOperation (ArmCleanDataCacheEntryBySetWay);
- }
|