1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
|
/*
* Copyright (C) 2016 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <assert.h>
#include <errno.h>
#include <stdbool.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <sys/uio.h>
#include <unistd.h>
#include <trusty/tipc.h>
#include "ipc.h"
#include "log.h"
#define MAX_RECONNECT_RETRY_COUNT 5
#define TRUSTY_RECONNECT_TIMEOUT_SEC 5
static int tipc_fd = -1;
int ipc_connect(const char *device, const char *port)
{
int rc;
uint retry_cnt = 0;
assert(tipc_fd == -1);
while(true) {
rc = tipc_connect(device, port);
if (rc >= 0)
break;
ALOGE("failed (%d) to connect to storage server\n", rc);
if (++retry_cnt > MAX_RECONNECT_RETRY_COUNT) {
ALOGE("max number of reconnect retries (%d) has been reached\n",
retry_cnt);
return -1;
}
sleep(TRUSTY_RECONNECT_TIMEOUT_SEC);
}
tipc_fd = rc;
return 0;
}
void ipc_disconnect(void)
{
assert(tipc_fd >= 0);
tipc_close(tipc_fd);
tipc_fd = -1;
}
ssize_t ipc_get_msg(struct storage_msg *msg, void *req_buf, size_t req_buf_len)
{
ssize_t rc;
struct iovec iovs[2] = {{msg, sizeof(*msg)}, {req_buf, req_buf_len}};
assert(tipc_fd >= 0);
rc = readv(tipc_fd, iovs, 2);
if (rc < 0) {
ALOGE("failed to read request: %s\n", strerror(errno));
return rc;
}
/* check for minimum size */
if ((size_t)rc < sizeof(*msg)) {
ALOGE("message is too short (%zu bytes received)\n", rc);
return -1;
}
/* check for message completeness */
if (msg->size != (uint32_t)rc) {
ALOGE("inconsistent message size [cmd=%d] (%u != %u)\n",
msg->cmd, msg->size, (uint32_t)rc);
return -1;
}
return rc - sizeof(*msg);
}
int ipc_respond(struct storage_msg *msg, void *out, size_t out_size)
{
ssize_t rc;
struct iovec iovs[2] = {{msg, sizeof(*msg)}, {out, out_size}};
assert(tipc_fd >= 0);
msg->cmd |= STORAGE_RESP_BIT;
rc = writev(tipc_fd, iovs, out ? 2 : 1);
if (rc < 0) {
ALOGE("error sending response 0x%x: %s\n",
msg->cmd, strerror(errno));
return -1;
}
return 0;
}
|
