smccc-call.S 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  1. /* SPDX-License-Identifier: GPL-2.0-only */
  2. /*
  3. * Copyright (c) 2015, Linaro Limited
  4. */
  5. #include <linux/linkage.h>
  6. #include <linux/arm-smccc.h>
  7. #include <asm/asm-offsets.h>
  8. #include <asm/opcodes-sec.h>
  9. #include <asm/opcodes-virt.h>
  10. #include <asm/unwind.h>
  11. /*
  12. * Wrap c macros in asm macros to delay expansion until after the
  13. * SMCCC asm macro is expanded.
  14. */
  15. .macro SMCCC_SMC
  16. __SMC(0)
  17. .endm
  18. .macro SMCCC_HVC
  19. __HVC(0)
  20. .endm
  21. .macro SMCCC instr
  22. UNWIND( .fnstart)
  23. mov r12, sp
  24. push {r4-r7}
  25. UNWIND( .save {r4-r7})
  26. ldm r12, {r4-r7}
  27. \instr
  28. ldr r4, [sp, #36]
  29. cmp r4, #0
  30. beq 1f // No quirk structure
  31. ldr r5, [r4, #ARM_SMCCC_QUIRK_ID_OFFS]
  32. cmp r5, #ARM_SMCCC_QUIRK_QCOM_A6
  33. bne 1f // No quirk present
  34. str r6, [r4, #ARM_SMCCC_QUIRK_STATE_OFFS]
  35. 1: 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)