4 * This driver supports USB CDC WCM Device Management.
6 * Copyright (c) 2007-2009 Oliver Neukum
8 * Some code taken from cdc-acm.c
10 * Released under the GPLv2.
12 * Many thanks to Carl Nordbeck
14 #include <linux/kernel.h>
15 #include <linux/errno.h>
16 #include <linux/slab.h>
17 #include <linux/module.h>
18 #include <linux/mutex.h>
19 #include <linux/uaccess.h>
20 #include <linux/bitops.h>
21 #include <linux/poll.h>
22 #include <linux/usb.h>
23 #include <linux/usb/cdc.h>
24 #include <asm/byteorder.h>
25 #include <asm/unaligned.h>
30 #define DRIVER_VERSION "v0.03"
31 #define DRIVER_AUTHOR "Oliver Neukum"
32 #define DRIVER_DESC "USB Abstract Control Model driver for USB WCM Device Management"
34 static const struct usb_device_id wdm_ids
[] = {
36 .match_flags
= USB_DEVICE_ID_MATCH_INT_CLASS
|
37 USB_DEVICE_ID_MATCH_INT_SUBCLASS
,
38 .bInterfaceClass
= USB_CLASS_COMM
,
39 .bInterfaceSubClass
= USB_CDC_SUBCLASS_DMM
44 MODULE_DEVICE_TABLE (usb
, wdm_ids
);
46 #define WDM_MINOR_BASE 176
50 #define WDM_DISCONNECTING 2
53 #define WDM_INT_STALL 5
54 #define WDM_POLL_RUNNING 6
55 #define WDM_RESPONDING 7
56 #define WDM_SUSPENDING 8
61 static DEFINE_MUTEX(wdm_mutex
);
63 /* --- method tables --- */
66 u8
*inbuf
; /* buffer for response */
67 u8
*outbuf
; /* buffer for command */
68 u8
*sbuf
; /* buffer for status */
69 u8
*ubuf
; /* buffer for copy to user space */
74 struct usb_interface
*intf
;
75 struct usb_ctrlrequest
*orq
;
76 struct usb_ctrlrequest
*irq
;
92 wait_queue_head_t wait
;
93 struct work_struct rxwork
;
98 static struct usb_driver wdm_driver
;
100 /* --- callbacks --- */
101 static void wdm_out_callback(struct urb
*urb
)
103 struct wdm_device
*desc
;
105 spin_lock(&desc
->iuspin
);
106 desc
->werr
= urb
->status
;
107 spin_unlock(&desc
->iuspin
);
108 clear_bit(WDM_IN_USE
, &desc
->flags
);
110 wake_up(&desc
->wait
);
113 static void wdm_in_callback(struct urb
*urb
)
115 struct wdm_device
*desc
= urb
->context
;
116 int status
= urb
->status
;
118 spin_lock(&desc
->iuspin
);
119 clear_bit(WDM_RESPONDING
, &desc
->flags
);
124 dev_dbg(&desc
->intf
->dev
,
125 "nonzero urb status received: -ENOENT");
128 dev_dbg(&desc
->intf
->dev
,
129 "nonzero urb status received: -ECONNRESET");
132 dev_dbg(&desc
->intf
->dev
,
133 "nonzero urb status received: -ESHUTDOWN");
136 dev_err(&desc
->intf
->dev
,
137 "nonzero urb status received: -EPIPE\n");
140 dev_err(&desc
->intf
->dev
,
141 "Unexpected error %d\n", status
);
147 desc
->reslength
= urb
->actual_length
;
148 memmove(desc
->ubuf
+ desc
->length
, desc
->inbuf
, desc
->reslength
);
149 desc
->length
+= desc
->reslength
;
151 wake_up(&desc
->wait
);
153 set_bit(WDM_READ
, &desc
->flags
);
154 spin_unlock(&desc
->iuspin
);
157 static void wdm_int_callback(struct urb
*urb
)
160 int status
= urb
->status
;
161 struct wdm_device
*desc
;
162 struct usb_ctrlrequest
*req
;
163 struct usb_cdc_notification
*dr
;
167 dr
= (struct usb_cdc_notification
*)desc
->sbuf
;
176 set_bit(WDM_INT_STALL
, &desc
->flags
);
177 dev_err(&desc
->intf
->dev
, "Stall on int endpoint\n");
178 goto sw
; /* halt is cleared in work */
180 dev_err(&desc
->intf
->dev
,
181 "nonzero urb status received: %d\n", status
);
186 if (urb
->actual_length
< sizeof(struct usb_cdc_notification
)) {
187 dev_err(&desc
->intf
->dev
, "wdm_int_callback - %d bytes\n",
192 switch (dr
->bNotificationType
) {
193 case USB_CDC_NOTIFY_RESPONSE_AVAILABLE
:
194 dev_dbg(&desc
->intf
->dev
,
195 "NOTIFY_RESPONSE_AVAILABLE received: index %d len %d",
196 dr
->wIndex
, dr
->wLength
);
199 case USB_CDC_NOTIFY_NETWORK_CONNECTION
:
201 dev_dbg(&desc
->intf
->dev
,
202 "NOTIFY_NETWORK_CONNECTION %s network",
203 dr
->wValue
? "connected to" : "disconnected from");
206 clear_bit(WDM_POLL_RUNNING
, &desc
->flags
);
207 dev_err(&desc
->intf
->dev
,
208 "unknown notification %d received: index %d len %d\n",
209 dr
->bNotificationType
, dr
->wIndex
, dr
->wLength
);
213 req
->bRequestType
= (USB_DIR_IN
| USB_TYPE_CLASS
| USB_RECIP_INTERFACE
);
214 req
->bRequest
= USB_CDC_GET_ENCAPSULATED_RESPONSE
;
216 req
->wIndex
= desc
->inum
;
217 req
->wLength
= cpu_to_le16(desc
->wMaxCommand
);
219 usb_fill_control_urb(
221 interface_to_usbdev(desc
->intf
),
222 /* using common endpoint 0 */
223 usb_rcvctrlpipe(interface_to_usbdev(desc
->intf
), 0),
224 (unsigned char *)req
,
230 desc
->response
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
231 spin_lock(&desc
->iuspin
);
232 clear_bit(WDM_READ
, &desc
->flags
);
233 set_bit(WDM_RESPONDING
, &desc
->flags
);
234 if (!test_bit(WDM_DISCONNECTING
, &desc
->flags
)
235 && !test_bit(WDM_SUSPENDING
, &desc
->flags
)) {
236 rv
= usb_submit_urb(desc
->response
, GFP_ATOMIC
);
237 dev_dbg(&desc
->intf
->dev
, "%s: usb_submit_urb %d",
240 spin_unlock(&desc
->iuspin
);
242 clear_bit(WDM_RESPONDING
, &desc
->flags
);
247 rv
= schedule_work(&desc
->rxwork
);
249 dev_err(&desc
->intf
->dev
,
250 "Cannot schedule work\n");
254 rv
= usb_submit_urb(urb
, GFP_ATOMIC
);
256 dev_err(&desc
->intf
->dev
,
257 "%s - usb_submit_urb failed with result %d\n",
262 static void kill_urbs(struct wdm_device
*desc
)
264 /* the order here is essential */
265 usb_kill_urb(desc
->command
);
266 usb_kill_urb(desc
->validity
);
267 usb_kill_urb(desc
->response
);
270 static void free_urbs(struct wdm_device
*desc
)
272 usb_free_urb(desc
->validity
);
273 usb_free_urb(desc
->response
);
274 usb_free_urb(desc
->command
);
277 static void cleanup(struct wdm_device
*desc
)
279 usb_free_coherent(interface_to_usbdev(desc
->intf
),
280 desc
->wMaxPacketSize
,
282 desc
->validity
->transfer_dma
);
283 usb_free_coherent(interface_to_usbdev(desc
->intf
),
284 desc
->bMaxPacketSize0
,
286 desc
->response
->transfer_dma
);
294 static ssize_t wdm_write
295 (struct file
*file
, const char __user
*buffer
, size_t count
, loff_t
*ppos
)
298 int rv
= -EMSGSIZE
, r
, we
;
299 struct wdm_device
*desc
= file
->private_data
;
300 struct usb_ctrlrequest
*req
;
302 if (count
> desc
->wMaxCommand
)
303 count
= desc
->wMaxCommand
;
305 spin_lock_irq(&desc
->iuspin
);
308 spin_unlock_irq(&desc
->iuspin
);
312 desc
->outbuf
= buf
= kmalloc(count
, GFP_KERNEL
);
318 r
= copy_from_user(buf
, buffer
, count
);
325 /* concurrent writes and disconnect */
326 r
= mutex_lock_interruptible(&desc
->lock
);
333 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
)) {
339 r
= usb_autopm_get_interface(desc
->intf
);
345 if (!(file
->f_flags
& O_NONBLOCK
))
346 r
= wait_event_interruptible(desc
->wait
, !test_bit(WDM_IN_USE
,
349 if (test_bit(WDM_IN_USE
, &desc
->flags
))
357 usb_fill_control_urb(
359 interface_to_usbdev(desc
->intf
),
360 /* using common endpoint 0 */
361 usb_sndctrlpipe(interface_to_usbdev(desc
->intf
), 0),
362 (unsigned char *)req
,
369 req
->bRequestType
= (USB_DIR_OUT
| USB_TYPE_CLASS
|
370 USB_RECIP_INTERFACE
);
371 req
->bRequest
= USB_CDC_SEND_ENCAPSULATED_COMMAND
;
373 req
->wIndex
= desc
->inum
;
374 req
->wLength
= cpu_to_le16(count
);
375 set_bit(WDM_IN_USE
, &desc
->flags
);
377 rv
= usb_submit_urb(desc
->command
, GFP_KERNEL
);
380 clear_bit(WDM_IN_USE
, &desc
->flags
);
381 dev_err(&desc
->intf
->dev
, "Tx URB error: %d\n", rv
);
383 dev_dbg(&desc
->intf
->dev
, "Tx URB has been submitted index=%d",
387 usb_autopm_put_interface(desc
->intf
);
389 mutex_unlock(&desc
->lock
);
391 return rv
< 0 ? rv
: count
;
394 static ssize_t wdm_read
395 (struct file
*file
, char __user
*buffer
, size_t count
, loff_t
*ppos
)
399 struct wdm_device
*desc
= file
->private_data
;
402 rv
= mutex_lock_interruptible(&desc
->lock
); /*concurrent reads */
406 if (desc
->length
== 0) {
409 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
)) {
414 if (file
->f_flags
& O_NONBLOCK
) {
415 if (!test_bit(WDM_READ
, &desc
->flags
)) {
416 rv
= cntr
? cntr
: -EAGAIN
;
421 rv
= wait_event_interruptible(desc
->wait
,
422 test_bit(WDM_READ
, &desc
->flags
));
425 /* may have happened while we slept */
426 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
)) {
430 usb_mark_last_busy(interface_to_usbdev(desc
->intf
));
436 spin_lock_irq(&desc
->iuspin
);
438 if (desc
->rerr
) { /* read completed, error happened */
440 spin_unlock_irq(&desc
->iuspin
);
445 * recheck whether we've lost the race
446 * against the completion handler
448 if (!test_bit(WDM_READ
, &desc
->flags
)) { /* lost race */
449 spin_unlock_irq(&desc
->iuspin
);
452 if (!desc
->reslength
) { /* zero length read */
453 spin_unlock_irq(&desc
->iuspin
);
456 clear_bit(WDM_READ
, &desc
->flags
);
457 spin_unlock_irq(&desc
->iuspin
);
460 cntr
= count
> desc
->length
? desc
->length
: count
;
461 rv
= copy_to_user(buffer
, desc
->ubuf
, cntr
);
467 for (i
= 0; i
< desc
->length
- cntr
; i
++)
468 desc
->ubuf
[i
] = desc
->ubuf
[i
+ cntr
];
470 spin_lock_irq(&desc
->iuspin
);
471 desc
->length
-= cntr
;
472 spin_unlock_irq(&desc
->iuspin
);
473 /* in case we had outstanding data */
475 clear_bit(WDM_READ
, &desc
->flags
);
479 mutex_unlock(&desc
->lock
);
483 static int wdm_flush(struct file
*file
, fl_owner_t id
)
485 struct wdm_device
*desc
= file
->private_data
;
487 wait_event(desc
->wait
, !test_bit(WDM_IN_USE
, &desc
->flags
));
489 dev_err(&desc
->intf
->dev
, "Error in flush path: %d\n",
495 static unsigned int wdm_poll(struct file
*file
, struct poll_table_struct
*wait
)
497 struct wdm_device
*desc
= file
->private_data
;
499 unsigned int mask
= 0;
501 spin_lock_irqsave(&desc
->iuspin
, flags
);
502 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
)) {
504 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
507 if (test_bit(WDM_READ
, &desc
->flags
))
508 mask
= POLLIN
| POLLRDNORM
;
509 if (desc
->rerr
|| desc
->werr
)
511 if (!test_bit(WDM_IN_USE
, &desc
->flags
))
512 mask
|= POLLOUT
| POLLWRNORM
;
513 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
515 poll_wait(file
, &desc
->wait
, wait
);
521 static int wdm_open(struct inode
*inode
, struct file
*file
)
523 int minor
= iminor(inode
);
525 struct usb_interface
*intf
;
526 struct wdm_device
*desc
;
528 mutex_lock(&wdm_mutex
);
529 intf
= usb_find_interface(&wdm_driver
, minor
);
533 desc
= usb_get_intfdata(intf
);
534 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
))
536 file
->private_data
= desc
;
538 rv
= usb_autopm_get_interface(desc
->intf
);
540 dev_err(&desc
->intf
->dev
, "Error autopm - %d\n", rv
);
543 intf
->needs_remote_wakeup
= 1;
545 mutex_lock(&desc
->lock
);
546 if (!desc
->count
++) {
549 rv
= usb_submit_urb(desc
->validity
, GFP_KERNEL
);
552 dev_err(&desc
->intf
->dev
,
553 "Error submitting int urb - %d\n", rv
);
558 mutex_unlock(&desc
->lock
);
559 usb_autopm_put_interface(desc
->intf
);
561 mutex_unlock(&wdm_mutex
);
565 static int wdm_release(struct inode
*inode
, struct file
*file
)
567 struct wdm_device
*desc
= file
->private_data
;
569 mutex_lock(&wdm_mutex
);
570 mutex_lock(&desc
->lock
);
572 mutex_unlock(&desc
->lock
);
575 dev_dbg(&desc
->intf
->dev
, "wdm_release: cleanup");
577 if (!test_bit(WDM_DISCONNECTING
, &desc
->flags
))
578 desc
->intf
->needs_remote_wakeup
= 0;
580 mutex_unlock(&wdm_mutex
);
584 static const struct file_operations wdm_fops
= {
585 .owner
= THIS_MODULE
,
590 .release
= wdm_release
,
592 .llseek
= noop_llseek
,
595 static struct usb_class_driver wdm_class
= {
598 .minor_base
= WDM_MINOR_BASE
,
601 /* --- error handling --- */
602 static void wdm_rxwork(struct work_struct
*work
)
604 struct wdm_device
*desc
= container_of(work
, struct wdm_device
, rxwork
);
608 spin_lock_irqsave(&desc
->iuspin
, flags
);
609 if (test_bit(WDM_DISCONNECTING
, &desc
->flags
)) {
610 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
612 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
613 rv
= usb_submit_urb(desc
->response
, GFP_KERNEL
);
614 if (rv
< 0 && rv
!= -EPERM
) {
615 spin_lock_irqsave(&desc
->iuspin
, flags
);
616 if (!test_bit(WDM_DISCONNECTING
, &desc
->flags
))
617 schedule_work(&desc
->rxwork
);
618 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
623 /* --- hotplug --- */
625 static int wdm_probe(struct usb_interface
*intf
, const struct usb_device_id
*id
)
628 struct usb_device
*udev
= interface_to_usbdev(intf
);
629 struct wdm_device
*desc
;
630 struct usb_host_interface
*iface
;
631 struct usb_endpoint_descriptor
*ep
;
632 struct usb_cdc_dmm_desc
*dmhd
;
633 u8
*buffer
= intf
->altsetting
->extra
;
634 int buflen
= intf
->altsetting
->extralen
;
641 if (buffer
[1] != USB_DT_CS_INTERFACE
) {
642 dev_err(&intf
->dev
, "skipping garbage\n");
646 switch (buffer
[2]) {
647 case USB_CDC_HEADER_TYPE
:
649 case USB_CDC_DMM_TYPE
:
650 dmhd
= (struct usb_cdc_dmm_desc
*)buffer
;
651 maxcom
= le16_to_cpu(dmhd
->wMaxCommand
);
653 "Finding maximum buffer length: %d", maxcom
);
657 "Ignoring extra header, type %d, length %d\n",
658 buffer
[2], buffer
[0]);
667 desc
= kzalloc(sizeof(struct wdm_device
), GFP_KERNEL
);
670 mutex_init(&desc
->lock
);
671 spin_lock_init(&desc
->iuspin
);
672 init_waitqueue_head(&desc
->wait
);
673 desc
->wMaxCommand
= maxcom
;
674 /* this will be expanded and needed in hardware endianness */
675 desc
->inum
= cpu_to_le16((u16
)intf
->cur_altsetting
->desc
.bInterfaceNumber
);
677 INIT_WORK(&desc
->rxwork
, wdm_rxwork
);
680 iface
= intf
->cur_altsetting
;
681 if (iface
->desc
.bNumEndpoints
!= 1)
683 ep
= &iface
->endpoint
[0].desc
;
684 if (!ep
|| !usb_endpoint_is_int_in(ep
))
687 desc
->wMaxPacketSize
= usb_endpoint_maxp(ep
);
688 desc
->bMaxPacketSize0
= udev
->descriptor
.bMaxPacketSize0
;
690 desc
->orq
= kmalloc(sizeof(struct usb_ctrlrequest
), GFP_KERNEL
);
693 desc
->irq
= kmalloc(sizeof(struct usb_ctrlrequest
), GFP_KERNEL
);
697 desc
->validity
= usb_alloc_urb(0, GFP_KERNEL
);
701 desc
->response
= usb_alloc_urb(0, GFP_KERNEL
);
705 desc
->command
= usb_alloc_urb(0, GFP_KERNEL
);
709 desc
->ubuf
= kmalloc(desc
->wMaxCommand
, GFP_KERNEL
);
713 desc
->sbuf
= usb_alloc_coherent(interface_to_usbdev(intf
),
714 desc
->wMaxPacketSize
,
716 &desc
->validity
->transfer_dma
);
720 desc
->inbuf
= usb_alloc_coherent(interface_to_usbdev(intf
),
721 desc
->bMaxPacketSize0
,
723 &desc
->response
->transfer_dma
);
729 interface_to_usbdev(intf
),
730 usb_rcvintpipe(interface_to_usbdev(intf
), ep
->bEndpointAddress
),
732 desc
->wMaxPacketSize
,
737 desc
->validity
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
739 usb_set_intfdata(intf
, desc
);
740 rv
= usb_register_dev(intf
, &wdm_class
);
744 dev_info(&intf
->dev
, "cdc-wdm%d: USB WDM device\n",
745 intf
->minor
- WDM_MINOR_BASE
);
749 usb_set_intfdata(intf
, NULL
);
750 usb_free_coherent(interface_to_usbdev(desc
->intf
),
751 desc
->bMaxPacketSize0
,
753 desc
->response
->transfer_dma
);
755 usb_free_coherent(interface_to_usbdev(desc
->intf
),
756 desc
->wMaxPacketSize
,
758 desc
->validity
->transfer_dma
);
768 static void wdm_disconnect(struct usb_interface
*intf
)
770 struct wdm_device
*desc
;
773 usb_deregister_dev(intf
, &wdm_class
);
774 mutex_lock(&wdm_mutex
);
775 desc
= usb_get_intfdata(intf
);
777 /* the spinlock makes sure no new urbs are generated in the callbacks */
778 spin_lock_irqsave(&desc
->iuspin
, flags
);
779 set_bit(WDM_DISCONNECTING
, &desc
->flags
);
780 set_bit(WDM_READ
, &desc
->flags
);
781 /* to terminate pending flushes */
782 clear_bit(WDM_IN_USE
, &desc
->flags
);
783 spin_unlock_irqrestore(&desc
->iuspin
, flags
);
784 mutex_lock(&desc
->lock
);
786 cancel_work_sync(&desc
->rxwork
);
787 mutex_unlock(&desc
->lock
);
788 wake_up_all(&desc
->wait
);
791 mutex_unlock(&wdm_mutex
);
795 static int wdm_suspend(struct usb_interface
*intf
, pm_message_t message
)
797 struct wdm_device
*desc
= usb_get_intfdata(intf
);
800 dev_dbg(&desc
->intf
->dev
, "wdm%d_suspend\n", intf
->minor
);
802 /* if this is an autosuspend the caller does the locking */
803 if (!PMSG_IS_AUTO(message
))
804 mutex_lock(&desc
->lock
);
805 spin_lock_irq(&desc
->iuspin
);
807 if (PMSG_IS_AUTO(message
) &&
808 (test_bit(WDM_IN_USE
, &desc
->flags
)
809 || test_bit(WDM_RESPONDING
, &desc
->flags
))) {
810 spin_unlock_irq(&desc
->iuspin
);
814 set_bit(WDM_SUSPENDING
, &desc
->flags
);
815 spin_unlock_irq(&desc
->iuspin
);
816 /* callback submits work - order is essential */
818 cancel_work_sync(&desc
->rxwork
);
820 if (!PMSG_IS_AUTO(message
))
821 mutex_unlock(&desc
->lock
);
827 static int recover_from_urb_loss(struct wdm_device
*desc
)
832 rv
= usb_submit_urb(desc
->validity
, GFP_NOIO
);
834 dev_err(&desc
->intf
->dev
,
835 "Error resume submitting int urb - %d\n", rv
);
841 static int wdm_resume(struct usb_interface
*intf
)
843 struct wdm_device
*desc
= usb_get_intfdata(intf
);
846 dev_dbg(&desc
->intf
->dev
, "wdm%d_resume\n", intf
->minor
);
848 clear_bit(WDM_SUSPENDING
, &desc
->flags
);
849 rv
= recover_from_urb_loss(desc
);
855 static int wdm_pre_reset(struct usb_interface
*intf
)
857 struct wdm_device
*desc
= usb_get_intfdata(intf
);
859 mutex_lock(&desc
->lock
);
863 * we notify everybody using poll of
864 * an exceptional situation
865 * must be done before recovery lest a spontaneous
866 * message from the device is lost
868 spin_lock_irq(&desc
->iuspin
);
870 spin_unlock_irq(&desc
->iuspin
);
871 wake_up_all(&desc
->wait
);
875 static int wdm_post_reset(struct usb_interface
*intf
)
877 struct wdm_device
*desc
= usb_get_intfdata(intf
);
880 rv
= recover_from_urb_loss(desc
);
881 mutex_unlock(&desc
->lock
);
885 static struct usb_driver wdm_driver
= {
888 .disconnect
= wdm_disconnect
,
890 .suspend
= wdm_suspend
,
891 .resume
= wdm_resume
,
892 .reset_resume
= wdm_resume
,
894 .pre_reset
= wdm_pre_reset
,
895 .post_reset
= wdm_post_reset
,
897 .supports_autosuspend
= 1,
900 /* --- low level module stuff --- */
902 static int __init
wdm_init(void)
906 rv
= usb_register(&wdm_driver
);
911 static void __exit
wdm_exit(void)
913 usb_deregister(&wdm_driver
);
916 module_init(wdm_init
);
917 module_exit(wdm_exit
);
919 MODULE_AUTHOR(DRIVER_AUTHOR
);
920 MODULE_DESCRIPTION(DRIVER_DESC
);
921 MODULE_LICENSE("GPL");