1 /*
2 * Copyright (c) 2022-2024, Arm Limited. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 *
6 */
7 #include <assert.h>
8
9 #include "rse_comms_protocol_common.h"
10 #include "rse_comms_protocol_pointer_access.h"
11
rse_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 rse_pointer_access_msg_t * msg,size_t * msg_len)12 psa_status_t rse_protocol_pointer_access_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 rse_pointer_access_msg_t *msg,
19 size_t *msg_len)
20 {
21 unsigned int i;
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 msg->ctrl_param = PARAM_PACK(type, in_len, out_len);
29 msg->handle = handle;
30
31 /* Fill msg iovec lengths */
32 for (i = 0U; i < in_len; ++i) {
33 msg->io_sizes[i] = in_vec[i].len;
34 msg->host_ptrs[i] = (uint64_t)in_vec[i].base;
35 }
36 for (i = 0U; i < out_len; ++i) {
37 msg->io_sizes[in_len + i] = out_vec[i].len;
38 msg->host_ptrs[in_len + i] = (uint64_t)out_vec[i].base;
39 }
40
41 *msg_len = sizeof(*msg);
42
43 return PSA_SUCCESS;
44 }
45
rse_protocol_pointer_access_deserialize_reply(psa_outvec * out_vec,uint8_t out_len,psa_status_t * return_val,const struct rse_pointer_access_reply_t * reply,size_t reply_size)46 psa_status_t rse_protocol_pointer_access_deserialize_reply(psa_outvec *out_vec,
47 uint8_t out_len,
48 psa_status_t *return_val,
49 const struct rse_pointer_access_reply_t *reply,
50 size_t reply_size)
51 {
52 unsigned int i;
53
54 assert(reply != NULL);
55 assert(return_val != NULL);
56
57 for (i = 0U; i < out_len; ++i) {
58 out_vec[i].len = reply->out_sizes[i];
59 }
60
61 *return_val = reply->return_val;
62
63 return PSA_SUCCESS;
64 }
65