xref: /rk3399_ARM-atf/drivers/arm/rse/rse_comms_protocol.c (revision 955116982f5bfb6803b1961eda5fa24ab7886419)
1*95511698STamas Ban /*
2*95511698STamas Ban  * Copyright (c) 2022, Arm Limited. All rights reserved.
3*95511698STamas Ban  *
4*95511698STamas Ban  * SPDX-License-Identifier: BSD-3-Clause
5*95511698STamas Ban  *
6*95511698STamas Ban  */
7*95511698STamas Ban #include <assert.h>
8*95511698STamas Ban 
9*95511698STamas Ban #include <common/debug.h>
10*95511698STamas Ban #include "rss_comms_protocol.h"
11*95511698STamas Ban 
12*95511698STamas Ban psa_status_t rss_protocol_serialize_msg(psa_handle_t handle,
13*95511698STamas Ban 					int16_t type,
14*95511698STamas Ban 					const psa_invec *in_vec,
15*95511698STamas Ban 					uint8_t in_len,
16*95511698STamas Ban 					const psa_outvec *out_vec,
17*95511698STamas Ban 					uint8_t out_len,
18*95511698STamas Ban 					struct serialized_rss_comms_msg_t *msg,
19*95511698STamas Ban 					size_t *msg_len)
20*95511698STamas Ban {
21*95511698STamas Ban 	psa_status_t status;
22*95511698STamas Ban 
23*95511698STamas Ban 	assert(msg != NULL);
24*95511698STamas Ban 	assert(msg_len != NULL);
25*95511698STamas Ban 	assert(in_vec != NULL);
26*95511698STamas Ban 
27*95511698STamas Ban 	switch (msg->header.protocol_ver) {
28*95511698STamas Ban 	case RSS_COMMS_PROTOCOL_EMBED:
29*95511698STamas Ban 		status = rss_protocol_embed_serialize_msg(handle, type, in_vec, in_len, out_vec,
30*95511698STamas Ban 							  out_len, &msg->msg.embed, msg_len);
31*95511698STamas Ban 		if (status != PSA_SUCCESS) {
32*95511698STamas Ban 			return status;
33*95511698STamas Ban 		}
34*95511698STamas Ban 		break;
35*95511698STamas Ban 	case RSS_COMMS_PROTOCOL_POINTER_ACCESS:
36*95511698STamas Ban 		status = rss_protocol_pointer_access_serialize_msg(handle, type, in_vec, in_len,
37*95511698STamas Ban 								   out_vec, out_len,
38*95511698STamas Ban 								   &msg->msg.pointer_access,
39*95511698STamas Ban 								   msg_len);
40*95511698STamas Ban 		if (status != PSA_SUCCESS) {
41*95511698STamas Ban 			return status;
42*95511698STamas Ban 		}
43*95511698STamas Ban 		break;
44*95511698STamas Ban 	default:
45*95511698STamas Ban 		return PSA_ERROR_NOT_SUPPORTED;
46*95511698STamas Ban 	}
47*95511698STamas Ban 
48*95511698STamas Ban 	*msg_len += sizeof(struct serialized_rss_comms_header_t);
49*95511698STamas Ban 
50*95511698STamas Ban 	return PSA_SUCCESS;
51*95511698STamas Ban }
52*95511698STamas Ban 
53*95511698STamas Ban psa_status_t rss_protocol_deserialize_reply(psa_outvec *out_vec,
54*95511698STamas Ban 					    uint8_t out_len,
55*95511698STamas Ban 					    psa_status_t *return_val,
56*95511698STamas Ban 					    const struct serialized_rss_comms_reply_t *reply,
57*95511698STamas Ban 					    size_t reply_size)
58*95511698STamas Ban {
59*95511698STamas Ban 	assert(reply != NULL);
60*95511698STamas Ban 	assert(return_val != NULL);
61*95511698STamas Ban 
62*95511698STamas Ban 	switch (reply->header.protocol_ver) {
63*95511698STamas Ban 	case RSS_COMMS_PROTOCOL_EMBED:
64*95511698STamas Ban 		return rss_protocol_embed_deserialize_reply(out_vec, out_len, return_val,
65*95511698STamas Ban 							    &reply->reply.embed, reply_size);
66*95511698STamas Ban 	case RSS_COMMS_PROTOCOL_POINTER_ACCESS:
67*95511698STamas Ban 		return rss_protocol_pointer_access_deserialize_reply(out_vec, out_len, return_val,
68*95511698STamas Ban 								     &reply->reply.pointer_access,
69*95511698STamas Ban 								     reply_size);
70*95511698STamas Ban 	default:
71*95511698STamas Ban 		return PSA_ERROR_NOT_SUPPORTED;
72*95511698STamas Ban 	}
73*95511698STamas Ban 
74*95511698STamas Ban 	return PSA_SUCCESS;
75*95511698STamas Ban }
76