summaryrefstree
path: root/kernel/init/rkp_cfp.S
blob: d2c2edf75da48a1fd3e9ad95a699e341a475d1bd (plain)
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
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
/*
 *
 * Copyright (c) 2015 Samsung Electronics Co., Ltd.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.

 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <linux/linkage.h>
#include <asm/assembler.h>

.section .hyperdrive, "ax"
.global _start_hyperdrive
_start_hyperdrive:
# Need a nop otherwise GCC keeps _start_hyperdrive label but NOT
# jopp_springboard_bl label.
nop

#ifdef CONFIG_RKP_CFP_JOPP

#define RRX x16
#define RRX_32 w16

/*
 * Load the word just before the function instructions.
 * Halt execution if the word doesn't match the magic number placed at function
 * entries.
 */
	.macro	springboard_blr, reg
	jopp_springboard_blr_\reg:
	push	RRX, xzr
	ldr	RRX_32, [\reg, #-4]
	subs	RRX_32, RRX_32, #0xbe7, lsl #12
	cmp	RRX_32, #0xbad
	b.eq	1f

	/* 
	 * DDK/VRA/RTA	0xffffff80fa000000 ~ 0xffffff80fa780000
	 * Should match FIMC_VA and FIMC_SIZE
	 */
	mov	RRX, #0xffffff8000000000
	movk	RRX, 0xfa00, lsl #16
	cmp 	\reg, RRX
	b.ls	2f
	movk	RRX, #0xfa78, lsl #16
	cmp 	\reg, RRX
	b.hs	2f
1: // Fail
	pop	RRX, xzr
	br 	\reg
2: // Pass
#if 0
	//Test code
	push	x0, x1
	push	x2, x3
	push	x4, x5
	push	x6, x7
	push	x8, x9
	push	x10, x11
	push	x12, x13
	push	x14, x15
	push	RRX, x17
	push	x29, x30
	mov	x0, \reg
	mov	x1, x30
	bl	cfp_record_jopp
	pop	x29, x30
	pop	RRX, x17
	pop	x14, x15
	pop	x12, x13
	pop	x10, x11
	pop	x8, x9
	pop	x6, x7
	pop	x4, x5
	pop	x2, x3
	pop	x0, x1
#else
	.inst	0xdeadc0de //crash for sure
#endif
	.endm

	// Only add springboards for a register rX if there exists a "BLR rX" instruction in vmlinux to instrument
	springboard_blr x0
	springboard_blr	x1
	springboard_blr	x2
	springboard_blr	x3
	springboard_blr	x4
	springboard_blr	x5
	springboard_blr	x6
	springboard_blr	x7
	springboard_blr	x8
	springboard_blr	x9
	springboard_blr	x10
	springboard_blr	x11
	springboard_blr	x12
	springboard_blr	x13
	springboard_blr	x14
	springboard_blr	x15
	/*
	 * x16, x17 are reserved.
	 * Undefine ROPP will free x16 and x17
	 * JOPP only needs no registers
	 */
#ifndef CONFIG_RKP_CFP_ROPP
	springboard_blr	x16
	springboard_blr	x17
#endif
	springboard_blr	x18
	springboard_blr	x19
	springboard_blr	x20
	springboard_blr	x21
	springboard_blr	x22
	springboard_blr	x23
	springboard_blr	x24
	springboard_blr	x25
	springboard_blr	x26
	springboard_blr	x27
	springboard_blr	x28
	springboard_blr	x29
	springboard_blr	x30
	// Don't need springboards for x31 (not allowed in RET by assembler)

#endif


.global _end_hyperdrive
_end_hyperdrive:

.section .text