32 static void handle_rpc_func_cmd_get_time(struct optee_msg_arg *arg)  in handle_rpc_func_cmd_get_time()  argument
36 	if (arg->num_params != 1)  in handle_rpc_func_cmd_get_time()
38 	if ((arg->params[0].attr & OPTEE_MSG_ATTR_TYPE_MASK) !=  in handle_rpc_func_cmd_get_time()
43 	arg->params[0].u.value.a = ts.tv_sec;  in handle_rpc_func_cmd_get_time()
44 	arg->params[0].u.value.b = ts.tv_nsec;  in handle_rpc_func_cmd_get_time()
46 	arg->ret = TEEC_SUCCESS;  in handle_rpc_func_cmd_get_time()
49 	arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_get_time()
95 				   struct optee_msg_arg *arg)  in handle_rpc_func_cmd_wq()  argument
97 	if (arg->num_params != 1)  in handle_rpc_func_cmd_wq()
100 	if ((arg->params[0].attr & OPTEE_MSG_ATTR_TYPE_MASK) !=  in handle_rpc_func_cmd_wq()
104 	switch (arg->params[0].u.value.a) {  in handle_rpc_func_cmd_wq()
106 		wq_sleep(&optee->wait_queue, arg->params[0].u.value.b);  in handle_rpc_func_cmd_wq()
109 		wq_wakeup(&optee->wait_queue, arg->params[0].u.value.b);  in handle_rpc_func_cmd_wq()
115 	arg->ret = TEEC_SUCCESS;  in handle_rpc_func_cmd_wq()
118 	arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_wq()
121 static void handle_rpc_func_cmd_wait(struct optee_msg_arg *arg)  in handle_rpc_func_cmd_wait()  argument
125 	if (arg->num_params != 1)  in handle_rpc_func_cmd_wait()
128 	if ((arg->params[0].attr & OPTEE_MSG_ATTR_TYPE_MASK) !=  in handle_rpc_func_cmd_wait()
132 	msec_to_wait = arg->params[0].u.value.a;  in handle_rpc_func_cmd_wait()
137 	arg->ret = TEEC_SUCCESS;  in handle_rpc_func_cmd_wait()
140 	arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_wait()
144 				struct optee_msg_arg *arg)  in handle_rpc_supp_cmd()  argument
148 	arg->ret_origin = TEEC_ORIGIN_COMMS;  in handle_rpc_supp_cmd()
150 	params = kmalloc_array(arg->num_params, sizeof(struct tee_param),  in handle_rpc_supp_cmd()
153 		arg->ret = TEEC_ERROR_OUT_OF_MEMORY;  in handle_rpc_supp_cmd()
157 	if (optee_from_msg_param(params, arg->num_params, arg->params)) {  in handle_rpc_supp_cmd()
158 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_supp_cmd()
162 	arg->ret = optee_supp_thrd_req(ctx, arg->cmd, arg->num_params, params);  in handle_rpc_supp_cmd()
164 	if (optee_to_msg_param(arg->params, arg->num_params, params))  in handle_rpc_supp_cmd()
165 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_supp_cmd()
194 					  struct optee_msg_arg *arg,  in handle_rpc_func_cmd_shm_alloc()  argument
202 	arg->ret_origin = TEEC_ORIGIN_COMMS;  in handle_rpc_func_cmd_shm_alloc()
204 	if (!arg->num_params ||  in handle_rpc_func_cmd_shm_alloc()
205 	    arg->params[0].attr != OPTEE_MSG_ATTR_TYPE_VALUE_INPUT) {  in handle_rpc_func_cmd_shm_alloc()
206 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_alloc()
210 	for (n = 1; n < arg->num_params; n++) {  in handle_rpc_func_cmd_shm_alloc()
211 		if (arg->params[n].attr != OPTEE_MSG_ATTR_TYPE_NONE) {  in handle_rpc_func_cmd_shm_alloc()
212 			arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_alloc()
217 	sz = arg->params[0].u.value.b;  in handle_rpc_func_cmd_shm_alloc()
218 	switch (arg->params[0].u.value.a) {  in handle_rpc_func_cmd_shm_alloc()
226 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_alloc()
231 		arg->ret = TEEC_ERROR_OUT_OF_MEMORY;  in handle_rpc_func_cmd_shm_alloc()
236 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_alloc()
249 			arg->ret = TEEC_ERROR_OUT_OF_MEMORY;  in handle_rpc_func_cmd_shm_alloc()
255 			arg->ret = TEEC_ERROR_OUT_OF_MEMORY;  in handle_rpc_func_cmd_shm_alloc()
262 		arg->params[0].attr = OPTEE_MSG_ATTR_TYPE_TMEM_OUTPUT |  in handle_rpc_func_cmd_shm_alloc()
268 		arg->params[0].u.tmem.buf_ptr = virt_to_phys(pages_list) |  in handle_rpc_func_cmd_shm_alloc()
271 		arg->params[0].u.tmem.size = tee_shm_get_size(shm);  in handle_rpc_func_cmd_shm_alloc()
272 		arg->params[0].u.tmem.shm_ref = (unsigned long)shm;  in handle_rpc_func_cmd_shm_alloc()
277 		arg->params[0].attr = OPTEE_MSG_ATTR_TYPE_TMEM_OUTPUT;  in handle_rpc_func_cmd_shm_alloc()
278 		arg->params[0].u.tmem.buf_ptr = pa;  in handle_rpc_func_cmd_shm_alloc()
279 		arg->params[0].u.tmem.size = sz;  in handle_rpc_func_cmd_shm_alloc()
280 		arg->params[0].u.tmem.shm_ref = (unsigned long)shm;  in handle_rpc_func_cmd_shm_alloc()
283 	arg->ret = TEEC_SUCCESS;  in handle_rpc_func_cmd_shm_alloc()
315 					 struct optee_msg_arg *arg)  in handle_rpc_func_cmd_shm_free()  argument
319 	arg->ret_origin = TEEC_ORIGIN_COMMS;  in handle_rpc_func_cmd_shm_free()
321 	if (arg->num_params != 1 ||  in handle_rpc_func_cmd_shm_free()
322 	    arg->params[0].attr != OPTEE_MSG_ATTR_TYPE_VALUE_INPUT) {  in handle_rpc_func_cmd_shm_free()
323 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_free()
327 	shm = (struct tee_shm *)(unsigned long)arg->params[0].u.value.b;  in handle_rpc_func_cmd_shm_free()
328 	switch (arg->params[0].u.value.a) {  in handle_rpc_func_cmd_shm_free()
336 		arg->ret = TEEC_ERROR_BAD_PARAMETERS;  in handle_rpc_func_cmd_shm_free()
338 	arg->ret = TEEC_SUCCESS;  in handle_rpc_func_cmd_shm_free()
360 	struct optee_msg_arg *arg;  in handle_rpc_func_cmd()  local
362 	arg = tee_shm_get_va(shm, 0);  in handle_rpc_func_cmd()
363 	if (IS_ERR(arg)) {  in handle_rpc_func_cmd()
368 	switch (arg->cmd) {  in handle_rpc_func_cmd()
370 		handle_rpc_func_cmd_get_time(arg);  in handle_rpc_func_cmd()
373 		handle_rpc_func_cmd_wq(optee, arg);  in handle_rpc_func_cmd()
376 		handle_rpc_func_cmd_wait(arg);  in handle_rpc_func_cmd()
380 		handle_rpc_func_cmd_shm_alloc(ctx, arg, call_ctx);  in handle_rpc_func_cmd()
383 		handle_rpc_func_cmd_shm_free(ctx, arg);  in handle_rpc_func_cmd()
386 		handle_rpc_supp_cmd(ctx, arg);  in handle_rpc_func_cmd()