arch/arm/cpu/armv8/fwcall.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /**
   3  * (C) Copyright 2014, Cavium Inc.
   4  * (C) Copyright 2017, Xilinx Inc.
   5  *
   6 **/
   7
   8 #include <asm-offsets.h>
   9 #include <config.h>
  10 #include <version.h>
  11 #include <asm/cache.h>
  12 #include <asm/macro.h>
  13 #include <asm/psci.h>
  14 #include <asm/ptrace.h>
  15 #include <asm/system.h>
  16
  17 /*
  18  * Issue the hypervisor call
  19  *
  20  * x0~x7: input arguments
  21  * x0~x3: output arguments
  22  */
  23 static void hvc_call(struct pt_regs *args)
  24 {
  25         asm volatile(
  26                 "ldr x0, %0\n"
  27                 "ldr x1, %1\n"
  28                 "ldr x2, %2\n"
  29                 "ldr x3, %3\n"
  30                 "ldr x4, %4\n"
  31                 "ldr x5, %5\n"
  32                 "ldr x6, %6\n"
  33                 "hvc    #0\n"
  34                 "str x0, %0\n"
  35                 "str x1, %1\n"
  36                 "str x2, %2\n"
  37                 "str x3, %3\n"
  38                 : "+m" (args->regs[0]), "+m" (args->regs[1]),
  39                   "+m" (args->regs[2]), "+m" (args->regs[3])
  40                 : "m" (args->regs[4]), "m" (args->regs[5]),
  41                   "m" (args->regs[6])
  42                 : "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",
  43                   "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
  44                   "x16", "x17");
  45 }
  46
  47 /*
  48  * void smc_call(arg0, arg1...arg7)
  49  *
  50  * issue the secure monitor call
  51  *
  52  * x0~x7: input arguments
  53  * x0~x3: output arguments
  54  */
  55
  56 void smc_call(struct pt_regs *args)
  57 {
  58         asm volatile(
  59                 "ldr x0, %0\n"
  60                 "ldr x1, %1\n"
  61                 "ldr x2, %2\n"
  62                 "ldr x3, %3\n"
  63                 "ldr x4, %4\n"
  64                 "ldr x5, %5\n"
  65                 "ldr x6, %6\n"
  66                 "smc    #0\n"
  67                 "str x0, %0\n"
  68                 "str x1, %1\n"
  69                 "str x2, %2\n"
  70                 "str x3, %3\n"
  71                 : "+m" (args->regs[0]), "+m" (args->regs[1]),
  72                   "+m" (args->regs[2]), "+m" (args->regs[3])
  73                 : "m" (args->regs[4]), "m" (args->regs[5]),
  74                   "m" (args->regs[6])
  75                 : "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",
  76                   "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
  77                   "x16", "x17");
  78 }
  79
  80 /*
  81  * For now, all systems we support run at least in EL2 and thus
  82  * trigger PSCI calls to EL3 using SMC. If anyone ever wants to
  83  * use PSCI on U-Boot running below a hypervisor, please detect
  84  * this and set the flag accordingly.
  85  */
  86 static const bool use_smc_for_psci = true;
  87
  88 void __noreturn psci_system_reset(void)
  89 {
  90         struct pt_regs regs;
  91
  92         regs.regs[0] = ARM_PSCI_0_2_FN_SYSTEM_RESET;
  93
  94         if (use_smc_for_psci)
  95                 smc_call(&regs);
  96         else
  97                 hvc_call(&regs);
  98
  99         while (1)
 100                 ;
 101 }
 102
 103 void __noreturn psci_system_reset2(u32 reset_level, u32 cookie)
 104 {
 105         struct pt_regs regs;
 106
 107         regs.regs[0] = ARM_PSCI_0_2_FN64_SYSTEM_RESET2;
 108         regs.regs[1] = PSCI_RESET2_TYPE_VENDOR | reset_level;
 109         regs.regs[2] = cookie;
 110         if (use_smc_for_psci)
 111                 smc_call(&regs);
 112         else
 113                 hvc_call(&regs);
 114
 115         while (1)
 116                 ;
 117 }
 118
 119 void __noreturn psci_system_off(void)
 120 {
 121         struct pt_regs regs;
 122
 123         regs.regs[0] = ARM_PSCI_0_2_FN_SYSTEM_OFF;
 124
 125         if (use_smc_for_psci)
 126                 smc_call(&regs);
 127         else
 128                 hvc_call(&regs);
 129
 130         while (1)
 131                 ;
 132 }