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
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
|
/*
* Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <assert.h>
#include <stdarg.h>
#include <stdint.h>
#include <stdio.h>
#include <string.h>
#include <arch.h>
#include <arch_helpers.h>
#include <bl31/bl31.h>
#include <context.h>
#include <drivers/arm/gicv3.h>
#include <drivers/delay_timer.h>
#include <lib/coreboot.h>
#include <lib/el3_runtime/context_mgmt.h>
#include <lib/spinlock.h>
#include <lib/xlat_tables/xlat_tables_v2.h>
#include <platform.h>
#include <qti_plat.h>
#include <qtiseclib_cb_interface.h>
void *qtiseclib_cb_memcpy(void *dst, const void *src, size_t len)
{
return memcpy(dst, src, len);
}
int qtiseclib_cb_strcmp(const char *s1, const char *s2)
{
return strcmp(s1, s2);
}
void *qtiseclib_cb_memset(void *s, int c, size_t n)
{
return memset(s, c, n);
}
void *qtiseclib_cb_memmove(void *dest, const void *src, size_t n)
{
return memmove(dest, src, n);
}
/* Printing logs below or equal LOG_LEVEL from QTISECLIB. */
void qtiseclib_cb_log(unsigned int loglvl, const char *fmt, ...)
{
if (loglvl <= LOG_LEVEL) {
va_list argp;
static spinlock_t qti_log_lock;
uint64_t uptime = read_cntpct_el0();
va_start(argp, fmt);
spin_lock(&qti_log_lock);
printf("QTISECLIB [%x%08x]",
(uint32_t) ((uptime >> 32) & 0xFFFFFFFF),
(uint32_t) (uptime & 0xFFFFFFFF));
vprintf(fmt, argp);
putchar('\n');
spin_unlock(&qti_log_lock);
va_end(argp);
}
}
void qtiseclib_cb_spin_lock(qtiseclib_cb_spinlock_t *lock)
{
spin_lock((spinlock_t *) lock);
}
void qtiseclib_cb_spin_unlock(qtiseclib_cb_spinlock_t *lock)
{
spin_unlock((spinlock_t *) lock);
}
unsigned int qtiseclib_cb_plat_my_core_pos(void)
{
return plat_my_core_pos();
}
int qtiseclib_cb_plat_core_pos_by_mpidr(u_register_t mpidr)
{
return plat_core_pos_by_mpidr(mpidr);
}
unsigned int qtiseclib_cb_plat_my_cluster_pos(void)
{
return plat_qti_my_cluster_pos();
}
/* GIC platform functions */
void qtiseclib_cb_gic_pcpu_init(void)
{
plat_qti_gic_pcpu_init();
}
void qtiseclib_cb_ic_raise_sgi(int sgi_num, u_register_t target)
{
plat_ic_raise_el3_sgi(sgi_num, target);
}
void qtiseclib_cb_set_spi_routing(unsigned int id, unsigned int irm,
u_register_t target)
{
assert(QTI_GICV3_IRM_PE == GICV3_IRM_PE);
assert(QTI_GICV3_IRM_ANY == GICV3_IRM_ANY);
gic_set_spi_routing(id, irm, target);
}
/* Crash reporting api's wrappers */
void qtiseclib_cb_switch_console_to_crash_state(void)
{
console_switch_state(CONSOLE_FLAG_CRASH);
}
void qtiseclib_cb_udelay(uint32_t usec)
{
udelay(usec);
}
void qtiseclib_cb_console_flush(void)
{
return console_flush();
}
#if QTI_SDI_BUILD
void qtiseclib_cb_get_ns_ctx(qtiseclib_dbg_a64_ctxt_regs_type *qti_ns_ctx)
{
void *ctx;
ctx = cm_get_context(NON_SECURE);
if (ctx) {
/* nothing to be done w/o ns context */
return;
}
qti_ns_ctx->spsr_el3 =
read_ctx_reg(get_el3state_ctx(ctx), CTX_SPSR_EL3);
qti_ns_ctx->elr_el3 = read_ctx_reg(get_el3state_ctx(ctx), CTX_ELR_EL3);
qti_ns_ctx->spsr_el1 =
read_ctx_reg(get_el1_sysregs_ctx(ctx), CTX_SPSR_EL1);
qti_ns_ctx->elr_el1 =
read_ctx_reg(get_el1_sysregs_ctx(ctx), CTX_ELR_EL1);
qti_ns_ctx->sp_el1 = read_ctx_reg(get_el1_sysregs_ctx(ctx), CTX_SP_EL1);
qti_ns_ctx->x0 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X0);
qti_ns_ctx->x1 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X1);
qti_ns_ctx->x2 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X2);
qti_ns_ctx->x3 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X3);
qti_ns_ctx->x4 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X4);
qti_ns_ctx->x5 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X5);
qti_ns_ctx->x6 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X6);
qti_ns_ctx->x7 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X7);
qti_ns_ctx->x8 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X8);
qti_ns_ctx->x9 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X9);
qti_ns_ctx->x10 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X10);
qti_ns_ctx->x11 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X11);
qti_ns_ctx->x12 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X12);
qti_ns_ctx->x13 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X13);
qti_ns_ctx->x14 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X14);
qti_ns_ctx->x15 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X15);
qti_ns_ctx->x16 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X16);
qti_ns_ctx->x17 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X17);
qti_ns_ctx->x18 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X18);
qti_ns_ctx->x19 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X19);
qti_ns_ctx->x20 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X20);
qti_ns_ctx->x21 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X21);
qti_ns_ctx->x22 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X22);
qti_ns_ctx->x23 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X23);
qti_ns_ctx->x24 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X24);
qti_ns_ctx->x25 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X25);
qti_ns_ctx->x26 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X26);
qti_ns_ctx->x27 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X27);
qti_ns_ctx->x28 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X28);
qti_ns_ctx->x29 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_X29);
qti_ns_ctx->x30 = read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_LR);
qti_ns_ctx->sp_el0 =
read_ctx_reg(get_gpregs_ctx(ctx), CTX_GPREG_SP_EL0);
}
void qtiseclib_cb_flush_dcache_all(void)
{
dcsw_op_all(DCCISW);
}
int qtiseclib_cb_mmap_add_dynamic_region(unsigned long long base_pa,
size_t size,
qtiseclib_mmap_attr_t attr)
{
unsigned int l_attr = 0;
if (attr == QTISECLIB_MAP_NS_RO_XN_DATA) {
l_attr = MT_NS | MT_RO | MT_EXECUTE_NEVER;
} else if (attr == QTISECLIB_MAP_RW_XN_NC_DATA) {
l_attr = MT_RW | MT_NON_CACHEABLE | MT_EXECUTE_NEVER;
} else if (attr == QTISECLIB_MAP_RW_XN_DATA) {
l_attr = MT_RW | MT_EXECUTE_NEVER;
}
return qti_mmap_add_dynamic_region(base_pa, size, l_attr);
}
int qtiseclib_cb_mmap_remove_dynamic_region(uintptr_t base_va, size_t size)
{
return qti_mmap_remove_dynamic_region(base_va, size);
}
#endif
|
