cdc-wdm.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858
  1. /*
  2. * cdc-wdm.c
  3. *
  4. * This driver supports USB CDC WCM Device Management.
  5. *
  6. * Copyright (c) 2007-2008 Oliver Neukum
  7. *
  8. * Some code taken from cdc-acm.c
  9. *
  10. * Released under the GPLv2.
  11. *
  12. * Many thanks to Carl Nordbeck
  13. */
  14. #include <linux/kernel.h>
  15. #include <linux/errno.h>
  16. #include <linux/slab.h>
  17. #include <linux/module.h>
  18. #include <linux/smp_lock.h>
  19. #include <linux/mutex.h>
  20. #include <linux/uaccess.h>
  21. #include <linux/bitops.h>
  22. #include <linux/poll.h>
  23. #include <linux/usb.h>
  24. #include <linux/usb/cdc.h>
  25. #include <asm/byteorder.h>
  26. #include <asm/unaligned.h>
  27. /*
  28. * Version Information
  29. */
  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"
  33. static struct usb_device_id wdm_ids[] = {
  34. {
  35. .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS |
  36. USB_DEVICE_ID_MATCH_INT_SUBCLASS,
  37. .bInterfaceClass = USB_CLASS_COMM,
  38. .bInterfaceSubClass = USB_CDC_SUBCLASS_DMM
  39. },
  40. { }
  41. };
  42. MODULE_DEVICE_TABLE (usb, wdm_ids);
  43. #define WDM_MINOR_BASE 176
  44. #define WDM_IN_USE 1
  45. #define WDM_DISCONNECTING 2
  46. #define WDM_RESULT 3
  47. #define WDM_READ 4
  48. #define WDM_INT_STALL 5
  49. #define WDM_POLL_RUNNING 6
  50. #define WDM_MAX 16
  51. static DEFINE_MUTEX(wdm_mutex);
  52. /* --- method tables --- */
  53. struct wdm_device {
  54. u8 *inbuf; /* buffer for response */
  55. u8 *outbuf; /* buffer for command */
  56. u8 *sbuf; /* buffer for status */
  57. u8 *ubuf; /* buffer for copy to user space */
  58. struct urb *command;
  59. struct urb *response;
  60. struct urb *validity;
  61. struct usb_interface *intf;
  62. struct usb_ctrlrequest *orq;
  63. struct usb_ctrlrequest *irq;
  64. spinlock_t iuspin;
  65. unsigned long flags;
  66. u16 bufsize;
  67. u16 wMaxCommand;
  68. u16 wMaxPacketSize;
  69. u16 bMaxPacketSize0;
  70. __le16 inum;
  71. int reslength;
  72. int length;
  73. int read;
  74. int count;
  75. dma_addr_t shandle;
  76. dma_addr_t ihandle;
  77. struct mutex wlock;
  78. struct mutex rlock;
  79. struct mutex plock;
  80. wait_queue_head_t wait;
  81. struct work_struct rxwork;
  82. int werr;
  83. int rerr;
  84. };
  85. static struct usb_driver wdm_driver;
  86. /* --- callbacks --- */
  87. static void wdm_out_callback(struct urb *urb)
  88. {
  89. struct wdm_device *desc;
  90. desc = urb->context;
  91. spin_lock(&desc->iuspin);
  92. desc->werr = urb->status;
  93. spin_unlock(&desc->iuspin);
  94. clear_bit(WDM_IN_USE, &desc->flags);
  95. kfree(desc->outbuf);
  96. wake_up(&desc->wait);
  97. }
  98. static void wdm_in_callback(struct urb *urb)
  99. {
  100. struct wdm_device *desc = urb->context;
  101. int status = urb->status;
  102. spin_lock(&desc->iuspin);
  103. if (status) {
  104. switch (status) {
  105. case -ENOENT:
  106. dev_dbg(&desc->intf->dev,
  107. "nonzero urb status received: -ENOENT");
  108. break;
  109. case -ECONNRESET:
  110. dev_dbg(&desc->intf->dev,
  111. "nonzero urb status received: -ECONNRESET");
  112. break;
  113. case -ESHUTDOWN:
  114. dev_dbg(&desc->intf->dev,
  115. "nonzero urb status received: -ESHUTDOWN");
  116. break;
  117. case -EPIPE:
  118. dev_err(&desc->intf->dev,
  119. "nonzero urb status received: -EPIPE\n");
  120. break;
  121. default:
  122. dev_err(&desc->intf->dev,
  123. "Unexpected error %d\n", status);
  124. break;
  125. }
  126. }
  127. desc->rerr = status;
  128. desc->reslength = urb->actual_length;
  129. memmove(desc->ubuf + desc->length, desc->inbuf, desc->reslength);
  130. desc->length += desc->reslength;
  131. wake_up(&desc->wait);
  132. set_bit(WDM_READ, &desc->flags);
  133. spin_unlock(&desc->iuspin);
  134. }
  135. static void wdm_int_callback(struct urb *urb)
  136. {
  137. int rv = 0;
  138. int status = urb->status;
  139. struct wdm_device *desc;
  140. struct usb_ctrlrequest *req;
  141. struct usb_cdc_notification *dr;
  142. desc = urb->context;
  143. req = desc->irq;
  144. dr = (struct usb_cdc_notification *)desc->sbuf;
  145. if (status) {
  146. switch (status) {
  147. case -ESHUTDOWN:
  148. case -ENOENT:
  149. case -ECONNRESET:
  150. return; /* unplug */
  151. case -EPIPE:
  152. set_bit(WDM_INT_STALL, &desc->flags);
  153. dev_err(&desc->intf->dev, "Stall on int endpoint\n");
  154. goto sw; /* halt is cleared in work */
  155. default:
  156. dev_err(&desc->intf->dev,
  157. "nonzero urb status received: %d\n", status);
  158. break;
  159. }
  160. }
  161. if (urb->actual_length < sizeof(struct usb_cdc_notification)) {
  162. dev_err(&desc->intf->dev, "wdm_int_callback - %d bytes\n",
  163. urb->actual_length);
  164. goto exit;
  165. }
  166. switch (dr->bNotificationType) {
  167. case USB_CDC_NOTIFY_RESPONSE_AVAILABLE:
  168. dev_dbg(&desc->intf->dev,
  169. "NOTIFY_RESPONSE_AVAILABLE received: index %d len %d",
  170. dr->wIndex, dr->wLength);
  171. break;
  172. case USB_CDC_NOTIFY_NETWORK_CONNECTION:
  173. dev_dbg(&desc->intf->dev,
  174. "NOTIFY_NETWORK_CONNECTION %s network",
  175. dr->wValue ? "connected to" : "disconnected from");
  176. goto exit;
  177. default:
  178. clear_bit(WDM_POLL_RUNNING, &desc->flags);
  179. dev_err(&desc->intf->dev,
  180. "unknown notification %d received: index %d len %d\n",
  181. dr->bNotificationType, dr->wIndex, dr->wLength);
  182. goto exit;
  183. }
  184. req->bRequestType = (USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE);
  185. req->bRequest = USB_CDC_GET_ENCAPSULATED_RESPONSE;
  186. req->wValue = 0;
  187. req->wIndex = desc->inum;
  188. req->wLength = cpu_to_le16(desc->wMaxCommand);
  189. usb_fill_control_urb(
  190. desc->response,
  191. interface_to_usbdev(desc->intf),
  192. /* using common endpoint 0 */
  193. usb_rcvctrlpipe(interface_to_usbdev(desc->intf), 0),
  194. (unsigned char *)req,
  195. desc->inbuf,
  196. desc->wMaxCommand,
  197. wdm_in_callback,
  198. desc
  199. );
  200. desc->response->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  201. spin_lock(&desc->iuspin);
  202. clear_bit(WDM_READ, &desc->flags);
  203. if (!test_bit(WDM_DISCONNECTING, &desc->flags)) {
  204. rv = usb_submit_urb(desc->response, GFP_ATOMIC);
  205. dev_dbg(&desc->intf->dev, "%s: usb_submit_urb %d",
  206. __func__, rv);
  207. }
  208. spin_unlock(&desc->iuspin);
  209. if (rv < 0) {
  210. if (rv == -EPERM)
  211. return;
  212. if (rv == -ENOMEM) {
  213. sw:
  214. rv = schedule_work(&desc->rxwork);
  215. if (rv)
  216. dev_err(&desc->intf->dev,
  217. "Cannot schedule work\n");
  218. }
  219. }
  220. exit:
  221. rv = usb_submit_urb(urb, GFP_ATOMIC);
  222. if (rv)
  223. dev_err(&desc->intf->dev,
  224. "%s - usb_submit_urb failed with result %d\n",
  225. __func__, rv);
  226. }
  227. static void kill_urbs(struct wdm_device *desc)
  228. {
  229. /* the order here is essential */
  230. usb_kill_urb(desc->command);
  231. usb_kill_urb(desc->validity);
  232. usb_kill_urb(desc->response);
  233. }
  234. static void free_urbs(struct wdm_device *desc)
  235. {
  236. usb_free_urb(desc->validity);
  237. usb_free_urb(desc->response);
  238. usb_free_urb(desc->command);
  239. }
  240. static void cleanup(struct wdm_device *desc)
  241. {
  242. usb_buffer_free(interface_to_usbdev(desc->intf),
  243. desc->wMaxPacketSize,
  244. desc->sbuf,
  245. desc->validity->transfer_dma);
  246. usb_buffer_free(interface_to_usbdev(desc->intf),
  247. desc->wMaxCommand,
  248. desc->inbuf,
  249. desc->response->transfer_dma);
  250. kfree(desc->orq);
  251. kfree(desc->irq);
  252. kfree(desc->ubuf);
  253. free_urbs(desc);
  254. kfree(desc);
  255. }
  256. static ssize_t wdm_write
  257. (struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
  258. {
  259. u8 *buf;
  260. int rv = -EMSGSIZE, r, we;
  261. struct wdm_device *desc = file->private_data;
  262. struct usb_ctrlrequest *req;
  263. if (count > desc->wMaxCommand)
  264. count = desc->wMaxCommand;
  265. spin_lock_irq(&desc->iuspin);
  266. we = desc->werr;
  267. desc->werr = 0;
  268. spin_unlock_irq(&desc->iuspin);
  269. if (we < 0)
  270. return -EIO;
  271. r = mutex_lock_interruptible(&desc->wlock); /* concurrent writes */
  272. rv = -ERESTARTSYS;
  273. if (r)
  274. goto outnl;
  275. r = usb_autopm_get_interface(desc->intf);
  276. if (r < 0)
  277. goto outnp;
  278. r = wait_event_interruptible(desc->wait, !test_bit(WDM_IN_USE,
  279. &desc->flags));
  280. if (r < 0)
  281. goto out;
  282. if (test_bit(WDM_DISCONNECTING, &desc->flags)) {
  283. rv = -ENODEV;
  284. goto out;
  285. }
  286. desc->outbuf = buf = kmalloc(count, GFP_KERNEL);
  287. if (!buf) {
  288. rv = -ENOMEM;
  289. goto out;
  290. }
  291. r = copy_from_user(buf, buffer, count);
  292. if (r > 0) {
  293. kfree(buf);
  294. rv = -EFAULT;
  295. goto out;
  296. }
  297. req = desc->orq;
  298. usb_fill_control_urb(
  299. desc->command,
  300. interface_to_usbdev(desc->intf),
  301. /* using common endpoint 0 */
  302. usb_sndctrlpipe(interface_to_usbdev(desc->intf), 0),
  303. (unsigned char *)req,
  304. buf,
  305. count,
  306. wdm_out_callback,
  307. desc
  308. );
  309. req->bRequestType = (USB_DIR_OUT | USB_TYPE_CLASS |
  310. USB_RECIP_INTERFACE);
  311. req->bRequest = USB_CDC_SEND_ENCAPSULATED_COMMAND;
  312. req->wValue = 0;
  313. req->wIndex = desc->inum;
  314. req->wLength = cpu_to_le16(count);
  315. set_bit(WDM_IN_USE, &desc->flags);
  316. rv = usb_submit_urb(desc->command, GFP_KERNEL);
  317. if (rv < 0) {
  318. kfree(buf);
  319. clear_bit(WDM_IN_USE, &desc->flags);
  320. dev_err(&desc->intf->dev, "Tx URB error: %d\n", rv);
  321. } else {
  322. dev_dbg(&desc->intf->dev, "Tx URB has been submitted index=%d",
  323. req->wIndex);
  324. }
  325. out:
  326. usb_autopm_put_interface(desc->intf);
  327. outnp:
  328. mutex_unlock(&desc->wlock);
  329. outnl:
  330. return rv < 0 ? rv : count;
  331. }
  332. static ssize_t wdm_read
  333. (struct file *file, char __user *buffer, size_t count, loff_t *ppos)
  334. {
  335. int rv, cntr;
  336. int i = 0;
  337. struct wdm_device *desc = file->private_data;
  338. rv = mutex_lock_interruptible(&desc->rlock); /*concurrent reads */
  339. if (rv < 0)
  340. return -ERESTARTSYS;
  341. if (desc->length == 0) {
  342. desc->read = 0;
  343. retry:
  344. i++;
  345. rv = wait_event_interruptible(desc->wait,
  346. test_bit(WDM_READ, &desc->flags));
  347. if (test_bit(WDM_DISCONNECTING, &desc->flags)) {
  348. rv = -ENODEV;
  349. goto err;
  350. }
  351. usb_mark_last_busy(interface_to_usbdev(desc->intf));
  352. if (rv < 0) {
  353. rv = -ERESTARTSYS;
  354. goto err;
  355. }
  356. spin_lock_irq(&desc->iuspin);
  357. if (desc->rerr) { /* read completed, error happened */
  358. int t = desc->rerr;
  359. desc->rerr = 0;
  360. spin_unlock_irq(&desc->iuspin);
  361. dev_err(&desc->intf->dev,
  362. "reading had resulted in %d\n", t);
  363. rv = -EIO;
  364. goto err;
  365. }
  366. /*
  367. * recheck whether we've lost the race
  368. * against the completion handler
  369. */
  370. if (!test_bit(WDM_READ, &desc->flags)) { /* lost race */
  371. spin_unlock_irq(&desc->iuspin);
  372. goto retry;
  373. }
  374. if (!desc->reslength) { /* zero length read */
  375. spin_unlock_irq(&desc->iuspin);
  376. goto retry;
  377. }
  378. clear_bit(WDM_READ, &desc->flags);
  379. spin_unlock_irq(&desc->iuspin);
  380. }
  381. cntr = count > desc->length ? desc->length : count;
  382. rv = copy_to_user(buffer, desc->ubuf, cntr);
  383. if (rv > 0) {
  384. rv = -EFAULT;
  385. goto err;
  386. }
  387. for (i = 0; i < desc->length - cntr; i++)
  388. desc->ubuf[i] = desc->ubuf[i + cntr];
  389. desc->length -= cntr;
  390. /* in case we had outstanding data */
  391. if (!desc->length)
  392. clear_bit(WDM_READ, &desc->flags);
  393. rv = cntr;
  394. err:
  395. mutex_unlock(&desc->rlock);
  396. if (rv < 0)
  397. dev_err(&desc->intf->dev, "wdm_read: exit error\n");
  398. return rv;
  399. }
  400. static int wdm_flush(struct file *file, fl_owner_t id)
  401. {
  402. struct wdm_device *desc = file->private_data;
  403. wait_event(desc->wait, !test_bit(WDM_IN_USE, &desc->flags));
  404. if (desc->werr < 0)
  405. dev_err(&desc->intf->dev, "Error in flush path: %d\n",
  406. desc->werr);
  407. return desc->werr;
  408. }
  409. static unsigned int wdm_poll(struct file *file, struct poll_table_struct *wait)
  410. {
  411. struct wdm_device *desc = file->private_data;
  412. unsigned long flags;
  413. unsigned int mask = 0;
  414. spin_lock_irqsave(&desc->iuspin, flags);
  415. if (test_bit(WDM_DISCONNECTING, &desc->flags)) {
  416. mask = POLLERR;
  417. spin_unlock_irqrestore(&desc->iuspin, flags);
  418. goto desc_out;
  419. }
  420. if (test_bit(WDM_READ, &desc->flags))
  421. mask = POLLIN | POLLRDNORM;
  422. if (desc->rerr || desc->werr)
  423. mask |= POLLERR;
  424. if (!test_bit(WDM_IN_USE, &desc->flags))
  425. mask |= POLLOUT | POLLWRNORM;
  426. spin_unlock_irqrestore(&desc->iuspin, flags);
  427. poll_wait(file, &desc->wait, wait);
  428. desc_out:
  429. return mask;
  430. }
  431. static int wdm_open(struct inode *inode, struct file *file)
  432. {
  433. int minor = iminor(inode);
  434. int rv = -ENODEV;
  435. struct usb_interface *intf;
  436. struct wdm_device *desc;
  437. mutex_lock(&wdm_mutex);
  438. intf = usb_find_interface(&wdm_driver, minor);
  439. if (!intf)
  440. goto out;
  441. desc = usb_get_intfdata(intf);
  442. if (test_bit(WDM_DISCONNECTING, &desc->flags))
  443. goto out;
  444. ;
  445. file->private_data = desc;
  446. rv = usb_autopm_get_interface(desc->intf);
  447. if (rv < 0) {
  448. dev_err(&desc->intf->dev, "Error autopm - %d\n", rv);
  449. goto out;
  450. }
  451. intf->needs_remote_wakeup = 1;
  452. mutex_lock(&desc->plock);
  453. if (!desc->count++) {
  454. rv = usb_submit_urb(desc->validity, GFP_KERNEL);
  455. if (rv < 0) {
  456. desc->count--;
  457. dev_err(&desc->intf->dev,
  458. "Error submitting int urb - %d\n", rv);
  459. }
  460. } else {
  461. rv = 0;
  462. }
  463. mutex_unlock(&desc->plock);
  464. usb_autopm_put_interface(desc->intf);
  465. out:
  466. mutex_unlock(&wdm_mutex);
  467. return rv;
  468. }
  469. static int wdm_release(struct inode *inode, struct file *file)
  470. {
  471. struct wdm_device *desc = file->private_data;
  472. mutex_lock(&wdm_mutex);
  473. mutex_lock(&desc->plock);
  474. desc->count--;
  475. mutex_unlock(&desc->plock);
  476. if (!desc->count) {
  477. dev_dbg(&desc->intf->dev, "wdm_release: cleanup");
  478. kill_urbs(desc);
  479. if (!test_bit(WDM_DISCONNECTING, &desc->flags))
  480. desc->intf->needs_remote_wakeup = 0;
  481. }
  482. mutex_unlock(&wdm_mutex);
  483. return 0;
  484. }
  485. static const struct file_operations wdm_fops = {
  486. .owner = THIS_MODULE,
  487. .read = wdm_read,
  488. .write = wdm_write,
  489. .open = wdm_open,
  490. .flush = wdm_flush,
  491. .release = wdm_release,
  492. .poll = wdm_poll
  493. };
  494. static struct usb_class_driver wdm_class = {
  495. .name = "cdc-wdm%d",
  496. .fops = &wdm_fops,
  497. .minor_base = WDM_MINOR_BASE,
  498. };
  499. /* --- error handling --- */
  500. static void wdm_rxwork(struct work_struct *work)
  501. {
  502. struct wdm_device *desc = container_of(work, struct wdm_device, rxwork);
  503. unsigned long flags;
  504. int rv;
  505. spin_lock_irqsave(&desc->iuspin, flags);
  506. if (test_bit(WDM_DISCONNECTING, &desc->flags)) {
  507. spin_unlock_irqrestore(&desc->iuspin, flags);
  508. } else {
  509. spin_unlock_irqrestore(&desc->iuspin, flags);
  510. rv = usb_submit_urb(desc->response, GFP_KERNEL);
  511. if (rv < 0 && rv != -EPERM) {
  512. spin_lock_irqsave(&desc->iuspin, flags);
  513. if (!test_bit(WDM_DISCONNECTING, &desc->flags))
  514. schedule_work(&desc->rxwork);
  515. spin_unlock_irqrestore(&desc->iuspin, flags);
  516. }
  517. }
  518. }
  519. /* --- hotplug --- */
  520. static int wdm_probe(struct usb_interface *intf, const struct usb_device_id *id)
  521. {
  522. int rv = -EINVAL;
  523. struct usb_device *udev = interface_to_usbdev(intf);
  524. struct wdm_device *desc;
  525. struct usb_host_interface *iface;
  526. struct usb_endpoint_descriptor *ep;
  527. struct usb_cdc_dmm_desc *dmhd;
  528. u8 *buffer = intf->altsetting->extra;
  529. int buflen = intf->altsetting->extralen;
  530. u16 maxcom = 0;
  531. if (!buffer)
  532. goto out;
  533. while (buflen > 0) {
  534. if (buffer [1] != USB_DT_CS_INTERFACE) {
  535. dev_err(&intf->dev, "skipping garbage\n");
  536. goto next_desc;
  537. }
  538. switch (buffer [2]) {
  539. case USB_CDC_HEADER_TYPE:
  540. break;
  541. case USB_CDC_DMM_TYPE:
  542. dmhd = (struct usb_cdc_dmm_desc *)buffer;
  543. maxcom = le16_to_cpu(dmhd->wMaxCommand);
  544. dev_dbg(&intf->dev,
  545. "Finding maximum buffer length: %d", maxcom);
  546. break;
  547. default:
  548. dev_err(&intf->dev,
  549. "Ignoring extra header, type %d, length %d\n",
  550. buffer[2], buffer[0]);
  551. break;
  552. }
  553. next_desc:
  554. buflen -= buffer[0];
  555. buffer += buffer[0];
  556. }
  557. rv = -ENOMEM;
  558. desc = kzalloc(sizeof(struct wdm_device), GFP_KERNEL);
  559. if (!desc)
  560. goto out;
  561. mutex_init(&desc->wlock);
  562. mutex_init(&desc->rlock);
  563. mutex_init(&desc->plock);
  564. spin_lock_init(&desc->iuspin);
  565. init_waitqueue_head(&desc->wait);
  566. desc->wMaxCommand = maxcom;
  567. desc->inum = cpu_to_le16((u16)intf->cur_altsetting->desc.bInterfaceNumber);
  568. desc->intf = intf;
  569. INIT_WORK(&desc->rxwork, wdm_rxwork);
  570. iface = &intf->altsetting[0];
  571. ep = &iface->endpoint[0].desc;
  572. if (!usb_endpoint_is_int_in(ep)) {
  573. rv = -EINVAL;
  574. goto err;
  575. }
  576. desc->wMaxPacketSize = le16_to_cpu(ep->wMaxPacketSize);
  577. desc->bMaxPacketSize0 = udev->descriptor.bMaxPacketSize0;
  578. desc->orq = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL);
  579. if (!desc->orq)
  580. goto err;
  581. desc->irq = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL);
  582. if (!desc->irq)
  583. goto err;
  584. desc->validity = usb_alloc_urb(0, GFP_KERNEL);
  585. if (!desc->validity)
  586. goto err;
  587. desc->response = usb_alloc_urb(0, GFP_KERNEL);
  588. if (!desc->response)
  589. goto err;
  590. desc->command = usb_alloc_urb(0, GFP_KERNEL);
  591. if (!desc->command)
  592. goto err;
  593. desc->ubuf = kmalloc(desc->wMaxCommand, GFP_KERNEL);
  594. if (!desc->ubuf)
  595. goto err;
  596. desc->sbuf = usb_buffer_alloc(interface_to_usbdev(intf),
  597. desc->wMaxPacketSize,
  598. GFP_KERNEL,
  599. &desc->validity->transfer_dma);
  600. if (!desc->sbuf)
  601. goto err;
  602. desc->inbuf = usb_buffer_alloc(interface_to_usbdev(intf),
  603. desc->bMaxPacketSize0,
  604. GFP_KERNEL,
  605. &desc->response->transfer_dma);
  606. if (!desc->inbuf)
  607. goto err2;
  608. usb_fill_int_urb(
  609. desc->validity,
  610. interface_to_usbdev(intf),
  611. usb_rcvintpipe(interface_to_usbdev(intf), ep->bEndpointAddress),
  612. desc->sbuf,
  613. desc->wMaxPacketSize,
  614. wdm_int_callback,
  615. desc,
  616. ep->bInterval
  617. );
  618. desc->validity->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  619. usb_set_intfdata(intf, desc);
  620. rv = usb_register_dev(intf, &wdm_class);
  621. dev_info(&intf->dev, "cdc-wdm%d: USB WDM device\n",
  622. intf->minor - WDM_MINOR_BASE);
  623. if (rv < 0)
  624. goto err;
  625. out:
  626. return rv;
  627. err2:
  628. usb_buffer_free(interface_to_usbdev(desc->intf),
  629. desc->wMaxPacketSize,
  630. desc->sbuf,
  631. desc->validity->transfer_dma);
  632. err:
  633. free_urbs(desc);
  634. kfree(desc->ubuf);
  635. kfree(desc->orq);
  636. kfree(desc->irq);
  637. kfree(desc);
  638. return rv;
  639. }
  640. static void wdm_disconnect(struct usb_interface *intf)
  641. {
  642. struct wdm_device *desc;
  643. unsigned long flags;
  644. usb_deregister_dev(intf, &wdm_class);
  645. mutex_lock(&wdm_mutex);
  646. desc = usb_get_intfdata(intf);
  647. /* the spinlock makes sure no new urbs are generated in the callbacks */
  648. spin_lock_irqsave(&desc->iuspin, flags);
  649. set_bit(WDM_DISCONNECTING, &desc->flags);
  650. set_bit(WDM_READ, &desc->flags);
  651. /* to terminate pending flushes */
  652. clear_bit(WDM_IN_USE, &desc->flags);
  653. spin_unlock_irqrestore(&desc->iuspin, flags);
  654. cancel_work_sync(&desc->rxwork);
  655. kill_urbs(desc);
  656. wake_up_all(&desc->wait);
  657. if (!desc->count)
  658. cleanup(desc);
  659. mutex_unlock(&wdm_mutex);
  660. }
  661. static int wdm_suspend(struct usb_interface *intf, pm_message_t message)
  662. {
  663. struct wdm_device *desc = usb_get_intfdata(intf);
  664. int rv = 0;
  665. dev_dbg(&desc->intf->dev, "wdm%d_suspend\n", intf->minor);
  666. mutex_lock(&desc->plock);
  667. #ifdef CONFIG_PM
  668. if ((message.event & PM_EVENT_AUTO) &&
  669. test_bit(WDM_IN_USE, &desc->flags)) {
  670. rv = -EBUSY;
  671. } else {
  672. #endif
  673. cancel_work_sync(&desc->rxwork);
  674. kill_urbs(desc);
  675. #ifdef CONFIG_PM
  676. }
  677. #endif
  678. mutex_unlock(&desc->plock);
  679. return rv;
  680. }
  681. static int recover_from_urb_loss(struct wdm_device *desc)
  682. {
  683. int rv = 0;
  684. if (desc->count) {
  685. rv = usb_submit_urb(desc->validity, GFP_NOIO);
  686. if (rv < 0)
  687. dev_err(&desc->intf->dev,
  688. "Error resume submitting int urb - %d\n", rv);
  689. }
  690. return rv;
  691. }
  692. static int wdm_resume(struct usb_interface *intf)
  693. {
  694. struct wdm_device *desc = usb_get_intfdata(intf);
  695. int rv;
  696. dev_dbg(&desc->intf->dev, "wdm%d_resume\n", intf->minor);
  697. mutex_lock(&desc->plock);
  698. rv = recover_from_urb_loss(desc);
  699. mutex_unlock(&desc->plock);
  700. return rv;
  701. }
  702. static int wdm_pre_reset(struct usb_interface *intf)
  703. {
  704. struct wdm_device *desc = usb_get_intfdata(intf);
  705. mutex_lock(&desc->plock);
  706. return 0;
  707. }
  708. static int wdm_post_reset(struct usb_interface *intf)
  709. {
  710. struct wdm_device *desc = usb_get_intfdata(intf);
  711. int rv;
  712. rv = recover_from_urb_loss(desc);
  713. mutex_unlock(&desc->plock);
  714. return 0;
  715. }
  716. static struct usb_driver wdm_driver = {
  717. .name = "cdc_wdm",
  718. .probe = wdm_probe,
  719. .disconnect = wdm_disconnect,
  720. .suspend = wdm_suspend,
  721. .resume = wdm_resume,
  722. .reset_resume = wdm_resume,
  723. .pre_reset = wdm_pre_reset,
  724. .post_reset = wdm_post_reset,
  725. .id_table = wdm_ids,
  726. .supports_autosuspend = 1,
  727. };
  728. /* --- low level module stuff --- */
  729. static int __init wdm_init(void)
  730. {
  731. int rv;
  732. rv = usb_register(&wdm_driver);
  733. return rv;
  734. }
  735. static void __exit wdm_exit(void)
  736. {
  737. usb_deregister(&wdm_driver);
  738. }
  739. module_init(wdm_init);
  740. module_exit(wdm_exit);
  741. MODULE_AUTHOR(DRIVER_AUTHOR);
  742. MODULE_DESCRIPTION(DRIVER_DESC);
  743. MODULE_LICENSE("GPL");