xref: /OK3568_Linux_fs/kernel/drivers/usb/usbip/usbip_common.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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