1 // SPDX-License-Identifier: GPL-2.0
3 * USB Raw Gadget driver.
4 * See Documentation/usb/raw-gadget.rst for more details.
6 * Andrey Konovalov <andreyknvl@gmail.com>
9 #include <linux/compiler.h>
10 #include <linux/ctype.h>
11 #include <linux/debugfs.h>
12 #include <linux/delay.h>
13 #include <linux/idr.h>
14 #include <linux/kref.h>
15 #include <linux/miscdevice.h>
16 #include <linux/module.h>
17 #include <linux/semaphore.h>
18 #include <linux/sched.h>
19 #include <linux/slab.h>
20 #include <linux/uaccess.h>
21 #include <linux/wait.h>
23 #include <linux/usb.h>
24 #include <linux/usb/ch9.h>
25 #include <linux/usb/ch11.h>
26 #include <linux/usb/gadget.h>
28 #include <uapi/linux/usb/raw_gadget.h>
30 #define DRIVER_DESC "USB Raw Gadget"
31 #define DRIVER_NAME "raw-gadget"
33 MODULE_DESCRIPTION(DRIVER_DESC);
34 MODULE_AUTHOR("Andrey Konovalov");
35 MODULE_LICENSE("GPL");
37 /*----------------------------------------------------------------------*/
39 static DEFINE_IDA(driver_id_numbers);
40 #define DRIVER_DRIVER_NAME_LENGTH_MAX 32
42 #define RAW_EVENT_QUEUE_SIZE 16
44 struct raw_event_queue {
45 /* See the comment in raw_event_queue_fetch() for locking details. */
47 struct semaphore sema;
48 struct usb_raw_event *events[RAW_EVENT_QUEUE_SIZE];
52 static void raw_event_queue_init(struct raw_event_queue *queue)
54 spin_lock_init(&queue->lock);
55 sema_init(&queue->sema, 0);
59 static int raw_event_queue_add(struct raw_event_queue *queue,
60 enum usb_raw_event_type type, size_t length, const void *data)
63 struct usb_raw_event *event;
65 spin_lock_irqsave(&queue->lock, flags);
66 if (WARN_ON(queue->size >= RAW_EVENT_QUEUE_SIZE)) {
67 spin_unlock_irqrestore(&queue->lock, flags);
70 event = kmalloc(sizeof(*event) + length, GFP_ATOMIC);
72 spin_unlock_irqrestore(&queue->lock, flags);
76 event->length = length;
78 memcpy(&event->data[0], data, length);
79 queue->events[queue->size] = event;
82 spin_unlock_irqrestore(&queue->lock, flags);
86 static struct usb_raw_event *raw_event_queue_fetch(
87 struct raw_event_queue *queue)
91 struct usb_raw_event *event;
94 * This function can be called concurrently. We first check that
95 * there's at least one event queued by decrementing the semaphore,
96 * and then take the lock to protect queue struct fields.
98 ret = down_interruptible(&queue->sema);
101 spin_lock_irqsave(&queue->lock, flags);
103 * queue->size must have the same value as queue->sema counter (before
104 * the down_interruptible() call above), so this check is a fail-safe.
106 if (WARN_ON(!queue->size)) {
107 spin_unlock_irqrestore(&queue->lock, flags);
108 return ERR_PTR(-ENODEV);
110 event = queue->events[0];
112 memmove(&queue->events[0], &queue->events[1],
113 queue->size * sizeof(queue->events[0]));
114 spin_unlock_irqrestore(&queue->lock, flags);
118 static void raw_event_queue_destroy(struct raw_event_queue *queue)
122 for (i = 0; i < queue->size; i++)
123 kfree(queue->events[i]);
127 /*----------------------------------------------------------------------*/
141 struct usb_request *req;
148 STATE_DEV_INVALID = 0,
150 STATE_DEV_INITIALIZED,
151 STATE_DEV_REGISTERING,
161 const char *udc_name;
162 struct usb_gadget_driver driver;
164 /* Reference to misc device: */
167 /* Make driver names unique */
168 int driver_id_number;
170 /* Protected by lock: */
171 enum dev_state state;
172 bool gadget_registered;
173 struct usb_gadget *gadget;
174 struct usb_request *req;
176 bool ep0_out_pending;
179 struct raw_ep eps[USB_RAW_EPS_NUM_MAX];
182 struct completion ep0_done;
183 struct raw_event_queue queue;
186 static struct raw_dev *dev_new(void)
190 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
193 /* Matches kref_put() in raw_release(). */
194 kref_init(&dev->count);
195 spin_lock_init(&dev->lock);
196 init_completion(&dev->ep0_done);
197 raw_event_queue_init(&dev->queue);
198 dev->driver_id_number = -1;
202 static void dev_free(struct kref *kref)
204 struct raw_dev *dev = container_of(kref, struct raw_dev, count);
207 kfree(dev->udc_name);
208 kfree(dev->driver.udc_name);
209 kfree(dev->driver.driver.name);
210 if (dev->driver_id_number >= 0)
211 ida_free(&driver_id_numbers, dev->driver_id_number);
213 if (dev->ep0_urb_queued)
214 usb_ep_dequeue(dev->gadget->ep0, dev->req);
215 usb_ep_free_request(dev->gadget->ep0, dev->req);
217 raw_event_queue_destroy(&dev->queue);
218 for (i = 0; i < dev->eps_num; i++) {
219 if (dev->eps[i].state == STATE_EP_DISABLED)
221 usb_ep_disable(dev->eps[i].ep);
222 usb_ep_free_request(dev->eps[i].ep, dev->eps[i].req);
223 kfree(dev->eps[i].ep->desc);
224 dev->eps[i].state = STATE_EP_DISABLED;
229 /*----------------------------------------------------------------------*/
231 static int raw_queue_event(struct raw_dev *dev,
232 enum usb_raw_event_type type, size_t length, const void *data)
237 ret = raw_event_queue_add(&dev->queue, type, length, data);
239 spin_lock_irqsave(&dev->lock, flags);
240 dev->state = STATE_DEV_FAILED;
241 spin_unlock_irqrestore(&dev->lock, flags);
246 static void gadget_ep0_complete(struct usb_ep *ep, struct usb_request *req)
248 struct raw_dev *dev = req->context;
251 spin_lock_irqsave(&dev->lock, flags);
253 dev->ep0_status = req->status;
255 dev->ep0_status = req->actual;
256 if (dev->ep0_in_pending)
257 dev->ep0_in_pending = false;
259 dev->ep0_out_pending = false;
260 spin_unlock_irqrestore(&dev->lock, flags);
262 complete(&dev->ep0_done);
265 static u8 get_ep_addr(const char *name)
267 /* If the endpoint has fixed function (named as e.g. "ep12out-bulk"),
268 * parse the endpoint address from its name. We deliberately use
269 * deprecated simple_strtoul() function here, as the number isn't
270 * followed by '\0' nor '\n'.
272 if (isdigit(name[2]))
273 return simple_strtoul(&name[2], NULL, 10);
274 /* Otherwise the endpoint is configurable (named as e.g. "ep-a"). */
275 return USB_RAW_EP_ADDR_ANY;
278 static int gadget_bind(struct usb_gadget *gadget,
279 struct usb_gadget_driver *driver)
282 struct raw_dev *dev = container_of(driver, struct raw_dev, driver);
283 struct usb_request *req;
287 if (strcmp(gadget->name, dev->udc_name) != 0)
290 set_gadget_data(gadget, dev);
291 req = usb_ep_alloc_request(gadget->ep0, GFP_KERNEL);
293 dev_err(&gadget->dev, "usb_ep_alloc_request failed\n");
294 set_gadget_data(gadget, NULL);
298 spin_lock_irqsave(&dev->lock, flags);
300 dev->req->context = dev;
301 dev->req->complete = gadget_ep0_complete;
302 dev->gadget = gadget;
303 gadget_for_each_ep(ep, dev->gadget) {
305 dev->eps[i].addr = get_ep_addr(ep->name);
306 dev->eps[i].state = STATE_EP_DISABLED;
310 spin_unlock_irqrestore(&dev->lock, flags);
312 /* Matches kref_put() in gadget_unbind(). */
313 kref_get(&dev->count);
315 ret = raw_queue_event(dev, USB_RAW_EVENT_CONNECT, 0, NULL);
317 dev_err(&gadget->dev, "failed to queue event\n");
322 static void gadget_unbind(struct usb_gadget *gadget)
324 struct raw_dev *dev = get_gadget_data(gadget);
326 set_gadget_data(gadget, NULL);
327 /* Matches kref_get() in gadget_bind(). */
328 kref_put(&dev->count, dev_free);
331 static int gadget_setup(struct usb_gadget *gadget,
332 const struct usb_ctrlrequest *ctrl)
335 struct raw_dev *dev = get_gadget_data(gadget);
338 spin_lock_irqsave(&dev->lock, flags);
339 if (dev->state != STATE_DEV_RUNNING) {
340 dev_err(&gadget->dev, "ignoring, device is not running\n");
344 if (dev->ep0_in_pending || dev->ep0_out_pending) {
345 dev_dbg(&gadget->dev, "stalling, request already pending\n");
349 if ((ctrl->bRequestType & USB_DIR_IN) && ctrl->wLength)
350 dev->ep0_in_pending = true;
352 dev->ep0_out_pending = true;
353 spin_unlock_irqrestore(&dev->lock, flags);
355 ret = raw_queue_event(dev, USB_RAW_EVENT_CONTROL, sizeof(*ctrl), ctrl);
357 dev_err(&gadget->dev, "failed to queue event\n");
361 spin_unlock_irqrestore(&dev->lock, flags);
366 /* These are currently unused but present in case UDC driver requires them. */
367 static void gadget_disconnect(struct usb_gadget *gadget) { }
368 static void gadget_suspend(struct usb_gadget *gadget) { }
369 static void gadget_resume(struct usb_gadget *gadget) { }
370 static void gadget_reset(struct usb_gadget *gadget) { }
372 /*----------------------------------------------------------------------*/
374 static struct miscdevice raw_misc_device;
376 static int raw_open(struct inode *inode, struct file *fd)
380 /* Nonblocking I/O is not supported yet. */
381 if (fd->f_flags & O_NONBLOCK)
387 fd->private_data = dev;
388 dev->state = STATE_DEV_OPENED;
389 dev->dev = raw_misc_device.this_device;
393 static int raw_release(struct inode *inode, struct file *fd)
396 struct raw_dev *dev = fd->private_data;
398 bool unregister = false;
400 spin_lock_irqsave(&dev->lock, flags);
401 dev->state = STATE_DEV_CLOSED;
403 spin_unlock_irqrestore(&dev->lock, flags);
406 if (dev->gadget_registered)
408 dev->gadget_registered = false;
409 spin_unlock_irqrestore(&dev->lock, flags);
412 ret = usb_gadget_unregister_driver(&dev->driver);
415 "usb_gadget_unregister_driver() failed with %d\n",
417 /* Matches kref_get() in raw_ioctl_run(). */
418 kref_put(&dev->count, dev_free);
422 /* Matches dev_new() in raw_open(). */
423 kref_put(&dev->count, dev_free);
427 /*----------------------------------------------------------------------*/
429 static int raw_ioctl_init(struct raw_dev *dev, unsigned long value)
432 int driver_id_number;
433 struct usb_raw_init arg;
434 char *udc_driver_name;
435 char *udc_device_name;
436 char *driver_driver_name;
439 if (copy_from_user(&arg, (void __user *)value, sizeof(arg)))
443 case USB_SPEED_UNKNOWN:
444 arg.speed = USB_SPEED_HIGH;
449 case USB_SPEED_SUPER:
455 driver_id_number = ida_alloc(&driver_id_numbers, GFP_KERNEL);
456 if (driver_id_number < 0)
457 return driver_id_number;
459 driver_driver_name = kmalloc(DRIVER_DRIVER_NAME_LENGTH_MAX, GFP_KERNEL);
460 if (!driver_driver_name) {
462 goto out_free_driver_id_number;
464 snprintf(driver_driver_name, DRIVER_DRIVER_NAME_LENGTH_MAX,
465 DRIVER_NAME ".%d", driver_id_number);
467 udc_driver_name = kmalloc(UDC_NAME_LENGTH_MAX, GFP_KERNEL);
468 if (!udc_driver_name) {
470 goto out_free_driver_driver_name;
472 ret = strscpy(udc_driver_name, &arg.driver_name[0],
473 UDC_NAME_LENGTH_MAX);
475 goto out_free_udc_driver_name;
478 udc_device_name = kmalloc(UDC_NAME_LENGTH_MAX, GFP_KERNEL);
479 if (!udc_device_name) {
481 goto out_free_udc_driver_name;
483 ret = strscpy(udc_device_name, &arg.device_name[0],
484 UDC_NAME_LENGTH_MAX);
486 goto out_free_udc_device_name;
489 spin_lock_irqsave(&dev->lock, flags);
490 if (dev->state != STATE_DEV_OPENED) {
491 dev_dbg(dev->dev, "fail, device is not opened\n");
495 dev->udc_name = udc_driver_name;
497 dev->driver.function = DRIVER_DESC;
498 dev->driver.max_speed = arg.speed;
499 dev->driver.setup = gadget_setup;
500 dev->driver.disconnect = gadget_disconnect;
501 dev->driver.bind = gadget_bind;
502 dev->driver.unbind = gadget_unbind;
503 dev->driver.suspend = gadget_suspend;
504 dev->driver.resume = gadget_resume;
505 dev->driver.reset = gadget_reset;
506 dev->driver.driver.name = driver_driver_name;
507 dev->driver.udc_name = udc_device_name;
508 dev->driver.match_existing_only = 1;
509 dev->driver_id_number = driver_id_number;
511 dev->state = STATE_DEV_INITIALIZED;
512 spin_unlock_irqrestore(&dev->lock, flags);
516 spin_unlock_irqrestore(&dev->lock, flags);
517 out_free_udc_device_name:
518 kfree(udc_device_name);
519 out_free_udc_driver_name:
520 kfree(udc_driver_name);
521 out_free_driver_driver_name:
522 kfree(driver_driver_name);
523 out_free_driver_id_number:
524 ida_free(&driver_id_numbers, driver_id_number);
528 static int raw_ioctl_run(struct raw_dev *dev, unsigned long value)
536 spin_lock_irqsave(&dev->lock, flags);
537 if (dev->state != STATE_DEV_INITIALIZED) {
538 dev_dbg(dev->dev, "fail, device is not initialized\n");
542 dev->state = STATE_DEV_REGISTERING;
543 spin_unlock_irqrestore(&dev->lock, flags);
545 ret = usb_gadget_probe_driver(&dev->driver);
547 spin_lock_irqsave(&dev->lock, flags);
550 "fail, usb_gadget_probe_driver returned %d\n", ret);
551 dev->state = STATE_DEV_FAILED;
554 dev->gadget_registered = true;
555 dev->state = STATE_DEV_RUNNING;
556 /* Matches kref_put() in raw_release(). */
557 kref_get(&dev->count);
560 spin_unlock_irqrestore(&dev->lock, flags);
564 static int raw_ioctl_event_fetch(struct raw_dev *dev, unsigned long value)
566 struct usb_raw_event arg;
568 struct usb_raw_event *event;
571 if (copy_from_user(&arg, (void __user *)value, sizeof(arg)))
574 spin_lock_irqsave(&dev->lock, flags);
575 if (dev->state != STATE_DEV_RUNNING) {
576 dev_dbg(dev->dev, "fail, device is not running\n");
577 spin_unlock_irqrestore(&dev->lock, flags);
581 dev_dbg(dev->dev, "fail, gadget is not bound\n");
582 spin_unlock_irqrestore(&dev->lock, flags);
585 spin_unlock_irqrestore(&dev->lock, flags);
587 event = raw_event_queue_fetch(&dev->queue);
588 if (PTR_ERR(event) == -EINTR) {
589 dev_dbg(&dev->gadget->dev, "event fetching interrupted\n");
593 dev_err(&dev->gadget->dev, "failed to fetch event\n");
594 spin_lock_irqsave(&dev->lock, flags);
595 dev->state = STATE_DEV_FAILED;
596 spin_unlock_irqrestore(&dev->lock, flags);
599 length = min(arg.length, event->length);
600 if (copy_to_user((void __user *)value, event, sizeof(*event) + length)) {
609 static void *raw_alloc_io_data(struct usb_raw_ep_io *io, void __user *ptr,
614 if (copy_from_user(io, ptr, sizeof(*io)))
615 return ERR_PTR(-EFAULT);
616 if (io->ep >= USB_RAW_EPS_NUM_MAX)
617 return ERR_PTR(-EINVAL);
618 if (!usb_raw_io_flags_valid(io->flags))
619 return ERR_PTR(-EINVAL);
620 if (io->length > PAGE_SIZE)
621 return ERR_PTR(-EINVAL);
623 data = memdup_user(ptr + sizeof(*io), io->length);
625 data = kmalloc(io->length, GFP_KERNEL);
627 data = ERR_PTR(-ENOMEM);
632 static int raw_process_ep0_io(struct raw_dev *dev, struct usb_raw_ep_io *io,
638 spin_lock_irqsave(&dev->lock, flags);
639 if (dev->state != STATE_DEV_RUNNING) {
640 dev_dbg(dev->dev, "fail, device is not running\n");
645 dev_dbg(dev->dev, "fail, gadget is not bound\n");
649 if (dev->ep0_urb_queued) {
650 dev_dbg(&dev->gadget->dev, "fail, urb already queued\n");
654 if ((in && !dev->ep0_in_pending) ||
655 (!in && !dev->ep0_out_pending)) {
656 dev_dbg(&dev->gadget->dev, "fail, wrong direction\n");
660 if (WARN_ON(in && dev->ep0_out_pending)) {
662 dev->state = STATE_DEV_FAILED;
665 if (WARN_ON(!in && dev->ep0_in_pending)) {
667 dev->state = STATE_DEV_FAILED;
671 dev->req->buf = data;
672 dev->req->length = io->length;
673 dev->req->zero = usb_raw_io_flags_zero(io->flags);
674 dev->ep0_urb_queued = true;
675 spin_unlock_irqrestore(&dev->lock, flags);
677 ret = usb_ep_queue(dev->gadget->ep0, dev->req, GFP_KERNEL);
679 dev_err(&dev->gadget->dev,
680 "fail, usb_ep_queue returned %d\n", ret);
681 spin_lock_irqsave(&dev->lock, flags);
682 dev->state = STATE_DEV_FAILED;
686 ret = wait_for_completion_interruptible(&dev->ep0_done);
688 dev_dbg(&dev->gadget->dev, "wait interrupted\n");
689 usb_ep_dequeue(dev->gadget->ep0, dev->req);
690 wait_for_completion(&dev->ep0_done);
691 spin_lock_irqsave(&dev->lock, flags);
695 spin_lock_irqsave(&dev->lock, flags);
696 ret = dev->ep0_status;
699 dev->ep0_urb_queued = false;
701 spin_unlock_irqrestore(&dev->lock, flags);
705 static int raw_ioctl_ep0_write(struct raw_dev *dev, unsigned long value)
709 struct usb_raw_ep_io io;
711 data = raw_alloc_io_data(&io, (void __user *)value, true);
713 return PTR_ERR(data);
714 ret = raw_process_ep0_io(dev, &io, data, true);
719 static int raw_ioctl_ep0_read(struct raw_dev *dev, unsigned long value)
723 struct usb_raw_ep_io io;
726 data = raw_alloc_io_data(&io, (void __user *)value, false);
728 return PTR_ERR(data);
729 ret = raw_process_ep0_io(dev, &io, data, false);
733 length = min(io.length, (unsigned int)ret);
734 if (copy_to_user((void __user *)(value + sizeof(io)), data, length))
743 static int raw_ioctl_ep0_stall(struct raw_dev *dev, unsigned long value)
750 spin_lock_irqsave(&dev->lock, flags);
751 if (dev->state != STATE_DEV_RUNNING) {
752 dev_dbg(dev->dev, "fail, device is not running\n");
757 dev_dbg(dev->dev, "fail, gadget is not bound\n");
761 if (dev->ep0_urb_queued) {
762 dev_dbg(&dev->gadget->dev, "fail, urb already queued\n");
766 if (!dev->ep0_in_pending && !dev->ep0_out_pending) {
767 dev_dbg(&dev->gadget->dev, "fail, no request pending\n");
772 ret = usb_ep_set_halt(dev->gadget->ep0);
774 dev_err(&dev->gadget->dev,
775 "fail, usb_ep_set_halt returned %d\n", ret);
777 if (dev->ep0_in_pending)
778 dev->ep0_in_pending = false;
780 dev->ep0_out_pending = false;
783 spin_unlock_irqrestore(&dev->lock, flags);
787 static int raw_ioctl_ep_enable(struct raw_dev *dev, unsigned long value)
791 struct usb_endpoint_descriptor *desc;
794 desc = memdup_user((void __user *)value, sizeof(*desc));
796 return PTR_ERR(desc);
799 * Endpoints with a maxpacket length of 0 can cause crashes in UDC
802 if (usb_endpoint_maxp(desc) == 0) {
803 dev_dbg(dev->dev, "fail, bad endpoint maxpacket\n");
808 spin_lock_irqsave(&dev->lock, flags);
809 if (dev->state != STATE_DEV_RUNNING) {
810 dev_dbg(dev->dev, "fail, device is not running\n");
815 dev_dbg(dev->dev, "fail, gadget is not bound\n");
820 for (i = 0; i < dev->eps_num; i++) {
822 if (ep->state != STATE_EP_DISABLED)
824 if (ep->addr != usb_endpoint_num(desc) &&
825 ep->addr != USB_RAW_EP_ADDR_ANY)
827 if (!usb_gadget_ep_match_desc(dev->gadget, ep->ep, desc, NULL))
830 ret = usb_ep_enable(ep->ep);
832 dev_err(&dev->gadget->dev,
833 "fail, usb_ep_enable returned %d\n", ret);
836 ep->req = usb_ep_alloc_request(ep->ep, GFP_ATOMIC);
838 dev_err(&dev->gadget->dev,
839 "fail, usb_ep_alloc_request failed\n");
840 usb_ep_disable(ep->ep);
844 ep->state = STATE_EP_ENABLED;
845 ep->ep->driver_data = ep;
850 dev_dbg(&dev->gadget->dev, "fail, no gadget endpoints available\n");
856 spin_unlock_irqrestore(&dev->lock, flags);
860 static int raw_ioctl_ep_disable(struct raw_dev *dev, unsigned long value)
862 int ret = 0, i = value;
865 spin_lock_irqsave(&dev->lock, flags);
866 if (dev->state != STATE_DEV_RUNNING) {
867 dev_dbg(dev->dev, "fail, device is not running\n");
872 dev_dbg(dev->dev, "fail, gadget is not bound\n");
876 if (i < 0 || i >= dev->eps_num) {
877 dev_dbg(dev->dev, "fail, invalid endpoint\n");
881 if (dev->eps[i].state == STATE_EP_DISABLED) {
882 dev_dbg(&dev->gadget->dev, "fail, endpoint is not enabled\n");
886 if (dev->eps[i].disabling) {
887 dev_dbg(&dev->gadget->dev,
888 "fail, disable already in progress\n");
892 if (dev->eps[i].urb_queued) {
893 dev_dbg(&dev->gadget->dev,
894 "fail, waiting for urb completion\n");
898 dev->eps[i].disabling = true;
899 spin_unlock_irqrestore(&dev->lock, flags);
901 usb_ep_disable(dev->eps[i].ep);
903 spin_lock_irqsave(&dev->lock, flags);
904 usb_ep_free_request(dev->eps[i].ep, dev->eps[i].req);
905 kfree(dev->eps[i].ep->desc);
906 dev->eps[i].state = STATE_EP_DISABLED;
907 dev->eps[i].disabling = false;
910 spin_unlock_irqrestore(&dev->lock, flags);
914 static int raw_ioctl_ep_set_clear_halt_wedge(struct raw_dev *dev,
915 unsigned long value, bool set, bool halt)
917 int ret = 0, i = value;
920 spin_lock_irqsave(&dev->lock, flags);
921 if (dev->state != STATE_DEV_RUNNING) {
922 dev_dbg(dev->dev, "fail, device is not running\n");
927 dev_dbg(dev->dev, "fail, gadget is not bound\n");
931 if (i < 0 || i >= dev->eps_num) {
932 dev_dbg(dev->dev, "fail, invalid endpoint\n");
936 if (dev->eps[i].state == STATE_EP_DISABLED) {
937 dev_dbg(&dev->gadget->dev, "fail, endpoint is not enabled\n");
941 if (dev->eps[i].disabling) {
942 dev_dbg(&dev->gadget->dev,
943 "fail, disable is in progress\n");
947 if (dev->eps[i].urb_queued) {
948 dev_dbg(&dev->gadget->dev,
949 "fail, waiting for urb completion\n");
953 if (usb_endpoint_xfer_isoc(dev->eps[i].ep->desc)) {
954 dev_dbg(&dev->gadget->dev,
955 "fail, can't halt/wedge ISO endpoint\n");
961 ret = usb_ep_set_halt(dev->eps[i].ep);
963 dev_err(&dev->gadget->dev,
964 "fail, usb_ep_set_halt returned %d\n", ret);
965 } else if (!set && halt) {
966 ret = usb_ep_clear_halt(dev->eps[i].ep);
968 dev_err(&dev->gadget->dev,
969 "fail, usb_ep_clear_halt returned %d\n", ret);
970 } else if (set && !halt) {
971 ret = usb_ep_set_wedge(dev->eps[i].ep);
973 dev_err(&dev->gadget->dev,
974 "fail, usb_ep_set_wedge returned %d\n", ret);
978 spin_unlock_irqrestore(&dev->lock, flags);
982 static void gadget_ep_complete(struct usb_ep *ep, struct usb_request *req)
984 struct raw_ep *r_ep = (struct raw_ep *)ep->driver_data;
985 struct raw_dev *dev = r_ep->dev;
988 spin_lock_irqsave(&dev->lock, flags);
990 r_ep->status = req->status;
992 r_ep->status = req->actual;
993 spin_unlock_irqrestore(&dev->lock, flags);
995 complete((struct completion *)req->context);
998 static int raw_process_ep_io(struct raw_dev *dev, struct usb_raw_ep_io *io,
1002 unsigned long flags;
1004 DECLARE_COMPLETION_ONSTACK(done);
1006 spin_lock_irqsave(&dev->lock, flags);
1007 if (dev->state != STATE_DEV_RUNNING) {
1008 dev_dbg(dev->dev, "fail, device is not running\n");
1013 dev_dbg(dev->dev, "fail, gadget is not bound\n");
1017 if (io->ep >= dev->eps_num) {
1018 dev_dbg(&dev->gadget->dev, "fail, invalid endpoint\n");
1022 ep = &dev->eps[io->ep];
1023 if (ep->state != STATE_EP_ENABLED) {
1024 dev_dbg(&dev->gadget->dev, "fail, endpoint is not enabled\n");
1028 if (ep->disabling) {
1029 dev_dbg(&dev->gadget->dev,
1030 "fail, endpoint is already being disabled\n");
1034 if (ep->urb_queued) {
1035 dev_dbg(&dev->gadget->dev, "fail, urb already queued\n");
1039 if (in != usb_endpoint_dir_in(ep->ep->desc)) {
1040 dev_dbg(&dev->gadget->dev, "fail, wrong direction\n");
1046 ep->req->context = &done;
1047 ep->req->complete = gadget_ep_complete;
1048 ep->req->buf = data;
1049 ep->req->length = io->length;
1050 ep->req->zero = usb_raw_io_flags_zero(io->flags);
1051 ep->urb_queued = true;
1052 spin_unlock_irqrestore(&dev->lock, flags);
1054 ret = usb_ep_queue(ep->ep, ep->req, GFP_KERNEL);
1056 dev_err(&dev->gadget->dev,
1057 "fail, usb_ep_queue returned %d\n", ret);
1058 spin_lock_irqsave(&dev->lock, flags);
1059 dev->state = STATE_DEV_FAILED;
1063 ret = wait_for_completion_interruptible(&done);
1065 dev_dbg(&dev->gadget->dev, "wait interrupted\n");
1066 usb_ep_dequeue(ep->ep, ep->req);
1067 wait_for_completion(&done);
1068 spin_lock_irqsave(&dev->lock, flags);
1072 spin_lock_irqsave(&dev->lock, flags);
1076 ep->urb_queued = false;
1078 spin_unlock_irqrestore(&dev->lock, flags);
1082 static int raw_ioctl_ep_write(struct raw_dev *dev, unsigned long value)
1086 struct usb_raw_ep_io io;
1088 data = raw_alloc_io_data(&io, (void __user *)value, true);
1090 return PTR_ERR(data);
1091 ret = raw_process_ep_io(dev, &io, data, true);
1096 static int raw_ioctl_ep_read(struct raw_dev *dev, unsigned long value)
1100 struct usb_raw_ep_io io;
1101 unsigned int length;
1103 data = raw_alloc_io_data(&io, (void __user *)value, false);
1105 return PTR_ERR(data);
1106 ret = raw_process_ep_io(dev, &io, data, false);
1110 length = min(io.length, (unsigned int)ret);
1111 if (copy_to_user((void __user *)(value + sizeof(io)), data, length))
1120 static int raw_ioctl_configure(struct raw_dev *dev, unsigned long value)
1123 unsigned long flags;
1127 spin_lock_irqsave(&dev->lock, flags);
1128 if (dev->state != STATE_DEV_RUNNING) {
1129 dev_dbg(dev->dev, "fail, device is not running\n");
1134 dev_dbg(dev->dev, "fail, gadget is not bound\n");
1138 usb_gadget_set_state(dev->gadget, USB_STATE_CONFIGURED);
1141 spin_unlock_irqrestore(&dev->lock, flags);
1145 static int raw_ioctl_vbus_draw(struct raw_dev *dev, unsigned long value)
1148 unsigned long flags;
1150 spin_lock_irqsave(&dev->lock, flags);
1151 if (dev->state != STATE_DEV_RUNNING) {
1152 dev_dbg(dev->dev, "fail, device is not running\n");
1157 dev_dbg(dev->dev, "fail, gadget is not bound\n");
1161 usb_gadget_vbus_draw(dev->gadget, 2 * value);
1164 spin_unlock_irqrestore(&dev->lock, flags);
1168 static void fill_ep_caps(struct usb_ep_caps *caps,
1169 struct usb_raw_ep_caps *raw_caps)
1171 raw_caps->type_control = caps->type_control;
1172 raw_caps->type_iso = caps->type_iso;
1173 raw_caps->type_bulk = caps->type_bulk;
1174 raw_caps->type_int = caps->type_int;
1175 raw_caps->dir_in = caps->dir_in;
1176 raw_caps->dir_out = caps->dir_out;
1179 static void fill_ep_limits(struct usb_ep *ep, struct usb_raw_ep_limits *limits)
1181 limits->maxpacket_limit = ep->maxpacket_limit;
1182 limits->max_streams = ep->max_streams;
1185 static int raw_ioctl_eps_info(struct raw_dev *dev, unsigned long value)
1188 unsigned long flags;
1189 struct usb_raw_eps_info *info;
1192 info = kmalloc(sizeof(*info), GFP_KERNEL);
1198 spin_lock_irqsave(&dev->lock, flags);
1199 if (dev->state != STATE_DEV_RUNNING) {
1200 dev_dbg(dev->dev, "fail, device is not running\n");
1202 spin_unlock_irqrestore(&dev->lock, flags);
1206 dev_dbg(dev->dev, "fail, gadget is not bound\n");
1208 spin_unlock_irqrestore(&dev->lock, flags);
1212 memset(info, 0, sizeof(*info));
1213 for (i = 0; i < dev->eps_num; i++) {
1215 strscpy(&info->eps[i].name[0], ep->ep->name,
1216 USB_RAW_EP_NAME_MAX);
1217 info->eps[i].addr = ep->addr;
1218 fill_ep_caps(&ep->ep->caps, &info->eps[i].caps);
1219 fill_ep_limits(ep->ep, &info->eps[i].limits);
1222 spin_unlock_irqrestore(&dev->lock, flags);
1224 if (copy_to_user((void __user *)value, info, sizeof(*info)))
1233 static long raw_ioctl(struct file *fd, unsigned int cmd, unsigned long value)
1235 struct raw_dev *dev = fd->private_data;
1242 case USB_RAW_IOCTL_INIT:
1243 ret = raw_ioctl_init(dev, value);
1245 case USB_RAW_IOCTL_RUN:
1246 ret = raw_ioctl_run(dev, value);
1248 case USB_RAW_IOCTL_EVENT_FETCH:
1249 ret = raw_ioctl_event_fetch(dev, value);
1251 case USB_RAW_IOCTL_EP0_WRITE:
1252 ret = raw_ioctl_ep0_write(dev, value);
1254 case USB_RAW_IOCTL_EP0_READ:
1255 ret = raw_ioctl_ep0_read(dev, value);
1257 case USB_RAW_IOCTL_EP_ENABLE:
1258 ret = raw_ioctl_ep_enable(dev, value);
1260 case USB_RAW_IOCTL_EP_DISABLE:
1261 ret = raw_ioctl_ep_disable(dev, value);
1263 case USB_RAW_IOCTL_EP_WRITE:
1264 ret = raw_ioctl_ep_write(dev, value);
1266 case USB_RAW_IOCTL_EP_READ:
1267 ret = raw_ioctl_ep_read(dev, value);
1269 case USB_RAW_IOCTL_CONFIGURE:
1270 ret = raw_ioctl_configure(dev, value);
1272 case USB_RAW_IOCTL_VBUS_DRAW:
1273 ret = raw_ioctl_vbus_draw(dev, value);
1275 case USB_RAW_IOCTL_EPS_INFO:
1276 ret = raw_ioctl_eps_info(dev, value);
1278 case USB_RAW_IOCTL_EP0_STALL:
1279 ret = raw_ioctl_ep0_stall(dev, value);
1281 case USB_RAW_IOCTL_EP_SET_HALT:
1282 ret = raw_ioctl_ep_set_clear_halt_wedge(
1283 dev, value, true, true);
1285 case USB_RAW_IOCTL_EP_CLEAR_HALT:
1286 ret = raw_ioctl_ep_set_clear_halt_wedge(
1287 dev, value, false, true);
1289 case USB_RAW_IOCTL_EP_SET_WEDGE:
1290 ret = raw_ioctl_ep_set_clear_halt_wedge(
1291 dev, value, true, false);
1300 /*----------------------------------------------------------------------*/
1302 static const struct file_operations raw_fops = {
1304 .unlocked_ioctl = raw_ioctl,
1305 .compat_ioctl = raw_ioctl,
1306 .release = raw_release,
1307 .llseek = no_llseek,
1310 static struct miscdevice raw_misc_device = {
1311 .minor = MISC_DYNAMIC_MINOR,
1312 .name = DRIVER_NAME,
1316 module_misc_device(raw_misc_device);