aboutsummaryrefslogtreecommitdiff
path: root/arch/arm/lib/semihosting.S
blob: 6e1691a832c1311fe2f090a7686337c92830e29e (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
/* SPDX-License-Identifier: GPL-2.0+ */
/*
 * (C) 2022 Arm Ltd.
 */

#include <config.h>
#include <asm/macro.h>
#include <linux/linkage.h>

.pushsection .text.smh_trap, "ax"
/* long smh_trap(unsigned int sysnum, void *addr); */
ENTRY(smh_trap)

#if defined(CONFIG_ARM64)
	hlt	#0xf000
#elif defined(CONFIG_CPU_V7M)
	bkpt	#0xab
#elif defined(CONFIG_SYS_THUMB_BUILD)
	svc	#0xab
#else
#if CONFIG_SYS_ARM_ARCH < 7
	/* Before the ARMv7 exception model, svc (swi) clobbers lr */
	mov	r2, lr
#endif
	svc	#0x123456
#endif

#if defined(CONFIG_ARM64)
	ret
#elif CONFIG_SYS_ARM_ARCH < 7
	bx	r2
#else
	bx	lr
#endif

ENDPROC(smh_trap)
.popsection