162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*  Copyright(c) 2016-20 Intel Corporation. */
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include <stddef.h>
562306a36Sopenharmony_ci#include "defines.h"
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci/*
862306a36Sopenharmony_ci * Data buffer spanning two pages that will be placed first in .data
962306a36Sopenharmony_ci * segment. Even if not used internally the second page is needed by
1062306a36Sopenharmony_ci * external test manipulating page permissions.
1162306a36Sopenharmony_ci */
1262306a36Sopenharmony_cistatic uint8_t encl_buffer[8192] = { 1 };
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_cienum sgx_enclu_function {
1562306a36Sopenharmony_ci	EACCEPT = 0x5,
1662306a36Sopenharmony_ci	EMODPE = 0x6,
1762306a36Sopenharmony_ci};
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_cistatic void do_encl_emodpe(void *_op)
2062306a36Sopenharmony_ci{
2162306a36Sopenharmony_ci	struct sgx_secinfo secinfo __aligned(sizeof(struct sgx_secinfo)) = {0};
2262306a36Sopenharmony_ci	struct encl_op_emodpe *op = _op;
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci	secinfo.flags = op->flags;
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci	asm volatile(".byte 0x0f, 0x01, 0xd7"
2762306a36Sopenharmony_ci				: /* no outputs */
2862306a36Sopenharmony_ci				: "a" (EMODPE),
2962306a36Sopenharmony_ci				  "b" (&secinfo),
3062306a36Sopenharmony_ci				  "c" (op->epc_addr)
3162306a36Sopenharmony_ci				: "memory" /* read from secinfo pointer */);
3262306a36Sopenharmony_ci}
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cistatic void do_encl_eaccept(void *_op)
3562306a36Sopenharmony_ci{
3662306a36Sopenharmony_ci	struct sgx_secinfo secinfo __aligned(sizeof(struct sgx_secinfo)) = {0};
3762306a36Sopenharmony_ci	struct encl_op_eaccept *op = _op;
3862306a36Sopenharmony_ci	int rax;
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ci	secinfo.flags = op->flags;
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci	asm volatile(".byte 0x0f, 0x01, 0xd7"
4362306a36Sopenharmony_ci				: "=a" (rax)
4462306a36Sopenharmony_ci				: "a" (EACCEPT),
4562306a36Sopenharmony_ci				  "b" (&secinfo),
4662306a36Sopenharmony_ci				  "c" (op->epc_addr)
4762306a36Sopenharmony_ci				: "memory" /* read from secinfo pointer */);
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci	op->ret = rax;
5062306a36Sopenharmony_ci}
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_cistatic void *memcpy(void *dest, const void *src, size_t n)
5362306a36Sopenharmony_ci{
5462306a36Sopenharmony_ci	size_t i;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	for (i = 0; i < n; i++)
5762306a36Sopenharmony_ci		((char *)dest)[i] = ((char *)src)[i];
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_ci	return dest;
6062306a36Sopenharmony_ci}
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_cistatic void *memset(void *dest, int c, size_t n)
6362306a36Sopenharmony_ci{
6462306a36Sopenharmony_ci	size_t i;
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	for (i = 0; i < n; i++)
6762306a36Sopenharmony_ci		((char *)dest)[i] = c;
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	return dest;
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic void do_encl_init_tcs_page(void *_op)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	struct encl_op_init_tcs_page *op = _op;
7562306a36Sopenharmony_ci	void *tcs = (void *)op->tcs_page;
7662306a36Sopenharmony_ci	uint32_t val_32;
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ci	memset(tcs, 0, 16);			/* STATE and FLAGS */
7962306a36Sopenharmony_ci	memcpy(tcs + 16, &op->ssa, 8);		/* OSSA */
8062306a36Sopenharmony_ci	memset(tcs + 24, 0, 4);			/* CSSA */
8162306a36Sopenharmony_ci	val_32 = 1;
8262306a36Sopenharmony_ci	memcpy(tcs + 28, &val_32, 4);		/* NSSA */
8362306a36Sopenharmony_ci	memcpy(tcs + 32, &op->entry, 8);	/* OENTRY */
8462306a36Sopenharmony_ci	memset(tcs + 40, 0, 24);		/* AEP, OFSBASE, OGSBASE */
8562306a36Sopenharmony_ci	val_32 = 0xFFFFFFFF;
8662306a36Sopenharmony_ci	memcpy(tcs + 64, &val_32, 4);		/* FSLIMIT */
8762306a36Sopenharmony_ci	memcpy(tcs + 68, &val_32, 4);		/* GSLIMIT */
8862306a36Sopenharmony_ci	memset(tcs + 72, 0, 4024);		/* Reserved */
8962306a36Sopenharmony_ci}
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_cistatic void do_encl_op_put_to_buf(void *op)
9262306a36Sopenharmony_ci{
9362306a36Sopenharmony_ci	struct encl_op_put_to_buf *op2 = op;
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	memcpy(&encl_buffer[0], &op2->value, 8);
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic void do_encl_op_get_from_buf(void *op)
9962306a36Sopenharmony_ci{
10062306a36Sopenharmony_ci	struct encl_op_get_from_buf *op2 = op;
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_ci	memcpy(&op2->value, &encl_buffer[0], 8);
10362306a36Sopenharmony_ci}
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_cistatic void do_encl_op_put_to_addr(void *_op)
10662306a36Sopenharmony_ci{
10762306a36Sopenharmony_ci	struct encl_op_put_to_addr *op = _op;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	memcpy((void *)op->addr, &op->value, 8);
11062306a36Sopenharmony_ci}
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic void do_encl_op_get_from_addr(void *_op)
11362306a36Sopenharmony_ci{
11462306a36Sopenharmony_ci	struct encl_op_get_from_addr *op = _op;
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_ci	memcpy(&op->value, (void *)op->addr, 8);
11762306a36Sopenharmony_ci}
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_cistatic void do_encl_op_nop(void *_op)
12062306a36Sopenharmony_ci{
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_civoid encl_body(void *rdi,  void *rsi)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci	const void (*encl_op_array[ENCL_OP_MAX])(void *) = {
12762306a36Sopenharmony_ci		do_encl_op_put_to_buf,
12862306a36Sopenharmony_ci		do_encl_op_get_from_buf,
12962306a36Sopenharmony_ci		do_encl_op_put_to_addr,
13062306a36Sopenharmony_ci		do_encl_op_get_from_addr,
13162306a36Sopenharmony_ci		do_encl_op_nop,
13262306a36Sopenharmony_ci		do_encl_eaccept,
13362306a36Sopenharmony_ci		do_encl_emodpe,
13462306a36Sopenharmony_ci		do_encl_init_tcs_page,
13562306a36Sopenharmony_ci	};
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ci	struct encl_op_header *op = (struct encl_op_header *)rdi;
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	if (op->type < ENCL_OP_MAX)
14062306a36Sopenharmony_ci		(*encl_op_array[op->type])(op);
14162306a36Sopenharmony_ci}
142