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-r11}
  32. UNWIND( .save {r4-r11})
  33. ldm r12, {r4-r7}
  34. mov r12, #0x200
  35. \instr
  36. pop {r4-r11}
  37. ldr r12, [sp, #(4 * 4)]
  38. stm r12, {r0-r3}
  39. bx lr
  40. UNWIND( .fnend)
  41. .endm
  42. /*
  43. * void smccc_smc(unsigned long a0, unsigned long a1, unsigned long a2,
  44. * unsigned long a3, unsigned long a4, unsigned long a5,
  45. * unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
  46. * struct arm_smccc_quirk *quirk)
  47. */
  48. ENTRY(__arm_smccc_smc)
  49. SMCCC SMCCC_SMC
  50. ENDPROC(__arm_smccc_smc)
  51. /*
  52. * void smccc_hvc(unsigned long a0, unsigned long a1, unsigned long a2,
  53. * unsigned long a3, unsigned long a4, unsigned long a5,
  54. * unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
  55. * struct arm_smccc_quirk *quirk)
  56. */
  57. ENTRY(__arm_smccc_hvc)
  58. SMCCC SMCCC_HVC
  59. ENDPROC(__arm_smccc_hvc)