Commit | Line | Data |
---|---|---|
cdda479f LP |
1 | /* |
2 | * uvc_gadget.c -- USB Video Class Gadget driver | |
3 | * | |
4 | * Copyright (C) 2009-2010 | |
5 | * Laurent Pinchart (laurent.pinchart@ideasonboard.com) | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
cdda479f LP |
11 | */ |
12 | ||
13 | #include <linux/kernel.h> | |
14 | #include <linux/device.h> | |
15 | #include <linux/errno.h> | |
16 | #include <linux/fs.h> | |
17 | #include <linux/list.h> | |
18 | #include <linux/mutex.h> | |
19 | #include <linux/usb/ch9.h> | |
20 | #include <linux/usb/gadget.h> | |
21 | #include <linux/usb/video.h> | |
22 | #include <linux/vmalloc.h> | |
23 | #include <linux/wait.h> | |
24 | ||
25 | #include <media/v4l2-dev.h> | |
26 | #include <media/v4l2-event.h> | |
27 | ||
28 | #include "uvc.h" | |
29 | ||
5d9955f8 | 30 | unsigned int uvc_gadget_trace_param; |
cdda479f | 31 | |
fbcaba0e BS |
32 | /*-------------------------------------------------------------------------*/ |
33 | ||
34 | /* module parameters specific to the Video streaming endpoint */ | |
35 | static unsigned streaming_interval = 1; | |
36 | module_param(streaming_interval, uint, S_IRUGO|S_IWUSR); | |
37 | MODULE_PARM_DESC(streaming_interval, "1 - 16"); | |
38 | ||
39 | static unsigned streaming_maxpacket = 1024; | |
40 | module_param(streaming_maxpacket, uint, S_IRUGO|S_IWUSR); | |
41 | MODULE_PARM_DESC(streaming_maxpacket, "0 - 1023 (fs), 0 - 1024 (hs/ss)"); | |
42 | ||
43 | static unsigned streaming_mult; | |
44 | module_param(streaming_mult, uint, S_IRUGO|S_IWUSR); | |
45 | MODULE_PARM_DESC(streaming_mult, "0 - 2 (hs/ss only)"); | |
46 | ||
47 | static unsigned streaming_maxburst; | |
48 | module_param(streaming_maxburst, uint, S_IRUGO|S_IWUSR); | |
49 | MODULE_PARM_DESC(streaming_maxburst, "0 - 15 (ss only)"); | |
50 | ||
cdda479f LP |
51 | /* -------------------------------------------------------------------------- |
52 | * Function descriptors | |
53 | */ | |
54 | ||
55 | /* string IDs are assigned dynamically */ | |
56 | ||
57 | #define UVC_STRING_ASSOCIATION_IDX 0 | |
58 | #define UVC_STRING_CONTROL_IDX 1 | |
59 | #define UVC_STRING_STREAMING_IDX 2 | |
60 | ||
61 | static struct usb_string uvc_en_us_strings[] = { | |
62 | [UVC_STRING_ASSOCIATION_IDX].s = "UVC Camera", | |
63 | [UVC_STRING_CONTROL_IDX].s = "Video Control", | |
64 | [UVC_STRING_STREAMING_IDX].s = "Video Streaming", | |
65 | { } | |
66 | }; | |
67 | ||
68 | static struct usb_gadget_strings uvc_stringtab = { | |
69 | .language = 0x0409, /* en-us */ | |
70 | .strings = uvc_en_us_strings, | |
71 | }; | |
72 | ||
73 | static struct usb_gadget_strings *uvc_function_strings[] = { | |
74 | &uvc_stringtab, | |
75 | NULL, | |
76 | }; | |
77 | ||
78 | #define UVC_INTF_VIDEO_CONTROL 0 | |
79 | #define UVC_INTF_VIDEO_STREAMING 1 | |
80 | ||
57976636 BS |
81 | #define STATUS_BYTECOUNT 16 /* 16 bytes status */ |
82 | ||
cdda479f | 83 | static struct usb_interface_assoc_descriptor uvc_iad __initdata = { |
bbafc0cb | 84 | .bLength = sizeof(uvc_iad), |
cdda479f LP |
85 | .bDescriptorType = USB_DT_INTERFACE_ASSOCIATION, |
86 | .bFirstInterface = 0, | |
87 | .bInterfaceCount = 2, | |
88 | .bFunctionClass = USB_CLASS_VIDEO, | |
bbafc0cb | 89 | .bFunctionSubClass = UVC_SC_VIDEO_INTERFACE_COLLECTION, |
cdda479f LP |
90 | .bFunctionProtocol = 0x00, |
91 | .iFunction = 0, | |
92 | }; | |
93 | ||
94 | static struct usb_interface_descriptor uvc_control_intf __initdata = { | |
95 | .bLength = USB_DT_INTERFACE_SIZE, | |
96 | .bDescriptorType = USB_DT_INTERFACE, | |
97 | .bInterfaceNumber = UVC_INTF_VIDEO_CONTROL, | |
98 | .bAlternateSetting = 0, | |
99 | .bNumEndpoints = 1, | |
100 | .bInterfaceClass = USB_CLASS_VIDEO, | |
bbafc0cb | 101 | .bInterfaceSubClass = UVC_SC_VIDEOCONTROL, |
cdda479f LP |
102 | .bInterfaceProtocol = 0x00, |
103 | .iInterface = 0, | |
104 | }; | |
105 | ||
fbcaba0e | 106 | static struct usb_endpoint_descriptor uvc_fs_control_ep __initdata = { |
cdda479f LP |
107 | .bLength = USB_DT_ENDPOINT_SIZE, |
108 | .bDescriptorType = USB_DT_ENDPOINT, | |
109 | .bEndpointAddress = USB_DIR_IN, | |
110 | .bmAttributes = USB_ENDPOINT_XFER_INT, | |
57976636 | 111 | .wMaxPacketSize = cpu_to_le16(STATUS_BYTECOUNT), |
cdda479f LP |
112 | .bInterval = 8, |
113 | }; | |
114 | ||
115 | static struct uvc_control_endpoint_descriptor uvc_control_cs_ep __initdata = { | |
116 | .bLength = UVC_DT_CONTROL_ENDPOINT_SIZE, | |
117 | .bDescriptorType = USB_DT_CS_ENDPOINT, | |
118 | .bDescriptorSubType = UVC_EP_INTERRUPT, | |
57976636 | 119 | .wMaxTransferSize = cpu_to_le16(STATUS_BYTECOUNT), |
cdda479f LP |
120 | }; |
121 | ||
122 | static struct usb_interface_descriptor uvc_streaming_intf_alt0 __initdata = { | |
123 | .bLength = USB_DT_INTERFACE_SIZE, | |
124 | .bDescriptorType = USB_DT_INTERFACE, | |
125 | .bInterfaceNumber = UVC_INTF_VIDEO_STREAMING, | |
126 | .bAlternateSetting = 0, | |
127 | .bNumEndpoints = 0, | |
128 | .bInterfaceClass = USB_CLASS_VIDEO, | |
bbafc0cb | 129 | .bInterfaceSubClass = UVC_SC_VIDEOSTREAMING, |
cdda479f LP |
130 | .bInterfaceProtocol = 0x00, |
131 | .iInterface = 0, | |
132 | }; | |
133 | ||
134 | static struct usb_interface_descriptor uvc_streaming_intf_alt1 __initdata = { | |
135 | .bLength = USB_DT_INTERFACE_SIZE, | |
136 | .bDescriptorType = USB_DT_INTERFACE, | |
137 | .bInterfaceNumber = UVC_INTF_VIDEO_STREAMING, | |
138 | .bAlternateSetting = 1, | |
139 | .bNumEndpoints = 1, | |
140 | .bInterfaceClass = USB_CLASS_VIDEO, | |
bbafc0cb | 141 | .bInterfaceSubClass = UVC_SC_VIDEOSTREAMING, |
cdda479f LP |
142 | .bInterfaceProtocol = 0x00, |
143 | .iInterface = 0, | |
144 | }; | |
145 | ||
fbcaba0e | 146 | static struct usb_endpoint_descriptor uvc_fs_streaming_ep = { |
cdda479f LP |
147 | .bLength = USB_DT_ENDPOINT_SIZE, |
148 | .bDescriptorType = USB_DT_ENDPOINT, | |
149 | .bEndpointAddress = USB_DIR_IN, | |
150 | .bmAttributes = USB_ENDPOINT_XFER_ISOC, | |
151 | .wMaxPacketSize = cpu_to_le16(512), | |
152 | .bInterval = 1, | |
153 | }; | |
154 | ||
fbcaba0e BS |
155 | static struct usb_endpoint_descriptor uvc_hs_streaming_ep = { |
156 | .bLength = USB_DT_ENDPOINT_SIZE, | |
157 | .bDescriptorType = USB_DT_ENDPOINT, | |
158 | .bEndpointAddress = USB_DIR_IN, | |
159 | .bmAttributes = USB_ENDPOINT_XFER_ISOC, | |
160 | .wMaxPacketSize = cpu_to_le16(1024), | |
161 | .bInterval = 1, | |
162 | }; | |
163 | ||
164 | /* super speed support */ | |
165 | static struct usb_endpoint_descriptor uvc_ss_control_ep __initdata = { | |
166 | .bLength = USB_DT_ENDPOINT_SIZE, | |
167 | .bDescriptorType = USB_DT_ENDPOINT, | |
168 | ||
169 | .bEndpointAddress = USB_DIR_IN, | |
170 | .bmAttributes = USB_ENDPOINT_XFER_INT, | |
171 | .wMaxPacketSize = cpu_to_le16(STATUS_BYTECOUNT), | |
172 | .bInterval = 8, | |
173 | }; | |
174 | ||
175 | static struct usb_ss_ep_comp_descriptor uvc_ss_control_comp __initdata = { | |
176 | .bLength = sizeof uvc_ss_control_comp, | |
177 | .bDescriptorType = USB_DT_SS_ENDPOINT_COMP, | |
178 | ||
179 | /* the following 3 values can be tweaked if necessary */ | |
180 | /* .bMaxBurst = 0, */ | |
181 | /* .bmAttributes = 0, */ | |
182 | .wBytesPerInterval = cpu_to_le16(STATUS_BYTECOUNT), | |
183 | }; | |
184 | ||
185 | static struct usb_endpoint_descriptor uvc_ss_streaming_ep __initdata = { | |
186 | .bLength = USB_DT_ENDPOINT_SIZE, | |
187 | .bDescriptorType = USB_DT_ENDPOINT, | |
188 | ||
189 | .bEndpointAddress = USB_DIR_IN, | |
190 | .bmAttributes = USB_ENDPOINT_XFER_ISOC, | |
191 | .wMaxPacketSize = cpu_to_le16(1024), | |
192 | .bInterval = 4, | |
193 | }; | |
194 | ||
195 | static struct usb_ss_ep_comp_descriptor uvc_ss_streaming_comp = { | |
196 | .bLength = sizeof uvc_ss_streaming_comp, | |
197 | .bDescriptorType = USB_DT_SS_ENDPOINT_COMP, | |
198 | ||
199 | /* the following 3 values can be tweaked if necessary */ | |
200 | .bMaxBurst = 0, | |
201 | .bmAttributes = 0, | |
202 | .wBytesPerInterval = cpu_to_le16(1024), | |
203 | }; | |
204 | ||
cdda479f LP |
205 | static const struct usb_descriptor_header * const uvc_fs_streaming[] = { |
206 | (struct usb_descriptor_header *) &uvc_streaming_intf_alt1, | |
fbcaba0e | 207 | (struct usb_descriptor_header *) &uvc_fs_streaming_ep, |
cdda479f LP |
208 | NULL, |
209 | }; | |
210 | ||
211 | static const struct usb_descriptor_header * const uvc_hs_streaming[] = { | |
212 | (struct usb_descriptor_header *) &uvc_streaming_intf_alt1, | |
fbcaba0e BS |
213 | (struct usb_descriptor_header *) &uvc_hs_streaming_ep, |
214 | NULL, | |
215 | }; | |
216 | ||
217 | static const struct usb_descriptor_header * const uvc_ss_streaming[] = { | |
218 | (struct usb_descriptor_header *) &uvc_streaming_intf_alt1, | |
219 | (struct usb_descriptor_header *) &uvc_ss_streaming_ep, | |
220 | (struct usb_descriptor_header *) &uvc_ss_streaming_comp, | |
cdda479f LP |
221 | NULL, |
222 | }; | |
223 | ||
224 | /* -------------------------------------------------------------------------- | |
225 | * Control requests | |
226 | */ | |
227 | ||
228 | static void | |
229 | uvc_function_ep0_complete(struct usb_ep *ep, struct usb_request *req) | |
230 | { | |
231 | struct uvc_device *uvc = req->context; | |
232 | struct v4l2_event v4l2_event; | |
233 | struct uvc_event *uvc_event = (void *)&v4l2_event.u.data; | |
234 | ||
235 | if (uvc->event_setup_out) { | |
236 | uvc->event_setup_out = 0; | |
237 | ||
238 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
239 | v4l2_event.type = UVC_EVENT_DATA; | |
240 | uvc_event->data.length = req->actual; | |
241 | memcpy(&uvc_event->data.data, req->buf, req->actual); | |
242 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
243 | } | |
244 | } | |
245 | ||
246 | static int | |
247 | uvc_function_setup(struct usb_function *f, const struct usb_ctrlrequest *ctrl) | |
248 | { | |
249 | struct uvc_device *uvc = to_uvc(f); | |
250 | struct v4l2_event v4l2_event; | |
251 | struct uvc_event *uvc_event = (void *)&v4l2_event.u.data; | |
252 | ||
253 | /* printk(KERN_INFO "setup request %02x %02x value %04x index %04x %04x\n", | |
254 | * ctrl->bRequestType, ctrl->bRequest, le16_to_cpu(ctrl->wValue), | |
255 | * le16_to_cpu(ctrl->wIndex), le16_to_cpu(ctrl->wLength)); | |
256 | */ | |
257 | ||
258 | if ((ctrl->bRequestType & USB_TYPE_MASK) != USB_TYPE_CLASS) { | |
259 | INFO(f->config->cdev, "invalid request type\n"); | |
260 | return -EINVAL; | |
261 | } | |
262 | ||
263 | /* Stall too big requests. */ | |
264 | if (le16_to_cpu(ctrl->wLength) > UVC_MAX_REQUEST_SIZE) | |
265 | return -EINVAL; | |
266 | ||
267 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
268 | v4l2_event.type = UVC_EVENT_SETUP; | |
269 | memcpy(&uvc_event->req, ctrl, sizeof(uvc_event->req)); | |
270 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
271 | ||
272 | return 0; | |
273 | } | |
274 | ||
275 | static int | |
276 | uvc_function_get_alt(struct usb_function *f, unsigned interface) | |
277 | { | |
278 | struct uvc_device *uvc = to_uvc(f); | |
279 | ||
280 | INFO(f->config->cdev, "uvc_function_get_alt(%u)\n", interface); | |
281 | ||
282 | if (interface == uvc->control_intf) | |
283 | return 0; | |
284 | else if (interface != uvc->streaming_intf) | |
285 | return -EINVAL; | |
286 | else | |
287 | return uvc->state == UVC_STATE_STREAMING ? 1 : 0; | |
288 | } | |
289 | ||
290 | static int | |
291 | uvc_function_set_alt(struct usb_function *f, unsigned interface, unsigned alt) | |
292 | { | |
293 | struct uvc_device *uvc = to_uvc(f); | |
294 | struct v4l2_event v4l2_event; | |
295 | struct uvc_event *uvc_event = (void *)&v4l2_event.u.data; | |
fbcaba0e | 296 | int ret; |
cdda479f LP |
297 | |
298 | INFO(f->config->cdev, "uvc_function_set_alt(%u, %u)\n", interface, alt); | |
299 | ||
300 | if (interface == uvc->control_intf) { | |
301 | if (alt) | |
302 | return -EINVAL; | |
303 | ||
304 | if (uvc->state == UVC_STATE_DISCONNECTED) { | |
305 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
306 | v4l2_event.type = UVC_EVENT_CONNECT; | |
307 | uvc_event->speed = f->config->cdev->gadget->speed; | |
308 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
309 | ||
310 | uvc->state = UVC_STATE_CONNECTED; | |
311 | } | |
312 | ||
313 | return 0; | |
314 | } | |
315 | ||
316 | if (interface != uvc->streaming_intf) | |
317 | return -EINVAL; | |
318 | ||
319 | /* TODO | |
320 | if (usb_endpoint_xfer_bulk(&uvc->desc.vs_ep)) | |
321 | return alt ? -EINVAL : 0; | |
322 | */ | |
323 | ||
324 | switch (alt) { | |
325 | case 0: | |
326 | if (uvc->state != UVC_STATE_STREAMING) | |
327 | return 0; | |
328 | ||
329 | if (uvc->video.ep) | |
330 | usb_ep_disable(uvc->video.ep); | |
331 | ||
332 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
333 | v4l2_event.type = UVC_EVENT_STREAMOFF; | |
334 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
335 | ||
336 | uvc->state = UVC_STATE_CONNECTED; | |
337 | break; | |
338 | ||
339 | case 1: | |
340 | if (uvc->state != UVC_STATE_CONNECTED) | |
341 | return 0; | |
342 | ||
72c973dd | 343 | if (uvc->video.ep) { |
fbcaba0e BS |
344 | ret = config_ep_by_speed(f->config->cdev->gadget, |
345 | &(uvc->func), uvc->video.ep); | |
346 | if (ret) | |
347 | return ret; | |
72c973dd TB |
348 | usb_ep_enable(uvc->video.ep); |
349 | } | |
cdda479f LP |
350 | |
351 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
352 | v4l2_event.type = UVC_EVENT_STREAMON; | |
353 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
354 | ||
355 | uvc->state = UVC_STATE_STREAMING; | |
356 | break; | |
357 | ||
358 | default: | |
359 | return -EINVAL; | |
360 | } | |
361 | ||
362 | return 0; | |
363 | } | |
364 | ||
365 | static void | |
366 | uvc_function_disable(struct usb_function *f) | |
367 | { | |
368 | struct uvc_device *uvc = to_uvc(f); | |
369 | struct v4l2_event v4l2_event; | |
370 | ||
371 | INFO(f->config->cdev, "uvc_function_disable\n"); | |
372 | ||
373 | memset(&v4l2_event, 0, sizeof(v4l2_event)); | |
374 | v4l2_event.type = UVC_EVENT_DISCONNECT; | |
375 | v4l2_event_queue(uvc->vdev, &v4l2_event); | |
376 | ||
377 | uvc->state = UVC_STATE_DISCONNECTED; | |
378 | } | |
379 | ||
380 | /* -------------------------------------------------------------------------- | |
381 | * Connection / disconnection | |
382 | */ | |
383 | ||
384 | void | |
385 | uvc_function_connect(struct uvc_device *uvc) | |
386 | { | |
387 | struct usb_composite_dev *cdev = uvc->func.config->cdev; | |
388 | int ret; | |
389 | ||
390 | if ((ret = usb_function_activate(&uvc->func)) < 0) | |
391 | INFO(cdev, "UVC connect failed with %d\n", ret); | |
392 | } | |
393 | ||
394 | void | |
395 | uvc_function_disconnect(struct uvc_device *uvc) | |
396 | { | |
397 | struct usb_composite_dev *cdev = uvc->func.config->cdev; | |
398 | int ret; | |
399 | ||
400 | if ((ret = usb_function_deactivate(&uvc->func)) < 0) | |
401 | INFO(cdev, "UVC disconnect failed with %d\n", ret); | |
402 | } | |
403 | ||
404 | /* -------------------------------------------------------------------------- | |
405 | * USB probe and disconnect | |
406 | */ | |
407 | ||
408 | static int | |
409 | uvc_register_video(struct uvc_device *uvc) | |
410 | { | |
411 | struct usb_composite_dev *cdev = uvc->func.config->cdev; | |
412 | struct video_device *video; | |
413 | ||
414 | /* TODO reference counting. */ | |
415 | video = video_device_alloc(); | |
416 | if (video == NULL) | |
417 | return -ENOMEM; | |
418 | ||
419 | video->parent = &cdev->gadget->dev; | |
cdda479f LP |
420 | video->fops = &uvc_v4l2_fops; |
421 | video->release = video_device_release; | |
422 | strncpy(video->name, cdev->gadget->name, sizeof(video->name)); | |
423 | ||
424 | uvc->vdev = video; | |
425 | video_set_drvdata(video, uvc); | |
426 | ||
427 | return video_register_device(video, VFL_TYPE_GRABBER, -1); | |
428 | } | |
429 | ||
430 | #define UVC_COPY_DESCRIPTOR(mem, dst, desc) \ | |
431 | do { \ | |
432 | memcpy(mem, desc, (desc)->bLength); \ | |
433 | *(dst)++ = mem; \ | |
434 | mem += (desc)->bLength; \ | |
435 | } while (0); | |
436 | ||
437 | #define UVC_COPY_DESCRIPTORS(mem, dst, src) \ | |
438 | do { \ | |
439 | const struct usb_descriptor_header * const *__src; \ | |
440 | for (__src = src; *__src; ++__src) { \ | |
441 | memcpy(mem, *__src, (*__src)->bLength); \ | |
442 | *dst++ = mem; \ | |
443 | mem += (*__src)->bLength; \ | |
444 | } \ | |
445 | } while (0) | |
446 | ||
447 | static struct usb_descriptor_header ** __init | |
448 | uvc_copy_descriptors(struct uvc_device *uvc, enum usb_device_speed speed) | |
449 | { | |
450 | struct uvc_input_header_descriptor *uvc_streaming_header; | |
451 | struct uvc_header_descriptor *uvc_control_header; | |
fbcaba0e | 452 | const struct uvc_descriptor_header * const *uvc_control_desc; |
cdda479f LP |
453 | const struct uvc_descriptor_header * const *uvc_streaming_cls; |
454 | const struct usb_descriptor_header * const *uvc_streaming_std; | |
455 | const struct usb_descriptor_header * const *src; | |
fbcaba0e | 456 | static struct usb_endpoint_descriptor *uvc_control_ep; |
cdda479f LP |
457 | struct usb_descriptor_header **dst; |
458 | struct usb_descriptor_header **hdr; | |
459 | unsigned int control_size; | |
460 | unsigned int streaming_size; | |
461 | unsigned int n_desc; | |
462 | unsigned int bytes; | |
463 | void *mem; | |
464 | ||
fbcaba0e BS |
465 | switch (speed) { |
466 | case USB_SPEED_SUPER: | |
467 | uvc_control_desc = uvc->desc.ss_control; | |
468 | uvc_streaming_cls = uvc->desc.ss_streaming; | |
469 | uvc_streaming_std = uvc_ss_streaming; | |
470 | uvc_control_ep = &uvc_ss_control_ep; | |
471 | break; | |
472 | ||
473 | case USB_SPEED_HIGH: | |
474 | uvc_control_desc = uvc->desc.fs_control; | |
475 | uvc_streaming_cls = uvc->desc.hs_streaming; | |
476 | uvc_streaming_std = uvc_hs_streaming; | |
477 | uvc_control_ep = &uvc_fs_control_ep; | |
478 | break; | |
479 | ||
480 | case USB_SPEED_FULL: | |
481 | default: | |
482 | uvc_control_desc = uvc->desc.fs_control; | |
483 | uvc_streaming_cls = uvc->desc.fs_streaming; | |
484 | uvc_streaming_std = uvc_fs_streaming; | |
485 | uvc_control_ep = &uvc_fs_control_ep; | |
486 | break; | |
487 | } | |
cdda479f LP |
488 | |
489 | /* Descriptors layout | |
490 | * | |
491 | * uvc_iad | |
492 | * uvc_control_intf | |
493 | * Class-specific UVC control descriptors | |
494 | * uvc_control_ep | |
495 | * uvc_control_cs_ep | |
496 | * uvc_streaming_intf_alt0 | |
497 | * Class-specific UVC streaming descriptors | |
498 | * uvc_{fs|hs}_streaming | |
499 | */ | |
500 | ||
501 | /* Count descriptors and compute their size. */ | |
502 | control_size = 0; | |
503 | streaming_size = 0; | |
504 | bytes = uvc_iad.bLength + uvc_control_intf.bLength | |
fbcaba0e | 505 | + uvc_control_ep->bLength + uvc_control_cs_ep.bLength |
cdda479f | 506 | + uvc_streaming_intf_alt0.bLength; |
cdda479f | 507 | |
fbcaba0e BS |
508 | if (speed == USB_SPEED_SUPER) { |
509 | bytes += uvc_ss_control_comp.bLength; | |
510 | n_desc = 6; | |
511 | } else { | |
512 | n_desc = 5; | |
513 | } | |
514 | ||
515 | for (src = (const struct usb_descriptor_header **)uvc_control_desc; | |
516 | *src; ++src) { | |
cdda479f LP |
517 | control_size += (*src)->bLength; |
518 | bytes += (*src)->bLength; | |
519 | n_desc++; | |
520 | } | |
fbcaba0e BS |
521 | for (src = (const struct usb_descriptor_header **)uvc_streaming_cls; |
522 | *src; ++src) { | |
cdda479f LP |
523 | streaming_size += (*src)->bLength; |
524 | bytes += (*src)->bLength; | |
525 | n_desc++; | |
526 | } | |
527 | for (src = uvc_streaming_std; *src; ++src) { | |
528 | bytes += (*src)->bLength; | |
529 | n_desc++; | |
530 | } | |
531 | ||
532 | mem = kmalloc((n_desc + 1) * sizeof(*src) + bytes, GFP_KERNEL); | |
533 | if (mem == NULL) | |
534 | return NULL; | |
535 | ||
536 | hdr = mem; | |
537 | dst = mem; | |
538 | mem += (n_desc + 1) * sizeof(*src); | |
539 | ||
540 | /* Copy the descriptors. */ | |
541 | UVC_COPY_DESCRIPTOR(mem, dst, &uvc_iad); | |
542 | UVC_COPY_DESCRIPTOR(mem, dst, &uvc_control_intf); | |
543 | ||
544 | uvc_control_header = mem; | |
545 | UVC_COPY_DESCRIPTORS(mem, dst, | |
fbcaba0e | 546 | (const struct usb_descriptor_header **)uvc_control_desc); |
cdda479f LP |
547 | uvc_control_header->wTotalLength = cpu_to_le16(control_size); |
548 | uvc_control_header->bInCollection = 1; | |
549 | uvc_control_header->baInterfaceNr[0] = uvc->streaming_intf; | |
550 | ||
fbcaba0e BS |
551 | UVC_COPY_DESCRIPTOR(mem, dst, uvc_control_ep); |
552 | if (speed == USB_SPEED_SUPER) | |
553 | UVC_COPY_DESCRIPTOR(mem, dst, &uvc_ss_control_comp); | |
554 | ||
cdda479f LP |
555 | UVC_COPY_DESCRIPTOR(mem, dst, &uvc_control_cs_ep); |
556 | UVC_COPY_DESCRIPTOR(mem, dst, &uvc_streaming_intf_alt0); | |
557 | ||
558 | uvc_streaming_header = mem; | |
559 | UVC_COPY_DESCRIPTORS(mem, dst, | |
560 | (const struct usb_descriptor_header**)uvc_streaming_cls); | |
561 | uvc_streaming_header->wTotalLength = cpu_to_le16(streaming_size); | |
fbcaba0e BS |
562 | uvc_streaming_header->bEndpointAddress = |
563 | uvc_fs_streaming_ep.bEndpointAddress; | |
cdda479f LP |
564 | |
565 | UVC_COPY_DESCRIPTORS(mem, dst, uvc_streaming_std); | |
566 | ||
567 | *dst = NULL; | |
568 | return hdr; | |
569 | } | |
570 | ||
571 | static void | |
572 | uvc_function_unbind(struct usb_configuration *c, struct usb_function *f) | |
573 | { | |
574 | struct usb_composite_dev *cdev = c->cdev; | |
575 | struct uvc_device *uvc = to_uvc(f); | |
576 | ||
577 | INFO(cdev, "uvc_function_unbind\n"); | |
578 | ||
0f9df939 SAS |
579 | video_unregister_device(uvc->vdev); |
580 | uvc->control_ep->driver_data = NULL; | |
581 | uvc->video.ep->driver_data = NULL; | |
cdda479f | 582 | |
0f9df939 SAS |
583 | usb_ep_free_request(cdev->gadget->ep0, uvc->control_req); |
584 | kfree(uvc->control_buf); | |
cdda479f | 585 | |
10287bae | 586 | usb_free_all_descriptors(f); |
cdda479f LP |
587 | |
588 | kfree(uvc); | |
589 | } | |
590 | ||
591 | static int __init | |
592 | uvc_function_bind(struct usb_configuration *c, struct usb_function *f) | |
593 | { | |
594 | struct usb_composite_dev *cdev = c->cdev; | |
595 | struct uvc_device *uvc = to_uvc(f); | |
596 | struct usb_ep *ep; | |
597 | int ret = -EINVAL; | |
598 | ||
599 | INFO(cdev, "uvc_function_bind\n"); | |
600 | ||
fbcaba0e BS |
601 | /* sanity check the streaming endpoint module parameters */ |
602 | if (streaming_interval < 1) | |
603 | streaming_interval = 1; | |
604 | if (streaming_interval > 16) | |
605 | streaming_interval = 16; | |
606 | if (streaming_mult > 2) | |
607 | streaming_mult = 2; | |
608 | if (streaming_maxburst > 15) | |
609 | streaming_maxburst = 15; | |
610 | ||
611 | /* | |
612 | * fill in the FS video streaming specific descriptors from the | |
613 | * module parameters | |
614 | */ | |
615 | uvc_fs_streaming_ep.wMaxPacketSize = streaming_maxpacket > 1023 ? | |
616 | 1023 : streaming_maxpacket; | |
617 | uvc_fs_streaming_ep.bInterval = streaming_interval; | |
618 | ||
cdda479f | 619 | /* Allocate endpoints. */ |
fbcaba0e | 620 | ep = usb_ep_autoconfig(cdev->gadget, &uvc_fs_control_ep); |
cdda479f LP |
621 | if (!ep) { |
622 | INFO(cdev, "Unable to allocate control EP\n"); | |
623 | goto error; | |
624 | } | |
625 | uvc->control_ep = ep; | |
626 | ep->driver_data = uvc; | |
627 | ||
fbcaba0e | 628 | ep = usb_ep_autoconfig(cdev->gadget, &uvc_fs_streaming_ep); |
cdda479f LP |
629 | if (!ep) { |
630 | INFO(cdev, "Unable to allocate streaming EP\n"); | |
631 | goto error; | |
632 | } | |
633 | uvc->video.ep = ep; | |
634 | ep->driver_data = uvc; | |
635 | ||
636 | /* Allocate interface IDs. */ | |
637 | if ((ret = usb_interface_id(c, f)) < 0) | |
638 | goto error; | |
639 | uvc_iad.bFirstInterface = ret; | |
640 | uvc_control_intf.bInterfaceNumber = ret; | |
641 | uvc->control_intf = ret; | |
642 | ||
643 | if ((ret = usb_interface_id(c, f)) < 0) | |
644 | goto error; | |
645 | uvc_streaming_intf_alt0.bInterfaceNumber = ret; | |
646 | uvc_streaming_intf_alt1.bInterfaceNumber = ret; | |
647 | uvc->streaming_intf = ret; | |
648 | ||
fbcaba0e BS |
649 | /* sanity check the streaming endpoint module parameters */ |
650 | if (streaming_maxpacket > 1024) | |
651 | streaming_maxpacket = 1024; | |
10287bae SAS |
652 | /* |
653 | * Fill in the HS descriptors from the module parameters for the Video | |
654 | * Streaming endpoint. | |
655 | * NOTE: We assume that the user knows what they are doing and won't | |
656 | * give parameters that their UDC doesn't support. | |
657 | */ | |
658 | uvc_hs_streaming_ep.wMaxPacketSize = streaming_maxpacket; | |
659 | uvc_hs_streaming_ep.wMaxPacketSize |= streaming_mult << 11; | |
660 | uvc_hs_streaming_ep.bInterval = streaming_interval; | |
661 | uvc_hs_streaming_ep.bEndpointAddress = | |
662 | uvc_fs_streaming_ep.bEndpointAddress; | |
fbcaba0e | 663 | |
10287bae SAS |
664 | /* |
665 | * Fill in the SS descriptors from the module parameters for the Video | |
666 | * Streaming endpoint. | |
667 | * NOTE: We assume that the user knows what they are doing and won't | |
668 | * give parameters that their UDC doesn't support. | |
669 | */ | |
670 | uvc_ss_streaming_ep.wMaxPacketSize = streaming_maxpacket; | |
671 | uvc_ss_streaming_ep.bInterval = streaming_interval; | |
672 | uvc_ss_streaming_comp.bmAttributes = streaming_mult; | |
673 | uvc_ss_streaming_comp.bMaxBurst = streaming_maxburst; | |
674 | uvc_ss_streaming_comp.wBytesPerInterval = | |
675 | streaming_maxpacket * (streaming_mult + 1) * | |
676 | (streaming_maxburst + 1); | |
677 | uvc_ss_streaming_ep.bEndpointAddress = | |
678 | uvc_fs_streaming_ep.bEndpointAddress; | |
fbcaba0e | 679 | |
10287bae SAS |
680 | /* Copy descriptors */ |
681 | f->fs_descriptors = uvc_copy_descriptors(uvc, USB_SPEED_FULL); | |
682 | if (gadget_is_dualspeed(cdev->gadget)) | |
683 | f->hs_descriptors = uvc_copy_descriptors(uvc, USB_SPEED_HIGH); | |
684 | if (gadget_is_superspeed(c->cdev->gadget)) | |
fbcaba0e | 685 | f->ss_descriptors = uvc_copy_descriptors(uvc, USB_SPEED_SUPER); |
cdda479f LP |
686 | |
687 | /* Preallocate control endpoint request. */ | |
688 | uvc->control_req = usb_ep_alloc_request(cdev->gadget->ep0, GFP_KERNEL); | |
689 | uvc->control_buf = kmalloc(UVC_MAX_REQUEST_SIZE, GFP_KERNEL); | |
690 | if (uvc->control_req == NULL || uvc->control_buf == NULL) { | |
691 | ret = -ENOMEM; | |
692 | goto error; | |
693 | } | |
694 | ||
695 | uvc->control_req->buf = uvc->control_buf; | |
696 | uvc->control_req->complete = uvc_function_ep0_complete; | |
697 | uvc->control_req->context = uvc; | |
698 | ||
699 | /* Avoid letting this gadget enumerate until the userspace server is | |
700 | * active. | |
701 | */ | |
702 | if ((ret = usb_function_deactivate(f)) < 0) | |
703 | goto error; | |
704 | ||
705 | /* Initialise video. */ | |
706 | ret = uvc_video_init(&uvc->video); | |
707 | if (ret < 0) | |
708 | goto error; | |
709 | ||
710 | /* Register a V4L2 device. */ | |
711 | ret = uvc_register_video(uvc); | |
712 | if (ret < 0) { | |
713 | printk(KERN_INFO "Unable to register video device\n"); | |
714 | goto error; | |
715 | } | |
716 | ||
717 | return 0; | |
718 | ||
719 | error: | |
0f9df939 SAS |
720 | if (uvc->vdev) |
721 | video_device_release(uvc->vdev); | |
722 | ||
723 | if (uvc->control_ep) | |
724 | uvc->control_ep->driver_data = NULL; | |
725 | if (uvc->video.ep) | |
726 | uvc->video.ep->driver_data = NULL; | |
727 | ||
728 | if (uvc->control_req) { | |
729 | usb_ep_free_request(cdev->gadget->ep0, uvc->control_req); | |
730 | kfree(uvc->control_buf); | |
731 | } | |
732 | ||
10287bae | 733 | usb_free_all_descriptors(f); |
cdda479f LP |
734 | return ret; |
735 | } | |
736 | ||
737 | /* -------------------------------------------------------------------------- | |
738 | * USB gadget function | |
739 | */ | |
740 | ||
741 | /** | |
742 | * uvc_bind_config - add a UVC function to a configuration | |
743 | * @c: the configuration to support the UVC instance | |
744 | * Context: single threaded during gadget setup | |
745 | * | |
746 | * Returns zero on success, else negative errno. | |
747 | * | |
748 | * Caller must have called @uvc_setup(). Caller is also responsible for | |
749 | * calling @uvc_cleanup() before module unload. | |
750 | */ | |
751 | int __init | |
752 | uvc_bind_config(struct usb_configuration *c, | |
fbcaba0e BS |
753 | const struct uvc_descriptor_header * const *fs_control, |
754 | const struct uvc_descriptor_header * const *ss_control, | |
cdda479f | 755 | const struct uvc_descriptor_header * const *fs_streaming, |
fbcaba0e BS |
756 | const struct uvc_descriptor_header * const *hs_streaming, |
757 | const struct uvc_descriptor_header * const *ss_streaming) | |
cdda479f LP |
758 | { |
759 | struct uvc_device *uvc; | |
760 | int ret = 0; | |
761 | ||
762 | /* TODO Check if the USB device controller supports the required | |
763 | * features. | |
764 | */ | |
765 | if (!gadget_is_dualspeed(c->cdev->gadget)) | |
766 | return -EINVAL; | |
767 | ||
768 | uvc = kzalloc(sizeof(*uvc), GFP_KERNEL); | |
769 | if (uvc == NULL) | |
770 | return -ENOMEM; | |
771 | ||
772 | uvc->state = UVC_STATE_DISCONNECTED; | |
773 | ||
774 | /* Validate the descriptors. */ | |
fbcaba0e BS |
775 | if (fs_control == NULL || fs_control[0] == NULL || |
776 | fs_control[0]->bDescriptorSubType != UVC_VC_HEADER) | |
777 | goto error; | |
778 | ||
779 | if (ss_control == NULL || ss_control[0] == NULL || | |
780 | ss_control[0]->bDescriptorSubType != UVC_VC_HEADER) | |
cdda479f LP |
781 | goto error; |
782 | ||
783 | if (fs_streaming == NULL || fs_streaming[0] == NULL || | |
fbcaba0e | 784 | fs_streaming[0]->bDescriptorSubType != UVC_VS_INPUT_HEADER) |
cdda479f LP |
785 | goto error; |
786 | ||
787 | if (hs_streaming == NULL || hs_streaming[0] == NULL || | |
fbcaba0e BS |
788 | hs_streaming[0]->bDescriptorSubType != UVC_VS_INPUT_HEADER) |
789 | goto error; | |
790 | ||
791 | if (ss_streaming == NULL || ss_streaming[0] == NULL || | |
792 | ss_streaming[0]->bDescriptorSubType != UVC_VS_INPUT_HEADER) | |
cdda479f LP |
793 | goto error; |
794 | ||
fbcaba0e BS |
795 | uvc->desc.fs_control = fs_control; |
796 | uvc->desc.ss_control = ss_control; | |
cdda479f LP |
797 | uvc->desc.fs_streaming = fs_streaming; |
798 | uvc->desc.hs_streaming = hs_streaming; | |
fbcaba0e | 799 | uvc->desc.ss_streaming = ss_streaming; |
cdda479f | 800 | |
3de6e63f BS |
801 | /* maybe allocate device-global string IDs, and patch descriptors */ |
802 | if (uvc_en_us_strings[UVC_STRING_ASSOCIATION_IDX].id == 0) { | |
803 | /* Allocate string descriptor numbers. */ | |
804 | ret = usb_string_id(c->cdev); | |
805 | if (ret < 0) | |
806 | goto error; | |
807 | uvc_en_us_strings[UVC_STRING_ASSOCIATION_IDX].id = ret; | |
808 | uvc_iad.iFunction = ret; | |
809 | ||
810 | ret = usb_string_id(c->cdev); | |
811 | if (ret < 0) | |
812 | goto error; | |
813 | uvc_en_us_strings[UVC_STRING_CONTROL_IDX].id = ret; | |
814 | uvc_control_intf.iInterface = ret; | |
815 | ||
816 | ret = usb_string_id(c->cdev); | |
817 | if (ret < 0) | |
818 | goto error; | |
819 | uvc_en_us_strings[UVC_STRING_STREAMING_IDX].id = ret; | |
820 | uvc_streaming_intf_alt0.iInterface = ret; | |
821 | uvc_streaming_intf_alt1.iInterface = ret; | |
822 | } | |
cdda479f LP |
823 | |
824 | /* Register the function. */ | |
825 | uvc->func.name = "uvc"; | |
826 | uvc->func.strings = uvc_function_strings; | |
827 | uvc->func.bind = uvc_function_bind; | |
828 | uvc->func.unbind = uvc_function_unbind; | |
829 | uvc->func.get_alt = uvc_function_get_alt; | |
830 | uvc->func.set_alt = uvc_function_set_alt; | |
831 | uvc->func.disable = uvc_function_disable; | |
832 | uvc->func.setup = uvc_function_setup; | |
833 | ||
834 | ret = usb_add_function(c, &uvc->func); | |
835 | if (ret) | |
836 | kfree(uvc); | |
837 | ||
28f75f4d | 838 | return ret; |
cdda479f LP |
839 | |
840 | error: | |
841 | kfree(uvc); | |
842 | return ret; | |
843 | } | |
844 | ||
5d9955f8 | 845 | module_param_named(trace, uvc_gadget_trace_param, uint, S_IRUGO|S_IWUSR); |
cdda479f LP |
846 | MODULE_PARM_DESC(trace, "Trace level bitmask"); |
847 |