xref: /optee_os/core/tee/tee_svc.c (revision 359324a2d577a98b4405c67e140b1cff41b1d7cd)
1 // SPDX-License-Identifier: BSD-2-Clause
2 /*
3  * Copyright (c) 2014, STMicroelectronics International N.V.
4  */
5 #include <util.h>
6 #include <kernel/tee_common_otp.h>
7 #include <kernel/tee_common.h>
8 #include <tee_api_types.h>
9 #include <kernel/tee_ta_manager.h>
10 #include <utee_types.h>
11 #include <tee/tee_svc.h>
12 #include <tee/tee_cryp_utl.h>
13 #include <mm/tee_mmu.h>
14 #include <mm/tee_mm.h>
15 #include <mm/core_memprot.h>
16 #include <kernel/tee_time.h>
17 
18 #include <user_ta_header.h>
19 #include <trace.h>
20 #include <kernel/trace_ta.h>
21 #include <kernel/chip_services.h>
22 #include <kernel/pseudo_ta.h>
23 #include <mm/mobj.h>
24 
25 vaddr_t tee_svc_uref_base;
26 
27 void syscall_log(const void *buf __maybe_unused, size_t len __maybe_unused)
28 {
29 #ifdef CFG_TEE_CORE_TA_TRACE
30 	char *kbuf;
31 
32 	if (len == 0)
33 		return;
34 
35 	kbuf = malloc(len + 1);
36 	if (kbuf == NULL)
37 		return;
38 
39 	if (tee_svc_copy_from_user(kbuf, buf, len) == TEE_SUCCESS) {
40 		kbuf[len] = '\0';
41 		trace_ext_puts(kbuf);
42 	}
43 
44 	free(kbuf);
45 #endif
46 }
47 
48 TEE_Result syscall_not_supported(void)
49 {
50 	return TEE_ERROR_NOT_SUPPORTED;
51 }
52 
53 /* Configuration properties */
54 /* API implementation version */
55 static const char api_vers[] = TO_STR(CFG_TEE_API_VERSION);
56 
57 /* Implementation description (implementation-dependent) */
58 static const char descr[] = TO_STR(CFG_TEE_IMPL_DESCR);
59 
60 /*
61  * TA persistent time protection level
62  * 100: Persistent time based on an REE-controlled real-time clock
63  * and on the TEE Trusted Storage for the storage of origins (default).
64  * 1000: Persistent time based on a TEE-controlled real-time clock
65  * and the TEE Trusted Storage.
66  * The real-time clock MUST be out of reach of software attacks
67  * from the REE.
68  */
69 static const uint32_t ta_time_prot_lvl = 100;
70 
71 /* Elliptic Curve Cryptographic support */
72 #ifdef CFG_CRYPTO_ECC
73 static const bool crypto_ecc_en = 1;
74 #else
75 static const bool crypto_ecc_en;
76 #endif
77 
78 /*
79  * Trusted storage anti rollback protection level
80  * 0 (or missing): No antirollback protection (default)
81  * 100: Antirollback enforced at REE level
82  * 1000: Antirollback TEE-controlled hardware
83  */
84 #ifdef CFG_RPMB_FS
85 static const uint32_t ts_antiroll_prot_lvl = 1000;
86 #else
87 static const uint32_t ts_antiroll_prot_lvl;
88 #endif
89 
90 /* Trusted OS implementation version */
91 static const char trustedos_impl_version[] = TO_STR(TEE_IMPL_VERSION);
92 
93 /* Trusted OS implementation version (binary value) */
94 static const uint32_t trustedos_impl_bin_version; /* 0 by default */
95 
96 /* Trusted OS implementation manufacturer name */
97 static const char trustedos_manufacturer[] = TO_STR(CFG_TEE_MANUFACTURER);
98 
99 /* Trusted firmware version */
100 static const char fw_impl_version[] = TO_STR(CFG_TEE_FW_IMPL_VERSION);
101 
102 /* Trusted firmware version (binary value) */
103 static const uint32_t fw_impl_bin_version; /* 0 by default */
104 
105 /* Trusted firmware manufacturer name */
106 static const char fw_manufacturer[] = TO_STR(CFG_TEE_FW_MANUFACTURER);
107 
108 static TEE_Result get_prop_tee_dev_id(struct tee_ta_session *sess __unused,
109 				      void *buf, size_t *blen)
110 {
111 	TEE_Result res;
112 	TEE_UUID uuid;
113 	const size_t nslen = 5;
114 	uint8_t data[5 + FVR_DIE_ID_NUM_REGS * sizeof(uint32_t)] = {
115 	    'O', 'P', 'T', 'E', 'E' };
116 
117 	if (*blen < sizeof(uuid)) {
118 		*blen = sizeof(uuid);
119 		return TEE_ERROR_SHORT_BUFFER;
120 	}
121 	*blen = sizeof(uuid);
122 
123 	if (tee_otp_get_die_id(data + nslen, sizeof(data) - nslen))
124 		return TEE_ERROR_BAD_STATE;
125 
126 	res = tee_hash_createdigest(TEE_ALG_SHA256, data, sizeof(data),
127 				    (uint8_t *)&uuid, sizeof(uuid));
128 	if (res != TEE_SUCCESS)
129 		return TEE_ERROR_BAD_STATE;
130 
131 	/*
132 	 * Changes the random value into and UUID as specifiec
133 	 * in RFC 4122. The magic values are from the example
134 	 * code in the RFC.
135 	 *
136 	 * TEE_UUID is defined slightly different from the RFC,
137 	 * but close enough for our purpose.
138 	 */
139 
140 	uuid.timeHiAndVersion &= 0x0fff;
141 	uuid.timeHiAndVersion |= 5 << 12;
142 
143 	/* uuid.clock_seq_hi_and_reserved in the RFC */
144 	uuid.clockSeqAndNode[0] &= 0x3f;
145 	uuid.clockSeqAndNode[0] |= 0x80;
146 
147 	return tee_svc_copy_to_user(buf, &uuid, sizeof(TEE_UUID));
148 }
149 
150 static TEE_Result get_prop_tee_sys_time_prot_level(
151 			struct tee_ta_session *sess __unused,
152 			void *buf, size_t *blen)
153 {
154 	uint32_t prot;
155 
156 	if (*blen < sizeof(prot)) {
157 		*blen = sizeof(prot);
158 		return TEE_ERROR_SHORT_BUFFER;
159 	}
160 	*blen = sizeof(prot);
161 	prot = tee_time_get_sys_time_protection_level();
162 	return tee_svc_copy_to_user(buf, &prot, sizeof(prot));
163 }
164 
165 static TEE_Result get_prop_client_id(struct tee_ta_session *sess __unused,
166 				     void *buf, size_t *blen)
167 {
168 	if (*blen < sizeof(TEE_Identity)) {
169 		*blen = sizeof(TEE_Identity);
170 		return TEE_ERROR_SHORT_BUFFER;
171 	}
172 	*blen = sizeof(TEE_Identity);
173 	return tee_svc_copy_to_user(buf, &sess->clnt_id, sizeof(TEE_Identity));
174 }
175 
176 static TEE_Result get_prop_ta_app_id(struct tee_ta_session *sess,
177 				     void *buf, size_t *blen)
178 {
179 	if (*blen < sizeof(TEE_UUID)) {
180 		*blen = sizeof(TEE_UUID);
181 		return TEE_ERROR_SHORT_BUFFER;
182 	}
183 	*blen = sizeof(TEE_UUID);
184 	return tee_svc_copy_to_user(buf, &sess->ctx->uuid, sizeof(TEE_UUID));
185 }
186 
187 /* Properties of the set TEE_PROPSET_CURRENT_CLIENT */
188 const struct tee_props tee_propset_client[] = {
189 	{
190 		.name = "gpd.client.identity",
191 		.prop_type = USER_TA_PROP_TYPE_IDENTITY,
192 		.get_prop_func = get_prop_client_id
193 	},
194 };
195 
196 /* Properties of the set TEE_PROPSET_CURRENT_TA */
197 const struct tee_props tee_propset_ta[] = {
198 	{
199 		.name = "gpd.ta.appID",
200 		.prop_type = USER_TA_PROP_TYPE_UUID,
201 		.get_prop_func = get_prop_ta_app_id
202 	},
203 
204 	/*
205 	 * Following properties are processed directly in libutee:
206 	 *	TA_PROP_STR_SINGLE_INSTANCE
207 	 *	TA_PROP_STR_MULTI_SESSION
208 	 *	TA_PROP_STR_KEEP_ALIVE
209 	 *	TA_PROP_STR_DATA_SIZE
210 	 *	TA_PROP_STR_STACK_SIZE
211 	 *	TA_PROP_STR_VERSION
212 	 *	TA_PROP_STR_DESCRIPTION
213 	 *	USER_TA_PROP_TYPE_STRING,
214 	 *	TA_DESCRIPTION
215 	 */
216 };
217 
218 /* Properties of the set TEE_PROPSET_TEE_IMPLEMENTATION */
219 const struct tee_props tee_propset_tee[] = {
220 	{
221 		.name = "gpd.tee.apiversion",
222 		.prop_type = USER_TA_PROP_TYPE_STRING,
223 		.data = api_vers,
224 		.len = sizeof(api_vers),
225 	},
226 	{
227 		.name = "gpd.tee.description",
228 		.prop_type = USER_TA_PROP_TYPE_STRING,
229 		.data = descr, .len = sizeof(descr)
230 	},
231 	{
232 		.name = "gpd.tee.deviceID",
233 		.prop_type = USER_TA_PROP_TYPE_UUID,
234 		.get_prop_func = get_prop_tee_dev_id
235 	},
236 	{
237 		.name = "gpd.tee.systemTime.protectionLevel",
238 		.prop_type = USER_TA_PROP_TYPE_U32,
239 		.get_prop_func = get_prop_tee_sys_time_prot_level
240 	},
241 	{
242 		.name = "gpd.tee.TAPersistentTime.protectionLevel",
243 		.prop_type = USER_TA_PROP_TYPE_U32,
244 		.data = &ta_time_prot_lvl,
245 		.len = sizeof(ta_time_prot_lvl)
246 	},
247 	{
248 		.name = "gpd.tee.cryptography.ecc",
249 		.prop_type = USER_TA_PROP_TYPE_BOOL,
250 		.data = &crypto_ecc_en,
251 		.len = sizeof(crypto_ecc_en)
252 	},
253 	{
254 		.name = "gpd.tee.trustedStorage.antiRollback.protectionLevel",
255 		.prop_type = USER_TA_PROP_TYPE_U32,
256 		.data = &ts_antiroll_prot_lvl,
257 		.len = sizeof(ts_antiroll_prot_lvl)
258 	},
259 	{
260 		.name = "gpd.tee.trustedos.implementation.version",
261 		.prop_type = USER_TA_PROP_TYPE_STRING,
262 		.data = trustedos_impl_version,
263 		.len = sizeof(trustedos_impl_version)
264 	},
265 	{
266 		.name = "gpd.tee.trustedos.implementation.binaryversion",
267 		.prop_type = USER_TA_PROP_TYPE_U32,
268 		.data = &trustedos_impl_bin_version,
269 		.len = sizeof(trustedos_impl_bin_version)
270 	},
271 	{
272 		.name = "gpd.tee.trustedos.manufacturer",
273 		.prop_type = USER_TA_PROP_TYPE_STRING,
274 		.data = trustedos_manufacturer,
275 		.len = sizeof(trustedos_manufacturer)
276 	},
277 	{
278 		.name = "gpd.tee.firmware.implementation.version",
279 		.prop_type = USER_TA_PROP_TYPE_STRING,
280 		.data = fw_impl_version,
281 		.len = sizeof(fw_impl_version)
282 	},
283 	{
284 		.name = "gpd.tee.firmware.implementation.binaryversion",
285 		.prop_type = USER_TA_PROP_TYPE_U32,
286 		.data = &fw_impl_bin_version,
287 		.len = sizeof(fw_impl_bin_version)
288 	},
289 	{
290 		.name = "gpd.tee.firmware.manufacturer",
291 		.prop_type = USER_TA_PROP_TYPE_STRING,
292 		.data = fw_manufacturer,
293 		.len = sizeof(fw_manufacturer)
294 	},
295 
296 	/*
297 	 * Following properties are processed directly in libutee:
298 	 *	gpd.tee.arith.maxBigIntSize
299 	 */
300 };
301 
302 __weak const struct tee_vendor_props vendor_props_client;
303 __weak const struct tee_vendor_props vendor_props_ta;
304 __weak const struct tee_vendor_props vendor_props_tee;
305 
306 static void get_prop_set(unsigned long prop_set,
307 			 const struct tee_props **props,
308 			 size_t *size,
309 			 const struct tee_props **vendor_props,
310 			 size_t *vendor_size)
311 {
312 	if ((TEE_PropSetHandle)prop_set == TEE_PROPSET_CURRENT_CLIENT) {
313 		*props = tee_propset_client;
314 		*size = ARRAY_SIZE(tee_propset_client);
315 		*vendor_props = vendor_props_client.props;
316 		*vendor_size = vendor_props_client.len;
317 	} else if ((TEE_PropSetHandle)prop_set == TEE_PROPSET_CURRENT_TA) {
318 		*props = tee_propset_ta;
319 		*size = ARRAY_SIZE(tee_propset_ta);
320 		*vendor_props = vendor_props_ta.props;
321 		*vendor_size = vendor_props_ta.len;
322 	} else if ((TEE_PropSetHandle)prop_set ==
323 		   TEE_PROPSET_TEE_IMPLEMENTATION) {
324 		*props = tee_propset_tee;
325 		*size = ARRAY_SIZE(tee_propset_tee);
326 		*vendor_props = vendor_props_tee.props;
327 		*vendor_size = vendor_props_tee.len;
328 	} else {
329 		*props = NULL;
330 		*size = 0;
331 		*vendor_props = NULL;
332 		*vendor_size = 0;
333 	}
334 }
335 
336 static const struct tee_props *get_prop_struct(unsigned long prop_set,
337 					       unsigned long index)
338 {
339 	const struct tee_props *props;
340 	const struct tee_props *vendor_props;
341 	size_t size;
342 	size_t vendor_size;
343 
344 	get_prop_set(prop_set, &props, &size, &vendor_props, &vendor_size);
345 
346 	if (index < size)
347 		return &(props[index]);
348 	index -= size;
349 
350 	if (index < vendor_size)
351 		return &(vendor_props[index]);
352 
353 	return NULL;
354 }
355 
356 /*
357  * prop_set is part of TEE_PROPSET_xxx
358  * index is the index in the Property Set to retrieve
359  * if name is not NULL, the name of "index" property is returned
360  * if buf is not NULL, the property is returned
361  */
362 TEE_Result syscall_get_property(unsigned long prop_set,
363 				unsigned long index,
364 				void *name, uint32_t *name_len,
365 				void *buf, uint32_t *blen,
366 				uint32_t *prop_type)
367 {
368 	struct tee_ta_session *sess;
369 	TEE_Result res;
370 	TEE_Result res2;
371 	const struct tee_props *prop;
372 	uint32_t klen;
373 	size_t klen_size;
374 	uint32_t elen;
375 
376 	prop = get_prop_struct(prop_set, index);
377 	if (!prop)
378 		return TEE_ERROR_ITEM_NOT_FOUND;
379 
380 	res = tee_ta_get_current_session(&sess);
381 	if (res != TEE_SUCCESS)
382 		return res;
383 
384 	/* Get the property type */
385 	if (prop_type) {
386 		res = tee_svc_copy_to_user(prop_type, &prop->prop_type,
387 					   sizeof(*prop_type));
388 		if (res != TEE_SUCCESS)
389 			return res;
390 	}
391 
392 	/* Get the property */
393 	if (buf && blen) {
394 		res = tee_svc_copy_from_user(&klen, blen, sizeof(klen));
395 		if (res != TEE_SUCCESS)
396 			return res;
397 
398 		if (prop->get_prop_func) {
399 			klen_size = klen;
400 			res = prop->get_prop_func(sess, buf, &klen_size);
401 			klen = klen_size;
402 			res2 = tee_svc_copy_to_user(blen, &klen, sizeof(*blen));
403 		} else {
404 			if (klen < prop->len)
405 				res = TEE_ERROR_SHORT_BUFFER;
406 			else
407 				res = tee_svc_copy_to_user(buf, prop->data,
408 							   prop->len);
409 			res2 = tee_svc_copy_to_user(blen, &prop->len,
410 						    sizeof(*blen));
411 		}
412 		if (res2 != TEE_SUCCESS)
413 			return res2;
414 		if (res != TEE_SUCCESS)
415 			return res;
416 	}
417 
418 	/* Get the property name */
419 	if (name && name_len) {
420 		res = tee_svc_copy_from_user(&klen, name_len, sizeof(klen));
421 		if (res != TEE_SUCCESS)
422 			return res;
423 
424 		elen = strlen(prop->name) + 1;
425 
426 		if (klen < elen)
427 			res = TEE_ERROR_SHORT_BUFFER;
428 		else
429 			res = tee_svc_copy_to_user(name, prop->name, elen);
430 		res2 = tee_svc_copy_to_user(name_len, &elen, sizeof(*name_len));
431 		if (res2 != TEE_SUCCESS)
432 			return res2;
433 		if (res != TEE_SUCCESS)
434 			return res;
435 	}
436 
437 	return res;
438 }
439 
440 /*
441  * prop_set is part of TEE_PROPSET_xxx
442  */
443 TEE_Result syscall_get_property_name_to_index(unsigned long prop_set,
444 					      void *name,
445 					      unsigned long name_len,
446 					      uint32_t *index)
447 {
448 	TEE_Result res;
449 	struct tee_ta_session *sess;
450 	const struct tee_props *props;
451 	size_t size;
452 	const struct tee_props *vendor_props;
453 	size_t vendor_size;
454 	char *kname = 0;
455 	uint32_t i;
456 
457 	get_prop_set(prop_set, &props, &size, &vendor_props, &vendor_size);
458 	if (!props)
459 		return TEE_ERROR_ITEM_NOT_FOUND;
460 
461 	res = tee_ta_get_current_session(&sess);
462 	if (res != TEE_SUCCESS)
463 		goto out;
464 
465 	if (!name || !name_len) {
466 		res = TEE_ERROR_BAD_PARAMETERS;
467 		goto out;
468 	}
469 
470 	kname = malloc(name_len);
471 	if (!kname)
472 		return TEE_ERROR_OUT_OF_MEMORY;
473 	res = tee_svc_copy_from_user(kname, name, name_len);
474 	if (res != TEE_SUCCESS)
475 		goto out;
476 	kname[name_len - 1] = 0;
477 
478 	res = TEE_ERROR_ITEM_NOT_FOUND;
479 	for (i = 0; i < size; i++) {
480 		if (!strcmp(kname, props[i].name)) {
481 			res = tee_svc_copy_to_user(index, &i, sizeof(*index));
482 			goto out;
483 		}
484 	}
485 	for (i = size; i < size + vendor_size; i++) {
486 		if (!strcmp(kname, vendor_props[i - size].name)) {
487 			res = tee_svc_copy_to_user(index, &i, sizeof(*index));
488 			goto out;
489 		}
490 	}
491 
492 out:
493 	free(kname);
494 	return res;
495 }
496 
497 static void utee_param_to_param(struct tee_ta_param *p, struct utee_params *up)
498 {
499 	size_t n;
500 	uint32_t types = up->types;
501 
502 	p->types = types;
503 	for (n = 0; n < TEE_NUM_PARAMS; n++) {
504 		uintptr_t a = up->vals[n * 2];
505 		size_t b = up->vals[n * 2 + 1];
506 
507 		switch (TEE_PARAM_TYPE_GET(types, n)) {
508 		case TEE_PARAM_TYPE_MEMREF_INPUT:
509 		case TEE_PARAM_TYPE_MEMREF_OUTPUT:
510 		case TEE_PARAM_TYPE_MEMREF_INOUT:
511 			p->u[n].mem.mobj = &mobj_virt;
512 			p->u[n].mem.offs = a;
513 			p->u[n].mem.size = b;
514 			break;
515 		case TEE_PARAM_TYPE_VALUE_INPUT:
516 		case TEE_PARAM_TYPE_VALUE_INOUT:
517 			p->u[n].val.a = a;
518 			p->u[n].val.b = b;
519 			break;
520 		default:
521 			memset(&p->u[n], 0, sizeof(p->u[n]));
522 			break;
523 		}
524 	}
525 }
526 
527 static TEE_Result alloc_temp_sec_mem(size_t size, struct mobj **mobj,
528 				     uint8_t **va)
529 {
530 	/* Allocate section in secure DDR */
531 #ifdef CFG_PAGED_USER_TA
532 	*mobj = mobj_seccpy_shm_alloc(size);
533 #else
534 	*mobj = mobj_mm_alloc(mobj_sec_ddr, size, &tee_mm_sec_ddr);
535 #endif
536 	if (!*mobj)
537 		return TEE_ERROR_GENERIC;
538 
539 	*va = mobj_get_va(*mobj, 0);
540 	return TEE_SUCCESS;
541 }
542 
543 /*
544  * TA invokes some TA with parameter.
545  * If some parameters are memory references:
546  * - either the memref is inside TA private RAM: TA is not allowed to expose
547  *   its private RAM: use a temporary memory buffer and copy the data.
548  * - or the memref is not in the TA private RAM:
549  *   - if the memref was mapped to the TA, TA is allowed to expose it.
550  *   - if so, converts memref virtual address into a physical address.
551  */
552 static TEE_Result tee_svc_copy_param(struct tee_ta_session *sess,
553 				     struct tee_ta_session *called_sess,
554 				     struct utee_params *callee_params,
555 				     struct tee_ta_param *param,
556 				     void *tmp_buf_va[TEE_NUM_PARAMS],
557 				     struct mobj **mobj_tmp)
558 {
559 	size_t n;
560 	TEE_Result res;
561 	size_t req_mem = 0;
562 	size_t s;
563 	uint8_t *dst = 0;
564 	bool ta_private_memref[TEE_NUM_PARAMS];
565 	struct user_ta_ctx *utc = to_user_ta_ctx(sess->ctx);
566 	void *va;
567 	size_t dst_offs;
568 
569 	/* fill 'param' input struct with caller params description buffer */
570 	if (!callee_params) {
571 		memset(param, 0, sizeof(*param));
572 	} else {
573 		res = tee_mmu_check_access_rights(utc,
574 			TEE_MEMORY_ACCESS_READ | TEE_MEMORY_ACCESS_ANY_OWNER,
575 			(uaddr_t)callee_params, sizeof(struct utee_params));
576 		if (res != TEE_SUCCESS)
577 			return res;
578 		utee_param_to_param(param, callee_params);
579 	}
580 
581 	if (called_sess && is_pseudo_ta_ctx(called_sess->ctx)) {
582 		/* pseudo TA borrows the mapping of the calling TA */
583 		return TEE_SUCCESS;
584 	}
585 
586 	/* All mobj in param are of type MOJB_TYPE_VIRT */
587 
588 	for (n = 0; n < TEE_NUM_PARAMS; n++) {
589 
590 		ta_private_memref[n] = false;
591 
592 		switch (TEE_PARAM_TYPE_GET(param->types, n)) {
593 		case TEE_PARAM_TYPE_MEMREF_INPUT:
594 		case TEE_PARAM_TYPE_MEMREF_OUTPUT:
595 		case TEE_PARAM_TYPE_MEMREF_INOUT:
596 			va = (void *)param->u[n].mem.offs;
597 			s = param->u[n].mem.size;
598 			if (!va) {
599 				if (s)
600 					return TEE_ERROR_BAD_PARAMETERS;
601 				break;
602 			}
603 			/* uTA cannot expose its private memory */
604 			if (tee_mmu_is_vbuf_inside_ta_private(utc, va, s)) {
605 
606 				s = ROUNDUP(s, sizeof(uint32_t));
607 				if (ADD_OVERFLOW(req_mem, s, &req_mem))
608 					return TEE_ERROR_BAD_PARAMETERS;
609 				ta_private_memref[n] = true;
610 				break;
611 			}
612 
613 			res = tee_mmu_vbuf_to_mobj_offs(utc, va, s,
614 							&param->u[n].mem.mobj,
615 							&param->u[n].mem.offs);
616 			if (res != TEE_SUCCESS)
617 				return res;
618 			break;
619 		default:
620 			break;
621 		}
622 	}
623 
624 	if (req_mem == 0)
625 		return TEE_SUCCESS;
626 
627 	res = alloc_temp_sec_mem(req_mem, mobj_tmp, &dst);
628 	if (res != TEE_SUCCESS)
629 		return res;
630 	dst_offs = 0;
631 
632 	for (n = 0; n < TEE_NUM_PARAMS; n++) {
633 
634 		if (!ta_private_memref[n])
635 			continue;
636 
637 		s = ROUNDUP(param->u[n].mem.size, sizeof(uint32_t));
638 
639 		switch (TEE_PARAM_TYPE_GET(param->types, n)) {
640 		case TEE_PARAM_TYPE_MEMREF_INPUT:
641 		case TEE_PARAM_TYPE_MEMREF_INOUT:
642 			va = (void *)param->u[n].mem.offs;
643 			if (va) {
644 				res = tee_svc_copy_from_user(dst, va,
645 						param->u[n].mem.size);
646 				if (res != TEE_SUCCESS)
647 					return res;
648 				param->u[n].mem.offs = dst_offs;
649 				param->u[n].mem.mobj = *mobj_tmp;
650 				tmp_buf_va[n] = dst;
651 				dst += s;
652 				dst_offs += s;
653 			}
654 			break;
655 
656 		case TEE_PARAM_TYPE_MEMREF_OUTPUT:
657 			va = (void *)param->u[n].mem.offs;
658 			if (va) {
659 				param->u[n].mem.offs = dst_offs;
660 				param->u[n].mem.mobj = *mobj_tmp;
661 				tmp_buf_va[n] = dst;
662 				dst += s;
663 				dst_offs += s;
664 			}
665 			break;
666 
667 		default:
668 			continue;
669 		}
670 	}
671 
672 	return TEE_SUCCESS;
673 }
674 
675 /*
676  * Back from execution of service: update parameters passed from TA:
677  * If some parameters were memory references:
678  * - either the memref was temporary: copy back data and update size
679  * - or it was the original TA memref: update only the size value.
680  */
681 static TEE_Result tee_svc_update_out_param(
682 		struct tee_ta_param *param,
683 		void *tmp_buf_va[TEE_NUM_PARAMS],
684 		struct utee_params *usr_param)
685 {
686 	size_t n;
687 	uint64_t *vals = usr_param->vals;
688 
689 	for (n = 0; n < TEE_NUM_PARAMS; n++) {
690 		switch (TEE_PARAM_TYPE_GET(param->types, n)) {
691 		case TEE_PARAM_TYPE_MEMREF_OUTPUT:
692 		case TEE_PARAM_TYPE_MEMREF_INOUT:
693 			/*
694 			 * Memory copy is only needed if there's a temporary
695 			 * buffer involved, tmp_buf_va[n] is only update if
696 			 * a temporary buffer is used. Otherwise only the
697 			 * size needs to be updated.
698 			 */
699 			if (tmp_buf_va[n] &&
700 			    param->u[n].mem.size <= vals[n * 2 + 1]) {
701 				void *src = tmp_buf_va[n];
702 				void *dst = (void *)(uintptr_t)vals[n * 2];
703 				TEE_Result res;
704 
705 				res = tee_svc_copy_to_user(dst, src,
706 						 param->u[n].mem.size);
707 				if (res != TEE_SUCCESS)
708 					return res;
709 
710 			}
711 			usr_param->vals[n * 2 + 1] = param->u[n].mem.size;
712 			break;
713 
714 		case TEE_PARAM_TYPE_VALUE_OUTPUT:
715 		case TEE_PARAM_TYPE_VALUE_INOUT:
716 			vals[n * 2] = param->u[n].val.a;
717 			vals[n * 2 + 1] = param->u[n].val.b;
718 			break;
719 
720 		default:
721 			continue;
722 		}
723 	}
724 
725 	return TEE_SUCCESS;
726 }
727 
728 /* Called when a TA calls an OpenSession on another TA */
729 TEE_Result syscall_open_ta_session(const TEE_UUID *dest,
730 			unsigned long cancel_req_to,
731 			struct utee_params *usr_param, uint32_t *ta_sess,
732 			uint32_t *ret_orig)
733 {
734 	TEE_Result res;
735 	uint32_t ret_o = TEE_ORIGIN_TEE;
736 	struct tee_ta_session *s = NULL;
737 	struct tee_ta_session *sess;
738 	struct mobj *mobj_param = NULL;
739 	TEE_UUID *uuid = malloc(sizeof(TEE_UUID));
740 	struct tee_ta_param *param = malloc(sizeof(struct tee_ta_param));
741 	TEE_Identity *clnt_id = malloc(sizeof(TEE_Identity));
742 	void *tmp_buf_va[TEE_NUM_PARAMS] = { NULL };
743 	struct user_ta_ctx *utc;
744 
745 	if (uuid == NULL || param == NULL || clnt_id == NULL) {
746 		res = TEE_ERROR_OUT_OF_MEMORY;
747 		goto out_free_only;
748 	}
749 
750 	memset(param, 0, sizeof(struct tee_ta_param));
751 
752 	res = tee_ta_get_current_session(&sess);
753 	if (res != TEE_SUCCESS)
754 		goto out_free_only;
755 	utc = to_user_ta_ctx(sess->ctx);
756 
757 	res = tee_svc_copy_from_user(uuid, dest, sizeof(TEE_UUID));
758 	if (res != TEE_SUCCESS)
759 		goto function_exit;
760 
761 	clnt_id->login = TEE_LOGIN_TRUSTED_APP;
762 	memcpy(&clnt_id->uuid, &sess->ctx->uuid, sizeof(TEE_UUID));
763 
764 	res = tee_svc_copy_param(sess, NULL, usr_param, param, tmp_buf_va,
765 				 &mobj_param);
766 	if (res != TEE_SUCCESS)
767 		goto function_exit;
768 
769 	res = tee_ta_open_session(&ret_o, &s, &utc->open_sessions, uuid,
770 				  clnt_id, cancel_req_to, param);
771 	tee_mmu_set_ctx(&utc->ctx);
772 	if (res != TEE_SUCCESS)
773 		goto function_exit;
774 
775 	res = tee_svc_update_out_param(param, tmp_buf_va, usr_param);
776 
777 function_exit:
778 	mobj_free(mobj_param);
779 	if (res == TEE_SUCCESS)
780 		tee_svc_copy_kaddr_to_uref(ta_sess, s);
781 	tee_svc_copy_to_user(ret_orig, &ret_o, sizeof(ret_o));
782 
783 out_free_only:
784 	free(param);
785 	free(uuid);
786 	free(clnt_id);
787 	return res;
788 }
789 
790 TEE_Result syscall_close_ta_session(unsigned long ta_sess)
791 {
792 	TEE_Result res;
793 	struct tee_ta_session *sess;
794 	TEE_Identity clnt_id;
795 	struct tee_ta_session *s = tee_svc_uref_to_kaddr(ta_sess);
796 	struct user_ta_ctx *utc;
797 
798 	res = tee_ta_get_current_session(&sess);
799 	if (res != TEE_SUCCESS)
800 		return res;
801 	utc = to_user_ta_ctx(sess->ctx);
802 
803 	clnt_id.login = TEE_LOGIN_TRUSTED_APP;
804 	memcpy(&clnt_id.uuid, &sess->ctx->uuid, sizeof(TEE_UUID));
805 
806 	return tee_ta_close_session(s, &utc->open_sessions, &clnt_id);
807 }
808 
809 TEE_Result syscall_invoke_ta_command(unsigned long ta_sess,
810 			unsigned long cancel_req_to, unsigned long cmd_id,
811 			struct utee_params *usr_param, uint32_t *ret_orig)
812 {
813 	TEE_Result res;
814 	TEE_Result res2;
815 	uint32_t ret_o = TEE_ORIGIN_TEE;
816 	struct tee_ta_param param = { 0 };
817 	TEE_Identity clnt_id;
818 	struct tee_ta_session *sess;
819 	struct tee_ta_session *called_sess;
820 	struct mobj *mobj_param = NULL;
821 	void *tmp_buf_va[TEE_NUM_PARAMS] = { NULL };
822 	struct user_ta_ctx *utc;
823 
824 	res = tee_ta_get_current_session(&sess);
825 	if (res != TEE_SUCCESS)
826 		return res;
827 	utc = to_user_ta_ctx(sess->ctx);
828 
829 	called_sess = tee_ta_get_session(
830 				(vaddr_t)tee_svc_uref_to_kaddr(ta_sess), true,
831 				&utc->open_sessions);
832 	if (!called_sess)
833 		return TEE_ERROR_BAD_PARAMETERS;
834 
835 	clnt_id.login = TEE_LOGIN_TRUSTED_APP;
836 	memcpy(&clnt_id.uuid, &sess->ctx->uuid, sizeof(TEE_UUID));
837 
838 	res = tee_svc_copy_param(sess, called_sess, usr_param, &param,
839 				 tmp_buf_va, &mobj_param);
840 	if (res != TEE_SUCCESS)
841 		goto function_exit;
842 
843 	res = tee_ta_invoke_command(&ret_o, called_sess, &clnt_id,
844 				    cancel_req_to, cmd_id, &param);
845 
846 	res2 = tee_svc_update_out_param(&param, tmp_buf_va, usr_param);
847 	if (res2 != TEE_SUCCESS) {
848 		/*
849 		 * Spec for TEE_InvokeTACommand() says:
850 		 * "If the return origin is different from
851 		 * TEE_ORIGIN_TRUSTED_APP, then the function has failed
852 		 * before it could reach the destination Trusted
853 		 * Application."
854 		 *
855 		 * But if we can't update params to the caller we have no
856 		 * choice we need to return some error to indicate that
857 		 * parameters aren't updated as expected.
858 		 */
859 		ret_o = TEE_ORIGIN_TEE;
860 		res = res2;
861 	}
862 
863 function_exit:
864 	tee_ta_put_session(called_sess);
865 	mobj_free(mobj_param);
866 	if (ret_orig)
867 		tee_svc_copy_to_user(ret_orig, &ret_o, sizeof(ret_o));
868 	return res;
869 }
870 
871 TEE_Result syscall_check_access_rights(unsigned long flags, const void *buf,
872 				       size_t len)
873 {
874 	TEE_Result res;
875 	struct tee_ta_session *s;
876 
877 	res = tee_ta_get_current_session(&s);
878 	if (res != TEE_SUCCESS)
879 		return res;
880 
881 	return tee_mmu_check_access_rights(to_user_ta_ctx(s->ctx), flags,
882 					   (uaddr_t)buf, len);
883 }
884 
885 TEE_Result tee_svc_copy_from_user(void *kaddr, const void *uaddr, size_t len)
886 {
887 	TEE_Result res;
888 	struct tee_ta_session *s;
889 
890 	res = tee_ta_get_current_session(&s);
891 	if (res != TEE_SUCCESS)
892 		return res;
893 
894 	res = tee_mmu_check_access_rights(to_user_ta_ctx(s->ctx),
895 					TEE_MEMORY_ACCESS_READ |
896 					TEE_MEMORY_ACCESS_ANY_OWNER,
897 					(uaddr_t)uaddr, len);
898 	if (res != TEE_SUCCESS)
899 		return res;
900 
901 	memcpy(kaddr, uaddr, len);
902 	return TEE_SUCCESS;
903 }
904 
905 TEE_Result tee_svc_copy_to_user(void *uaddr, const void *kaddr, size_t len)
906 {
907 	TEE_Result res;
908 	struct tee_ta_session *s;
909 
910 	res = tee_ta_get_current_session(&s);
911 	if (res != TEE_SUCCESS)
912 		return res;
913 
914 	res = tee_mmu_check_access_rights(to_user_ta_ctx(s->ctx),
915 					TEE_MEMORY_ACCESS_WRITE |
916 					TEE_MEMORY_ACCESS_ANY_OWNER,
917 					(uaddr_t)uaddr, len);
918 	if (res != TEE_SUCCESS)
919 		return res;
920 
921 	memcpy(uaddr, kaddr, len);
922 	return TEE_SUCCESS;
923 }
924 
925 TEE_Result tee_svc_copy_kaddr_to_uref(uint32_t *uref, void *kaddr)
926 {
927 	uint32_t ref = tee_svc_kaddr_to_uref(kaddr);
928 
929 	return tee_svc_copy_to_user(uref, &ref, sizeof(ref));
930 }
931 
932 TEE_Result syscall_get_cancellation_flag(uint32_t *cancel)
933 {
934 	TEE_Result res;
935 	struct tee_ta_session *s = NULL;
936 	uint32_t c;
937 
938 	res = tee_ta_get_current_session(&s);
939 	if (res != TEE_SUCCESS)
940 		return res;
941 
942 	c = tee_ta_session_is_cancelled(s, NULL);
943 
944 	return tee_svc_copy_to_user(cancel, &c, sizeof(c));
945 }
946 
947 TEE_Result syscall_unmask_cancellation(uint32_t *old_mask)
948 {
949 	TEE_Result res;
950 	struct tee_ta_session *s = NULL;
951 	uint32_t m;
952 
953 	res = tee_ta_get_current_session(&s);
954 	if (res != TEE_SUCCESS)
955 		return res;
956 
957 	m = s->cancel_mask;
958 	s->cancel_mask = false;
959 	return tee_svc_copy_to_user(old_mask, &m, sizeof(m));
960 }
961 
962 TEE_Result syscall_mask_cancellation(uint32_t *old_mask)
963 {
964 	TEE_Result res;
965 	struct tee_ta_session *s = NULL;
966 	uint32_t m;
967 
968 	res = tee_ta_get_current_session(&s);
969 	if (res != TEE_SUCCESS)
970 		return res;
971 
972 	m = s->cancel_mask;
973 	s->cancel_mask = true;
974 	return tee_svc_copy_to_user(old_mask, &m, sizeof(m));
975 }
976 
977 TEE_Result syscall_wait(unsigned long timeout)
978 {
979 	TEE_Result res = TEE_SUCCESS;
980 	uint32_t mytime = 0;
981 	struct tee_ta_session *s;
982 	TEE_Time base_time;
983 	TEE_Time current_time;
984 
985 	res = tee_ta_get_current_session(&s);
986 	if (res != TEE_SUCCESS)
987 		return res;
988 
989 	res = tee_time_get_sys_time(&base_time);
990 	if (res != TEE_SUCCESS)
991 		return res;
992 
993 	while (true) {
994 		res = tee_time_get_sys_time(&current_time);
995 		if (res != TEE_SUCCESS)
996 			return res;
997 
998 		if (tee_ta_session_is_cancelled(s, &current_time))
999 			return TEE_ERROR_CANCEL;
1000 
1001 		mytime = (current_time.seconds - base_time.seconds) * 1000 +
1002 		    (int)current_time.millis - (int)base_time.millis;
1003 		if (mytime >= timeout)
1004 			return TEE_SUCCESS;
1005 
1006 		tee_time_wait(timeout - mytime);
1007 	}
1008 
1009 	return res;
1010 }
1011 
1012 TEE_Result syscall_get_time(unsigned long cat, TEE_Time *mytime)
1013 {
1014 	TEE_Result res, res2;
1015 	struct tee_ta_session *s = NULL;
1016 	TEE_Time t;
1017 
1018 	res = tee_ta_get_current_session(&s);
1019 	if (res != TEE_SUCCESS)
1020 		return res;
1021 
1022 	switch (cat) {
1023 	case UTEE_TIME_CAT_SYSTEM:
1024 		res = tee_time_get_sys_time(&t);
1025 		break;
1026 	case UTEE_TIME_CAT_TA_PERSISTENT:
1027 		res = tee_time_get_ta_time((const void *)&s->ctx->uuid, &t);
1028 		break;
1029 	case UTEE_TIME_CAT_REE:
1030 		res = tee_time_get_ree_time(&t);
1031 		break;
1032 	default:
1033 		res = TEE_ERROR_BAD_PARAMETERS;
1034 		break;
1035 	}
1036 
1037 	if (res == TEE_SUCCESS || res == TEE_ERROR_OVERFLOW) {
1038 		res2 = tee_svc_copy_to_user(mytime, &t, sizeof(t));
1039 		if (res2 != TEE_SUCCESS)
1040 			res = res2;
1041 	}
1042 
1043 	return res;
1044 }
1045 
1046 TEE_Result syscall_set_ta_time(const TEE_Time *mytime)
1047 {
1048 	TEE_Result res;
1049 	struct tee_ta_session *s = NULL;
1050 	TEE_Time t;
1051 
1052 	res = tee_ta_get_current_session(&s);
1053 	if (res != TEE_SUCCESS)
1054 		return res;
1055 
1056 	res = tee_svc_copy_from_user(&t, mytime, sizeof(t));
1057 	if (res != TEE_SUCCESS)
1058 		return res;
1059 
1060 	return tee_time_set_ta_time((const void *)&s->ctx->uuid, &t);
1061 }
1062