cdc-wdm.c 20 KB

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