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
10 #include "sfcp_psa_protocol_common.h"
11 #include "sfcp_psa_protocol_pointer_access.h"
12
sfcp_protocol_pointer_access_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 sfcp_pointer_access_msg_t * msg,size_t * msg_len)13 psa_status_t sfcp_protocol_pointer_access_serialize_msg(
14 psa_handle_t handle, int16_t type, const psa_invec *in_vec,
15 uint8_t in_len, const psa_outvec *out_vec, uint8_t out_len,
16 struct sfcp_pointer_access_msg_t *msg, size_t *msg_len)
17 {
18 uint8_t i;
19
20 assert(msg != NULL);
21 assert(msg_len != NULL);
22 assert(in_vec != NULL);
23
24 msg->ctrl_param = PARAM_PACK(type, in_len, out_len);
25 msg->handle = handle;
26
27 /* Fill msg iovec lengths */
28 for (i = 0U; i < in_len; ++i) {
29 msg->io_sizes[i] = in_vec[i].len;
30 msg->host_ptrs[i] = (uint64_t)in_vec[i].base;
31 }
32 for (i = 0U; i < out_len; ++i) {
33 msg->io_sizes[in_len + i] = out_vec[i].len;
34 msg->host_ptrs[in_len + i] = (uint64_t)out_vec[i].base;
35 }
36
37 *msg_len = sizeof(*msg);
38
39 return PSA_SUCCESS;
40 }
41
sfcp_protocol_pointer_access_deserialize_reply(psa_outvec * out_vec,uint8_t out_len,psa_status_t * return_val,const struct sfcp_pointer_access_reply_t * reply,size_t reply_size)42 psa_status_t sfcp_protocol_pointer_access_deserialize_reply(
43 psa_outvec *out_vec, uint8_t out_len, psa_status_t *return_val,
44 const struct sfcp_pointer_access_reply_t *reply, size_t reply_size)
45 {
46 uint8_t i;
47
48 assert(reply != NULL);
49 assert(return_val != NULL);
50
51 for (i = 0U; i < out_len; ++i) {
52 out_vec[i].len = reply->out_size[i];
53 }
54
55 *return_val = reply->return_val;
56
57 return PSA_SUCCESS;
58 }
59