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