cdc-acm.c 38 KB

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