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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
|
/*-
* SPDX-License-Identifier: BSD-2-Clause
*
* Copyright (c) 2024 Hans Rosenfeld
* Author: Hans Rosenfeld <rosenfeld@grumpf.hope-2000.org>
*/
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/un.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#ifdef __FreeBSD__
#include <malloc_np.h>
#else
#include <sys/vmm.h>
#endif
#include <stdlib.h>
#include <string.h>
#include <strings.h>
#include <unistd.h>
#include "config.h"
#include "tpm_device.h"
#include "tpm_emul.h"
struct tpm_swtpm {
int fd;
};
struct tpm_resp_hdr {
uint16_t tag;
uint32_t len;
uint32_t errcode;
} __packed;
static int
tpm_swtpm_init(void **sc, nvlist_t *nvl)
{
struct tpm_swtpm *tpm;
const char *path;
struct sockaddr_un tpm_addr;
tpm = calloc(1, sizeof (struct tpm_swtpm));
if (tpm == NULL) {
warnx("%s: failed to allocate tpm_swtpm", __func__);
return (ENOMEM);
}
path = get_config_value_node(nvl, "path");
if (path == NULL) {
warnx("%s: no socket path specified", __func__);
return (ENOENT);
}
tpm->fd = socket(PF_UNIX, SOCK_STREAM | SOCK_CLOEXEC, 0);
if (tpm->fd < 0) {
warnx("%s: unable to open tpm socket", __func__);
return (ENOENT);
}
bzero(&tpm_addr, sizeof (tpm_addr));
tpm_addr.sun_family = AF_UNIX;
strlcpy(tpm_addr.sun_path, path, sizeof (tpm_addr.sun_path) - 1);
if (connect(tpm->fd, (struct sockaddr *)&tpm_addr, sizeof (tpm_addr)) ==
-1) {
warnx("%s: unable to connect to tpm socket \"%s\"", __func__,
path);
return (ENOENT);
}
*sc = tpm;
return (0);
}
static int
tpm_swtpm_execute_cmd(void *sc, void *cmd, uint32_t cmd_size, void *rsp,
uint32_t rsp_size)
{
struct tpm_swtpm *tpm;
ssize_t len;
if (rsp_size < (ssize_t)sizeof(struct tpm_resp_hdr)) {
warn("%s: rsp_size of %u is too small", __func__, rsp_size);
return (EINVAL);
}
tpm = sc;
#ifdef __FreeBSD__
len = send(tpm->fd, cmd, cmd_size, MSG_NOSIGNAL|MSG_DONTWAIT);
if (len == -1)
err(1, "%s: cmd send failed, is swtpm running?", __func__);
if (len != cmd_size) {
warn("%s: cmd write failed (bytes written: %zd / %d)", __func__,
len, cmd_size);
return (EFAULT);
}
len = recv(tpm->fd, rsp, rsp_size, 0);
if (len == -1)
err(1, "%s: rsp recv failed, is swtpm running?", __func__);
if (len < (ssize_t)sizeof(struct tpm_resp_hdr)) {
warn("%s: rsp read failed (bytes read: %zd / %d)", __func__,
len, rsp_size);
return (EFAULT);
}
#else
while (cmd_size > 0) {
len = send(tpm->fd, cmd, cmd_size, MSG_NOSIGNAL|MSG_DONTWAIT);
if (len == -1) {
if (errno == EINTR)
continue;
err(1, "%s: cmd send failed, is swtpm running?",
__func__);
}
cmd += len;
cmd_size -= len;
}
size_t buflen = rsp_size;
size_t rcvd = 0;
while (buflen > 0 && rcvd < sizeof (struct tpm_resp_hdr)) {
len = recv(tpm->fd, rsp, buflen, 0);
if (len == -1) {
if (errno == EINTR)
continue;
err(1, "%s: rsp recv failed, is swtpm running?",
__func__);
}
if (len == 0)
break;
rsp += len;
buflen -= len;
rcvd += len;
}
#endif
return (0);
}
static void
tpm_swtpm_deinit(void *sc)
{
struct tpm_swtpm *tpm;
tpm = sc;
if (tpm == NULL)
return;
if (tpm->fd >= 0)
close(tpm->fd);
free(tpm);
}
static const struct tpm_emul tpm_emul_swtpm = {
.name = "swtpm",
.init = tpm_swtpm_init,
.deinit = tpm_swtpm_deinit,
.execute_cmd = tpm_swtpm_execute_cmd,
};
TPM_EMUL_SET(tpm_emul_swtpm);
|