smccc-call.S 1.6 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465
  1. /*
  2. * Copyright (c) 2015, Linaro Limited
  3. *
  4. * This software is licensed under the terms of the GNU General Public
  5. * License version 2, as published by the Free Software Foundation, and
  6. * may be copied, distributed, and modified under those terms.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. */
  14. #include <linux/linkage.h>
  15. #include <asm/opcodes-sec.h>
  16. #include <asm/opcodes-virt.h>
  17. #include <asm/unwind.h>
  18. /*
  19. * Wrap c macros in asm macros to delay expansion until after the
  20. * SMCCC asm macro is expanded.
  21. */
  22. .macro SMCCC_SMC
  23. __SMC(0)
  24. .endm
  25. .macro SMCCC_HVC
  26. __HVC(0)
  27. .endm
  28. .macro SMCCC instr
  29. UNWIND( .fnstart)
  30. mov r12, sp
  31. push {r4-r7}
  32. UNWIND( .save {r4-r7})
  33. ldm r12, {r4-r7}
  34. \instr
  35. pop {r4-r7}
  36. ldr r12, [sp, #(4 * 4)]
  37. stm r12, {r0-r3}
  38. bx lr
  39. UNWIND( .fnend)
  40. .endm
  41. /*
  42. * void smccc_smc(unsigned long a0, unsigned long a1, unsigned long a2,
  43. * unsigned long a3, unsigned long a4, unsigned long a5,
  44. * unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
  45. * struct arm_smccc_quirk *quirk)
  46. */
  47. ENTRY(__arm_smccc_smc)
  48. SMCCC SMCCC_SMC
  49. ENDPROC(__arm_smccc_smc)
  50. /*
  51. * void smccc_hvc(unsigned long a0, unsigned long a1, unsigned long a2,
  52. * unsigned long a3, unsigned long a4, unsigned long a5,
  53. * unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
  54. * struct arm_smccc_quirk *quirk)
  55. */
  56. ENTRY(__arm_smccc_hvc)
  57. SMCCC SMCCC_HVC
  58. ENDPROC(__arm_smccc_hvc)