xref: /rk3399_ARM-atf/drivers/arm/sfcp/sfcp_psa/sfcp_psa_protocol/sfcp_psa_protocol.c (revision 2801427972c4b0d4c0165edb509f21186103f21f)
1 /*
2  * Copyright (c) 2026, Arm Limited. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  *
6  */
7 
8 #include <assert.h>
9 #include <string.h>
10 #include "sfcp_psa_protocol.h"
11 
12 psa_status_t
sfcp_protocol_serialize_msg(psa_handle_t handle,int16_t type,const psa_invec * in_vec,uint8_t in_len,const psa_outvec * out_vec,uint8_t out_len,struct serialized_psa_msg_t * msg,size_t * msg_len)13 sfcp_protocol_serialize_msg(psa_handle_t handle, int16_t type,
14 			    const psa_invec *in_vec, uint8_t in_len,
15 			    const psa_outvec *out_vec, uint8_t out_len,
16 			    struct serialized_psa_msg_t *msg, size_t *msg_len)
17 {
18 	psa_status_t status;
19 
20 	assert(msg != NULL);
21 	assert(msg_len != NULL);
22 	assert(in_vec != NULL);
23 
24 	switch (msg->header.protocol_ver) {
25 #ifdef SFCP_PROTOCOL_EMBED_ENABLED
26 	case SFCP_PROTOCOL_EMBED:
27 		status = sfcp_protocol_embed_serialize_msg(
28 			handle, type, in_vec, in_len, out_vec, out_len,
29 			&msg->msg.embed, msg_len);
30 		if (status != PSA_SUCCESS) {
31 			return status;
32 		}
33 		break;
34 #endif
35 #ifdef SFCP_PROTOCOL_POINTER_ACCESS_ENABLED
36 	case SFCP_PROTOCOL_POINTER_ACCESS:
37 		status = sfcp_protocol_pointer_access_serialize_msg(
38 			handle, type, in_vec, in_len, out_vec, out_len,
39 			&msg->msg.pointer_access, msg_len);
40 		if (status != PSA_SUCCESS) {
41 			return status;
42 		}
43 		break;
44 #endif
45 	default:
46 		return PSA_ERROR_NOT_SUPPORTED;
47 	}
48 
49 	*msg_len += sizeof(struct serialized_sfcp_header_t);
50 
51 	return PSA_SUCCESS;
52 }
53 
sfcp_protocol_deserialize_reply(psa_outvec * out_vec,uint8_t out_len,psa_status_t * return_val,const struct serialized_psa_reply_t * reply,size_t reply_size)54 psa_status_t sfcp_protocol_deserialize_reply(
55 	psa_outvec *out_vec, uint8_t out_len, psa_status_t *return_val,
56 	const struct serialized_psa_reply_t *reply, size_t reply_size)
57 {
58 	assert(reply != NULL);
59 	assert(return_val != NULL);
60 
61 	switch (reply->header.protocol_ver) {
62 #ifdef SFCP_PROTOCOL_EMBED_ENABLED
63 	case SFCP_PROTOCOL_EMBED:
64 		return sfcp_protocol_embed_deserialize_reply(
65 			out_vec, out_len, return_val, &reply->reply.embed,
66 			reply_size);
67 #endif
68 #ifdef SFCP_PROTOCOL_POINTER_ACCESS_ENABLED
69 	case SFCP_PROTOCOL_POINTER_ACCESS:
70 		return sfcp_protocol_pointer_access_deserialize_reply(
71 			out_vec, out_len, return_val,
72 			&reply->reply.pointer_access, reply_size);
73 #endif
74 	default:
75 		return PSA_ERROR_NOT_SUPPORTED;
76 	}
77 
78 	return PSA_SUCCESS;
79 }
80