cdc-acm.c 42 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623
  1. /*
  2. * cdc-acm.c
  3. *
  4. * Copyright (c) 1999 Armin Fuerst <fuerst@in.tum.de>
  5. * Copyright (c) 1999 Pavel Machek <pavel@suse.cz>
  6. * Copyright (c) 1999 Johannes Erdfelt <johannes@erdfelt.com>
  7. * Copyright (c) 2000 Vojtech Pavlik <vojtech@suse.cz>
  8. * Copyright (c) 2004 Oliver Neukum <oliver@neukum.name>
  9. * Copyright (c) 2005 David Kubicek <dave@awk.cz>
  10. *
  11. * USB Abstract Control Model driver for USB modems and ISDN adapters
  12. *
  13. * Sponsored by SuSE
  14. *
  15. * ChangeLog:
  16. * v0.9 - thorough cleaning, URBification, almost a rewrite
  17. * v0.10 - some more cleanups
  18. * v0.11 - fixed flow control, read error doesn't stop reads
  19. * v0.12 - added TIOCM ioctls, added break handling, made struct acm
  20. * kmalloced
  21. * v0.13 - added termios, added hangup
  22. * v0.14 - sized down struct acm
  23. * v0.15 - fixed flow control again - characters could be lost
  24. * v0.16 - added code for modems with swapped data and control interfaces
  25. * v0.17 - added new style probing
  26. * v0.18 - fixed new style probing for devices with more configurations
  27. * v0.19 - fixed CLOCAL handling (thanks to Richard Shih-Ping Chan)
  28. * v0.20 - switched to probing on interface (rather than device) class
  29. * v0.21 - revert to probing on device for devices with multiple configs
  30. * v0.22 - probe only the control interface. if usbcore doesn't choose the
  31. * config we want, sysadmin changes bConfigurationValue in sysfs.
  32. * v0.23 - use softirq for rx processing, as needed by tty layer
  33. * v0.24 - change probe method to evaluate CDC union descriptor
  34. * v0.25 - downstream tasks paralelized to maximize throughput
  35. * v0.26 - multiple write urbs, writesize increased
  36. */
  37. /*
  38. * This program is free software; you can redistribute it and/or modify
  39. * it under the terms of the GNU General Public License as published by
  40. * the Free Software Foundation; either version 2 of the License, or
  41. * (at your option) any later version.
  42. *
  43. * This program is distributed in the hope that it will be useful,
  44. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  45. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  46. * GNU General Public License for more details.
  47. *
  48. * You should have received a copy of the GNU General Public License
  49. * along with this program; if not, write to the Free Software
  50. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  51. */
  52. #undef DEBUG
  53. #undef VERBOSE_DEBUG
  54. #include <linux/kernel.h>
  55. #include <linux/errno.h>
  56. #include <linux/init.h>
  57. #include <linux/slab.h>
  58. #include <linux/tty.h>
  59. #include <linux/tty_driver.h>
  60. #include <linux/tty_flip.h>
  61. #include <linux/module.h>
  62. #include <linux/mutex.h>
  63. #include <linux/uaccess.h>
  64. #include <linux/usb.h>
  65. #include <linux/usb/cdc.h>
  66. #include <asm/byteorder.h>
  67. #include <asm/unaligned.h>
  68. #include <linux/list.h>
  69. #include "cdc-acm.h"
  70. #define ACM_CLOSE_TIMEOUT 15 /* seconds to let writes drain */
  71. /*
  72. * Version Information
  73. */
  74. #define DRIVER_VERSION "v0.26"
  75. #define DRIVER_AUTHOR "Armin Fuerst, Pavel Machek, Johannes Erdfelt, Vojtech Pavlik, David Kubicek"
  76. #define DRIVER_DESC "USB Abstract Control Model driver for USB modems and ISDN adapters"
  77. static struct usb_driver acm_driver;
  78. static struct tty_driver *acm_tty_driver;
  79. static struct acm *acm_table[ACM_TTY_MINORS];
  80. static DEFINE_MUTEX(open_mutex);
  81. #define ACM_READY(acm) (acm && acm->dev && acm->port.count)
  82. static const struct tty_port_operations acm_port_ops = {
  83. };
  84. #ifdef VERBOSE_DEBUG
  85. #define verbose 1
  86. #else
  87. #define verbose 0
  88. #endif
  89. /*
  90. * Functions for ACM control messages.
  91. */
  92. static int acm_ctrl_msg(struct acm *acm, int request, int value,
  93. void *buf, int len)
  94. {
  95. int retval = usb_control_msg(acm->dev, usb_sndctrlpipe(acm->dev, 0),
  96. request, USB_RT_ACM, value,
  97. acm->control->altsetting[0].desc.bInterfaceNumber,
  98. buf, len, 5000);
  99. dbg("acm_control_msg: rq: 0x%02x val: %#x len: %#x result: %d",
  100. request, value, len, retval);
  101. return retval < 0 ? retval : 0;
  102. }
  103. /* devices aren't required to support these requests.
  104. * the cdc acm descriptor tells whether they do...
  105. */
  106. #define acm_set_control(acm, control) \
  107. acm_ctrl_msg(acm, USB_CDC_REQ_SET_CONTROL_LINE_STATE, control, NULL, 0)
  108. #define acm_set_line(acm, line) \
  109. acm_ctrl_msg(acm, USB_CDC_REQ_SET_LINE_CODING, 0, line, sizeof *(line))
  110. #define acm_send_break(acm, ms) \
  111. acm_ctrl_msg(acm, USB_CDC_REQ_SEND_BREAK, ms, NULL, 0)
  112. /*
  113. * Write buffer management.
  114. * All of these assume proper locks taken by the caller.
  115. */
  116. static int acm_wb_alloc(struct acm *acm)
  117. {
  118. int i, wbn;
  119. struct acm_wb *wb;
  120. wbn = 0;
  121. i = 0;
  122. for (;;) {
  123. wb = &acm->wb[wbn];
  124. if (!wb->use) {
  125. wb->use = 1;
  126. return wbn;
  127. }
  128. wbn = (wbn + 1) % ACM_NW;
  129. if (++i >= ACM_NW)
  130. return -1;
  131. }
  132. }
  133. static int acm_wb_is_avail(struct acm *acm)
  134. {
  135. int i, n;
  136. unsigned long flags;
  137. n = ACM_NW;
  138. spin_lock_irqsave(&acm->write_lock, flags);
  139. for (i = 0; i < ACM_NW; i++)
  140. n -= acm->wb[i].use;
  141. spin_unlock_irqrestore(&acm->write_lock, flags);
  142. return n;
  143. }
  144. /*
  145. * Finish write. Caller must hold acm->write_lock
  146. */
  147. static void acm_write_done(struct acm *acm, struct acm_wb *wb)
  148. {
  149. wb->use = 0;
  150. acm->transmitting--;
  151. }
  152. /*
  153. * Poke write.
  154. *
  155. * the caller is responsible for locking
  156. */
  157. static int acm_start_wb(struct acm *acm, struct acm_wb *wb)
  158. {
  159. int rc;
  160. acm->transmitting++;
  161. wb->urb->transfer_buffer = wb->buf;
  162. wb->urb->transfer_dma = wb->dmah;
  163. wb->urb->transfer_buffer_length = wb->len;
  164. wb->urb->dev = acm->dev;
  165. rc = usb_submit_urb(wb->urb, GFP_ATOMIC);
  166. if (rc < 0) {
  167. dbg("usb_submit_urb(write bulk) failed: %d", rc);
  168. acm_write_done(acm, wb);
  169. }
  170. return rc;
  171. }
  172. static int acm_write_start(struct acm *acm, int wbn)
  173. {
  174. unsigned long flags;
  175. struct acm_wb *wb = &acm->wb[wbn];
  176. int rc;
  177. spin_lock_irqsave(&acm->write_lock, flags);
  178. if (!acm->dev) {
  179. wb->use = 0;
  180. spin_unlock_irqrestore(&acm->write_lock, flags);
  181. return -ENODEV;
  182. }
  183. dbg("%s susp_count: %d", __func__, acm->susp_count);
  184. if (acm->susp_count) {
  185. acm->delayed_wb = wb;
  186. schedule_work(&acm->waker);
  187. spin_unlock_irqrestore(&acm->write_lock, flags);
  188. return 0; /* A white lie */
  189. }
  190. usb_mark_last_busy(acm->dev);
  191. rc = acm_start_wb(acm, wb);
  192. spin_unlock_irqrestore(&acm->write_lock, flags);
  193. return rc;
  194. }
  195. /*
  196. * attributes exported through sysfs
  197. */
  198. static ssize_t show_caps
  199. (struct device *dev, struct device_attribute *attr, char *buf)
  200. {
  201. struct usb_interface *intf = to_usb_interface(dev);
  202. struct acm *acm = usb_get_intfdata(intf);
  203. return sprintf(buf, "%d", acm->ctrl_caps);
  204. }
  205. static DEVICE_ATTR(bmCapabilities, S_IRUGO, show_caps, NULL);
  206. static ssize_t show_country_codes
  207. (struct device *dev, struct device_attribute *attr, char *buf)
  208. {
  209. struct usb_interface *intf = to_usb_interface(dev);
  210. struct acm *acm = usb_get_intfdata(intf);
  211. memcpy(buf, acm->country_codes, acm->country_code_size);
  212. return acm->country_code_size;
  213. }
  214. static DEVICE_ATTR(wCountryCodes, S_IRUGO, show_country_codes, NULL);
  215. static ssize_t show_country_rel_date
  216. (struct device *dev, struct device_attribute *attr, char *buf)
  217. {
  218. struct usb_interface *intf = to_usb_interface(dev);
  219. struct acm *acm = usb_get_intfdata(intf);
  220. return sprintf(buf, "%d", acm->country_rel_date);
  221. }
  222. static DEVICE_ATTR(iCountryCodeRelDate, S_IRUGO, show_country_rel_date, NULL);
  223. /*
  224. * Interrupt handlers for various ACM device responses
  225. */
  226. /* control interface reports status changes with "interrupt" transfers */
  227. static void acm_ctrl_irq(struct urb *urb)
  228. {
  229. struct acm *acm = urb->context;
  230. struct usb_cdc_notification *dr = urb->transfer_buffer;
  231. struct tty_struct *tty;
  232. unsigned char *data;
  233. int newctrl;
  234. int retval;
  235. int status = urb->status;
  236. switch (status) {
  237. case 0:
  238. /* success */
  239. break;
  240. case -ECONNRESET:
  241. case -ENOENT:
  242. case -ESHUTDOWN:
  243. /* this urb is terminated, clean up */
  244. dbg("%s - urb shutting down with status: %d", __func__, status);
  245. return;
  246. default:
  247. dbg("%s - nonzero urb status received: %d", __func__, status);
  248. goto exit;
  249. }
  250. if (!ACM_READY(acm))
  251. goto exit;
  252. data = (unsigned char *)(dr + 1);
  253. switch (dr->bNotificationType) {
  254. case USB_CDC_NOTIFY_NETWORK_CONNECTION:
  255. dbg("%s network", dr->wValue ?
  256. "connected to" : "disconnected from");
  257. break;
  258. case USB_CDC_NOTIFY_SERIAL_STATE:
  259. tty = tty_port_tty_get(&acm->port);
  260. newctrl = get_unaligned_le16(data);
  261. if (tty) {
  262. if (!acm->clocal &&
  263. (acm->ctrlin & ~newctrl & ACM_CTRL_DCD)) {
  264. dbg("calling hangup");
  265. tty_hangup(tty);
  266. }
  267. tty_kref_put(tty);
  268. }
  269. acm->ctrlin = newctrl;
  270. dbg("input control lines: dcd%c dsr%c break%c ring%c framing%c parity%c overrun%c",
  271. acm->ctrlin & ACM_CTRL_DCD ? '+' : '-',
  272. acm->ctrlin & ACM_CTRL_DSR ? '+' : '-',
  273. acm->ctrlin & ACM_CTRL_BRK ? '+' : '-',
  274. acm->ctrlin & ACM_CTRL_RI ? '+' : '-',
  275. acm->ctrlin & ACM_CTRL_FRAMING ? '+' : '-',
  276. acm->ctrlin & ACM_CTRL_PARITY ? '+' : '-',
  277. acm->ctrlin & ACM_CTRL_OVERRUN ? '+' : '-');
  278. break;
  279. default:
  280. dbg("unknown notification %d received: index %d len %d data0 %d data1 %d",
  281. dr->bNotificationType, dr->wIndex,
  282. dr->wLength, data[0], data[1]);
  283. break;
  284. }
  285. exit:
  286. usb_mark_last_busy(acm->dev);
  287. retval = usb_submit_urb(urb, GFP_ATOMIC);
  288. if (retval)
  289. dev_err(&urb->dev->dev, "%s - usb_submit_urb failed with "
  290. "result %d", __func__, retval);
  291. }
  292. /* data interface returns incoming bytes, or we got unthrottled */
  293. static void acm_read_bulk(struct urb *urb)
  294. {
  295. struct acm_rb *buf;
  296. struct acm_ru *rcv = urb->context;
  297. struct acm *acm = rcv->instance;
  298. int status = urb->status;
  299. dbg("Entering acm_read_bulk with status %d", status);
  300. if (!ACM_READY(acm)) {
  301. dev_dbg(&acm->data->dev, "Aborting, acm not ready");
  302. return;
  303. }
  304. usb_mark_last_busy(acm->dev);
  305. if (status)
  306. dev_dbg(&acm->data->dev, "bulk rx status %d\n", status);
  307. buf = rcv->buffer;
  308. buf->size = urb->actual_length;
  309. if (likely(status == 0)) {
  310. spin_lock(&acm->read_lock);
  311. acm->processing++;
  312. list_add_tail(&rcv->list, &acm->spare_read_urbs);
  313. list_add_tail(&buf->list, &acm->filled_read_bufs);
  314. spin_unlock(&acm->read_lock);
  315. } else {
  316. /* we drop the buffer due to an error */
  317. spin_lock(&acm->read_lock);
  318. list_add_tail(&rcv->list, &acm->spare_read_urbs);
  319. list_add(&buf->list, &acm->spare_read_bufs);
  320. spin_unlock(&acm->read_lock);
  321. /* nevertheless the tasklet must be kicked unconditionally
  322. so the queue cannot dry up */
  323. }
  324. if (likely(!acm->susp_count))
  325. tasklet_schedule(&acm->urb_task);
  326. }
  327. static void acm_rx_tasklet(unsigned long _acm)
  328. {
  329. struct acm *acm = (void *)_acm;
  330. struct acm_rb *buf;
  331. struct tty_struct *tty;
  332. struct acm_ru *rcv;
  333. unsigned long flags;
  334. unsigned char throttled;
  335. dbg("Entering acm_rx_tasklet");
  336. if (!ACM_READY(acm)) {
  337. dbg("acm_rx_tasklet: ACM not ready");
  338. return;
  339. }
  340. spin_lock_irqsave(&acm->throttle_lock, flags);
  341. throttled = acm->throttle;
  342. spin_unlock_irqrestore(&acm->throttle_lock, flags);
  343. if (throttled) {
  344. dbg("acm_rx_tasklet: throttled");
  345. return;
  346. }
  347. tty = tty_port_tty_get(&acm->port);
  348. next_buffer:
  349. spin_lock_irqsave(&acm->read_lock, flags);
  350. if (list_empty(&acm->filled_read_bufs)) {
  351. spin_unlock_irqrestore(&acm->read_lock, flags);
  352. goto urbs;
  353. }
  354. buf = list_entry(acm->filled_read_bufs.next,
  355. struct acm_rb, list);
  356. list_del(&buf->list);
  357. spin_unlock_irqrestore(&acm->read_lock, flags);
  358. dbg("acm_rx_tasklet: procesing buf 0x%p, size = %d", buf, buf->size);
  359. if (tty) {
  360. spin_lock_irqsave(&acm->throttle_lock, flags);
  361. throttled = acm->throttle;
  362. spin_unlock_irqrestore(&acm->throttle_lock, flags);
  363. if (!throttled) {
  364. tty_buffer_request_room(tty, buf->size);
  365. tty_insert_flip_string(tty, buf->base, buf->size);
  366. tty_flip_buffer_push(tty);
  367. } else {
  368. tty_kref_put(tty);
  369. dbg("Throttling noticed");
  370. spin_lock_irqsave(&acm->read_lock, flags);
  371. list_add(&buf->list, &acm->filled_read_bufs);
  372. spin_unlock_irqrestore(&acm->read_lock, flags);
  373. return;
  374. }
  375. }
  376. spin_lock_irqsave(&acm->read_lock, flags);
  377. list_add(&buf->list, &acm->spare_read_bufs);
  378. spin_unlock_irqrestore(&acm->read_lock, flags);
  379. goto next_buffer;
  380. urbs:
  381. tty_kref_put(tty);
  382. while (!list_empty(&acm->spare_read_bufs)) {
  383. spin_lock_irqsave(&acm->read_lock, flags);
  384. if (list_empty(&acm->spare_read_urbs)) {
  385. acm->processing = 0;
  386. spin_unlock_irqrestore(&acm->read_lock, flags);
  387. return;
  388. }
  389. rcv = list_entry(acm->spare_read_urbs.next,
  390. struct acm_ru, list);
  391. list_del(&rcv->list);
  392. spin_unlock_irqrestore(&acm->read_lock, flags);
  393. buf = list_entry(acm->spare_read_bufs.next,
  394. struct acm_rb, list);
  395. list_del(&buf->list);
  396. rcv->buffer = buf;
  397. if (acm->is_int_ep)
  398. usb_fill_int_urb(rcv->urb, acm->dev,
  399. acm->rx_endpoint,
  400. buf->base,
  401. acm->readsize,
  402. acm_read_bulk, rcv, acm->bInterval);
  403. else
  404. usb_fill_bulk_urb(rcv->urb, acm->dev,
  405. acm->rx_endpoint,
  406. buf->base,
  407. acm->readsize,
  408. acm_read_bulk, rcv);
  409. rcv->urb->transfer_dma = buf->dma;
  410. rcv->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  411. /* This shouldn't kill the driver as unsuccessful URBs are
  412. returned to the free-urbs-pool and resubmited ASAP */
  413. spin_lock_irqsave(&acm->read_lock, flags);
  414. if (acm->susp_count ||
  415. usb_submit_urb(rcv->urb, GFP_ATOMIC) < 0) {
  416. list_add(&buf->list, &acm->spare_read_bufs);
  417. list_add(&rcv->list, &acm->spare_read_urbs);
  418. acm->processing = 0;
  419. spin_unlock_irqrestore(&acm->read_lock, flags);
  420. return;
  421. } else {
  422. spin_unlock_irqrestore(&acm->read_lock, flags);
  423. dbg("acm_rx_tasklet: sending urb 0x%p, rcv 0x%p, buf 0x%p", rcv->urb, rcv, buf);
  424. }
  425. }
  426. spin_lock_irqsave(&acm->read_lock, flags);
  427. acm->processing = 0;
  428. spin_unlock_irqrestore(&acm->read_lock, flags);
  429. }
  430. /* data interface wrote those outgoing bytes */
  431. static void acm_write_bulk(struct urb *urb)
  432. {
  433. struct acm_wb *wb = urb->context;
  434. struct acm *acm = wb->instance;
  435. unsigned long flags;
  436. if (verbose || urb->status
  437. || (urb->actual_length != urb->transfer_buffer_length))
  438. dev_dbg(&acm->data->dev, "tx %d/%d bytes -- > %d\n",
  439. urb->actual_length,
  440. urb->transfer_buffer_length,
  441. urb->status);
  442. spin_lock_irqsave(&acm->write_lock, flags);
  443. acm_write_done(acm, wb);
  444. spin_unlock_irqrestore(&acm->write_lock, flags);
  445. if (ACM_READY(acm))
  446. schedule_work(&acm->work);
  447. else
  448. wake_up_interruptible(&acm->drain_wait);
  449. }
  450. static void acm_softint(struct work_struct *work)
  451. {
  452. struct acm *acm = container_of(work, struct acm, work);
  453. struct tty_struct *tty;
  454. dev_vdbg(&acm->data->dev, "tx work\n");
  455. if (!ACM_READY(acm))
  456. return;
  457. tty = tty_port_tty_get(&acm->port);
  458. tty_wakeup(tty);
  459. tty_kref_put(tty);
  460. }
  461. static void acm_waker(struct work_struct *waker)
  462. {
  463. struct acm *acm = container_of(waker, struct acm, waker);
  464. int rv;
  465. rv = usb_autopm_get_interface(acm->control);
  466. if (rv < 0) {
  467. dev_err(&acm->dev->dev, "Autopm failure in %s\n", __func__);
  468. return;
  469. }
  470. if (acm->delayed_wb) {
  471. acm_start_wb(acm, acm->delayed_wb);
  472. acm->delayed_wb = NULL;
  473. }
  474. usb_autopm_put_interface(acm->control);
  475. }
  476. /*
  477. * TTY handlers
  478. */
  479. static int acm_tty_open(struct tty_struct *tty, struct file *filp)
  480. {
  481. struct acm *acm;
  482. int rv = -ENODEV;
  483. int i;
  484. dbg("Entering acm_tty_open.");
  485. mutex_lock(&open_mutex);
  486. acm = acm_table[tty->index];
  487. if (!acm || !acm->dev)
  488. goto err_out;
  489. else
  490. rv = 0;
  491. set_bit(TTY_NO_WRITE_SPLIT, &tty->flags);
  492. tty->driver_data = acm;
  493. tty_port_tty_set(&acm->port, tty);
  494. if (usb_autopm_get_interface(acm->control) < 0)
  495. goto early_bail;
  496. else
  497. acm->control->needs_remote_wakeup = 1;
  498. mutex_lock(&acm->mutex);
  499. if (acm->port.count++) {
  500. usb_autopm_put_interface(acm->control);
  501. goto done;
  502. }
  503. acm->ctrlurb->dev = acm->dev;
  504. if (usb_submit_urb(acm->ctrlurb, GFP_KERNEL)) {
  505. dbg("usb_submit_urb(ctrl irq) failed");
  506. goto bail_out;
  507. }
  508. if (0 > acm_set_control(acm, acm->ctrlout = ACM_CTRL_DTR | ACM_CTRL_RTS) &&
  509. (acm->ctrl_caps & USB_CDC_CAP_LINE))
  510. goto full_bailout;
  511. usb_autopm_put_interface(acm->control);
  512. INIT_LIST_HEAD(&acm->spare_read_urbs);
  513. INIT_LIST_HEAD(&acm->spare_read_bufs);
  514. INIT_LIST_HEAD(&acm->filled_read_bufs);
  515. for (i = 0; i < acm->rx_buflimit; i++)
  516. list_add(&(acm->ru[i].list), &acm->spare_read_urbs);
  517. for (i = 0; i < acm->rx_buflimit; i++)
  518. list_add(&(acm->rb[i].list), &acm->spare_read_bufs);
  519. acm->throttle = 0;
  520. tasklet_schedule(&acm->urb_task);
  521. rv = tty_port_block_til_ready(&acm->port, tty, filp);
  522. done:
  523. mutex_unlock(&acm->mutex);
  524. err_out:
  525. mutex_unlock(&open_mutex);
  526. return rv;
  527. full_bailout:
  528. usb_kill_urb(acm->ctrlurb);
  529. bail_out:
  530. usb_autopm_put_interface(acm->control);
  531. acm->port.count--;
  532. mutex_unlock(&acm->mutex);
  533. early_bail:
  534. mutex_unlock(&open_mutex);
  535. tty_port_tty_set(&acm->port, NULL);
  536. return -EIO;
  537. }
  538. static void acm_tty_unregister(struct acm *acm)
  539. {
  540. int i, nr;
  541. nr = acm->rx_buflimit;
  542. tty_unregister_device(acm_tty_driver, acm->minor);
  543. usb_put_intf(acm->control);
  544. acm_table[acm->minor] = NULL;
  545. usb_free_urb(acm->ctrlurb);
  546. for (i = 0; i < ACM_NW; i++)
  547. usb_free_urb(acm->wb[i].urb);
  548. for (i = 0; i < nr; i++)
  549. usb_free_urb(acm->ru[i].urb);
  550. kfree(acm->country_codes);
  551. kfree(acm);
  552. }
  553. static int acm_tty_chars_in_buffer(struct tty_struct *tty);
  554. static void acm_port_down(struct acm *acm, int drain)
  555. {
  556. int i, nr = acm->rx_buflimit;
  557. mutex_lock(&open_mutex);
  558. if (acm->dev) {
  559. usb_autopm_get_interface(acm->control);
  560. acm_set_control(acm, acm->ctrlout = 0);
  561. /* try letting the last writes drain naturally */
  562. if (drain) {
  563. wait_event_interruptible_timeout(acm->drain_wait,
  564. (ACM_NW == acm_wb_is_avail(acm)) || !acm->dev,
  565. ACM_CLOSE_TIMEOUT * HZ);
  566. }
  567. usb_kill_urb(acm->ctrlurb);
  568. for (i = 0; i < ACM_NW; i++)
  569. usb_kill_urb(acm->wb[i].urb);
  570. for (i = 0; i < nr; i++)
  571. usb_kill_urb(acm->ru[i].urb);
  572. acm->control->needs_remote_wakeup = 0;
  573. usb_autopm_put_interface(acm->control);
  574. }
  575. mutex_unlock(&open_mutex);
  576. }
  577. static void acm_tty_hangup(struct tty_struct *tty)
  578. {
  579. struct acm *acm = tty->driver_data;
  580. tty_port_hangup(&acm->port);
  581. acm_port_down(acm, 0);
  582. }
  583. static void acm_tty_close(struct tty_struct *tty, struct file *filp)
  584. {
  585. struct acm *acm = tty->driver_data;
  586. /* Perform the closing process and see if we need to do the hardware
  587. shutdown */
  588. if (!acm || tty_port_close_start(&acm->port, tty, filp) == 0)
  589. return;
  590. acm_port_down(acm, 0);
  591. tty_port_close_end(&acm->port, tty);
  592. mutex_lock(&open_mutex);
  593. tty_port_tty_set(&acm->port, NULL);
  594. if (!acm->dev)
  595. acm_tty_unregister(acm);
  596. mutex_unlock(&open_mutex);
  597. }
  598. static int acm_tty_write(struct tty_struct *tty,
  599. const unsigned char *buf, int count)
  600. {
  601. struct acm *acm = tty->driver_data;
  602. int stat;
  603. unsigned long flags;
  604. int wbn;
  605. struct acm_wb *wb;
  606. dbg("Entering acm_tty_write to write %d bytes,", count);
  607. if (!ACM_READY(acm))
  608. return -EINVAL;
  609. if (!count)
  610. return 0;
  611. spin_lock_irqsave(&acm->write_lock, flags);
  612. wbn = acm_wb_alloc(acm);
  613. if (wbn < 0) {
  614. spin_unlock_irqrestore(&acm->write_lock, flags);
  615. return 0;
  616. }
  617. wb = &acm->wb[wbn];
  618. count = (count > acm->writesize) ? acm->writesize : count;
  619. dbg("Get %d bytes...", count);
  620. memcpy(wb->buf, buf, count);
  621. wb->len = count;
  622. spin_unlock_irqrestore(&acm->write_lock, flags);
  623. stat = acm_write_start(acm, wbn);
  624. if (stat < 0)
  625. return stat;
  626. return count;
  627. }
  628. static int acm_tty_write_room(struct tty_struct *tty)
  629. {
  630. struct acm *acm = tty->driver_data;
  631. if (!ACM_READY(acm))
  632. return -EINVAL;
  633. /*
  634. * Do not let the line discipline to know that we have a reserve,
  635. * or it might get too enthusiastic.
  636. */
  637. return acm_wb_is_avail(acm) ? acm->writesize : 0;
  638. }
  639. static int acm_tty_chars_in_buffer(struct tty_struct *tty)
  640. {
  641. struct acm *acm = tty->driver_data;
  642. if (!ACM_READY(acm))
  643. return 0;
  644. /*
  645. * This is inaccurate (overcounts), but it works.
  646. */
  647. return (ACM_NW - acm_wb_is_avail(acm)) * acm->writesize;
  648. }
  649. static void acm_tty_throttle(struct tty_struct *tty)
  650. {
  651. struct acm *acm = tty->driver_data;
  652. if (!ACM_READY(acm))
  653. return;
  654. spin_lock_bh(&acm->throttle_lock);
  655. acm->throttle = 1;
  656. spin_unlock_bh(&acm->throttle_lock);
  657. }
  658. static void acm_tty_unthrottle(struct tty_struct *tty)
  659. {
  660. struct acm *acm = tty->driver_data;
  661. if (!ACM_READY(acm))
  662. return;
  663. spin_lock_bh(&acm->throttle_lock);
  664. acm->throttle = 0;
  665. spin_unlock_bh(&acm->throttle_lock);
  666. tasklet_schedule(&acm->urb_task);
  667. }
  668. static int acm_tty_break_ctl(struct tty_struct *tty, int state)
  669. {
  670. struct acm *acm = tty->driver_data;
  671. int retval;
  672. if (!ACM_READY(acm))
  673. return -EINVAL;
  674. retval = acm_send_break(acm, state ? 0xffff : 0);
  675. if (retval < 0)
  676. dbg("send break failed");
  677. return retval;
  678. }
  679. static int acm_tty_tiocmget(struct tty_struct *tty, struct file *file)
  680. {
  681. struct acm *acm = tty->driver_data;
  682. if (!ACM_READY(acm))
  683. return -EINVAL;
  684. return (acm->ctrlout & ACM_CTRL_DTR ? TIOCM_DTR : 0) |
  685. (acm->ctrlout & ACM_CTRL_RTS ? TIOCM_RTS : 0) |
  686. (acm->ctrlin & ACM_CTRL_DSR ? TIOCM_DSR : 0) |
  687. (acm->ctrlin & ACM_CTRL_RI ? TIOCM_RI : 0) |
  688. (acm->ctrlin & ACM_CTRL_DCD ? TIOCM_CD : 0) |
  689. TIOCM_CTS;
  690. }
  691. static int acm_tty_tiocmset(struct tty_struct *tty, struct file *file,
  692. unsigned int set, unsigned int clear)
  693. {
  694. struct acm *acm = tty->driver_data;
  695. unsigned int newctrl;
  696. if (!ACM_READY(acm))
  697. return -EINVAL;
  698. newctrl = acm->ctrlout;
  699. set = (set & TIOCM_DTR ? ACM_CTRL_DTR : 0) |
  700. (set & TIOCM_RTS ? ACM_CTRL_RTS : 0);
  701. clear = (clear & TIOCM_DTR ? ACM_CTRL_DTR : 0) |
  702. (clear & TIOCM_RTS ? ACM_CTRL_RTS : 0);
  703. newctrl = (newctrl & ~clear) | set;
  704. if (acm->ctrlout == newctrl)
  705. return 0;
  706. return acm_set_control(acm, acm->ctrlout = newctrl);
  707. }
  708. static int acm_tty_ioctl(struct tty_struct *tty, struct file *file,
  709. unsigned int cmd, unsigned long arg)
  710. {
  711. struct acm *acm = tty->driver_data;
  712. if (!ACM_READY(acm))
  713. return -EINVAL;
  714. return -ENOIOCTLCMD;
  715. }
  716. static const __u32 acm_tty_speed[] = {
  717. 0, 50, 75, 110, 134, 150, 200, 300, 600,
  718. 1200, 1800, 2400, 4800, 9600, 19200, 38400,
  719. 57600, 115200, 230400, 460800, 500000, 576000,
  720. 921600, 1000000, 1152000, 1500000, 2000000,
  721. 2500000, 3000000, 3500000, 4000000
  722. };
  723. static const __u8 acm_tty_size[] = {
  724. 5, 6, 7, 8
  725. };
  726. static void acm_tty_set_termios(struct tty_struct *tty,
  727. struct ktermios *termios_old)
  728. {
  729. struct acm *acm = tty->driver_data;
  730. struct ktermios *termios = tty->termios;
  731. struct usb_cdc_line_coding newline;
  732. int newctrl = acm->ctrlout;
  733. if (!ACM_READY(acm))
  734. return;
  735. newline.dwDTERate = cpu_to_le32(tty_get_baud_rate(tty));
  736. newline.bCharFormat = termios->c_cflag & CSTOPB ? 2 : 0;
  737. newline.bParityType = termios->c_cflag & PARENB ?
  738. (termios->c_cflag & PARODD ? 1 : 2) +
  739. (termios->c_cflag & CMSPAR ? 2 : 0) : 0;
  740. newline.bDataBits = acm_tty_size[(termios->c_cflag & CSIZE) >> 4];
  741. /* FIXME: Needs to clear unsupported bits in the termios */
  742. acm->clocal = ((termios->c_cflag & CLOCAL) != 0);
  743. if (!newline.dwDTERate) {
  744. newline.dwDTERate = acm->line.dwDTERate;
  745. newctrl &= ~ACM_CTRL_DTR;
  746. } else
  747. newctrl |= ACM_CTRL_DTR;
  748. if (newctrl != acm->ctrlout)
  749. acm_set_control(acm, acm->ctrlout = newctrl);
  750. if (memcmp(&acm->line, &newline, sizeof newline)) {
  751. memcpy(&acm->line, &newline, sizeof newline);
  752. dbg("set line: %d %d %d %d", le32_to_cpu(newline.dwDTERate),
  753. newline.bCharFormat, newline.bParityType,
  754. newline.bDataBits);
  755. acm_set_line(acm, &acm->line);
  756. }
  757. }
  758. /*
  759. * USB probe and disconnect routines.
  760. */
  761. /* Little helpers: write/read buffers free */
  762. static void acm_write_buffers_free(struct acm *acm)
  763. {
  764. int i;
  765. struct acm_wb *wb;
  766. struct usb_device *usb_dev = interface_to_usbdev(acm->control);
  767. for (wb = &acm->wb[0], i = 0; i < ACM_NW; i++, wb++)
  768. usb_buffer_free(usb_dev, acm->writesize, wb->buf, wb->dmah);
  769. }
  770. static void acm_read_buffers_free(struct acm *acm)
  771. {
  772. struct usb_device *usb_dev = interface_to_usbdev(acm->control);
  773. int i, n = acm->rx_buflimit;
  774. for (i = 0; i < n; i++)
  775. usb_buffer_free(usb_dev, acm->readsize,
  776. acm->rb[i].base, acm->rb[i].dma);
  777. }
  778. /* Little helper: write buffers allocate */
  779. static int acm_write_buffers_alloc(struct acm *acm)
  780. {
  781. int i;
  782. struct acm_wb *wb;
  783. for (wb = &acm->wb[0], i = 0; i < ACM_NW; i++, wb++) {
  784. wb->buf = usb_buffer_alloc(acm->dev, acm->writesize, GFP_KERNEL,
  785. &wb->dmah);
  786. if (!wb->buf) {
  787. while (i != 0) {
  788. --i;
  789. --wb;
  790. usb_buffer_free(acm->dev, acm->writesize,
  791. wb->buf, wb->dmah);
  792. }
  793. return -ENOMEM;
  794. }
  795. }
  796. return 0;
  797. }
  798. static int acm_probe(struct usb_interface *intf,
  799. const struct usb_device_id *id)
  800. {
  801. struct usb_cdc_union_desc *union_header = NULL;
  802. struct usb_cdc_country_functional_desc *cfd = NULL;
  803. unsigned char *buffer = intf->altsetting->extra;
  804. int buflen = intf->altsetting->extralen;
  805. struct usb_interface *control_interface;
  806. struct usb_interface *data_interface;
  807. struct usb_endpoint_descriptor *epctrl = NULL;
  808. struct usb_endpoint_descriptor *epread = NULL;
  809. struct usb_endpoint_descriptor *epwrite = NULL;
  810. struct usb_device *usb_dev = interface_to_usbdev(intf);
  811. struct acm *acm;
  812. int minor;
  813. int ctrlsize, readsize;
  814. u8 *buf;
  815. u8 ac_management_function = 0;
  816. u8 call_management_function = 0;
  817. int call_interface_num = -1;
  818. int data_interface_num;
  819. unsigned long quirks;
  820. int num_rx_buf;
  821. int i;
  822. int combined_interfaces = 0;
  823. /* normal quirks */
  824. quirks = (unsigned long)id->driver_info;
  825. num_rx_buf = (quirks == SINGLE_RX_URB) ? 1 : ACM_NR;
  826. /* handle quirks deadly to normal probing*/
  827. if (quirks == NO_UNION_NORMAL) {
  828. data_interface = usb_ifnum_to_if(usb_dev, 1);
  829. control_interface = usb_ifnum_to_if(usb_dev, 0);
  830. goto skip_normal_probe;
  831. }
  832. /* normal probing*/
  833. if (!buffer) {
  834. dev_err(&intf->dev, "Weird descriptor references\n");
  835. return -EINVAL;
  836. }
  837. if (!buflen) {
  838. if (intf->cur_altsetting->endpoint->extralen &&
  839. intf->cur_altsetting->endpoint->extra) {
  840. dev_dbg(&intf->dev,
  841. "Seeking extra descriptors on endpoint\n");
  842. buflen = intf->cur_altsetting->endpoint->extralen;
  843. buffer = intf->cur_altsetting->endpoint->extra;
  844. } else {
  845. dev_err(&intf->dev,
  846. "Zero length descriptor references\n");
  847. return -EINVAL;
  848. }
  849. }
  850. while (buflen > 0) {
  851. if (buffer[1] != USB_DT_CS_INTERFACE) {
  852. dev_err(&intf->dev, "skipping garbage\n");
  853. goto next_desc;
  854. }
  855. switch (buffer[2]) {
  856. case USB_CDC_UNION_TYPE: /* we've found it */
  857. if (union_header) {
  858. dev_err(&intf->dev, "More than one "
  859. "union descriptor, skipping ...\n");
  860. goto next_desc;
  861. }
  862. union_header = (struct usb_cdc_union_desc *)buffer;
  863. break;
  864. case USB_CDC_COUNTRY_TYPE: /* export through sysfs*/
  865. cfd = (struct usb_cdc_country_functional_desc *)buffer;
  866. break;
  867. case USB_CDC_HEADER_TYPE: /* maybe check version */
  868. break; /* for now we ignore it */
  869. case USB_CDC_ACM_TYPE:
  870. ac_management_function = buffer[3];
  871. break;
  872. case USB_CDC_CALL_MANAGEMENT_TYPE:
  873. call_management_function = buffer[3];
  874. call_interface_num = buffer[4];
  875. if ((call_management_function & 3) != 3)
  876. dev_err(&intf->dev, "This device cannot do calls on its own. It is not a modem.\n");
  877. break;
  878. default:
  879. /* there are LOTS more CDC descriptors that
  880. * could legitimately be found here.
  881. */
  882. dev_dbg(&intf->dev, "Ignoring descriptor: "
  883. "type %02x, length %d\n",
  884. buffer[2], buffer[0]);
  885. break;
  886. }
  887. next_desc:
  888. buflen -= buffer[0];
  889. buffer += buffer[0];
  890. }
  891. if (!union_header) {
  892. if (call_interface_num > 0) {
  893. dev_dbg(&intf->dev, "No union descriptor, using call management descriptor\n");
  894. data_interface = usb_ifnum_to_if(usb_dev, (data_interface_num = call_interface_num));
  895. control_interface = intf;
  896. } else {
  897. if (intf->cur_altsetting->desc.bNumEndpoints != 3) {
  898. dev_dbg(&intf->dev,"No union descriptor, giving up\n");
  899. return -ENODEV;
  900. } else {
  901. dev_warn(&intf->dev,"No union descriptor, testing for castrated device\n");
  902. combined_interfaces = 1;
  903. control_interface = data_interface = intf;
  904. goto look_for_collapsed_interface;
  905. }
  906. }
  907. } else {
  908. control_interface = usb_ifnum_to_if(usb_dev, union_header->bMasterInterface0);
  909. data_interface = usb_ifnum_to_if(usb_dev, (data_interface_num = union_header->bSlaveInterface0));
  910. if (!control_interface || !data_interface) {
  911. dev_dbg(&intf->dev, "no interfaces\n");
  912. return -ENODEV;
  913. }
  914. }
  915. if (data_interface_num != call_interface_num)
  916. dev_dbg(&intf->dev, "Separate call control interface. That is not fully supported.\n");
  917. if (control_interface == data_interface) {
  918. /* some broken devices designed for windows work this way */
  919. dev_warn(&intf->dev,"Control and data interfaces are not separated!\n");
  920. combined_interfaces = 1;
  921. /* a popular other OS doesn't use it */
  922. quirks |= NO_CAP_LINE;
  923. if (data_interface->cur_altsetting->desc.bNumEndpoints != 3) {
  924. dev_err(&intf->dev, "This needs exactly 3 endpoints\n");
  925. return -EINVAL;
  926. }
  927. look_for_collapsed_interface:
  928. for (i = 0; i < 3; i++) {
  929. struct usb_endpoint_descriptor *ep;
  930. ep = &data_interface->cur_altsetting->endpoint[i].desc;
  931. if (usb_endpoint_is_int_in(ep))
  932. epctrl = ep;
  933. else if (usb_endpoint_is_bulk_out(ep))
  934. epwrite = ep;
  935. else if (usb_endpoint_is_bulk_in(ep))
  936. epread = ep;
  937. else
  938. return -EINVAL;
  939. }
  940. if (!epctrl || !epread || !epwrite)
  941. return -ENODEV;
  942. else
  943. goto made_compressed_probe;
  944. }
  945. skip_normal_probe:
  946. /*workaround for switched interfaces */
  947. if (data_interface->cur_altsetting->desc.bInterfaceClass
  948. != CDC_DATA_INTERFACE_TYPE) {
  949. if (control_interface->cur_altsetting->desc.bInterfaceClass
  950. == CDC_DATA_INTERFACE_TYPE) {
  951. struct usb_interface *t;
  952. dev_dbg(&intf->dev,
  953. "Your device has switched interfaces.\n");
  954. t = control_interface;
  955. control_interface = data_interface;
  956. data_interface = t;
  957. } else {
  958. return -EINVAL;
  959. }
  960. }
  961. /* Accept probe requests only for the control interface */
  962. if (!combined_interfaces && intf != control_interface)
  963. return -ENODEV;
  964. if (!combined_interfaces && usb_interface_claimed(data_interface)) {
  965. /* valid in this context */
  966. dev_dbg(&intf->dev, "The data interface isn't available\n");
  967. return -EBUSY;
  968. }
  969. if (data_interface->cur_altsetting->desc.bNumEndpoints < 2)
  970. return -EINVAL;
  971. epctrl = &control_interface->cur_altsetting->endpoint[0].desc;
  972. epread = &data_interface->cur_altsetting->endpoint[0].desc;
  973. epwrite = &data_interface->cur_altsetting->endpoint[1].desc;
  974. /* workaround for switched endpoints */
  975. if (!usb_endpoint_dir_in(epread)) {
  976. /* descriptors are swapped */
  977. struct usb_endpoint_descriptor *t;
  978. dev_dbg(&intf->dev,
  979. "The data interface has switched endpoints\n");
  980. t = epread;
  981. epread = epwrite;
  982. epwrite = t;
  983. }
  984. made_compressed_probe:
  985. dbg("interfaces are valid");
  986. for (minor = 0; minor < ACM_TTY_MINORS && acm_table[minor]; minor++);
  987. if (minor == ACM_TTY_MINORS) {
  988. dev_err(&intf->dev, "no more free acm devices\n");
  989. return -ENODEV;
  990. }
  991. acm = kzalloc(sizeof(struct acm), GFP_KERNEL);
  992. if (acm == NULL) {
  993. dev_dbg(&intf->dev, "out of memory (acm kzalloc)\n");
  994. goto alloc_fail;
  995. }
  996. ctrlsize = le16_to_cpu(epctrl->wMaxPacketSize);
  997. readsize = le16_to_cpu(epread->wMaxPacketSize) *
  998. (quirks == SINGLE_RX_URB ? 1 : 2);
  999. acm->combined_interfaces = combined_interfaces;
  1000. acm->writesize = le16_to_cpu(epwrite->wMaxPacketSize) * 20;
  1001. acm->control = control_interface;
  1002. acm->data = data_interface;
  1003. acm->minor = minor;
  1004. acm->dev = usb_dev;
  1005. acm->ctrl_caps = ac_management_function;
  1006. if (quirks & NO_CAP_LINE)
  1007. acm->ctrl_caps &= ~USB_CDC_CAP_LINE;
  1008. acm->ctrlsize = ctrlsize;
  1009. acm->readsize = readsize;
  1010. acm->rx_buflimit = num_rx_buf;
  1011. acm->urb_task.func = acm_rx_tasklet;
  1012. acm->urb_task.data = (unsigned long) acm;
  1013. INIT_WORK(&acm->work, acm_softint);
  1014. INIT_WORK(&acm->waker, acm_waker);
  1015. init_waitqueue_head(&acm->drain_wait);
  1016. spin_lock_init(&acm->throttle_lock);
  1017. spin_lock_init(&acm->write_lock);
  1018. spin_lock_init(&acm->read_lock);
  1019. mutex_init(&acm->mutex);
  1020. acm->rx_endpoint = usb_rcvbulkpipe(usb_dev, epread->bEndpointAddress);
  1021. acm->is_int_ep = usb_endpoint_xfer_int(epread);
  1022. if (acm->is_int_ep)
  1023. acm->bInterval = epread->bInterval;
  1024. tty_port_init(&acm->port);
  1025. acm->port.ops = &acm_port_ops;
  1026. buf = usb_buffer_alloc(usb_dev, ctrlsize, GFP_KERNEL, &acm->ctrl_dma);
  1027. if (!buf) {
  1028. dev_dbg(&intf->dev, "out of memory (ctrl buffer alloc)\n");
  1029. goto alloc_fail2;
  1030. }
  1031. acm->ctrl_buffer = buf;
  1032. if (acm_write_buffers_alloc(acm) < 0) {
  1033. dev_dbg(&intf->dev, "out of memory (write buffer alloc)\n");
  1034. goto alloc_fail4;
  1035. }
  1036. acm->ctrlurb = usb_alloc_urb(0, GFP_KERNEL);
  1037. if (!acm->ctrlurb) {
  1038. dev_dbg(&intf->dev, "out of memory (ctrlurb kmalloc)\n");
  1039. goto alloc_fail5;
  1040. }
  1041. for (i = 0; i < num_rx_buf; i++) {
  1042. struct acm_ru *rcv = &(acm->ru[i]);
  1043. rcv->urb = usb_alloc_urb(0, GFP_KERNEL);
  1044. if (rcv->urb == NULL) {
  1045. dev_dbg(&intf->dev,
  1046. "out of memory (read urbs usb_alloc_urb)\n");
  1047. goto alloc_fail7;
  1048. }
  1049. rcv->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  1050. rcv->instance = acm;
  1051. }
  1052. for (i = 0; i < num_rx_buf; i++) {
  1053. struct acm_rb *rb = &(acm->rb[i]);
  1054. rb->base = usb_buffer_alloc(acm->dev, readsize,
  1055. GFP_KERNEL, &rb->dma);
  1056. if (!rb->base) {
  1057. dev_dbg(&intf->dev,
  1058. "out of memory (read bufs usb_buffer_alloc)\n");
  1059. goto alloc_fail7;
  1060. }
  1061. }
  1062. for (i = 0; i < ACM_NW; i++) {
  1063. struct acm_wb *snd = &(acm->wb[i]);
  1064. snd->urb = usb_alloc_urb(0, GFP_KERNEL);
  1065. if (snd->urb == NULL) {
  1066. dev_dbg(&intf->dev,
  1067. "out of memory (write urbs usb_alloc_urb)");
  1068. goto alloc_fail7;
  1069. }
  1070. if (usb_endpoint_xfer_int(epwrite))
  1071. usb_fill_int_urb(snd->urb, usb_dev,
  1072. usb_sndbulkpipe(usb_dev, epwrite->bEndpointAddress),
  1073. NULL, acm->writesize, acm_write_bulk, snd, epwrite->bInterval);
  1074. else
  1075. usb_fill_bulk_urb(snd->urb, usb_dev,
  1076. usb_sndbulkpipe(usb_dev, epwrite->bEndpointAddress),
  1077. NULL, acm->writesize, acm_write_bulk, snd);
  1078. snd->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  1079. snd->instance = acm;
  1080. }
  1081. usb_set_intfdata(intf, acm);
  1082. i = device_create_file(&intf->dev, &dev_attr_bmCapabilities);
  1083. if (i < 0)
  1084. goto alloc_fail8;
  1085. if (cfd) { /* export the country data */
  1086. acm->country_codes = kmalloc(cfd->bLength - 4, GFP_KERNEL);
  1087. if (!acm->country_codes)
  1088. goto skip_countries;
  1089. acm->country_code_size = cfd->bLength - 4;
  1090. memcpy(acm->country_codes, (u8 *)&cfd->wCountyCode0,
  1091. cfd->bLength - 4);
  1092. acm->country_rel_date = cfd->iCountryCodeRelDate;
  1093. i = device_create_file(&intf->dev, &dev_attr_wCountryCodes);
  1094. if (i < 0) {
  1095. kfree(acm->country_codes);
  1096. goto skip_countries;
  1097. }
  1098. i = device_create_file(&intf->dev,
  1099. &dev_attr_iCountryCodeRelDate);
  1100. if (i < 0) {
  1101. kfree(acm->country_codes);
  1102. goto skip_countries;
  1103. }
  1104. }
  1105. skip_countries:
  1106. usb_fill_int_urb(acm->ctrlurb, usb_dev,
  1107. usb_rcvintpipe(usb_dev, epctrl->bEndpointAddress),
  1108. acm->ctrl_buffer, ctrlsize, acm_ctrl_irq, acm,
  1109. /* works around buggy devices */
  1110. epctrl->bInterval ? epctrl->bInterval : 0xff);
  1111. acm->ctrlurb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  1112. acm->ctrlurb->transfer_dma = acm->ctrl_dma;
  1113. dev_info(&intf->dev, "ttyACM%d: USB ACM device\n", minor);
  1114. acm_set_control(acm, acm->ctrlout);
  1115. acm->line.dwDTERate = cpu_to_le32(9600);
  1116. acm->line.bDataBits = 8;
  1117. acm_set_line(acm, &acm->line);
  1118. usb_driver_claim_interface(&acm_driver, data_interface, acm);
  1119. usb_set_intfdata(data_interface, acm);
  1120. usb_get_intf(control_interface);
  1121. tty_register_device(acm_tty_driver, minor, &control_interface->dev);
  1122. acm_table[minor] = acm;
  1123. return 0;
  1124. alloc_fail8:
  1125. for (i = 0; i < ACM_NW; i++)
  1126. usb_free_urb(acm->wb[i].urb);
  1127. alloc_fail7:
  1128. acm_read_buffers_free(acm);
  1129. for (i = 0; i < num_rx_buf; i++)
  1130. usb_free_urb(acm->ru[i].urb);
  1131. usb_free_urb(acm->ctrlurb);
  1132. alloc_fail5:
  1133. acm_write_buffers_free(acm);
  1134. alloc_fail4:
  1135. usb_buffer_free(usb_dev, ctrlsize, acm->ctrl_buffer, acm->ctrl_dma);
  1136. alloc_fail2:
  1137. kfree(acm);
  1138. alloc_fail:
  1139. return -ENOMEM;
  1140. }
  1141. static void stop_data_traffic(struct acm *acm)
  1142. {
  1143. int i;
  1144. dbg("Entering stop_data_traffic");
  1145. tasklet_disable(&acm->urb_task);
  1146. usb_kill_urb(acm->ctrlurb);
  1147. for (i = 0; i < ACM_NW; i++)
  1148. usb_kill_urb(acm->wb[i].urb);
  1149. for (i = 0; i < acm->rx_buflimit; i++)
  1150. usb_kill_urb(acm->ru[i].urb);
  1151. tasklet_enable(&acm->urb_task);
  1152. cancel_work_sync(&acm->work);
  1153. cancel_work_sync(&acm->waker);
  1154. }
  1155. static void acm_disconnect(struct usb_interface *intf)
  1156. {
  1157. struct acm *acm = usb_get_intfdata(intf);
  1158. struct usb_device *usb_dev = interface_to_usbdev(intf);
  1159. struct tty_struct *tty;
  1160. /* sibling interface is already cleaning up */
  1161. if (!acm)
  1162. return;
  1163. mutex_lock(&open_mutex);
  1164. if (acm->country_codes) {
  1165. device_remove_file(&acm->control->dev,
  1166. &dev_attr_wCountryCodes);
  1167. device_remove_file(&acm->control->dev,
  1168. &dev_attr_iCountryCodeRelDate);
  1169. }
  1170. device_remove_file(&acm->control->dev, &dev_attr_bmCapabilities);
  1171. acm->dev = NULL;
  1172. usb_set_intfdata(acm->control, NULL);
  1173. usb_set_intfdata(acm->data, NULL);
  1174. stop_data_traffic(acm);
  1175. acm_write_buffers_free(acm);
  1176. usb_buffer_free(usb_dev, acm->ctrlsize, acm->ctrl_buffer,
  1177. acm->ctrl_dma);
  1178. acm_read_buffers_free(acm);
  1179. if (!acm->combined_interfaces)
  1180. usb_driver_release_interface(&acm_driver, intf == acm->control ?
  1181. acm->data : acm->control);
  1182. if (acm->port.count == 0) {
  1183. acm_tty_unregister(acm);
  1184. mutex_unlock(&open_mutex);
  1185. return;
  1186. }
  1187. mutex_unlock(&open_mutex);
  1188. tty = tty_port_tty_get(&acm->port);
  1189. if (tty) {
  1190. tty_hangup(tty);
  1191. tty_kref_put(tty);
  1192. }
  1193. }
  1194. #ifdef CONFIG_PM
  1195. static int acm_suspend(struct usb_interface *intf, pm_message_t message)
  1196. {
  1197. struct acm *acm = usb_get_intfdata(intf);
  1198. int cnt;
  1199. if (message.event & PM_EVENT_AUTO) {
  1200. int b;
  1201. spin_lock_irq(&acm->read_lock);
  1202. spin_lock(&acm->write_lock);
  1203. b = acm->processing + acm->transmitting;
  1204. spin_unlock(&acm->write_lock);
  1205. spin_unlock_irq(&acm->read_lock);
  1206. if (b)
  1207. return -EBUSY;
  1208. }
  1209. spin_lock_irq(&acm->read_lock);
  1210. spin_lock(&acm->write_lock);
  1211. cnt = acm->susp_count++;
  1212. spin_unlock(&acm->write_lock);
  1213. spin_unlock_irq(&acm->read_lock);
  1214. if (cnt)
  1215. return 0;
  1216. /*
  1217. we treat opened interfaces differently,
  1218. we must guard against open
  1219. */
  1220. mutex_lock(&acm->mutex);
  1221. if (acm->port.count)
  1222. stop_data_traffic(acm);
  1223. mutex_unlock(&acm->mutex);
  1224. return 0;
  1225. }
  1226. static int acm_resume(struct usb_interface *intf)
  1227. {
  1228. struct acm *acm = usb_get_intfdata(intf);
  1229. int rv = 0;
  1230. int cnt;
  1231. spin_lock_irq(&acm->read_lock);
  1232. acm->susp_count -= 1;
  1233. cnt = acm->susp_count;
  1234. spin_unlock_irq(&acm->read_lock);
  1235. if (cnt)
  1236. return 0;
  1237. mutex_lock(&acm->mutex);
  1238. if (acm->port.count) {
  1239. rv = usb_submit_urb(acm->ctrlurb, GFP_NOIO);
  1240. if (rv < 0)
  1241. goto err_out;
  1242. tasklet_schedule(&acm->urb_task);
  1243. }
  1244. err_out:
  1245. mutex_unlock(&acm->mutex);
  1246. return rv;
  1247. }
  1248. #endif /* CONFIG_PM */
  1249. /*
  1250. * USB driver structure.
  1251. */
  1252. static struct usb_device_id acm_ids[] = {
  1253. /* quirky and broken devices */
  1254. { USB_DEVICE(0x0870, 0x0001), /* Metricom GS Modem */
  1255. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1256. },
  1257. { USB_DEVICE(0x0e8d, 0x0003), /* FIREFLY, MediaTek Inc; andrey.arapov@gmail.com */
  1258. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1259. },
  1260. { USB_DEVICE(0x0e8d, 0x3329), /* MediaTek Inc GPS */
  1261. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1262. },
  1263. { USB_DEVICE(0x0482, 0x0203), /* KYOCERA AH-K3001V */
  1264. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1265. },
  1266. { USB_DEVICE(0x079b, 0x000f), /* BT On-Air USB MODEM */
  1267. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1268. },
  1269. { USB_DEVICE(0x0ace, 0x1602), /* ZyDAS 56K USB MODEM */
  1270. .driver_info = SINGLE_RX_URB,
  1271. },
  1272. { USB_DEVICE(0x0ace, 0x1608), /* ZyDAS 56K USB MODEM */
  1273. .driver_info = SINGLE_RX_URB, /* firmware bug */
  1274. },
  1275. { USB_DEVICE(0x0ace, 0x1611), /* ZyDAS 56K USB MODEM - new version */
  1276. .driver_info = SINGLE_RX_URB, /* firmware bug */
  1277. },
  1278. { USB_DEVICE(0x22b8, 0x7000), /* Motorola Q Phone */
  1279. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1280. },
  1281. { USB_DEVICE(0x0803, 0x3095), /* Zoom Telephonics Model 3095F USB MODEM */
  1282. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1283. },
  1284. { USB_DEVICE(0x0572, 0x1321), /* Conexant USB MODEM CX93010 */
  1285. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1286. },
  1287. { USB_DEVICE(0x0572, 0x1324), /* Conexant USB MODEM RD02-D400 */
  1288. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1289. },
  1290. { USB_DEVICE(0x0572, 0x1328), /* Shiro / Aztech USB MODEM UM-3100 */
  1291. .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
  1292. },
  1293. { USB_DEVICE(0x22b8, 0x6425), /* Motorola MOTOMAGX phones */
  1294. },
  1295. { USB_DEVICE(0x0572, 0x1329), /* Hummingbird huc56s (Conexant) */
  1296. .driver_info = NO_UNION_NORMAL, /* union descriptor misplaced on
  1297. data interface instead of
  1298. communications interface.
  1299. Maybe we should define a new
  1300. quirk for this. */
  1301. },
  1302. { USB_DEVICE(0x1bbb, 0x0003), /* Alcatel OT-I650 */
  1303. .driver_info = NO_UNION_NORMAL, /* reports zero length descriptor */
  1304. },
  1305. /* control interfaces with various AT-command sets */
  1306. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1307. USB_CDC_ACM_PROTO_AT_V25TER) },
  1308. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1309. USB_CDC_ACM_PROTO_AT_PCCA101) },
  1310. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1311. USB_CDC_ACM_PROTO_AT_PCCA101_WAKE) },
  1312. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1313. USB_CDC_ACM_PROTO_AT_GSM) },
  1314. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1315. USB_CDC_ACM_PROTO_AT_3G) },
  1316. { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
  1317. USB_CDC_ACM_PROTO_AT_CDMA) },
  1318. /* NOTE: COMM/ACM/0xff is likely MSFT RNDIS ... NOT a modem!! */
  1319. { }
  1320. };
  1321. MODULE_DEVICE_TABLE(usb, acm_ids);
  1322. static struct usb_driver acm_driver = {
  1323. .name = "cdc_acm",
  1324. .probe = acm_probe,
  1325. .disconnect = acm_disconnect,
  1326. #ifdef CONFIG_PM
  1327. .suspend = acm_suspend,
  1328. .resume = acm_resume,
  1329. #endif
  1330. .id_table = acm_ids,
  1331. #ifdef CONFIG_PM
  1332. .supports_autosuspend = 1,
  1333. #endif
  1334. };
  1335. /*
  1336. * TTY driver structures.
  1337. */
  1338. static const struct tty_operations acm_ops = {
  1339. .open = acm_tty_open,
  1340. .close = acm_tty_close,
  1341. .hangup = acm_tty_hangup,
  1342. .write = acm_tty_write,
  1343. .write_room = acm_tty_write_room,
  1344. .ioctl = acm_tty_ioctl,
  1345. .throttle = acm_tty_throttle,
  1346. .unthrottle = acm_tty_unthrottle,
  1347. .chars_in_buffer = acm_tty_chars_in_buffer,
  1348. .break_ctl = acm_tty_break_ctl,
  1349. .set_termios = acm_tty_set_termios,
  1350. .tiocmget = acm_tty_tiocmget,
  1351. .tiocmset = acm_tty_tiocmset,
  1352. };
  1353. /*
  1354. * Init / exit.
  1355. */
  1356. static int __init acm_init(void)
  1357. {
  1358. int retval;
  1359. acm_tty_driver = alloc_tty_driver(ACM_TTY_MINORS);
  1360. if (!acm_tty_driver)
  1361. return -ENOMEM;
  1362. acm_tty_driver->owner = THIS_MODULE,
  1363. acm_tty_driver->driver_name = "acm",
  1364. acm_tty_driver->name = "ttyACM",
  1365. acm_tty_driver->major = ACM_TTY_MAJOR,
  1366. acm_tty_driver->minor_start = 0,
  1367. acm_tty_driver->type = TTY_DRIVER_TYPE_SERIAL,
  1368. acm_tty_driver->subtype = SERIAL_TYPE_NORMAL,
  1369. acm_tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
  1370. acm_tty_driver->init_termios = tty_std_termios;
  1371. acm_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD |
  1372. HUPCL | CLOCAL;
  1373. tty_set_operations(acm_tty_driver, &acm_ops);
  1374. retval = tty_register_driver(acm_tty_driver);
  1375. if (retval) {
  1376. put_tty_driver(acm_tty_driver);
  1377. return retval;
  1378. }
  1379. retval = usb_register(&acm_driver);
  1380. if (retval) {
  1381. tty_unregister_driver(acm_tty_driver);
  1382. put_tty_driver(acm_tty_driver);
  1383. return retval;
  1384. }
  1385. printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
  1386. DRIVER_DESC "\n");
  1387. return 0;
  1388. }
  1389. static void __exit acm_exit(void)
  1390. {
  1391. usb_deregister(&acm_driver);
  1392. tty_unregister_driver(acm_tty_driver);
  1393. put_tty_driver(acm_tty_driver);
  1394. }
  1395. module_init(acm_init);
  1396. module_exit(acm_exit);
  1397. MODULE_AUTHOR(DRIVER_AUTHOR);
  1398. MODULE_DESCRIPTION(DRIVER_DESC);
  1399. MODULE_LICENSE("GPL");
  1400. MODULE_ALIAS_CHARDEV_MAJOR(ACM_TTY_MAJOR);