git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_A53_64-bit_UltraScale_MPSoC/RTOSDemo_A53_bsp/psu_cortexa53_0/libsrc/standalone_v6_6/src/xil_smc.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2017 Xilinx, Inc. All rights reserved.
   4 *
   5 * Permission is hereby granted, free of charge, to any person obtaining a copy
   6 * of this software and associated documentation files (the "Software"), to deal
   7 * in the Software without restriction, including without limitation the rights
   8 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9 * copies of the Software, and to permit persons to whom the Software is
  10 * furnished to do so, subject to the following conditions:
  11 *
  12 * The above copyright notice and this permission notice shall be included in
  13 * all copies or substantial portions of the Software.
  14 *
  15 * Use of the Software is limited solely to applications:
  16 * (a) running on a Xilinx device, or
  17 * (b) that interact with a Xilinx device through a bus or interconnect.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  22 * XILINX  BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  23 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF
  24 * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  25 * SOFTWARE.
  26 *
  27 * Except as contained in this notice, the name of the Xilinx shall not be used
  28 * in advertising or otherwise to promote the sale, use or other dealings in
  29 * this Software without prior written authorization from Xilinx.
  30 *
  31 ******************************************************************************/
  32 /****************************************************************************/
  33 /**
  34 *
  35 * @file xil_smc.c
  36 *
  37 * This file contains function for initiating SMC call
  38 *
  39 * <pre>
  40 * MODIFICATION HISTORY:
  41 *
  42 * Ver   Who      Date     Changes
  43 * ----- -------- -------- -----------------------------------------------
  44 * 6.2   pkp      02/16/17 First release
  45 * </pre>
  46 *
  47 *****************************************************************************/
  48
  49 /***************************** Include Files ********************************/
  50 #include "xil_types.h"
  51 #include "xil_smc.h"
  52
  53 #if EL1_NONSECURE
  54 /************************** Constant Definitions ****************************/
  55
  56 /**************************** Type Definitions ******************************/
  57
  58 /***************** Macros (Inline Functions) Definitions ********************/
  59
  60 /************************** Function Prototypes *****************************/
  61
  62 /************************** Variable Definitions *****************************/
  63 XSmc_OutVar SmcResult;
  64
  65 /*****************************************************************************/
  66 /**
  67 * @brief        Initiate SMC call to EL3 secure monitor to request for secure
  68 *                       service. This function is only applicable for EL1 Non-secure bsp.
  69 *
  70 * @param        FunctionID is the SMC identifier for a particular secure service
  71 *                       request
  72 * @param        Arg1 to Arg6 is the arguements passed to EL3 secure monitor
  73 * @param        Arg7 is Hypervisor Client ID register
  74 *
  75 * @return       Result from secure payload service
  76 * @note         FunctionID and Arg1-Arg7 should be as per SMC calling convention
  77 *
  78 ******************************************************************************/
  79 XSmc_OutVar Xil_Smc(u64 FunctionID, u64 Arg1, u64 Arg2, u64 Arg3, u64 Arg4,
  80                                         u64 Arg5, u64 Arg6, u64 Arg7){
  81
  82         /*
  83          * Since registers x8 to x17 are not saved by secure monitor during SMC
  84          * it must be preserved.
  85          */
  86         XSave_X8toX17();
  87
  88         /* Moving to EL3 secure monitor with smc call. */
  89
  90         __asm__ __volatile__ ("smc #0x0");
  91
  92         /*
  93          * The result of the secure services are stored in x0 - x3. They are
  94          * moved to SmcResult to return the result.
  95          */
  96         __asm__ __volatile__("mov       x8, x0");
  97         __asm__ __volatile__("mov       x9, x1");
  98         __asm__ __volatile__("mov       x10, x2");
  99         __asm__ __volatile__("mov       x11, x3");
 100
 101         __asm__ __volatile__("mov       %0, x8" : "=r" (SmcResult.Arg0));
 102         __asm__ __volatile__("mov       %0, x9" : "=r" (SmcResult.Arg1));
 103         __asm__ __volatile__("mov       %0, x10" : "=r" (SmcResult.Arg2));
 104         __asm__ __volatile__("mov       %0, x11" : "=r" (SmcResult.Arg3));
 105
 106         XRestore_X8toX17();
 107
 108         return SmcResult;
 109 }
 110 #endif