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