blob: 735d829c99fb533ccc9e865430ea167bfd2f0cc2 (
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
|
// SPDX-License-Identifier: GPL-2.0
/*
* optee-early.c - start OP-TEE during PBL
*
* Copyright (c) 2019 Rouven Czerwinski <r.czerwinski@pengutronix.de>, Pengutronix
*
*/
#include <asm/cache.h>
#include <asm/setjmp.h>
#include <tee/optee.h>
#include <debug_ll.h>
#include <string.h>
static jmp_buf tee_buf;
int start_optee_early(void *fdt, void *tee)
{
void (*tee_start)(void *r0, void *r1, void *r2);
struct optee_header *hdr;
int ret;
hdr = tee;
ret = optee_verify_header(hdr);
if (ret < 0)
return ret;
memcpy((void *)hdr->init_load_addr_lo, tee + sizeof(*hdr), hdr->init_size);
tee_start = (void *) hdr->init_load_addr_lo;
/* We use setjmp/longjmp here because OP-TEE clobbers most registers */
ret = setjmp(tee_buf);
if (ret == 0) {
sync_caches_for_execution();
tee_start(0, 0, fdt);
longjmp(tee_buf, 1);
}
return 0;
}
|
