1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2003-2008 Takahiro Hirofuchi
4*4882a593Smuzhiyun * Copyright (C) 2015-2016 Samsung Electronics
5*4882a593Smuzhiyun * Krzysztof Opasiak <k.opasiak@samsung.com>
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <asm/byteorder.h>
9*4882a593Smuzhiyun #include <linux/file.h>
10*4882a593Smuzhiyun #include <linux/fs.h>
11*4882a593Smuzhiyun #include <linux/kernel.h>
12*4882a593Smuzhiyun #include <linux/slab.h>
13*4882a593Smuzhiyun #include <linux/stat.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/moduleparam.h>
16*4882a593Smuzhiyun #include <net/sock.h>
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun #include "usbip_common.h"
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun #define DRIVER_AUTHOR "Takahiro Hirofuchi <hirofuchi@users.sourceforge.net>"
21*4882a593Smuzhiyun #define DRIVER_DESC "USB/IP Core"
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #ifdef CONFIG_USBIP_DEBUG
24*4882a593Smuzhiyun unsigned long usbip_debug_flag = 0xffffffff;
25*4882a593Smuzhiyun #else
26*4882a593Smuzhiyun unsigned long usbip_debug_flag;
27*4882a593Smuzhiyun #endif
28*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_debug_flag);
29*4882a593Smuzhiyun module_param(usbip_debug_flag, ulong, S_IRUGO|S_IWUSR);
30*4882a593Smuzhiyun MODULE_PARM_DESC(usbip_debug_flag, "debug flags (defined in usbip_common.h)");
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun /* FIXME */
33*4882a593Smuzhiyun struct device_attribute dev_attr_usbip_debug;
34*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(dev_attr_usbip_debug);
35*4882a593Smuzhiyun
usbip_debug_show(struct device * dev,struct device_attribute * attr,char * buf)36*4882a593Smuzhiyun static ssize_t usbip_debug_show(struct device *dev,
37*4882a593Smuzhiyun struct device_attribute *attr, char *buf)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun return sprintf(buf, "%lx\n", usbip_debug_flag);
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun
usbip_debug_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)42*4882a593Smuzhiyun static ssize_t usbip_debug_store(struct device *dev,
43*4882a593Smuzhiyun struct device_attribute *attr, const char *buf,
44*4882a593Smuzhiyun size_t count)
45*4882a593Smuzhiyun {
46*4882a593Smuzhiyun if (sscanf(buf, "%lx", &usbip_debug_flag) != 1)
47*4882a593Smuzhiyun return -EINVAL;
48*4882a593Smuzhiyun return count;
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun DEVICE_ATTR_RW(usbip_debug);
51*4882a593Smuzhiyun
usbip_dump_buffer(char * buff,int bufflen)52*4882a593Smuzhiyun static void usbip_dump_buffer(char *buff, int bufflen)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun print_hex_dump(KERN_DEBUG, "usbip-core", DUMP_PREFIX_OFFSET, 16, 4,
55*4882a593Smuzhiyun buff, bufflen, false);
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun
usbip_dump_pipe(unsigned int p)58*4882a593Smuzhiyun static void usbip_dump_pipe(unsigned int p)
59*4882a593Smuzhiyun {
60*4882a593Smuzhiyun unsigned char type = usb_pipetype(p);
61*4882a593Smuzhiyun unsigned char ep = usb_pipeendpoint(p);
62*4882a593Smuzhiyun unsigned char dev = usb_pipedevice(p);
63*4882a593Smuzhiyun unsigned char dir = usb_pipein(p);
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun pr_debug("dev(%d) ep(%d) [%s] ", dev, ep, dir ? "IN" : "OUT");
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun switch (type) {
68*4882a593Smuzhiyun case PIPE_ISOCHRONOUS:
69*4882a593Smuzhiyun pr_debug("ISO\n");
70*4882a593Smuzhiyun break;
71*4882a593Smuzhiyun case PIPE_INTERRUPT:
72*4882a593Smuzhiyun pr_debug("INT\n");
73*4882a593Smuzhiyun break;
74*4882a593Smuzhiyun case PIPE_CONTROL:
75*4882a593Smuzhiyun pr_debug("CTRL\n");
76*4882a593Smuzhiyun break;
77*4882a593Smuzhiyun case PIPE_BULK:
78*4882a593Smuzhiyun pr_debug("BULK\n");
79*4882a593Smuzhiyun break;
80*4882a593Smuzhiyun default:
81*4882a593Smuzhiyun pr_debug("ERR\n");
82*4882a593Smuzhiyun break;
83*4882a593Smuzhiyun }
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
usbip_dump_usb_device(struct usb_device * udev)86*4882a593Smuzhiyun static void usbip_dump_usb_device(struct usb_device *udev)
87*4882a593Smuzhiyun {
88*4882a593Smuzhiyun struct device *dev = &udev->dev;
89*4882a593Smuzhiyun int i;
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun dev_dbg(dev, " devnum(%d) devpath(%s) usb speed(%s)",
92*4882a593Smuzhiyun udev->devnum, udev->devpath, usb_speed_string(udev->speed));
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun pr_debug("tt hub ttport %d\n", udev->ttport);
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun dev_dbg(dev, " ");
97*4882a593Smuzhiyun for (i = 0; i < 16; i++)
98*4882a593Smuzhiyun pr_debug(" %2u", i);
99*4882a593Smuzhiyun pr_debug("\n");
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun dev_dbg(dev, " toggle0(IN) :");
102*4882a593Smuzhiyun for (i = 0; i < 16; i++)
103*4882a593Smuzhiyun pr_debug(" %2u", (udev->toggle[0] & (1 << i)) ? 1 : 0);
104*4882a593Smuzhiyun pr_debug("\n");
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun dev_dbg(dev, " toggle1(OUT):");
107*4882a593Smuzhiyun for (i = 0; i < 16; i++)
108*4882a593Smuzhiyun pr_debug(" %2u", (udev->toggle[1] & (1 << i)) ? 1 : 0);
109*4882a593Smuzhiyun pr_debug("\n");
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun dev_dbg(dev, " epmaxp_in :");
112*4882a593Smuzhiyun for (i = 0; i < 16; i++) {
113*4882a593Smuzhiyun if (udev->ep_in[i])
114*4882a593Smuzhiyun pr_debug(" %2u",
115*4882a593Smuzhiyun le16_to_cpu(udev->ep_in[i]->desc.wMaxPacketSize));
116*4882a593Smuzhiyun }
117*4882a593Smuzhiyun pr_debug("\n");
118*4882a593Smuzhiyun
119*4882a593Smuzhiyun dev_dbg(dev, " epmaxp_out :");
120*4882a593Smuzhiyun for (i = 0; i < 16; i++) {
121*4882a593Smuzhiyun if (udev->ep_out[i])
122*4882a593Smuzhiyun pr_debug(" %2u",
123*4882a593Smuzhiyun le16_to_cpu(udev->ep_out[i]->desc.wMaxPacketSize));
124*4882a593Smuzhiyun }
125*4882a593Smuzhiyun pr_debug("\n");
126*4882a593Smuzhiyun
127*4882a593Smuzhiyun dev_dbg(dev, "parent %s, bus %s\n", dev_name(&udev->parent->dev),
128*4882a593Smuzhiyun udev->bus->bus_name);
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun dev_dbg(dev, "have_langid %d, string_langid %d\n",
131*4882a593Smuzhiyun udev->have_langid, udev->string_langid);
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun dev_dbg(dev, "maxchild %d\n", udev->maxchild);
134*4882a593Smuzhiyun }
135*4882a593Smuzhiyun
usbip_dump_request_type(__u8 rt)136*4882a593Smuzhiyun static void usbip_dump_request_type(__u8 rt)
137*4882a593Smuzhiyun {
138*4882a593Smuzhiyun switch (rt & USB_RECIP_MASK) {
139*4882a593Smuzhiyun case USB_RECIP_DEVICE:
140*4882a593Smuzhiyun pr_debug("DEVICE");
141*4882a593Smuzhiyun break;
142*4882a593Smuzhiyun case USB_RECIP_INTERFACE:
143*4882a593Smuzhiyun pr_debug("INTERF");
144*4882a593Smuzhiyun break;
145*4882a593Smuzhiyun case USB_RECIP_ENDPOINT:
146*4882a593Smuzhiyun pr_debug("ENDPOI");
147*4882a593Smuzhiyun break;
148*4882a593Smuzhiyun case USB_RECIP_OTHER:
149*4882a593Smuzhiyun pr_debug("OTHER ");
150*4882a593Smuzhiyun break;
151*4882a593Smuzhiyun default:
152*4882a593Smuzhiyun pr_debug("------");
153*4882a593Smuzhiyun break;
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun }
156*4882a593Smuzhiyun
usbip_dump_usb_ctrlrequest(struct usb_ctrlrequest * cmd)157*4882a593Smuzhiyun static void usbip_dump_usb_ctrlrequest(struct usb_ctrlrequest *cmd)
158*4882a593Smuzhiyun {
159*4882a593Smuzhiyun if (!cmd) {
160*4882a593Smuzhiyun pr_debug(" : null pointer\n");
161*4882a593Smuzhiyun return;
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun
164*4882a593Smuzhiyun pr_debug(" ");
165*4882a593Smuzhiyun pr_debug("bRequestType(%02X) bRequest(%02X) wValue(%04X) wIndex(%04X) wLength(%04X) ",
166*4882a593Smuzhiyun cmd->bRequestType, cmd->bRequest,
167*4882a593Smuzhiyun cmd->wValue, cmd->wIndex, cmd->wLength);
168*4882a593Smuzhiyun pr_debug("\n ");
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
171*4882a593Smuzhiyun pr_debug("STANDARD ");
172*4882a593Smuzhiyun switch (cmd->bRequest) {
173*4882a593Smuzhiyun case USB_REQ_GET_STATUS:
174*4882a593Smuzhiyun pr_debug("GET_STATUS\n");
175*4882a593Smuzhiyun break;
176*4882a593Smuzhiyun case USB_REQ_CLEAR_FEATURE:
177*4882a593Smuzhiyun pr_debug("CLEAR_FEAT\n");
178*4882a593Smuzhiyun break;
179*4882a593Smuzhiyun case USB_REQ_SET_FEATURE:
180*4882a593Smuzhiyun pr_debug("SET_FEAT\n");
181*4882a593Smuzhiyun break;
182*4882a593Smuzhiyun case USB_REQ_SET_ADDRESS:
183*4882a593Smuzhiyun pr_debug("SET_ADDRRS\n");
184*4882a593Smuzhiyun break;
185*4882a593Smuzhiyun case USB_REQ_GET_DESCRIPTOR:
186*4882a593Smuzhiyun pr_debug("GET_DESCRI\n");
187*4882a593Smuzhiyun break;
188*4882a593Smuzhiyun case USB_REQ_SET_DESCRIPTOR:
189*4882a593Smuzhiyun pr_debug("SET_DESCRI\n");
190*4882a593Smuzhiyun break;
191*4882a593Smuzhiyun case USB_REQ_GET_CONFIGURATION:
192*4882a593Smuzhiyun pr_debug("GET_CONFIG\n");
193*4882a593Smuzhiyun break;
194*4882a593Smuzhiyun case USB_REQ_SET_CONFIGURATION:
195*4882a593Smuzhiyun pr_debug("SET_CONFIG\n");
196*4882a593Smuzhiyun break;
197*4882a593Smuzhiyun case USB_REQ_GET_INTERFACE:
198*4882a593Smuzhiyun pr_debug("GET_INTERF\n");
199*4882a593Smuzhiyun break;
200*4882a593Smuzhiyun case USB_REQ_SET_INTERFACE:
201*4882a593Smuzhiyun pr_debug("SET_INTERF\n");
202*4882a593Smuzhiyun break;
203*4882a593Smuzhiyun case USB_REQ_SYNCH_FRAME:
204*4882a593Smuzhiyun pr_debug("SYNC_FRAME\n");
205*4882a593Smuzhiyun break;
206*4882a593Smuzhiyun default:
207*4882a593Smuzhiyun pr_debug("REQ(%02X)\n", cmd->bRequest);
208*4882a593Smuzhiyun break;
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun usbip_dump_request_type(cmd->bRequestType);
211*4882a593Smuzhiyun } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_CLASS) {
212*4882a593Smuzhiyun pr_debug("CLASS\n");
213*4882a593Smuzhiyun } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_VENDOR) {
214*4882a593Smuzhiyun pr_debug("VENDOR\n");
215*4882a593Smuzhiyun } else if ((cmd->bRequestType & USB_TYPE_MASK) == USB_TYPE_RESERVED) {
216*4882a593Smuzhiyun pr_debug("RESERVED\n");
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun }
219*4882a593Smuzhiyun
usbip_dump_urb(struct urb * urb)220*4882a593Smuzhiyun void usbip_dump_urb(struct urb *urb)
221*4882a593Smuzhiyun {
222*4882a593Smuzhiyun struct device *dev;
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun if (!urb) {
225*4882a593Smuzhiyun pr_debug("urb: null pointer!!\n");
226*4882a593Smuzhiyun return;
227*4882a593Smuzhiyun }
228*4882a593Smuzhiyun
229*4882a593Smuzhiyun if (!urb->dev) {
230*4882a593Smuzhiyun pr_debug("urb->dev: null pointer!!\n");
231*4882a593Smuzhiyun return;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun dev = &urb->dev->dev;
235*4882a593Smuzhiyun
236*4882a593Smuzhiyun usbip_dump_usb_device(urb->dev);
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun dev_dbg(dev, " pipe :%08x ", urb->pipe);
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun usbip_dump_pipe(urb->pipe);
241*4882a593Smuzhiyun
242*4882a593Smuzhiyun dev_dbg(dev, " status :%d\n", urb->status);
243*4882a593Smuzhiyun dev_dbg(dev, " transfer_flags :%08X\n", urb->transfer_flags);
244*4882a593Smuzhiyun dev_dbg(dev, " transfer_buffer_length:%d\n",
245*4882a593Smuzhiyun urb->transfer_buffer_length);
246*4882a593Smuzhiyun dev_dbg(dev, " actual_length :%d\n", urb->actual_length);
247*4882a593Smuzhiyun
248*4882a593Smuzhiyun if (urb->setup_packet && usb_pipetype(urb->pipe) == PIPE_CONTROL)
249*4882a593Smuzhiyun usbip_dump_usb_ctrlrequest(
250*4882a593Smuzhiyun (struct usb_ctrlrequest *)urb->setup_packet);
251*4882a593Smuzhiyun
252*4882a593Smuzhiyun dev_dbg(dev, " start_frame :%d\n", urb->start_frame);
253*4882a593Smuzhiyun dev_dbg(dev, " number_of_packets :%d\n", urb->number_of_packets);
254*4882a593Smuzhiyun dev_dbg(dev, " interval :%d\n", urb->interval);
255*4882a593Smuzhiyun dev_dbg(dev, " error_count :%d\n", urb->error_count);
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_dump_urb);
258*4882a593Smuzhiyun
usbip_dump_header(struct usbip_header * pdu)259*4882a593Smuzhiyun void usbip_dump_header(struct usbip_header *pdu)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun pr_debug("BASE: cmd %u seq %u devid %u dir %u ep %u\n",
262*4882a593Smuzhiyun pdu->base.command,
263*4882a593Smuzhiyun pdu->base.seqnum,
264*4882a593Smuzhiyun pdu->base.devid,
265*4882a593Smuzhiyun pdu->base.direction,
266*4882a593Smuzhiyun pdu->base.ep);
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun switch (pdu->base.command) {
269*4882a593Smuzhiyun case USBIP_CMD_SUBMIT:
270*4882a593Smuzhiyun pr_debug("USBIP_CMD_SUBMIT: x_flags %u x_len %u sf %u #p %d iv %d\n",
271*4882a593Smuzhiyun pdu->u.cmd_submit.transfer_flags,
272*4882a593Smuzhiyun pdu->u.cmd_submit.transfer_buffer_length,
273*4882a593Smuzhiyun pdu->u.cmd_submit.start_frame,
274*4882a593Smuzhiyun pdu->u.cmd_submit.number_of_packets,
275*4882a593Smuzhiyun pdu->u.cmd_submit.interval);
276*4882a593Smuzhiyun break;
277*4882a593Smuzhiyun case USBIP_CMD_UNLINK:
278*4882a593Smuzhiyun pr_debug("USBIP_CMD_UNLINK: seq %u\n",
279*4882a593Smuzhiyun pdu->u.cmd_unlink.seqnum);
280*4882a593Smuzhiyun break;
281*4882a593Smuzhiyun case USBIP_RET_SUBMIT:
282*4882a593Smuzhiyun pr_debug("USBIP_RET_SUBMIT: st %d al %u sf %d #p %d ec %d\n",
283*4882a593Smuzhiyun pdu->u.ret_submit.status,
284*4882a593Smuzhiyun pdu->u.ret_submit.actual_length,
285*4882a593Smuzhiyun pdu->u.ret_submit.start_frame,
286*4882a593Smuzhiyun pdu->u.ret_submit.number_of_packets,
287*4882a593Smuzhiyun pdu->u.ret_submit.error_count);
288*4882a593Smuzhiyun break;
289*4882a593Smuzhiyun case USBIP_RET_UNLINK:
290*4882a593Smuzhiyun pr_debug("USBIP_RET_UNLINK: status %d\n",
291*4882a593Smuzhiyun pdu->u.ret_unlink.status);
292*4882a593Smuzhiyun break;
293*4882a593Smuzhiyun default:
294*4882a593Smuzhiyun /* NOT REACHED */
295*4882a593Smuzhiyun pr_err("unknown command\n");
296*4882a593Smuzhiyun break;
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun }
299*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_dump_header);
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun /* Receive data over TCP/IP. */
usbip_recv(struct socket * sock,void * buf,int size)302*4882a593Smuzhiyun int usbip_recv(struct socket *sock, void *buf, int size)
303*4882a593Smuzhiyun {
304*4882a593Smuzhiyun int result;
305*4882a593Smuzhiyun struct kvec iov = {.iov_base = buf, .iov_len = size};
306*4882a593Smuzhiyun struct msghdr msg = {.msg_flags = MSG_NOSIGNAL};
307*4882a593Smuzhiyun int total = 0;
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun if (!sock || !buf || !size)
310*4882a593Smuzhiyun return -EINVAL;
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun iov_iter_kvec(&msg.msg_iter, READ, &iov, 1, size);
313*4882a593Smuzhiyun
314*4882a593Smuzhiyun usbip_dbg_xmit("enter\n");
315*4882a593Smuzhiyun
316*4882a593Smuzhiyun do {
317*4882a593Smuzhiyun sock->sk->sk_allocation = GFP_NOIO;
318*4882a593Smuzhiyun
319*4882a593Smuzhiyun result = sock_recvmsg(sock, &msg, MSG_WAITALL);
320*4882a593Smuzhiyun if (result <= 0)
321*4882a593Smuzhiyun goto err;
322*4882a593Smuzhiyun
323*4882a593Smuzhiyun total += result;
324*4882a593Smuzhiyun } while (msg_data_left(&msg));
325*4882a593Smuzhiyun
326*4882a593Smuzhiyun if (usbip_dbg_flag_xmit) {
327*4882a593Smuzhiyun if (!in_interrupt())
328*4882a593Smuzhiyun pr_debug("%-10s:", current->comm);
329*4882a593Smuzhiyun else
330*4882a593Smuzhiyun pr_debug("interrupt :");
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun pr_debug("receiving....\n");
333*4882a593Smuzhiyun usbip_dump_buffer(buf, size);
334*4882a593Smuzhiyun pr_debug("received, osize %d ret %d size %zd total %d\n",
335*4882a593Smuzhiyun size, result, msg_data_left(&msg), total);
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun
338*4882a593Smuzhiyun return total;
339*4882a593Smuzhiyun
340*4882a593Smuzhiyun err:
341*4882a593Smuzhiyun return result;
342*4882a593Smuzhiyun }
343*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_recv);
344*4882a593Smuzhiyun
345*4882a593Smuzhiyun /* there may be more cases to tweak the flags. */
tweak_transfer_flags(unsigned int flags)346*4882a593Smuzhiyun static unsigned int tweak_transfer_flags(unsigned int flags)
347*4882a593Smuzhiyun {
348*4882a593Smuzhiyun flags &= ~URB_NO_TRANSFER_DMA_MAP;
349*4882a593Smuzhiyun return flags;
350*4882a593Smuzhiyun }
351*4882a593Smuzhiyun
usbip_pack_cmd_submit(struct usbip_header * pdu,struct urb * urb,int pack)352*4882a593Smuzhiyun static void usbip_pack_cmd_submit(struct usbip_header *pdu, struct urb *urb,
353*4882a593Smuzhiyun int pack)
354*4882a593Smuzhiyun {
355*4882a593Smuzhiyun struct usbip_header_cmd_submit *spdu = &pdu->u.cmd_submit;
356*4882a593Smuzhiyun
357*4882a593Smuzhiyun /*
358*4882a593Smuzhiyun * Some members are not still implemented in usbip. I hope this issue
359*4882a593Smuzhiyun * will be discussed when usbip is ported to other operating systems.
360*4882a593Smuzhiyun */
361*4882a593Smuzhiyun if (pack) {
362*4882a593Smuzhiyun spdu->transfer_flags =
363*4882a593Smuzhiyun tweak_transfer_flags(urb->transfer_flags);
364*4882a593Smuzhiyun spdu->transfer_buffer_length = urb->transfer_buffer_length;
365*4882a593Smuzhiyun spdu->start_frame = urb->start_frame;
366*4882a593Smuzhiyun spdu->number_of_packets = urb->number_of_packets;
367*4882a593Smuzhiyun spdu->interval = urb->interval;
368*4882a593Smuzhiyun } else {
369*4882a593Smuzhiyun urb->transfer_flags = spdu->transfer_flags;
370*4882a593Smuzhiyun urb->transfer_buffer_length = spdu->transfer_buffer_length;
371*4882a593Smuzhiyun urb->start_frame = spdu->start_frame;
372*4882a593Smuzhiyun urb->number_of_packets = spdu->number_of_packets;
373*4882a593Smuzhiyun urb->interval = spdu->interval;
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun
usbip_pack_ret_submit(struct usbip_header * pdu,struct urb * urb,int pack)377*4882a593Smuzhiyun static void usbip_pack_ret_submit(struct usbip_header *pdu, struct urb *urb,
378*4882a593Smuzhiyun int pack)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun struct usbip_header_ret_submit *rpdu = &pdu->u.ret_submit;
381*4882a593Smuzhiyun
382*4882a593Smuzhiyun if (pack) {
383*4882a593Smuzhiyun rpdu->status = urb->status;
384*4882a593Smuzhiyun rpdu->actual_length = urb->actual_length;
385*4882a593Smuzhiyun rpdu->start_frame = urb->start_frame;
386*4882a593Smuzhiyun rpdu->number_of_packets = urb->number_of_packets;
387*4882a593Smuzhiyun rpdu->error_count = urb->error_count;
388*4882a593Smuzhiyun } else {
389*4882a593Smuzhiyun urb->status = rpdu->status;
390*4882a593Smuzhiyun urb->actual_length = rpdu->actual_length;
391*4882a593Smuzhiyun urb->start_frame = rpdu->start_frame;
392*4882a593Smuzhiyun urb->number_of_packets = rpdu->number_of_packets;
393*4882a593Smuzhiyun urb->error_count = rpdu->error_count;
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun }
396*4882a593Smuzhiyun
usbip_pack_pdu(struct usbip_header * pdu,struct urb * urb,int cmd,int pack)397*4882a593Smuzhiyun void usbip_pack_pdu(struct usbip_header *pdu, struct urb *urb, int cmd,
398*4882a593Smuzhiyun int pack)
399*4882a593Smuzhiyun {
400*4882a593Smuzhiyun switch (cmd) {
401*4882a593Smuzhiyun case USBIP_CMD_SUBMIT:
402*4882a593Smuzhiyun usbip_pack_cmd_submit(pdu, urb, pack);
403*4882a593Smuzhiyun break;
404*4882a593Smuzhiyun case USBIP_RET_SUBMIT:
405*4882a593Smuzhiyun usbip_pack_ret_submit(pdu, urb, pack);
406*4882a593Smuzhiyun break;
407*4882a593Smuzhiyun default:
408*4882a593Smuzhiyun /* NOT REACHED */
409*4882a593Smuzhiyun pr_err("unknown command\n");
410*4882a593Smuzhiyun break;
411*4882a593Smuzhiyun }
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_pack_pdu);
414*4882a593Smuzhiyun
correct_endian_basic(struct usbip_header_basic * base,int send)415*4882a593Smuzhiyun static void correct_endian_basic(struct usbip_header_basic *base, int send)
416*4882a593Smuzhiyun {
417*4882a593Smuzhiyun if (send) {
418*4882a593Smuzhiyun base->command = cpu_to_be32(base->command);
419*4882a593Smuzhiyun base->seqnum = cpu_to_be32(base->seqnum);
420*4882a593Smuzhiyun base->devid = cpu_to_be32(base->devid);
421*4882a593Smuzhiyun base->direction = cpu_to_be32(base->direction);
422*4882a593Smuzhiyun base->ep = cpu_to_be32(base->ep);
423*4882a593Smuzhiyun } else {
424*4882a593Smuzhiyun base->command = be32_to_cpu(base->command);
425*4882a593Smuzhiyun base->seqnum = be32_to_cpu(base->seqnum);
426*4882a593Smuzhiyun base->devid = be32_to_cpu(base->devid);
427*4882a593Smuzhiyun base->direction = be32_to_cpu(base->direction);
428*4882a593Smuzhiyun base->ep = be32_to_cpu(base->ep);
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun
correct_endian_cmd_submit(struct usbip_header_cmd_submit * pdu,int send)432*4882a593Smuzhiyun static void correct_endian_cmd_submit(struct usbip_header_cmd_submit *pdu,
433*4882a593Smuzhiyun int send)
434*4882a593Smuzhiyun {
435*4882a593Smuzhiyun if (send) {
436*4882a593Smuzhiyun pdu->transfer_flags = cpu_to_be32(pdu->transfer_flags);
437*4882a593Smuzhiyun
438*4882a593Smuzhiyun cpu_to_be32s(&pdu->transfer_buffer_length);
439*4882a593Smuzhiyun cpu_to_be32s(&pdu->start_frame);
440*4882a593Smuzhiyun cpu_to_be32s(&pdu->number_of_packets);
441*4882a593Smuzhiyun cpu_to_be32s(&pdu->interval);
442*4882a593Smuzhiyun } else {
443*4882a593Smuzhiyun pdu->transfer_flags = be32_to_cpu(pdu->transfer_flags);
444*4882a593Smuzhiyun
445*4882a593Smuzhiyun be32_to_cpus(&pdu->transfer_buffer_length);
446*4882a593Smuzhiyun be32_to_cpus(&pdu->start_frame);
447*4882a593Smuzhiyun be32_to_cpus(&pdu->number_of_packets);
448*4882a593Smuzhiyun be32_to_cpus(&pdu->interval);
449*4882a593Smuzhiyun }
450*4882a593Smuzhiyun }
451*4882a593Smuzhiyun
correct_endian_ret_submit(struct usbip_header_ret_submit * pdu,int send)452*4882a593Smuzhiyun static void correct_endian_ret_submit(struct usbip_header_ret_submit *pdu,
453*4882a593Smuzhiyun int send)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun if (send) {
456*4882a593Smuzhiyun cpu_to_be32s(&pdu->status);
457*4882a593Smuzhiyun cpu_to_be32s(&pdu->actual_length);
458*4882a593Smuzhiyun cpu_to_be32s(&pdu->start_frame);
459*4882a593Smuzhiyun cpu_to_be32s(&pdu->number_of_packets);
460*4882a593Smuzhiyun cpu_to_be32s(&pdu->error_count);
461*4882a593Smuzhiyun } else {
462*4882a593Smuzhiyun be32_to_cpus(&pdu->status);
463*4882a593Smuzhiyun be32_to_cpus(&pdu->actual_length);
464*4882a593Smuzhiyun be32_to_cpus(&pdu->start_frame);
465*4882a593Smuzhiyun be32_to_cpus(&pdu->number_of_packets);
466*4882a593Smuzhiyun be32_to_cpus(&pdu->error_count);
467*4882a593Smuzhiyun }
468*4882a593Smuzhiyun }
469*4882a593Smuzhiyun
correct_endian_cmd_unlink(struct usbip_header_cmd_unlink * pdu,int send)470*4882a593Smuzhiyun static void correct_endian_cmd_unlink(struct usbip_header_cmd_unlink *pdu,
471*4882a593Smuzhiyun int send)
472*4882a593Smuzhiyun {
473*4882a593Smuzhiyun if (send)
474*4882a593Smuzhiyun pdu->seqnum = cpu_to_be32(pdu->seqnum);
475*4882a593Smuzhiyun else
476*4882a593Smuzhiyun pdu->seqnum = be32_to_cpu(pdu->seqnum);
477*4882a593Smuzhiyun }
478*4882a593Smuzhiyun
correct_endian_ret_unlink(struct usbip_header_ret_unlink * pdu,int send)479*4882a593Smuzhiyun static void correct_endian_ret_unlink(struct usbip_header_ret_unlink *pdu,
480*4882a593Smuzhiyun int send)
481*4882a593Smuzhiyun {
482*4882a593Smuzhiyun if (send)
483*4882a593Smuzhiyun cpu_to_be32s(&pdu->status);
484*4882a593Smuzhiyun else
485*4882a593Smuzhiyun be32_to_cpus(&pdu->status);
486*4882a593Smuzhiyun }
487*4882a593Smuzhiyun
usbip_header_correct_endian(struct usbip_header * pdu,int send)488*4882a593Smuzhiyun void usbip_header_correct_endian(struct usbip_header *pdu, int send)
489*4882a593Smuzhiyun {
490*4882a593Smuzhiyun __u32 cmd = 0;
491*4882a593Smuzhiyun
492*4882a593Smuzhiyun if (send)
493*4882a593Smuzhiyun cmd = pdu->base.command;
494*4882a593Smuzhiyun
495*4882a593Smuzhiyun correct_endian_basic(&pdu->base, send);
496*4882a593Smuzhiyun
497*4882a593Smuzhiyun if (!send)
498*4882a593Smuzhiyun cmd = pdu->base.command;
499*4882a593Smuzhiyun
500*4882a593Smuzhiyun switch (cmd) {
501*4882a593Smuzhiyun case USBIP_CMD_SUBMIT:
502*4882a593Smuzhiyun correct_endian_cmd_submit(&pdu->u.cmd_submit, send);
503*4882a593Smuzhiyun break;
504*4882a593Smuzhiyun case USBIP_RET_SUBMIT:
505*4882a593Smuzhiyun correct_endian_ret_submit(&pdu->u.ret_submit, send);
506*4882a593Smuzhiyun break;
507*4882a593Smuzhiyun case USBIP_CMD_UNLINK:
508*4882a593Smuzhiyun correct_endian_cmd_unlink(&pdu->u.cmd_unlink, send);
509*4882a593Smuzhiyun break;
510*4882a593Smuzhiyun case USBIP_RET_UNLINK:
511*4882a593Smuzhiyun correct_endian_ret_unlink(&pdu->u.ret_unlink, send);
512*4882a593Smuzhiyun break;
513*4882a593Smuzhiyun default:
514*4882a593Smuzhiyun /* NOT REACHED */
515*4882a593Smuzhiyun pr_err("unknown command\n");
516*4882a593Smuzhiyun break;
517*4882a593Smuzhiyun }
518*4882a593Smuzhiyun }
519*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_header_correct_endian);
520*4882a593Smuzhiyun
usbip_iso_packet_correct_endian(struct usbip_iso_packet_descriptor * iso,int send)521*4882a593Smuzhiyun static void usbip_iso_packet_correct_endian(
522*4882a593Smuzhiyun struct usbip_iso_packet_descriptor *iso, int send)
523*4882a593Smuzhiyun {
524*4882a593Smuzhiyun /* does not need all members. but copy all simply. */
525*4882a593Smuzhiyun if (send) {
526*4882a593Smuzhiyun iso->offset = cpu_to_be32(iso->offset);
527*4882a593Smuzhiyun iso->length = cpu_to_be32(iso->length);
528*4882a593Smuzhiyun iso->status = cpu_to_be32(iso->status);
529*4882a593Smuzhiyun iso->actual_length = cpu_to_be32(iso->actual_length);
530*4882a593Smuzhiyun } else {
531*4882a593Smuzhiyun iso->offset = be32_to_cpu(iso->offset);
532*4882a593Smuzhiyun iso->length = be32_to_cpu(iso->length);
533*4882a593Smuzhiyun iso->status = be32_to_cpu(iso->status);
534*4882a593Smuzhiyun iso->actual_length = be32_to_cpu(iso->actual_length);
535*4882a593Smuzhiyun }
536*4882a593Smuzhiyun }
537*4882a593Smuzhiyun
usbip_pack_iso(struct usbip_iso_packet_descriptor * iso,struct usb_iso_packet_descriptor * uiso,int pack)538*4882a593Smuzhiyun static void usbip_pack_iso(struct usbip_iso_packet_descriptor *iso,
539*4882a593Smuzhiyun struct usb_iso_packet_descriptor *uiso, int pack)
540*4882a593Smuzhiyun {
541*4882a593Smuzhiyun if (pack) {
542*4882a593Smuzhiyun iso->offset = uiso->offset;
543*4882a593Smuzhiyun iso->length = uiso->length;
544*4882a593Smuzhiyun iso->status = uiso->status;
545*4882a593Smuzhiyun iso->actual_length = uiso->actual_length;
546*4882a593Smuzhiyun } else {
547*4882a593Smuzhiyun uiso->offset = iso->offset;
548*4882a593Smuzhiyun uiso->length = iso->length;
549*4882a593Smuzhiyun uiso->status = iso->status;
550*4882a593Smuzhiyun uiso->actual_length = iso->actual_length;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun }
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun /* must free buffer */
555*4882a593Smuzhiyun struct usbip_iso_packet_descriptor*
usbip_alloc_iso_desc_pdu(struct urb * urb,ssize_t * bufflen)556*4882a593Smuzhiyun usbip_alloc_iso_desc_pdu(struct urb *urb, ssize_t *bufflen)
557*4882a593Smuzhiyun {
558*4882a593Smuzhiyun struct usbip_iso_packet_descriptor *iso;
559*4882a593Smuzhiyun int np = urb->number_of_packets;
560*4882a593Smuzhiyun ssize_t size = np * sizeof(*iso);
561*4882a593Smuzhiyun int i;
562*4882a593Smuzhiyun
563*4882a593Smuzhiyun iso = kzalloc(size, GFP_KERNEL);
564*4882a593Smuzhiyun if (!iso)
565*4882a593Smuzhiyun return NULL;
566*4882a593Smuzhiyun
567*4882a593Smuzhiyun for (i = 0; i < np; i++) {
568*4882a593Smuzhiyun usbip_pack_iso(&iso[i], &urb->iso_frame_desc[i], 1);
569*4882a593Smuzhiyun usbip_iso_packet_correct_endian(&iso[i], 1);
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun
572*4882a593Smuzhiyun *bufflen = size;
573*4882a593Smuzhiyun
574*4882a593Smuzhiyun return iso;
575*4882a593Smuzhiyun }
576*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_alloc_iso_desc_pdu);
577*4882a593Smuzhiyun
578*4882a593Smuzhiyun /* some members of urb must be substituted before. */
usbip_recv_iso(struct usbip_device * ud,struct urb * urb)579*4882a593Smuzhiyun int usbip_recv_iso(struct usbip_device *ud, struct urb *urb)
580*4882a593Smuzhiyun {
581*4882a593Smuzhiyun void *buff;
582*4882a593Smuzhiyun struct usbip_iso_packet_descriptor *iso;
583*4882a593Smuzhiyun int np = urb->number_of_packets;
584*4882a593Smuzhiyun int size = np * sizeof(*iso);
585*4882a593Smuzhiyun int i;
586*4882a593Smuzhiyun int ret;
587*4882a593Smuzhiyun int total_length = 0;
588*4882a593Smuzhiyun
589*4882a593Smuzhiyun if (!usb_pipeisoc(urb->pipe))
590*4882a593Smuzhiyun return 0;
591*4882a593Smuzhiyun
592*4882a593Smuzhiyun /* my Bluetooth dongle gets ISO URBs which are np = 0 */
593*4882a593Smuzhiyun if (np == 0)
594*4882a593Smuzhiyun return 0;
595*4882a593Smuzhiyun
596*4882a593Smuzhiyun buff = kzalloc(size, GFP_KERNEL);
597*4882a593Smuzhiyun if (!buff)
598*4882a593Smuzhiyun return -ENOMEM;
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun ret = usbip_recv(ud->tcp_socket, buff, size);
601*4882a593Smuzhiyun if (ret != size) {
602*4882a593Smuzhiyun dev_err(&urb->dev->dev, "recv iso_frame_descriptor, %d\n",
603*4882a593Smuzhiyun ret);
604*4882a593Smuzhiyun kfree(buff);
605*4882a593Smuzhiyun
606*4882a593Smuzhiyun if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC)
607*4882a593Smuzhiyun usbip_event_add(ud, SDEV_EVENT_ERROR_TCP);
608*4882a593Smuzhiyun else
609*4882a593Smuzhiyun usbip_event_add(ud, VDEV_EVENT_ERROR_TCP);
610*4882a593Smuzhiyun
611*4882a593Smuzhiyun return -EPIPE;
612*4882a593Smuzhiyun }
613*4882a593Smuzhiyun
614*4882a593Smuzhiyun iso = (struct usbip_iso_packet_descriptor *) buff;
615*4882a593Smuzhiyun for (i = 0; i < np; i++) {
616*4882a593Smuzhiyun usbip_iso_packet_correct_endian(&iso[i], 0);
617*4882a593Smuzhiyun usbip_pack_iso(&iso[i], &urb->iso_frame_desc[i], 0);
618*4882a593Smuzhiyun total_length += urb->iso_frame_desc[i].actual_length;
619*4882a593Smuzhiyun }
620*4882a593Smuzhiyun
621*4882a593Smuzhiyun kfree(buff);
622*4882a593Smuzhiyun
623*4882a593Smuzhiyun if (total_length != urb->actual_length) {
624*4882a593Smuzhiyun dev_err(&urb->dev->dev,
625*4882a593Smuzhiyun "total length of iso packets %d not equal to actual length of buffer %d\n",
626*4882a593Smuzhiyun total_length, urb->actual_length);
627*4882a593Smuzhiyun
628*4882a593Smuzhiyun if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC)
629*4882a593Smuzhiyun usbip_event_add(ud, SDEV_EVENT_ERROR_TCP);
630*4882a593Smuzhiyun else
631*4882a593Smuzhiyun usbip_event_add(ud, VDEV_EVENT_ERROR_TCP);
632*4882a593Smuzhiyun
633*4882a593Smuzhiyun return -EPIPE;
634*4882a593Smuzhiyun }
635*4882a593Smuzhiyun
636*4882a593Smuzhiyun return ret;
637*4882a593Smuzhiyun }
638*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_recv_iso);
639*4882a593Smuzhiyun
640*4882a593Smuzhiyun /*
641*4882a593Smuzhiyun * This functions restores the padding which was removed for optimizing
642*4882a593Smuzhiyun * the bandwidth during transfer over tcp/ip
643*4882a593Smuzhiyun *
644*4882a593Smuzhiyun * buffer and iso packets need to be stored and be in propeper endian in urb
645*4882a593Smuzhiyun * before calling this function
646*4882a593Smuzhiyun */
usbip_pad_iso(struct usbip_device * ud,struct urb * urb)647*4882a593Smuzhiyun void usbip_pad_iso(struct usbip_device *ud, struct urb *urb)
648*4882a593Smuzhiyun {
649*4882a593Smuzhiyun int np = urb->number_of_packets;
650*4882a593Smuzhiyun int i;
651*4882a593Smuzhiyun int actualoffset = urb->actual_length;
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun if (!usb_pipeisoc(urb->pipe))
654*4882a593Smuzhiyun return;
655*4882a593Smuzhiyun
656*4882a593Smuzhiyun /* if no packets or length of data is 0, then nothing to unpack */
657*4882a593Smuzhiyun if (np == 0 || urb->actual_length == 0)
658*4882a593Smuzhiyun return;
659*4882a593Smuzhiyun
660*4882a593Smuzhiyun /*
661*4882a593Smuzhiyun * if actual_length is transfer_buffer_length then no padding is
662*4882a593Smuzhiyun * present.
663*4882a593Smuzhiyun */
664*4882a593Smuzhiyun if (urb->actual_length == urb->transfer_buffer_length)
665*4882a593Smuzhiyun return;
666*4882a593Smuzhiyun
667*4882a593Smuzhiyun /*
668*4882a593Smuzhiyun * loop over all packets from last to first (to prevent overwriting
669*4882a593Smuzhiyun * memory when padding) and move them into the proper place
670*4882a593Smuzhiyun */
671*4882a593Smuzhiyun for (i = np-1; i > 0; i--) {
672*4882a593Smuzhiyun actualoffset -= urb->iso_frame_desc[i].actual_length;
673*4882a593Smuzhiyun memmove(urb->transfer_buffer + urb->iso_frame_desc[i].offset,
674*4882a593Smuzhiyun urb->transfer_buffer + actualoffset,
675*4882a593Smuzhiyun urb->iso_frame_desc[i].actual_length);
676*4882a593Smuzhiyun }
677*4882a593Smuzhiyun }
678*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_pad_iso);
679*4882a593Smuzhiyun
680*4882a593Smuzhiyun /* some members of urb must be substituted before. */
usbip_recv_xbuff(struct usbip_device * ud,struct urb * urb)681*4882a593Smuzhiyun int usbip_recv_xbuff(struct usbip_device *ud, struct urb *urb)
682*4882a593Smuzhiyun {
683*4882a593Smuzhiyun struct scatterlist *sg;
684*4882a593Smuzhiyun int ret = 0;
685*4882a593Smuzhiyun int recv;
686*4882a593Smuzhiyun int size;
687*4882a593Smuzhiyun int copy;
688*4882a593Smuzhiyun int i;
689*4882a593Smuzhiyun
690*4882a593Smuzhiyun if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC) {
691*4882a593Smuzhiyun /* the direction of urb must be OUT. */
692*4882a593Smuzhiyun if (usb_pipein(urb->pipe))
693*4882a593Smuzhiyun return 0;
694*4882a593Smuzhiyun
695*4882a593Smuzhiyun size = urb->transfer_buffer_length;
696*4882a593Smuzhiyun } else {
697*4882a593Smuzhiyun /* the direction of urb must be IN. */
698*4882a593Smuzhiyun if (usb_pipeout(urb->pipe))
699*4882a593Smuzhiyun return 0;
700*4882a593Smuzhiyun
701*4882a593Smuzhiyun size = urb->actual_length;
702*4882a593Smuzhiyun }
703*4882a593Smuzhiyun
704*4882a593Smuzhiyun /* no need to recv xbuff */
705*4882a593Smuzhiyun if (!(size > 0))
706*4882a593Smuzhiyun return 0;
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun if (size > urb->transfer_buffer_length)
709*4882a593Smuzhiyun /* should not happen, probably malicious packet */
710*4882a593Smuzhiyun goto error;
711*4882a593Smuzhiyun
712*4882a593Smuzhiyun if (urb->num_sgs) {
713*4882a593Smuzhiyun copy = size;
714*4882a593Smuzhiyun for_each_sg(urb->sg, sg, urb->num_sgs, i) {
715*4882a593Smuzhiyun int recv_size;
716*4882a593Smuzhiyun
717*4882a593Smuzhiyun if (copy < sg->length)
718*4882a593Smuzhiyun recv_size = copy;
719*4882a593Smuzhiyun else
720*4882a593Smuzhiyun recv_size = sg->length;
721*4882a593Smuzhiyun
722*4882a593Smuzhiyun recv = usbip_recv(ud->tcp_socket, sg_virt(sg),
723*4882a593Smuzhiyun recv_size);
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun if (recv != recv_size)
726*4882a593Smuzhiyun goto error;
727*4882a593Smuzhiyun
728*4882a593Smuzhiyun copy -= recv;
729*4882a593Smuzhiyun ret += recv;
730*4882a593Smuzhiyun
731*4882a593Smuzhiyun if (!copy)
732*4882a593Smuzhiyun break;
733*4882a593Smuzhiyun }
734*4882a593Smuzhiyun
735*4882a593Smuzhiyun if (ret != size)
736*4882a593Smuzhiyun goto error;
737*4882a593Smuzhiyun } else {
738*4882a593Smuzhiyun ret = usbip_recv(ud->tcp_socket, urb->transfer_buffer, size);
739*4882a593Smuzhiyun if (ret != size)
740*4882a593Smuzhiyun goto error;
741*4882a593Smuzhiyun }
742*4882a593Smuzhiyun
743*4882a593Smuzhiyun return ret;
744*4882a593Smuzhiyun
745*4882a593Smuzhiyun error:
746*4882a593Smuzhiyun dev_err(&urb->dev->dev, "recv xbuf, %d\n", ret);
747*4882a593Smuzhiyun if (ud->side == USBIP_STUB || ud->side == USBIP_VUDC)
748*4882a593Smuzhiyun usbip_event_add(ud, SDEV_EVENT_ERROR_TCP);
749*4882a593Smuzhiyun else
750*4882a593Smuzhiyun usbip_event_add(ud, VDEV_EVENT_ERROR_TCP);
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun return -EPIPE;
753*4882a593Smuzhiyun }
754*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(usbip_recv_xbuff);
755*4882a593Smuzhiyun
usbip_core_init(void)756*4882a593Smuzhiyun static int __init usbip_core_init(void)
757*4882a593Smuzhiyun {
758*4882a593Smuzhiyun return usbip_init_eh();
759*4882a593Smuzhiyun }
760*4882a593Smuzhiyun
usbip_core_exit(void)761*4882a593Smuzhiyun static void __exit usbip_core_exit(void)
762*4882a593Smuzhiyun {
763*4882a593Smuzhiyun usbip_finish_eh();
764*4882a593Smuzhiyun return;
765*4882a593Smuzhiyun }
766*4882a593Smuzhiyun
767*4882a593Smuzhiyun module_init(usbip_core_init);
768*4882a593Smuzhiyun module_exit(usbip_core_exit);
769*4882a593Smuzhiyun
770*4882a593Smuzhiyun MODULE_AUTHOR(DRIVER_AUTHOR);
771*4882a593Smuzhiyun MODULE_DESCRIPTION(DRIVER_DESC);
772*4882a593Smuzhiyun MODULE_LICENSE("GPL");
773