mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-10-31 12:08:19 +00:00 
			
		
		
		
	add support for x0-x17 registers used by the SMC calls In SMCCC v1.2 [1] arguments are passed in registers x1-x17. Results are returned in x0-x17. This work is inspired from the following kernel commit: arm64: smccc: Add support for SMCCCv1.2 extended input/output registers [1]: https://documentation-service.arm.com/static/5f8edaeff86e16515cdbe4c6?token= Signed-off-by: Abdellatif El Khlifi <abdellatif.elkhlifi@arm.com> Reviewed-by: Ilias Apalodimas <ilias.apalodimas@linaro.org> Reviewed-by: Jens Wiklander <jens.wiklander@linaro.org> Reviewed-by: Simon Glass <sjg@chromium.org> Cc: Tom Rini <trini@konsulko.com>
		
			
				
	
	
		
			103 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			103 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /* SPDX-License-Identifier: GPL-2.0 */
 | |
| /*
 | |
|  * Copyright (c) 2015, Linaro Limited
 | |
|  * Copyright 2022-2023 Arm Limited and/or its affiliates <open-source-office@arm.com>
 | |
|  *
 | |
|  * Authors:
 | |
|  *   Abdellatif El Khlifi <abdellatif.elkhlifi@arm.com>
 | |
| */
 | |
| #include <linux/linkage.h>
 | |
| #include <linux/arm-smccc.h>
 | |
| #include <generated/asm-offsets.h>
 | |
| 
 | |
| #ifdef CONFIG_EFI_LOADER
 | |
| 	.section	.text.efi_runtime
 | |
| #endif
 | |
| 
 | |
| 	.macro SMCCC instr
 | |
| 	.cfi_startproc
 | |
| 	\instr	#0
 | |
| 	ldr	x4, [sp]
 | |
| 	stp	x0, x1, [x4, #ARM_SMCCC_RES_X0_OFFS]
 | |
| 	stp	x2, x3, [x4, #ARM_SMCCC_RES_X2_OFFS]
 | |
| 	ldr	x4, [sp, #8]
 | |
| 	cbz	x4, 1f /* no quirk structure */
 | |
| 	ldr	x9, [x4, #ARM_SMCCC_QUIRK_ID_OFFS]
 | |
| 	cmp	x9, #ARM_SMCCC_QUIRK_QCOM_A6
 | |
| 	b.ne	1f
 | |
| 	str	x6, [x4, ARM_SMCCC_QUIRK_STATE_OFFS]
 | |
| 1:	ret
 | |
| 	.cfi_endproc
 | |
| 	.endm
 | |
| 
 | |
| /*
 | |
|  * void arm_smccc_smc(unsigned long a0, unsigned long a1, unsigned long a2,
 | |
|  *		  unsigned long a3, unsigned long a4, unsigned long a5,
 | |
|  *		  unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
 | |
|  *		  struct arm_smccc_quirk *quirk)
 | |
|  */
 | |
| ENTRY(__arm_smccc_smc)
 | |
| 	SMCCC	smc
 | |
| ENDPROC(__arm_smccc_smc)
 | |
| 
 | |
| /*
 | |
|  * void arm_smccc_hvc(unsigned long a0, unsigned long a1, unsigned long a2,
 | |
|  *		  unsigned long a3, unsigned long a4, unsigned long a5,
 | |
|  *		  unsigned long a6, unsigned long a7, struct arm_smccc_res *res,
 | |
|  *		  struct arm_smccc_quirk *quirk)
 | |
|  */
 | |
| ENTRY(__arm_smccc_hvc)
 | |
| 	SMCCC	hvc
 | |
| ENDPROC(__arm_smccc_hvc)
 | |
| 
 | |
| #ifdef CONFIG_ARM64
 | |
| 
 | |
| 	.macro SMCCC_1_2 instr
 | |
| 	/* Save `res` and free a GPR that won't be clobbered */
 | |
| 	stp     x1, x19, [sp, #-16]!
 | |
| 
 | |
| 	/* Ensure `args` won't be clobbered while loading regs in next step */
 | |
| 	mov	x19, x0
 | |
| 
 | |
| 	/* Load the registers x0 - x17 from the struct arm_smccc_1_2_regs */
 | |
| 	ldp	x0, x1, [x19, #ARM_SMCCC_1_2_REGS_X0_OFFS]
 | |
| 	ldp	x2, x3, [x19, #ARM_SMCCC_1_2_REGS_X2_OFFS]
 | |
| 	ldp	x4, x5, [x19, #ARM_SMCCC_1_2_REGS_X4_OFFS]
 | |
| 	ldp	x6, x7, [x19, #ARM_SMCCC_1_2_REGS_X6_OFFS]
 | |
| 	ldp	x8, x9, [x19, #ARM_SMCCC_1_2_REGS_X8_OFFS]
 | |
| 	ldp	x10, x11, [x19, #ARM_SMCCC_1_2_REGS_X10_OFFS]
 | |
| 	ldp	x12, x13, [x19, #ARM_SMCCC_1_2_REGS_X12_OFFS]
 | |
| 	ldp	x14, x15, [x19, #ARM_SMCCC_1_2_REGS_X14_OFFS]
 | |
| 	ldp	x16, x17, [x19, #ARM_SMCCC_1_2_REGS_X16_OFFS]
 | |
| 
 | |
| 	\instr #0
 | |
| 
 | |
| 	/* Load the `res` from the stack */
 | |
| 	ldr	x19, [sp]
 | |
| 
 | |
| 	/* Store the registers x0 - x17 into the result structure */
 | |
| 	stp	x0, x1, [x19, #ARM_SMCCC_1_2_REGS_X0_OFFS]
 | |
| 	stp	x2, x3, [x19, #ARM_SMCCC_1_2_REGS_X2_OFFS]
 | |
| 	stp	x4, x5, [x19, #ARM_SMCCC_1_2_REGS_X4_OFFS]
 | |
| 	stp	x6, x7, [x19, #ARM_SMCCC_1_2_REGS_X6_OFFS]
 | |
| 	stp	x8, x9, [x19, #ARM_SMCCC_1_2_REGS_X8_OFFS]
 | |
| 	stp	x10, x11, [x19, #ARM_SMCCC_1_2_REGS_X10_OFFS]
 | |
| 	stp	x12, x13, [x19, #ARM_SMCCC_1_2_REGS_X12_OFFS]
 | |
| 	stp	x14, x15, [x19, #ARM_SMCCC_1_2_REGS_X14_OFFS]
 | |
| 	stp	x16, x17, [x19, #ARM_SMCCC_1_2_REGS_X16_OFFS]
 | |
| 
 | |
| 	/* Restore original x19 */
 | |
| 	ldp     xzr, x19, [sp], #16
 | |
| 	ret
 | |
| 	.endm
 | |
| 
 | |
| /*
 | |
|  * void arm_smccc_1_2_smc(const struct arm_smccc_1_2_regs *args,
 | |
|  *			  struct arm_smccc_1_2_regs *res);
 | |
|  */
 | |
| ENTRY(arm_smccc_1_2_smc)
 | |
| 	SMCCC_1_2 smc
 | |
| ENDPROC(arm_smccc_1_2_smc)
 | |
| 
 | |
| #endif
 |