ArmPlatformPkg/ArmVExpressPkg/Library/ArmVExpressSecLibRTSM/RTSMSec.c

   1 /** @file
   2 *
   3 *  Copyright (c) 2011-2012, 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 <Library/IoLib.h>
  16 #include <Library/ArmPlatformLib.h>
  17 #include <Library/DebugLib.h>
  18 #include <Library/PcdLib.h>
  19
  20 #include <Drivers/PL310L2Cache.h>
  21 #include <Drivers/SP804Timer.h>
  22
  23 #include <ArmPlatform.h>
  24
  25 /**
  26   Initialize the Secure peripherals and memory regions
  27
  28   If Trustzone is supported by your platform then this function makes the required initialization
  29   of the secure peripherals and memory regions.
  30
  31 **/
  32 VOID
  33 ArmPlatformSecTrustzoneInit (
  34   IN  UINTN                     MpId
  35   )
  36 {
  37   // No TZPC or TZASC on RTSM to initialize
  38 }
  39
  40 /**
  41   Initialize controllers that must setup at the early stage
  42
  43   Some peripherals must be initialized in Secure World.
  44   For example, some L2x0 requires to be initialized in Secure World
  45
  46 **/
  47 RETURN_STATUS
  48 ArmPlatformSecInitialize (
  49   IN  UINTN                     MpId
  50   )
  51 {
  52   // If it is not the primary core then there is nothing to do
  53   if (!IS_PRIMARY_CORE(MpId)) {
  54     return RETURN_SUCCESS;
  55   }
  56
  57   // Configure periodic timer (TIMER0) for 1MHz operation
  58   MmioOr32 (SP810_CTRL_BASE + SP810_SYS_CTRL_REG, SP810_SYS_CTRL_TIMER0_TIMCLK);
  59   // Configure 1MHz clock
  60   MmioOr32 (SP810_CTRL_BASE + SP810_SYS_CTRL_REG, SP810_SYS_CTRL_TIMER1_TIMCLK);
  61   // Configure SP810 to use 1MHz clock and disable
  62   MmioAndThenOr32 (SP810_CTRL_BASE + SP810_SYS_CTRL_REG, ~SP810_SYS_CTRL_TIMER2_EN, SP810_SYS_CTRL_TIMER2_TIMCLK);
  63   // Configure SP810 to use 1MHz clock and disable
  64   MmioAndThenOr32 (SP810_CTRL_BASE + SP810_SYS_CTRL_REG, ~SP810_SYS_CTRL_TIMER3_EN, SP810_SYS_CTRL_TIMER3_TIMCLK);
  65
  66   return RETURN_SUCCESS;
  67 }
  68
  69 /**
  70   Call before jumping to Normal World
  71
  72   This function allows the firmware platform to do extra actions before
  73   jumping to the Normal World
  74
  75 **/
  76 VOID
  77 ArmPlatformSecExtraAction (
  78   IN  UINTN         MpId,
  79   OUT UINTN*        JumpAddress
  80   )
  81 {
  82   *JumpAddress = PcdGet32(PcdFvBaseAddress);
  83 }