ArmPkg/Drivers/ArmCpuLib/ArmCortexA5xLib/ArmCortexA5xLib.c

   1 /** @file
   2
   3   Copyright (c) 2011-2013, ARM Limited. All rights reserved.
   4
   5   This program and the accompanying materials
   6   are licensed and made available under the terms and conditions of the BSD License
   7   which accompanies this 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,
  11   WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  12
  13 **/
  14
  15 #include <Base.h>
  16 #include <Library/ArmLib.h>
  17 #include <Library/ArmCpuLib.h>
  18 #include <Library/ArmArchTimerLib.h>
  19 #include <Library/DebugLib.h>
  20 #include <Library/IoLib.h>
  21 #include <Library/PcdLib.h>
  22
  23 #include <Chipset/ArmCortexA5x.h>
  24
  25 VOID
  26 ArmCpuSetup (
  27   IN  UINTN         MpId
  28   )
  29 {
  30   // Check if Architectural Timer frequency is valid number (should not be 0)
  31   ASSERT (PcdGet32 (PcdArmArchTimerFreqInHz));
  32   ASSERT (ArmIsArchTimerImplemented () != 0);
  33
  34   // Note: System Counter frequency can only be set in Secure privileged mode,
  35   // if security extensions are implemented.
  36   ArmArchTimerSetTimerFreq (PcdGet32 (PcdArmArchTimerFreqInHz));
  37
  38   if (ArmIsMpCore ()) {
  39     // Turn on SMP coherency
  40     ArmSetAuxCrBit (A5X_FEATURE_SMP);
  41   }
  42
  43 }
  44
  45 VOID
  46 ArmCpuSetupSmpNonSecure (
  47   IN  UINTN         MpId
  48   )
  49 {
  50 }
  51
  52 VOID
  53 EFIAPI
  54 ArmSetCpuExCrBit (
  55   IN  UINT64    Bits
  56   )
  57 {
  58   UINT64 Value;
  59   Value =  ArmReadCpuExCr ();
  60   Value |= Bits;
  61   ArmWriteCpuExCr (Value);
  62 }
  63
  64 VOID
  65 EFIAPI
  66 ArmUnsetCpuExCrBit (
  67   IN  UINT64    Bits
  68   )
  69 {
  70   UINT64 Value;
  71   Value = ArmReadCpuExCr ();
  72   Value &= ~Bits;
  73   ArmWriteCpuExCr (Value);
  74 }