1 /*
2 * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
3 * 2005-2007 Takahiro Hirofuchi
4 *
5 * This program is free software: you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation, either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program. If not, see <http://www.gnu.org/licenses/>.
17 */
18
19 #include <sys/socket.h>
20
21 #include <string.h>
22
23 #include <arpa/inet.h>
24 #include <netdb.h>
25 #include <netinet/tcp.h>
26 #include <unistd.h>
27
28 #ifdef HAVE_LIBWRAP
29 #include <tcpd.h>
30 #endif
31
32 #include "usbip_common.h"
33 #include "usbip_network.h"
34
35 int usbip_port = 3240;
36 char *usbip_port_string = "3240";
37
usbip_setup_port_number(char * arg)38 void usbip_setup_port_number(char *arg)
39 {
40 dbg("parsing port arg '%s'", arg);
41 char *end;
42 unsigned long int port = strtoul(arg, &end, 10);
43
44 if (end == arg) {
45 err("port: could not parse '%s' as a decimal integer", arg);
46 return;
47 }
48
49 if (*end != '\0') {
50 err("port: garbage at end of '%s'", arg);
51 return;
52 }
53
54 if (port > UINT16_MAX) {
55 err("port: %s too high (max=%d)",
56 arg, UINT16_MAX);
57 return;
58 }
59
60 usbip_port = port;
61 usbip_port_string = arg;
62 info("using port %d (\"%s\")", usbip_port, usbip_port_string);
63 }
64
usbip_net_pack_uint32_t(int pack,uint32_t num)65 uint32_t usbip_net_pack_uint32_t(int pack, uint32_t num)
66 {
67 uint32_t i;
68
69 if (pack)
70 i = htonl(num);
71 else
72 i = ntohl(num);
73
74 return i;
75 }
76
usbip_net_pack_uint16_t(int pack,uint16_t num)77 uint16_t usbip_net_pack_uint16_t(int pack, uint16_t num)
78 {
79 uint16_t i;
80
81 if (pack)
82 i = htons(num);
83 else
84 i = ntohs(num);
85
86 return i;
87 }
88
usbip_net_pack_usb_device(int pack,struct usbip_usb_device * udev)89 void usbip_net_pack_usb_device(int pack, struct usbip_usb_device *udev)
90 {
91 udev->busnum = usbip_net_pack_uint32_t(pack, udev->busnum);
92 udev->devnum = usbip_net_pack_uint32_t(pack, udev->devnum);
93 udev->speed = usbip_net_pack_uint32_t(pack, udev->speed);
94
95 udev->idVendor = usbip_net_pack_uint16_t(pack, udev->idVendor);
96 udev->idProduct = usbip_net_pack_uint16_t(pack, udev->idProduct);
97 udev->bcdDevice = usbip_net_pack_uint16_t(pack, udev->bcdDevice);
98 }
99
usbip_net_pack_usb_interface(int pack,struct usbip_usb_interface * udev)100 void usbip_net_pack_usb_interface(int pack __attribute__((unused)),
101 struct usbip_usb_interface *udev
102 __attribute__((unused)))
103 {
104 /* uint8_t members need nothing */
105 }
106
usbip_net_xmit(int sockfd,void * buff,size_t bufflen,int sending)107 static ssize_t usbip_net_xmit(int sockfd, void *buff, size_t bufflen,
108 int sending)
109 {
110 ssize_t nbytes;
111 ssize_t total = 0;
112
113 if (!bufflen)
114 return 0;
115
116 do {
117 if (sending)
118 nbytes = send(sockfd, buff, bufflen, 0);
119 else
120 nbytes = recv(sockfd, buff, bufflen, MSG_WAITALL);
121
122 if (nbytes <= 0)
123 return -1;
124
125 buff = (void *)((intptr_t) buff + nbytes);
126 bufflen -= nbytes;
127 total += nbytes;
128
129 } while (bufflen > 0);
130
131 return total;
132 }
133
usbip_net_recv(int sockfd,void * buff,size_t bufflen)134 ssize_t usbip_net_recv(int sockfd, void *buff, size_t bufflen)
135 {
136 return usbip_net_xmit(sockfd, buff, bufflen, 0);
137 }
138
usbip_net_send(int sockfd,void * buff,size_t bufflen)139 ssize_t usbip_net_send(int sockfd, void *buff, size_t bufflen)
140 {
141 return usbip_net_xmit(sockfd, buff, bufflen, 1);
142 }
143
usbip_net_pack_op_common(int pack,struct op_common * op_common)144 static inline void usbip_net_pack_op_common(int pack,
145 struct op_common *op_common)
146 {
147 op_common->version = usbip_net_pack_uint16_t(pack, op_common->version);
148 op_common->code = usbip_net_pack_uint16_t(pack, op_common->code);
149 op_common->status = usbip_net_pack_uint32_t(pack, op_common->status);
150 }
151
usbip_net_send_op_common(int sockfd,uint32_t code,uint32_t status)152 int usbip_net_send_op_common(int sockfd, uint32_t code, uint32_t status)
153 {
154 struct op_common op_common;
155 int rc;
156
157 memset(&op_common, 0, sizeof(op_common));
158
159 op_common.version = USBIP_VERSION;
160 op_common.code = code;
161 op_common.status = status;
162
163 usbip_net_pack_op_common(1, &op_common);
164
165 rc = usbip_net_send(sockfd, &op_common, sizeof(op_common));
166 if (rc < 0) {
167 dbg("usbip_net_send failed: %d", rc);
168 return -1;
169 }
170
171 return 0;
172 }
173
usbip_net_recv_op_common(int sockfd,uint16_t * code)174 int usbip_net_recv_op_common(int sockfd, uint16_t *code)
175 {
176 struct op_common op_common;
177 int rc;
178
179 memset(&op_common, 0, sizeof(op_common));
180
181 rc = usbip_net_recv(sockfd, &op_common, sizeof(op_common));
182 if (rc < 0) {
183 dbg("usbip_net_recv failed: %d", rc);
184 goto err;
185 }
186
187 usbip_net_pack_op_common(0, &op_common);
188
189 if (op_common.version != USBIP_VERSION) {
190 dbg("version mismatch: %d %d", op_common.version,
191 USBIP_VERSION);
192 goto err;
193 }
194
195 switch (*code) {
196 case OP_UNSPEC:
197 break;
198 default:
199 if (op_common.code != *code) {
200 dbg("unexpected pdu %#0x for %#0x", op_common.code,
201 *code);
202 goto err;
203 }
204 }
205
206 if (op_common.status != ST_OK) {
207 dbg("request failed at peer: %d", op_common.status);
208 goto err;
209 }
210
211 *code = op_common.code;
212
213 return 0;
214 err:
215 return -1;
216 }
217
usbip_net_set_reuseaddr(int sockfd)218 int usbip_net_set_reuseaddr(int sockfd)
219 {
220 const int val = 1;
221 int ret;
222
223 ret = setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(val));
224 if (ret < 0)
225 dbg("setsockopt: SO_REUSEADDR");
226
227 return ret;
228 }
229
usbip_net_set_nodelay(int sockfd)230 int usbip_net_set_nodelay(int sockfd)
231 {
232 const int val = 1;
233 int ret;
234
235 ret = setsockopt(sockfd, IPPROTO_TCP, TCP_NODELAY, &val, sizeof(val));
236 if (ret < 0)
237 dbg("setsockopt: TCP_NODELAY");
238
239 return ret;
240 }
241
usbip_net_set_keepalive(int sockfd)242 int usbip_net_set_keepalive(int sockfd)
243 {
244 const int val = 1;
245 int ret;
246
247 ret = setsockopt(sockfd, SOL_SOCKET, SO_KEEPALIVE, &val, sizeof(val));
248 if (ret < 0)
249 dbg("setsockopt: SO_KEEPALIVE");
250
251 return ret;
252 }
253
usbip_net_set_v6only(int sockfd)254 int usbip_net_set_v6only(int sockfd)
255 {
256 const int val = 1;
257 int ret;
258
259 ret = setsockopt(sockfd, IPPROTO_IPV6, IPV6_V6ONLY, &val, sizeof(val));
260 if (ret < 0)
261 dbg("setsockopt: IPV6_V6ONLY");
262
263 return ret;
264 }
265
266 /*
267 * IPv6 Ready
268 */
usbip_net_tcp_connect(char * hostname,char * service)269 int usbip_net_tcp_connect(char *hostname, char *service)
270 {
271 struct addrinfo hints, *res, *rp;
272 int sockfd;
273 int ret;
274
275 memset(&hints, 0, sizeof(hints));
276 hints.ai_family = AF_UNSPEC;
277 hints.ai_socktype = SOCK_STREAM;
278
279 /* get all possible addresses */
280 ret = getaddrinfo(hostname, service, &hints, &res);
281 if (ret < 0) {
282 dbg("getaddrinfo: %s service %s: %s", hostname, service,
283 gai_strerror(ret));
284 return ret;
285 }
286
287 /* try the addresses */
288 for (rp = res; rp; rp = rp->ai_next) {
289 sockfd = socket(rp->ai_family, rp->ai_socktype,
290 rp->ai_protocol);
291 if (sockfd < 0)
292 continue;
293
294 /* should set TCP_NODELAY for usbip */
295 usbip_net_set_nodelay(sockfd);
296 /* TODO: write code for heartbeat */
297 usbip_net_set_keepalive(sockfd);
298
299 if (connect(sockfd, rp->ai_addr, rp->ai_addrlen) == 0)
300 break;
301
302 close(sockfd);
303 }
304
305 freeaddrinfo(res);
306
307 if (!rp)
308 return EAI_SYSTEM;
309
310 return sockfd;
311 }
312