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