18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+ 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2003-2008 Takahiro Hirofuchi 48c2ecf20Sopenharmony_ci * Copyright (C) 2015-2016 Samsung Electronics 58c2ecf20Sopenharmony_ci * Krzysztof Opasiak <k.opasiak@samsung.com> 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <asm/byteorder.h> 98c2ecf20Sopenharmony_ci#include <linux/file.h> 108c2ecf20Sopenharmony_ci#include <linux/fs.h> 118c2ecf20Sopenharmony_ci#include <linux/kernel.h> 128c2ecf20Sopenharmony_ci#include <linux/slab.h> 138c2ecf20Sopenharmony_ci#include <linux/stat.h> 148c2ecf20Sopenharmony_ci#include <linux/module.h> 158c2ecf20Sopenharmony_ci#include <linux/moduleparam.h> 168c2ecf20Sopenharmony_ci#include <net/sock.h> 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci#include "usbip_common.h" 198c2ecf20Sopenharmony_ci 208c2ecf20Sopenharmony_ci#define DRIVER_AUTHOR "Takahiro Hirofuchi <hirofuchi@users.sourceforge.net>" 218c2ecf20Sopenharmony_ci#define DRIVER_DESC "USB/IP Core" 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ci#ifdef CONFIG_USBIP_DEBUG 248c2ecf20Sopenharmony_ciunsigned long usbip_debug_flag = 0xffffffff; 258c2ecf20Sopenharmony_ci#else 268c2ecf20Sopenharmony_ciunsigned long usbip_debug_flag; 278c2ecf20Sopenharmony_ci#endif 288c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_debug_flag); 298c2ecf20Sopenharmony_cimodule_param(usbip_debug_flag, ulong, S_IRUGO|S_IWUSR); 308c2ecf20Sopenharmony_ciMODULE_PARM_DESC(usbip_debug_flag, "debug flags (defined in usbip_common.h)"); 318c2ecf20Sopenharmony_ci 328c2ecf20Sopenharmony_ci/* FIXME */ 338c2ecf20Sopenharmony_cistruct device_attribute dev_attr_usbip_debug; 348c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(dev_attr_usbip_debug); 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_cistatic ssize_t usbip_debug_show(struct device *dev, 378c2ecf20Sopenharmony_ci struct device_attribute *attr, char *buf) 388c2ecf20Sopenharmony_ci{ 398c2ecf20Sopenharmony_ci return sprintf(buf, "%lx\n", usbip_debug_flag); 408c2ecf20Sopenharmony_ci} 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_cistatic ssize_t usbip_debug_store(struct device *dev, 438c2ecf20Sopenharmony_ci struct device_attribute *attr, const char *buf, 448c2ecf20Sopenharmony_ci size_t count) 458c2ecf20Sopenharmony_ci{ 468c2ecf20Sopenharmony_ci if (sscanf(buf, "%lx", &usbip_debug_flag) != 1) 478c2ecf20Sopenharmony_ci return -EINVAL; 488c2ecf20Sopenharmony_ci return count; 498c2ecf20Sopenharmony_ci} 508c2ecf20Sopenharmony_ciDEVICE_ATTR_RW(usbip_debug); 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_cistatic void usbip_dump_buffer(char *buff, int bufflen) 538c2ecf20Sopenharmony_ci{ 548c2ecf20Sopenharmony_ci print_hex_dump(KERN_DEBUG, "usbip-core", DUMP_PREFIX_OFFSET, 16, 4, 558c2ecf20Sopenharmony_ci buff, bufflen, false); 568c2ecf20Sopenharmony_ci} 578c2ecf20Sopenharmony_ci 588c2ecf20Sopenharmony_cistatic void usbip_dump_pipe(unsigned int p) 598c2ecf20Sopenharmony_ci{ 608c2ecf20Sopenharmony_ci unsigned char type = usb_pipetype(p); 618c2ecf20Sopenharmony_ci unsigned char ep = usb_pipeendpoint(p); 628c2ecf20Sopenharmony_ci unsigned char dev = usb_pipedevice(p); 638c2ecf20Sopenharmony_ci unsigned char dir = usb_pipein(p); 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_ci pr_debug("dev(%d) ep(%d) [%s] ", dev, ep, dir ? "IN" : "OUT"); 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci switch (type) { 688c2ecf20Sopenharmony_ci case PIPE_ISOCHRONOUS: 698c2ecf20Sopenharmony_ci pr_debug("ISO\n"); 708c2ecf20Sopenharmony_ci break; 718c2ecf20Sopenharmony_ci case PIPE_INTERRUPT: 728c2ecf20Sopenharmony_ci pr_debug("INT\n"); 738c2ecf20Sopenharmony_ci break; 748c2ecf20Sopenharmony_ci case PIPE_CONTROL: 758c2ecf20Sopenharmony_ci pr_debug("CTRL\n"); 768c2ecf20Sopenharmony_ci break; 778c2ecf20Sopenharmony_ci case PIPE_BULK: 788c2ecf20Sopenharmony_ci pr_debug("BULK\n"); 798c2ecf20Sopenharmony_ci break; 808c2ecf20Sopenharmony_ci default: 818c2ecf20Sopenharmony_ci pr_debug("ERR\n"); 828c2ecf20Sopenharmony_ci break; 838c2ecf20Sopenharmony_ci } 848c2ecf20Sopenharmony_ci} 858c2ecf20Sopenharmony_ci 868c2ecf20Sopenharmony_cistatic void usbip_dump_usb_device(struct usb_device *udev) 878c2ecf20Sopenharmony_ci{ 888c2ecf20Sopenharmony_ci struct device *dev = &udev->dev; 898c2ecf20Sopenharmony_ci int i; 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_ci dev_dbg(dev, " devnum(%d) devpath(%s) usb speed(%s)", 928c2ecf20Sopenharmony_ci udev->devnum, udev->devpath, usb_speed_string(udev->speed)); 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ci pr_debug("tt hub ttport %d\n", udev->ttport); 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci dev_dbg(dev, " "); 978c2ecf20Sopenharmony_ci for (i = 0; i < 16; i++) 988c2ecf20Sopenharmony_ci pr_debug(" %2u", i); 998c2ecf20Sopenharmony_ci pr_debug("\n"); 1008c2ecf20Sopenharmony_ci 1018c2ecf20Sopenharmony_ci dev_dbg(dev, " toggle0(IN) :"); 1028c2ecf20Sopenharmony_ci for (i = 0; i < 16; i++) 1038c2ecf20Sopenharmony_ci pr_debug(" %2u", (udev->toggle[0] & (1 << i)) ? 1 : 0); 1048c2ecf20Sopenharmony_ci pr_debug("\n"); 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci dev_dbg(dev, " toggle1(OUT):"); 1078c2ecf20Sopenharmony_ci for (i = 0; i < 16; i++) 1088c2ecf20Sopenharmony_ci pr_debug(" %2u", (udev->toggle[1] & (1 << i)) ? 1 : 0); 1098c2ecf20Sopenharmony_ci pr_debug("\n"); 1108c2ecf20Sopenharmony_ci 1118c2ecf20Sopenharmony_ci dev_dbg(dev, " epmaxp_in :"); 1128c2ecf20Sopenharmony_ci for (i = 0; i < 16; i++) { 1138c2ecf20Sopenharmony_ci if (udev->ep_in[i]) 1148c2ecf20Sopenharmony_ci pr_debug(" %2u", 1158c2ecf20Sopenharmony_ci le16_to_cpu(udev->ep_in[i]->desc.wMaxPacketSize)); 1168c2ecf20Sopenharmony_ci } 1178c2ecf20Sopenharmony_ci pr_debug("\n"); 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci dev_dbg(dev, " epmaxp_out :"); 1208c2ecf20Sopenharmony_ci for (i = 0; i < 16; i++) { 1218c2ecf20Sopenharmony_ci if (udev->ep_out[i]) 1228c2ecf20Sopenharmony_ci pr_debug(" %2u", 1238c2ecf20Sopenharmony_ci le16_to_cpu(udev->ep_out[i]->desc.wMaxPacketSize)); 1248c2ecf20Sopenharmony_ci } 1258c2ecf20Sopenharmony_ci pr_debug("\n"); 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_ci dev_dbg(dev, "parent %s, bus %s\n", dev_name(&udev->parent->dev), 1288c2ecf20Sopenharmony_ci udev->bus->bus_name); 1298c2ecf20Sopenharmony_ci 1308c2ecf20Sopenharmony_ci dev_dbg(dev, "have_langid %d, string_langid %d\n", 1318c2ecf20Sopenharmony_ci udev->have_langid, udev->string_langid); 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci dev_dbg(dev, "maxchild %d\n", udev->maxchild); 1348c2ecf20Sopenharmony_ci} 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_cistatic void usbip_dump_request_type(__u8 rt) 1378c2ecf20Sopenharmony_ci{ 1388c2ecf20Sopenharmony_ci switch (rt & USB_RECIP_MASK) { 1398c2ecf20Sopenharmony_ci case USB_RECIP_DEVICE: 1408c2ecf20Sopenharmony_ci pr_debug("DEVICE"); 1418c2ecf20Sopenharmony_ci break; 1428c2ecf20Sopenharmony_ci case USB_RECIP_INTERFACE: 1438c2ecf20Sopenharmony_ci pr_debug("INTERF"); 1448c2ecf20Sopenharmony_ci break; 1458c2ecf20Sopenharmony_ci case USB_RECIP_ENDPOINT: 1468c2ecf20Sopenharmony_ci pr_debug("ENDPOI"); 1478c2ecf20Sopenharmony_ci break; 1488c2ecf20Sopenharmony_ci case USB_RECIP_OTHER: 1498c2ecf20Sopenharmony_ci pr_debug("OTHER "); 1508c2ecf20Sopenharmony_ci break; 1518c2ecf20Sopenharmony_ci default: 1528c2ecf20Sopenharmony_ci pr_debug("------"); 1538c2ecf20Sopenharmony_ci break; 1548c2ecf20Sopenharmony_ci } 1558c2ecf20Sopenharmony_ci} 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_cistatic void usbip_dump_usb_ctrlrequest(struct usb_ctrlrequest *cmd) 1588c2ecf20Sopenharmony_ci{ 1598c2ecf20Sopenharmony_ci if (!cmd) { 1608c2ecf20Sopenharmony_ci pr_debug(" : null pointer\n"); 1618c2ecf20Sopenharmony_ci return; 1628c2ecf20Sopenharmony_ci } 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci pr_debug(" "); 1658c2ecf20Sopenharmony_ci pr_debug("bRequestType(%02X) bRequest(%02X) wValue(%04X) wIndex(%04X) wLength(%04X) ", 1668c2ecf20Sopenharmony_ci cmd->bRequestType, cmd->bRequest, 1678c2ecf20Sopenharmony_ci cmd->wValue, cmd->wIndex, cmd->wLength); 1688c2ecf20Sopenharmony_ci pr_debug("\n "); 1698c2ecf20Sopenharmony_ci 1708c2ecf20Sopenharmony_ci if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { 1718c2ecf20Sopenharmony_ci pr_debug("STANDARD "); 1728c2ecf20Sopenharmony_ci switch (cmd->bRequest) { 1738c2ecf20Sopenharmony_ci case USB_REQ_GET_STATUS: 1748c2ecf20Sopenharmony_ci pr_debug("GET_STATUS\n"); 1758c2ecf20Sopenharmony_ci break; 1768c2ecf20Sopenharmony_ci case USB_REQ_CLEAR_FEATURE: 1778c2ecf20Sopenharmony_ci pr_debug("CLEAR_FEAT\n"); 1788c2ecf20Sopenharmony_ci break; 1798c2ecf20Sopenharmony_ci case USB_REQ_SET_FEATURE: 1808c2ecf20Sopenharmony_ci pr_debug("SET_FEAT\n"); 1818c2ecf20Sopenharmony_ci break; 1828c2ecf20Sopenharmony_ci case USB_REQ_SET_ADDRESS: 1838c2ecf20Sopenharmony_ci pr_debug("SET_ADDRRS\n"); 1848c2ecf20Sopenharmony_ci break; 1858c2ecf20Sopenharmony_ci case USB_REQ_GET_DESCRIPTOR: 1868c2ecf20Sopenharmony_ci pr_debug("GET_DESCRI\n"); 1878c2ecf20Sopenharmony_ci break; 1888c2ecf20Sopenharmony_ci case USB_REQ_SET_DESCRIPTOR: 1898c2ecf20Sopenharmony_ci pr_debug("SET_DESCRI\n"); 1908c2ecf20Sopenharmony_ci break; 1918c2ecf20Sopenharmony_ci case USB_REQ_GET_CONFIGURATION: 1928c2ecf20Sopenharmony_ci pr_debug("GET_CONFIG\n"); 1938c2ecf20Sopenharmony_ci break; 1948c2ecf20Sopenharmony_ci case USB_REQ_SET_CONFIGURATION: 1958c2ecf20Sopenharmony_ci pr_debug("SET_CONFIG\n"); 1968c2ecf20Sopenharmony_ci break; 1978c2ecf20Sopenharmony_ci case USB_REQ_GET_INTERFACE: 1988c2ecf20Sopenharmony_ci pr_debug("GET_INTERF\n"); 1998c2ecf20Sopenharmony_ci break; 2008c2ecf20Sopenharmony_ci case USB_REQ_SET_INTERFACE: 2018c2ecf20Sopenharmony_ci pr_debug("SET_INTERF\n"); 2028c2ecf20Sopenharmony_ci break; 2038c2ecf20Sopenharmony_ci case USB_REQ_SYNCH_FRAME: 2048c2ecf20Sopenharmony_ci pr_debug("SYNC_FRAME\n"); 2058c2ecf20Sopenharmony_ci break; 2068c2ecf20Sopenharmony_ci default: 2078c2ecf20Sopenharmony_ci pr_debug("REQ(%02X)\n", cmd->bRequest); 2088c2ecf20Sopenharmony_ci break; 2098c2ecf20Sopenharmony_ci } 2108c2ecf20Sopenharmony_ci usbip_dump_request_type(cmd->bRequestType); 2118c2ecf20Sopenharmony_ci } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_CLASS) { 2128c2ecf20Sopenharmony_ci pr_debug("CLASS\n"); 2138c2ecf20Sopenharmony_ci } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_VENDOR) { 2148c2ecf20Sopenharmony_ci pr_debug("VENDOR\n"); 2158c2ecf20Sopenharmony_ci } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_RESERVED) { 2168c2ecf20Sopenharmony_ci pr_debug("RESERVED\n"); 2178c2ecf20Sopenharmony_ci } 2188c2ecf20Sopenharmony_ci} 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_civoid usbip_dump_urb(struct urb *urb) 2218c2ecf20Sopenharmony_ci{ 2228c2ecf20Sopenharmony_ci struct device *dev; 2238c2ecf20Sopenharmony_ci 2248c2ecf20Sopenharmony_ci if (!urb) { 2258c2ecf20Sopenharmony_ci pr_debug("urb: null pointer!!\n"); 2268c2ecf20Sopenharmony_ci return; 2278c2ecf20Sopenharmony_ci } 2288c2ecf20Sopenharmony_ci 2298c2ecf20Sopenharmony_ci if (!urb->dev) { 2308c2ecf20Sopenharmony_ci pr_debug("urb->dev: null pointer!!\n"); 2318c2ecf20Sopenharmony_ci return; 2328c2ecf20Sopenharmony_ci } 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_ci dev = &urb->dev->dev; 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_ci usbip_dump_usb_device(urb->dev); 2378c2ecf20Sopenharmony_ci 2388c2ecf20Sopenharmony_ci dev_dbg(dev, " pipe :%08x ", urb->pipe); 2398c2ecf20Sopenharmony_ci 2408c2ecf20Sopenharmony_ci usbip_dump_pipe(urb->pipe); 2418c2ecf20Sopenharmony_ci 2428c2ecf20Sopenharmony_ci dev_dbg(dev, " status :%d\n", urb->status); 2438c2ecf20Sopenharmony_ci dev_dbg(dev, " transfer_flags :%08X\n", urb->transfer_flags); 2448c2ecf20Sopenharmony_ci dev_dbg(dev, " transfer_buffer_length:%d\n", 2458c2ecf20Sopenharmony_ci urb->transfer_buffer_length); 2468c2ecf20Sopenharmony_ci dev_dbg(dev, " actual_length :%d\n", urb->actual_length); 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci if (urb->setup_packet && usb_pipetype(urb->pipe) == PIPE_CONTROL) 2498c2ecf20Sopenharmony_ci usbip_dump_usb_ctrlrequest( 2508c2ecf20Sopenharmony_ci (struct usb_ctrlrequest *)urb->setup_packet); 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci dev_dbg(dev, " start_frame :%d\n", urb->start_frame); 2538c2ecf20Sopenharmony_ci dev_dbg(dev, " number_of_packets :%d\n", urb->number_of_packets); 2548c2ecf20Sopenharmony_ci dev_dbg(dev, " interval :%d\n", urb->interval); 2558c2ecf20Sopenharmony_ci dev_dbg(dev, " error_count :%d\n", urb->error_count); 2568c2ecf20Sopenharmony_ci} 2578c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_dump_urb); 2588c2ecf20Sopenharmony_ci 2598c2ecf20Sopenharmony_civoid usbip_dump_header(struct usbip_header *pdu) 2608c2ecf20Sopenharmony_ci{ 2618c2ecf20Sopenharmony_ci pr_debug("BASE: cmd %u seq %u devid %u dir %u ep %u\n", 2628c2ecf20Sopenharmony_ci pdu->base.command, 2638c2ecf20Sopenharmony_ci pdu->base.seqnum, 2648c2ecf20Sopenharmony_ci pdu->base.devid, 2658c2ecf20Sopenharmony_ci pdu->base.direction, 2668c2ecf20Sopenharmony_ci pdu->base.ep); 2678c2ecf20Sopenharmony_ci 2688c2ecf20Sopenharmony_ci switch (pdu->base.command) { 2698c2ecf20Sopenharmony_ci case USBIP_CMD_SUBMIT: 2708c2ecf20Sopenharmony_ci pr_debug("USBIP_CMD_SUBMIT: x_flags %u x_len %u sf %u #p %d iv %d\n", 2718c2ecf20Sopenharmony_ci pdu->u.cmd_submit.transfer_flags, 2728c2ecf20Sopenharmony_ci pdu->u.cmd_submit.transfer_buffer_length, 2738c2ecf20Sopenharmony_ci pdu->u.cmd_submit.start_frame, 2748c2ecf20Sopenharmony_ci pdu->u.cmd_submit.number_of_packets, 2758c2ecf20Sopenharmony_ci pdu->u.cmd_submit.interval); 2768c2ecf20Sopenharmony_ci break; 2778c2ecf20Sopenharmony_ci case USBIP_CMD_UNLINK: 2788c2ecf20Sopenharmony_ci pr_debug("USBIP_CMD_UNLINK: seq %u\n", 2798c2ecf20Sopenharmony_ci pdu->u.cmd_unlink.seqnum); 2808c2ecf20Sopenharmony_ci break; 2818c2ecf20Sopenharmony_ci case USBIP_RET_SUBMIT: 2828c2ecf20Sopenharmony_ci pr_debug("USBIP_RET_SUBMIT: st %d al %u sf %d #p %d ec %d\n", 2838c2ecf20Sopenharmony_ci pdu->u.ret_submit.status, 2848c2ecf20Sopenharmony_ci pdu->u.ret_submit.actual_length, 2858c2ecf20Sopenharmony_ci pdu->u.ret_submit.start_frame, 2868c2ecf20Sopenharmony_ci pdu->u.ret_submit.number_of_packets, 2878c2ecf20Sopenharmony_ci pdu->u.ret_submit.error_count); 2888c2ecf20Sopenharmony_ci break; 2898c2ecf20Sopenharmony_ci case USBIP_RET_UNLINK: 2908c2ecf20Sopenharmony_ci pr_debug("USBIP_RET_UNLINK: status %d\n", 2918c2ecf20Sopenharmony_ci pdu->u.ret_unlink.status); 2928c2ecf20Sopenharmony_ci break; 2938c2ecf20Sopenharmony_ci default: 2948c2ecf20Sopenharmony_ci /* NOT REACHED */ 2958c2ecf20Sopenharmony_ci pr_err("unknown command\n"); 2968c2ecf20Sopenharmony_ci break; 2978c2ecf20Sopenharmony_ci } 2988c2ecf20Sopenharmony_ci} 2998c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_dump_header); 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_ci/* Receive data over TCP/IP. */ 3028c2ecf20Sopenharmony_ciint usbip_recv(struct socket *sock, void *buf, int size) 3038c2ecf20Sopenharmony_ci{ 3048c2ecf20Sopenharmony_ci int result; 3058c2ecf20Sopenharmony_ci struct kvec iov = {.iov_base = buf, .iov_len = size}; 3068c2ecf20Sopenharmony_ci struct msghdr msg = {.msg_flags = MSG_NOSIGNAL}; 3078c2ecf20Sopenharmony_ci int total = 0; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci if (!sock || !buf || !size) 3108c2ecf20Sopenharmony_ci return -EINVAL; 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_ci iov_iter_kvec(&msg.msg_iter, READ, &iov, 1, size); 3138c2ecf20Sopenharmony_ci 3148c2ecf20Sopenharmony_ci usbip_dbg_xmit("enter\n"); 3158c2ecf20Sopenharmony_ci 3168c2ecf20Sopenharmony_ci do { 3178c2ecf20Sopenharmony_ci sock->sk->sk_allocation = GFP_NOIO; 3188c2ecf20Sopenharmony_ci 3198c2ecf20Sopenharmony_ci result = sock_recvmsg(sock, &msg, MSG_WAITALL); 3208c2ecf20Sopenharmony_ci if (result <= 0) 3218c2ecf20Sopenharmony_ci goto err; 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_ci total += result; 3248c2ecf20Sopenharmony_ci } while (msg_data_left(&msg)); 3258c2ecf20Sopenharmony_ci 3268c2ecf20Sopenharmony_ci if (usbip_dbg_flag_xmit) { 3278c2ecf20Sopenharmony_ci if (!in_interrupt()) 3288c2ecf20Sopenharmony_ci pr_debug("%-10s:", current->comm); 3298c2ecf20Sopenharmony_ci else 3308c2ecf20Sopenharmony_ci pr_debug("interrupt :"); 3318c2ecf20Sopenharmony_ci 3328c2ecf20Sopenharmony_ci pr_debug("receiving....\n"); 3338c2ecf20Sopenharmony_ci usbip_dump_buffer(buf, size); 3348c2ecf20Sopenharmony_ci pr_debug("received, osize %d ret %d size %zd total %d\n", 3358c2ecf20Sopenharmony_ci size, result, msg_data_left(&msg), total); 3368c2ecf20Sopenharmony_ci } 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci return total; 3398c2ecf20Sopenharmony_ci 3408c2ecf20Sopenharmony_cierr: 3418c2ecf20Sopenharmony_ci return result; 3428c2ecf20Sopenharmony_ci} 3438c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_recv); 3448c2ecf20Sopenharmony_ci 3458c2ecf20Sopenharmony_ci/* there may be more cases to tweak the flags. */ 3468c2ecf20Sopenharmony_cistatic unsigned int tweak_transfer_flags(unsigned int flags) 3478c2ecf20Sopenharmony_ci{ 3488c2ecf20Sopenharmony_ci flags &= ~URB_NO_TRANSFER_DMA_MAP; 3498c2ecf20Sopenharmony_ci return flags; 3508c2ecf20Sopenharmony_ci} 3518c2ecf20Sopenharmony_ci 3528c2ecf20Sopenharmony_cistatic void usbip_pack_cmd_submit(struct usbip_header *pdu, struct urb *urb, 3538c2ecf20Sopenharmony_ci int pack) 3548c2ecf20Sopenharmony_ci{ 3558c2ecf20Sopenharmony_ci struct usbip_header_cmd_submit *spdu = &pdu->u.cmd_submit; 3568c2ecf20Sopenharmony_ci 3578c2ecf20Sopenharmony_ci /* 3588c2ecf20Sopenharmony_ci * Some members are not still implemented in usbip. I hope this issue 3598c2ecf20Sopenharmony_ci * will be discussed when usbip is ported to other operating systems. 3608c2ecf20Sopenharmony_ci */ 3618c2ecf20Sopenharmony_ci if (pack) { 3628c2ecf20Sopenharmony_ci spdu->transfer_flags = 3638c2ecf20Sopenharmony_ci tweak_transfer_flags(urb->transfer_flags); 3648c2ecf20Sopenharmony_ci spdu->transfer_buffer_length = urb->transfer_buffer_length; 3658c2ecf20Sopenharmony_ci spdu->start_frame = urb->start_frame; 3668c2ecf20Sopenharmony_ci spdu->number_of_packets = urb->number_of_packets; 3678c2ecf20Sopenharmony_ci spdu->interval = urb->interval; 3688c2ecf20Sopenharmony_ci } else { 3698c2ecf20Sopenharmony_ci urb->transfer_flags = spdu->transfer_flags; 3708c2ecf20Sopenharmony_ci urb->transfer_buffer_length = spdu->transfer_buffer_length; 3718c2ecf20Sopenharmony_ci urb->start_frame = spdu->start_frame; 3728c2ecf20Sopenharmony_ci urb->number_of_packets = spdu->number_of_packets; 3738c2ecf20Sopenharmony_ci urb->interval = spdu->interval; 3748c2ecf20Sopenharmony_ci } 3758c2ecf20Sopenharmony_ci} 3768c2ecf20Sopenharmony_ci 3778c2ecf20Sopenharmony_cistatic void usbip_pack_ret_submit(struct usbip_header *pdu, struct urb *urb, 3788c2ecf20Sopenharmony_ci int pack) 3798c2ecf20Sopenharmony_ci{ 3808c2ecf20Sopenharmony_ci struct usbip_header_ret_submit *rpdu = &pdu->u.ret_submit; 3818c2ecf20Sopenharmony_ci 3828c2ecf20Sopenharmony_ci if (pack) { 3838c2ecf20Sopenharmony_ci rpdu->status = urb->status; 3848c2ecf20Sopenharmony_ci rpdu->actual_length = urb->actual_length; 3858c2ecf20Sopenharmony_ci rpdu->start_frame = urb->start_frame; 3868c2ecf20Sopenharmony_ci rpdu->number_of_packets = urb->number_of_packets; 3878c2ecf20Sopenharmony_ci rpdu->error_count = urb->error_count; 3888c2ecf20Sopenharmony_ci } else { 3898c2ecf20Sopenharmony_ci urb->status = rpdu->status; 3908c2ecf20Sopenharmony_ci urb->actual_length = rpdu->actual_length; 3918c2ecf20Sopenharmony_ci urb->start_frame = rpdu->start_frame; 3928c2ecf20Sopenharmony_ci urb->number_of_packets = rpdu->number_of_packets; 3938c2ecf20Sopenharmony_ci urb->error_count = rpdu->error_count; 3948c2ecf20Sopenharmony_ci } 3958c2ecf20Sopenharmony_ci} 3968c2ecf20Sopenharmony_ci 3978c2ecf20Sopenharmony_civoid usbip_pack_pdu(struct usbip_header *pdu, struct urb *urb, int cmd, 3988c2ecf20Sopenharmony_ci int pack) 3998c2ecf20Sopenharmony_ci{ 4008c2ecf20Sopenharmony_ci switch (cmd) { 4018c2ecf20Sopenharmony_ci case USBIP_CMD_SUBMIT: 4028c2ecf20Sopenharmony_ci usbip_pack_cmd_submit(pdu, urb, pack); 4038c2ecf20Sopenharmony_ci break; 4048c2ecf20Sopenharmony_ci case USBIP_RET_SUBMIT: 4058c2ecf20Sopenharmony_ci usbip_pack_ret_submit(pdu, urb, pack); 4068c2ecf20Sopenharmony_ci break; 4078c2ecf20Sopenharmony_ci default: 4088c2ecf20Sopenharmony_ci /* NOT REACHED */ 4098c2ecf20Sopenharmony_ci pr_err("unknown command\n"); 4108c2ecf20Sopenharmony_ci break; 4118c2ecf20Sopenharmony_ci } 4128c2ecf20Sopenharmony_ci} 4138c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_pack_pdu); 4148c2ecf20Sopenharmony_ci 4158c2ecf20Sopenharmony_cistatic void correct_endian_basic(struct usbip_header_basic *base, int send) 4168c2ecf20Sopenharmony_ci{ 4178c2ecf20Sopenharmony_ci if (send) { 4188c2ecf20Sopenharmony_ci base->command = cpu_to_be32(base->command); 4198c2ecf20Sopenharmony_ci base->seqnum = cpu_to_be32(base->seqnum); 4208c2ecf20Sopenharmony_ci base->devid = cpu_to_be32(base->devid); 4218c2ecf20Sopenharmony_ci base->direction = cpu_to_be32(base->direction); 4228c2ecf20Sopenharmony_ci base->ep = cpu_to_be32(base->ep); 4238c2ecf20Sopenharmony_ci } else { 4248c2ecf20Sopenharmony_ci base->command = be32_to_cpu(base->command); 4258c2ecf20Sopenharmony_ci base->seqnum = be32_to_cpu(base->seqnum); 4268c2ecf20Sopenharmony_ci base->devid = be32_to_cpu(base->devid); 4278c2ecf20Sopenharmony_ci base->direction = be32_to_cpu(base->direction); 4288c2ecf20Sopenharmony_ci base->ep = be32_to_cpu(base->ep); 4298c2ecf20Sopenharmony_ci } 4308c2ecf20Sopenharmony_ci} 4318c2ecf20Sopenharmony_ci 4328c2ecf20Sopenharmony_cistatic void correct_endian_cmd_submit(struct usbip_header_cmd_submit *pdu, 4338c2ecf20Sopenharmony_ci int send) 4348c2ecf20Sopenharmony_ci{ 4358c2ecf20Sopenharmony_ci if (send) { 4368c2ecf20Sopenharmony_ci pdu->transfer_flags = cpu_to_be32(pdu->transfer_flags); 4378c2ecf20Sopenharmony_ci 4388c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->transfer_buffer_length); 4398c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->start_frame); 4408c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->number_of_packets); 4418c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->interval); 4428c2ecf20Sopenharmony_ci } else { 4438c2ecf20Sopenharmony_ci pdu->transfer_flags = be32_to_cpu(pdu->transfer_flags); 4448c2ecf20Sopenharmony_ci 4458c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->transfer_buffer_length); 4468c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->start_frame); 4478c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->number_of_packets); 4488c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->interval); 4498c2ecf20Sopenharmony_ci } 4508c2ecf20Sopenharmony_ci} 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_cistatic void correct_endian_ret_submit(struct usbip_header_ret_submit *pdu, 4538c2ecf20Sopenharmony_ci int send) 4548c2ecf20Sopenharmony_ci{ 4558c2ecf20Sopenharmony_ci if (send) { 4568c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->status); 4578c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->actual_length); 4588c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->start_frame); 4598c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->number_of_packets); 4608c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->error_count); 4618c2ecf20Sopenharmony_ci } else { 4628c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->status); 4638c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->actual_length); 4648c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->start_frame); 4658c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->number_of_packets); 4668c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->error_count); 4678c2ecf20Sopenharmony_ci } 4688c2ecf20Sopenharmony_ci} 4698c2ecf20Sopenharmony_ci 4708c2ecf20Sopenharmony_cistatic void correct_endian_cmd_unlink(struct usbip_header_cmd_unlink *pdu, 4718c2ecf20Sopenharmony_ci int send) 4728c2ecf20Sopenharmony_ci{ 4738c2ecf20Sopenharmony_ci if (send) 4748c2ecf20Sopenharmony_ci pdu->seqnum = cpu_to_be32(pdu->seqnum); 4758c2ecf20Sopenharmony_ci else 4768c2ecf20Sopenharmony_ci pdu->seqnum = be32_to_cpu(pdu->seqnum); 4778c2ecf20Sopenharmony_ci} 4788c2ecf20Sopenharmony_ci 4798c2ecf20Sopenharmony_cistatic void correct_endian_ret_unlink(struct usbip_header_ret_unlink *pdu, 4808c2ecf20Sopenharmony_ci int send) 4818c2ecf20Sopenharmony_ci{ 4828c2ecf20Sopenharmony_ci if (send) 4838c2ecf20Sopenharmony_ci cpu_to_be32s(&pdu->status); 4848c2ecf20Sopenharmony_ci else 4858c2ecf20Sopenharmony_ci be32_to_cpus(&pdu->status); 4868c2ecf20Sopenharmony_ci} 4878c2ecf20Sopenharmony_ci 4888c2ecf20Sopenharmony_civoid usbip_header_correct_endian(struct usbip_header *pdu, int send) 4898c2ecf20Sopenharmony_ci{ 4908c2ecf20Sopenharmony_ci __u32 cmd = 0; 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci if (send) 4938c2ecf20Sopenharmony_ci cmd = pdu->base.command; 4948c2ecf20Sopenharmony_ci 4958c2ecf20Sopenharmony_ci correct_endian_basic(&pdu->base, send); 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci if (!send) 4988c2ecf20Sopenharmony_ci cmd = pdu->base.command; 4998c2ecf20Sopenharmony_ci 5008c2ecf20Sopenharmony_ci switch (cmd) { 5018c2ecf20Sopenharmony_ci case USBIP_CMD_SUBMIT: 5028c2ecf20Sopenharmony_ci correct_endian_cmd_submit(&pdu->u.cmd_submit, send); 5038c2ecf20Sopenharmony_ci break; 5048c2ecf20Sopenharmony_ci case USBIP_RET_SUBMIT: 5058c2ecf20Sopenharmony_ci correct_endian_ret_submit(&pdu->u.ret_submit, send); 5068c2ecf20Sopenharmony_ci break; 5078c2ecf20Sopenharmony_ci case USBIP_CMD_UNLINK: 5088c2ecf20Sopenharmony_ci correct_endian_cmd_unlink(&pdu->u.cmd_unlink, send); 5098c2ecf20Sopenharmony_ci break; 5108c2ecf20Sopenharmony_ci case USBIP_RET_UNLINK: 5118c2ecf20Sopenharmony_ci correct_endian_ret_unlink(&pdu->u.ret_unlink, send); 5128c2ecf20Sopenharmony_ci break; 5138c2ecf20Sopenharmony_ci default: 5148c2ecf20Sopenharmony_ci /* NOT REACHED */ 5158c2ecf20Sopenharmony_ci pr_err("unknown command\n"); 5168c2ecf20Sopenharmony_ci break; 5178c2ecf20Sopenharmony_ci } 5188c2ecf20Sopenharmony_ci} 5198c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_header_correct_endian); 5208c2ecf20Sopenharmony_ci 5218c2ecf20Sopenharmony_cistatic void usbip_iso_packet_correct_endian( 5228c2ecf20Sopenharmony_ci struct usbip_iso_packet_descriptor *iso, int send) 5238c2ecf20Sopenharmony_ci{ 5248c2ecf20Sopenharmony_ci /* does not need all members. but copy all simply. */ 5258c2ecf20Sopenharmony_ci if (send) { 5268c2ecf20Sopenharmony_ci iso->offset = cpu_to_be32(iso->offset); 5278c2ecf20Sopenharmony_ci iso->length = cpu_to_be32(iso->length); 5288c2ecf20Sopenharmony_ci iso->status = cpu_to_be32(iso->status); 5298c2ecf20Sopenharmony_ci iso->actual_length = cpu_to_be32(iso->actual_length); 5308c2ecf20Sopenharmony_ci } else { 5318c2ecf20Sopenharmony_ci iso->offset = be32_to_cpu(iso->offset); 5328c2ecf20Sopenharmony_ci iso->length = be32_to_cpu(iso->length); 5338c2ecf20Sopenharmony_ci iso->status = be32_to_cpu(iso->status); 5348c2ecf20Sopenharmony_ci iso->actual_length = be32_to_cpu(iso->actual_length); 5358c2ecf20Sopenharmony_ci } 5368c2ecf20Sopenharmony_ci} 5378c2ecf20Sopenharmony_ci 5388c2ecf20Sopenharmony_cistatic void usbip_pack_iso(struct usbip_iso_packet_descriptor *iso, 5398c2ecf20Sopenharmony_ci struct usb_iso_packet_descriptor *uiso, int pack) 5408c2ecf20Sopenharmony_ci{ 5418c2ecf20Sopenharmony_ci if (pack) { 5428c2ecf20Sopenharmony_ci iso->offset = uiso->offset; 5438c2ecf20Sopenharmony_ci iso->length = uiso->length; 5448c2ecf20Sopenharmony_ci iso->status = uiso->status; 5458c2ecf20Sopenharmony_ci iso->actual_length = uiso->actual_length; 5468c2ecf20Sopenharmony_ci } else { 5478c2ecf20Sopenharmony_ci uiso->offset = iso->offset; 5488c2ecf20Sopenharmony_ci uiso->length = iso->length; 5498c2ecf20Sopenharmony_ci uiso->status = iso->status; 5508c2ecf20Sopenharmony_ci uiso->actual_length = iso->actual_length; 5518c2ecf20Sopenharmony_ci } 5528c2ecf20Sopenharmony_ci} 5538c2ecf20Sopenharmony_ci 5548c2ecf20Sopenharmony_ci/* must free buffer */ 5558c2ecf20Sopenharmony_cistruct usbip_iso_packet_descriptor* 5568c2ecf20Sopenharmony_ciusbip_alloc_iso_desc_pdu(struct urb *urb, ssize_t *bufflen) 5578c2ecf20Sopenharmony_ci{ 5588c2ecf20Sopenharmony_ci struct usbip_iso_packet_descriptor *iso; 5598c2ecf20Sopenharmony_ci int np = urb->number_of_packets; 5608c2ecf20Sopenharmony_ci ssize_t size = np * sizeof(*iso); 5618c2ecf20Sopenharmony_ci int i; 5628c2ecf20Sopenharmony_ci 5638c2ecf20Sopenharmony_ci iso = kzalloc(size, GFP_KERNEL); 5648c2ecf20Sopenharmony_ci if (!iso) 5658c2ecf20Sopenharmony_ci return NULL; 5668c2ecf20Sopenharmony_ci 5678c2ecf20Sopenharmony_ci for (i = 0; i < np; i++) { 5688c2ecf20Sopenharmony_ci usbip_pack_iso(&iso[i], &urb->iso_frame_desc[i], 1); 5698c2ecf20Sopenharmony_ci usbip_iso_packet_correct_endian(&iso[i], 1); 5708c2ecf20Sopenharmony_ci } 5718c2ecf20Sopenharmony_ci 5728c2ecf20Sopenharmony_ci *bufflen = size; 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci return iso; 5758c2ecf20Sopenharmony_ci} 5768c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_alloc_iso_desc_pdu); 5778c2ecf20Sopenharmony_ci 5788c2ecf20Sopenharmony_ci/* some members of urb must be substituted before. */ 5798c2ecf20Sopenharmony_ciint usbip_recv_iso(struct usbip_device *ud, struct urb *urb) 5808c2ecf20Sopenharmony_ci{ 5818c2ecf20Sopenharmony_ci void *buff; 5828c2ecf20Sopenharmony_ci struct usbip_iso_packet_descriptor *iso; 5838c2ecf20Sopenharmony_ci int np = urb->number_of_packets; 5848c2ecf20Sopenharmony_ci int size = np * sizeof(*iso); 5858c2ecf20Sopenharmony_ci int i; 5868c2ecf20Sopenharmony_ci int ret; 5878c2ecf20Sopenharmony_ci int total_length = 0; 5888c2ecf20Sopenharmony_ci 5898c2ecf20Sopenharmony_ci if (!usb_pipeisoc(urb->pipe)) 5908c2ecf20Sopenharmony_ci return 0; 5918c2ecf20Sopenharmony_ci 5928c2ecf20Sopenharmony_ci /* my Bluetooth dongle gets ISO URBs which are np = 0 */ 5938c2ecf20Sopenharmony_ci if (np == 0) 5948c2ecf20Sopenharmony_ci return 0; 5958c2ecf20Sopenharmony_ci 5968c2ecf20Sopenharmony_ci buff = kzalloc(size, GFP_KERNEL); 5978c2ecf20Sopenharmony_ci if (!buff) 5988c2ecf20Sopenharmony_ci return -ENOMEM; 5998c2ecf20Sopenharmony_ci 6008c2ecf20Sopenharmony_ci ret = usbip_recv(ud->tcp_socket, buff, size); 6018c2ecf20Sopenharmony_ci if (ret != size) { 6028c2ecf20Sopenharmony_ci dev_err(&urb->dev->dev, "recv iso_frame_descriptor, %d\n", 6038c2ecf20Sopenharmony_ci ret); 6048c2ecf20Sopenharmony_ci kfree(buff); 6058c2ecf20Sopenharmony_ci 6068c2ecf20Sopenharmony_ci if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC) 6078c2ecf20Sopenharmony_ci usbip_event_add(ud, SDEV_EVENT_ERROR_TCP); 6088c2ecf20Sopenharmony_ci else 6098c2ecf20Sopenharmony_ci usbip_event_add(ud, VDEV_EVENT_ERROR_TCP); 6108c2ecf20Sopenharmony_ci 6118c2ecf20Sopenharmony_ci return -EPIPE; 6128c2ecf20Sopenharmony_ci } 6138c2ecf20Sopenharmony_ci 6148c2ecf20Sopenharmony_ci iso = (struct usbip_iso_packet_descriptor *) buff; 6158c2ecf20Sopenharmony_ci for (i = 0; i < np; i++) { 6168c2ecf20Sopenharmony_ci usbip_iso_packet_correct_endian(&iso[i], 0); 6178c2ecf20Sopenharmony_ci usbip_pack_iso(&iso[i], &urb->iso_frame_desc[i], 0); 6188c2ecf20Sopenharmony_ci total_length += urb->iso_frame_desc[i].actual_length; 6198c2ecf20Sopenharmony_ci } 6208c2ecf20Sopenharmony_ci 6218c2ecf20Sopenharmony_ci kfree(buff); 6228c2ecf20Sopenharmony_ci 6238c2ecf20Sopenharmony_ci if (total_length != urb->actual_length) { 6248c2ecf20Sopenharmony_ci dev_err(&urb->dev->dev, 6258c2ecf20Sopenharmony_ci "total length of iso packets %d not equal to actual length of buffer %d\n", 6268c2ecf20Sopenharmony_ci total_length, urb->actual_length); 6278c2ecf20Sopenharmony_ci 6288c2ecf20Sopenharmony_ci if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC) 6298c2ecf20Sopenharmony_ci usbip_event_add(ud, SDEV_EVENT_ERROR_TCP); 6308c2ecf20Sopenharmony_ci else 6318c2ecf20Sopenharmony_ci usbip_event_add(ud, VDEV_EVENT_ERROR_TCP); 6328c2ecf20Sopenharmony_ci 6338c2ecf20Sopenharmony_ci return -EPIPE; 6348c2ecf20Sopenharmony_ci } 6358c2ecf20Sopenharmony_ci 6368c2ecf20Sopenharmony_ci return ret; 6378c2ecf20Sopenharmony_ci} 6388c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_recv_iso); 6398c2ecf20Sopenharmony_ci 6408c2ecf20Sopenharmony_ci/* 6418c2ecf20Sopenharmony_ci * This functions restores the padding which was removed for optimizing 6428c2ecf20Sopenharmony_ci * the bandwidth during transfer over tcp/ip 6438c2ecf20Sopenharmony_ci * 6448c2ecf20Sopenharmony_ci * buffer and iso packets need to be stored and be in propeper endian in urb 6458c2ecf20Sopenharmony_ci * before calling this function 6468c2ecf20Sopenharmony_ci */ 6478c2ecf20Sopenharmony_civoid usbip_pad_iso(struct usbip_device *ud, struct urb *urb) 6488c2ecf20Sopenharmony_ci{ 6498c2ecf20Sopenharmony_ci int np = urb->number_of_packets; 6508c2ecf20Sopenharmony_ci int i; 6518c2ecf20Sopenharmony_ci int actualoffset = urb->actual_length; 6528c2ecf20Sopenharmony_ci 6538c2ecf20Sopenharmony_ci if (!usb_pipeisoc(urb->pipe)) 6548c2ecf20Sopenharmony_ci return; 6558c2ecf20Sopenharmony_ci 6568c2ecf20Sopenharmony_ci /* if no packets or length of data is 0, then nothing to unpack */ 6578c2ecf20Sopenharmony_ci if (np == 0 || urb->actual_length == 0) 6588c2ecf20Sopenharmony_ci return; 6598c2ecf20Sopenharmony_ci 6608c2ecf20Sopenharmony_ci /* 6618c2ecf20Sopenharmony_ci * if actual_length is transfer_buffer_length then no padding is 6628c2ecf20Sopenharmony_ci * present. 6638c2ecf20Sopenharmony_ci */ 6648c2ecf20Sopenharmony_ci if (urb->actual_length == urb->transfer_buffer_length) 6658c2ecf20Sopenharmony_ci return; 6668c2ecf20Sopenharmony_ci 6678c2ecf20Sopenharmony_ci /* 6688c2ecf20Sopenharmony_ci * loop over all packets from last to first (to prevent overwriting 6698c2ecf20Sopenharmony_ci * memory when padding) and move them into the proper place 6708c2ecf20Sopenharmony_ci */ 6718c2ecf20Sopenharmony_ci for (i = np-1; i > 0; i--) { 6728c2ecf20Sopenharmony_ci actualoffset -= urb->iso_frame_desc[i].actual_length; 6738c2ecf20Sopenharmony_ci memmove(urb->transfer_buffer + urb->iso_frame_desc[i].offset, 6748c2ecf20Sopenharmony_ci urb->transfer_buffer + actualoffset, 6758c2ecf20Sopenharmony_ci urb->iso_frame_desc[i].actual_length); 6768c2ecf20Sopenharmony_ci } 6778c2ecf20Sopenharmony_ci} 6788c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_pad_iso); 6798c2ecf20Sopenharmony_ci 6808c2ecf20Sopenharmony_ci/* some members of urb must be substituted before. */ 6818c2ecf20Sopenharmony_ciint usbip_recv_xbuff(struct usbip_device *ud, struct urb *urb) 6828c2ecf20Sopenharmony_ci{ 6838c2ecf20Sopenharmony_ci struct scatterlist *sg; 6848c2ecf20Sopenharmony_ci int ret = 0; 6858c2ecf20Sopenharmony_ci int recv; 6868c2ecf20Sopenharmony_ci int size; 6878c2ecf20Sopenharmony_ci int copy; 6888c2ecf20Sopenharmony_ci int i; 6898c2ecf20Sopenharmony_ci 6908c2ecf20Sopenharmony_ci if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC) { 6918c2ecf20Sopenharmony_ci /* the direction of urb must be OUT. */ 6928c2ecf20Sopenharmony_ci if (usb_pipein(urb->pipe)) 6938c2ecf20Sopenharmony_ci return 0; 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_ci size = urb->transfer_buffer_length; 6968c2ecf20Sopenharmony_ci } else { 6978c2ecf20Sopenharmony_ci /* the direction of urb must be IN. */ 6988c2ecf20Sopenharmony_ci if (usb_pipeout(urb->pipe)) 6998c2ecf20Sopenharmony_ci return 0; 7008c2ecf20Sopenharmony_ci 7018c2ecf20Sopenharmony_ci size = urb->actual_length; 7028c2ecf20Sopenharmony_ci } 7038c2ecf20Sopenharmony_ci 7048c2ecf20Sopenharmony_ci /* no need to recv xbuff */ 7058c2ecf20Sopenharmony_ci if (!(size > 0)) 7068c2ecf20Sopenharmony_ci return 0; 7078c2ecf20Sopenharmony_ci 7088c2ecf20Sopenharmony_ci if (size > urb->transfer_buffer_length) 7098c2ecf20Sopenharmony_ci /* should not happen, probably malicious packet */ 7108c2ecf20Sopenharmony_ci goto error; 7118c2ecf20Sopenharmony_ci 7128c2ecf20Sopenharmony_ci if (urb->num_sgs) { 7138c2ecf20Sopenharmony_ci copy = size; 7148c2ecf20Sopenharmony_ci for_each_sg(urb->sg, sg, urb->num_sgs, i) { 7158c2ecf20Sopenharmony_ci int recv_size; 7168c2ecf20Sopenharmony_ci 7178c2ecf20Sopenharmony_ci if (copy < sg->length) 7188c2ecf20Sopenharmony_ci recv_size = copy; 7198c2ecf20Sopenharmony_ci else 7208c2ecf20Sopenharmony_ci recv_size = sg->length; 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_ci recv = usbip_recv(ud->tcp_socket, sg_virt(sg), 7238c2ecf20Sopenharmony_ci recv_size); 7248c2ecf20Sopenharmony_ci 7258c2ecf20Sopenharmony_ci if (recv != recv_size) 7268c2ecf20Sopenharmony_ci goto error; 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci copy -= recv; 7298c2ecf20Sopenharmony_ci ret += recv; 7308c2ecf20Sopenharmony_ci 7318c2ecf20Sopenharmony_ci if (!copy) 7328c2ecf20Sopenharmony_ci break; 7338c2ecf20Sopenharmony_ci } 7348c2ecf20Sopenharmony_ci 7358c2ecf20Sopenharmony_ci if (ret != size) 7368c2ecf20Sopenharmony_ci goto error; 7378c2ecf20Sopenharmony_ci } else { 7388c2ecf20Sopenharmony_ci ret = usbip_recv(ud->tcp_socket, urb->transfer_buffer, size); 7398c2ecf20Sopenharmony_ci if (ret != size) 7408c2ecf20Sopenharmony_ci goto error; 7418c2ecf20Sopenharmony_ci } 7428c2ecf20Sopenharmony_ci 7438c2ecf20Sopenharmony_ci return ret; 7448c2ecf20Sopenharmony_ci 7458c2ecf20Sopenharmony_cierror: 7468c2ecf20Sopenharmony_ci dev_err(&urb->dev->dev, "recv xbuf, %d\n", ret); 7478c2ecf20Sopenharmony_ci if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC) 7488c2ecf20Sopenharmony_ci usbip_event_add(ud, SDEV_EVENT_ERROR_TCP); 7498c2ecf20Sopenharmony_ci else 7508c2ecf20Sopenharmony_ci usbip_event_add(ud, VDEV_EVENT_ERROR_TCP); 7518c2ecf20Sopenharmony_ci 7528c2ecf20Sopenharmony_ci return -EPIPE; 7538c2ecf20Sopenharmony_ci} 7548c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(usbip_recv_xbuff); 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_cistatic int __init usbip_core_init(void) 7578c2ecf20Sopenharmony_ci{ 7588c2ecf20Sopenharmony_ci return usbip_init_eh(); 7598c2ecf20Sopenharmony_ci} 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_cistatic void __exit usbip_core_exit(void) 7628c2ecf20Sopenharmony_ci{ 7638c2ecf20Sopenharmony_ci usbip_finish_eh(); 7648c2ecf20Sopenharmony_ci return; 7658c2ecf20Sopenharmony_ci} 7668c2ecf20Sopenharmony_ci 7678c2ecf20Sopenharmony_cimodule_init(usbip_core_init); 7688c2ecf20Sopenharmony_cimodule_exit(usbip_core_exit); 7698c2ecf20Sopenharmony_ci 7708c2ecf20Sopenharmony_ciMODULE_AUTHOR(DRIVER_AUTHOR); 7718c2ecf20Sopenharmony_ciMODULE_DESCRIPTION(DRIVER_DESC); 7728c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 773