1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
4 * 2005-2007 Takahiro Hirofuchi
7 #include <sys/socket.h>
11 #include <arpa/inet.h>
13 #include <netinet/tcp.h>
20 #include "usbip_common.h"
21 #include "usbip_network.h"
23 int usbip_port = 3240;
24 char *usbip_port_string = "3240";
26 void usbip_setup_port_number(char *arg)
28 dbg("parsing port arg '%s'", arg);
30 unsigned long int port = strtoul(arg, &end, 10);
33 err("port: could not parse '%s' as a decimal integer", arg);
38 err("port: garbage at end of '%s'", arg);
42 if (port > UINT16_MAX) {
43 err("port: %s too high (max=%d)",
49 usbip_port_string = arg;
50 info("using port %d (\"%s\")", usbip_port, usbip_port_string);
53 uint32_t usbip_net_pack_uint32_t(int pack, uint32_t num)
65 uint16_t usbip_net_pack_uint16_t(int pack, uint16_t num)
77 void usbip_net_pack_usb_device(int pack, struct usbip_usb_device *udev)
79 udev->busnum = usbip_net_pack_uint32_t(pack, udev->busnum);
80 udev->devnum = usbip_net_pack_uint32_t(pack, udev->devnum);
81 udev->speed = usbip_net_pack_uint32_t(pack, udev->speed);
83 udev->idVendor = usbip_net_pack_uint16_t(pack, udev->idVendor);
84 udev->idProduct = usbip_net_pack_uint16_t(pack, udev->idProduct);
85 udev->bcdDevice = usbip_net_pack_uint16_t(pack, udev->bcdDevice);
88 void usbip_net_pack_usb_interface(int pack __attribute__((unused)),
89 struct usbip_usb_interface *udev
90 __attribute__((unused)))
92 /* uint8_t members need nothing */
95 static ssize_t usbip_net_xmit(int sockfd, void *buff, size_t bufflen,
106 nbytes = send(sockfd, buff, bufflen, 0);
108 nbytes = recv(sockfd, buff, bufflen, MSG_WAITALL);
113 buff = (void *)((intptr_t) buff + nbytes);
117 } while (bufflen > 0);
122 ssize_t usbip_net_recv(int sockfd, void *buff, size_t bufflen)
124 return usbip_net_xmit(sockfd, buff, bufflen, 0);
127 ssize_t usbip_net_send(int sockfd, void *buff, size_t bufflen)
129 return usbip_net_xmit(sockfd, buff, bufflen, 1);
132 static inline void usbip_net_pack_op_common(int pack,
133 struct op_common *op_common)
135 op_common->version = usbip_net_pack_uint16_t(pack, op_common->version);
136 op_common->code = usbip_net_pack_uint16_t(pack, op_common->code);
137 op_common->status = usbip_net_pack_uint32_t(pack, op_common->status);
140 int usbip_net_send_op_common(int sockfd, uint32_t code, uint32_t status)
142 struct op_common op_common;
145 memset(&op_common, 0, sizeof(op_common));
147 op_common.version = USBIP_VERSION;
148 op_common.code = code;
149 op_common.status = status;
151 usbip_net_pack_op_common(1, &op_common);
153 rc = usbip_net_send(sockfd, &op_common, sizeof(op_common));
155 dbg("usbip_net_send failed: %d", rc);
162 int usbip_net_recv_op_common(int sockfd, uint16_t *code, int *status)
164 struct op_common op_common;
167 memset(&op_common, 0, sizeof(op_common));
169 rc = usbip_net_recv(sockfd, &op_common, sizeof(op_common));
171 dbg("usbip_net_recv failed: %d", rc);
175 usbip_net_pack_op_common(0, &op_common);
177 if (op_common.version != USBIP_VERSION) {
178 err("USBIP Kernel and tool version mismatch: %d %d:",
179 op_common.version, USBIP_VERSION);
187 if (op_common.code != *code) {
188 dbg("unexpected pdu %#0x for %#0x", op_common.code,
190 /* return error status */
196 *status = op_common.status;
198 if (op_common.status != ST_OK) {
199 dbg("request failed at peer: %d", op_common.status);
203 *code = op_common.code;
210 int usbip_net_set_reuseaddr(int sockfd)
215 ret = setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(val));
217 dbg("setsockopt: SO_REUSEADDR");
222 int usbip_net_set_nodelay(int sockfd)
227 ret = setsockopt(sockfd, IPPROTO_TCP, TCP_NODELAY, &val, sizeof(val));
229 dbg("setsockopt: TCP_NODELAY");
234 int usbip_net_set_keepalive(int sockfd)
239 ret = setsockopt(sockfd, SOL_SOCKET, SO_KEEPALIVE, &val, sizeof(val));
241 dbg("setsockopt: SO_KEEPALIVE");
246 int usbip_net_set_v6only(int sockfd)
251 ret = setsockopt(sockfd, IPPROTO_IPV6, IPV6_V6ONLY, &val, sizeof(val));
253 dbg("setsockopt: IPV6_V6ONLY");
261 int usbip_net_tcp_connect(char *hostname, char *service)
263 struct addrinfo hints, *res, *rp;
267 memset(&hints, 0, sizeof(hints));
268 hints.ai_family = AF_UNSPEC;
269 hints.ai_socktype = SOCK_STREAM;
271 /* get all possible addresses */
272 ret = getaddrinfo(hostname, service, &hints, &res);
274 dbg("getaddrinfo: %s service %s: %s", hostname, service,
279 /* try the addresses */
280 for (rp = res; rp; rp = rp->ai_next) {
281 sockfd = socket(rp->ai_family, rp->ai_socktype,
286 /* should set TCP_NODELAY for usbip */
287 usbip_net_set_nodelay(sockfd);
288 /* TODO: write code for heartbeat */
289 usbip_net_set_keepalive(sockfd);
291 if (connect(sockfd, rp->ai_addr, rp->ai_addrlen) == 0)