blob: 7fe93e4419746b5f0adfcc909dcb8e9b67241703 (
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
|
// SPDX-License-Identifier: GPL-2.0
#define pr_fmt(fmt) "optee: " fmt
#include <tee/optee.h>
#include <linux/printk.h>
#include <linux/errno.h>
static u64 optee_membase = U64_MAX;
int optee_verify_header(const struct optee_header *hdr)
{
if (IS_ERR_OR_NULL(hdr))
return -EINVAL;
if (hdr->magic != OPTEE_MAGIC) {
pr_debug("Invalid header magic 0x%08x, expected 0x%08x\n",
hdr->magic, OPTEE_MAGIC);
return -EINVAL;
}
if (hdr->version != OPTEE_VERSION_V1) {
pr_err("Only V1 headers are supported right now\n");
return -EINVAL;
}
if (IS_ENABLED(CPU_V7) &&
(hdr->arch != OPTEE_ARCH_ARM32 || hdr->init_load_addr_hi)) {
pr_err("Wrong OP-TEE Arch for ARM v7 CPU\n");
return -EINVAL;
}
if (IS_ENABLED(CPU_V8) && hdr->arch != OPTEE_ARCH_ARM64) {
pr_err("Wrong OP-TEE Arch for ARM v8 CPU\n");
return -EINVAL;
}
return 0;
}
int optee_get_membase(u64 *membase)
{
if (optee_membase == U64_MAX)
return -EINVAL;
*membase = optee_membase;
return 0;
}
void optee_set_membase(const struct optee_header *hdr)
{
int ret;
ret = optee_verify_header(hdr);
if (ret)
return;
optee_membase = (u64)hdr->init_load_addr_hi << 32;
optee_membase |= hdr->init_load_addr_lo;
}
|