USB: cdc-acm: fix memory corruption / panic
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / usb / class / cdc-acm.c
blob2b26ff81b59d65d043914cedf2132d56bdf6c9b4
1 /*
2 * cdc-acm.c
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>
11 * USB Abstract Control Model driver for USB modems and ISDN adapters
13 * Sponsored by SuSE
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
39 * This program is free software; you can redistribute it and/or modify
40 * it under the terms of the GNU General Public License as published by
41 * the Free Software Foundation; either version 2 of the License, or
42 * (at your option) any later version.
44 * This program is distributed in the hope that it will be useful,
45 * but WITHOUT ANY WARRANTY; without even the implied warranty of
46 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
47 * GNU General Public License for more details.
49 * You should have received a copy of the GNU General Public License
50 * along with this program; if not, write to the Free Software
51 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
54 #undef DEBUG
55 #undef VERBOSE_DEBUG
57 #include <linux/kernel.h>
58 #include <linux/errno.h>
59 #include <linux/init.h>
60 #include <linux/slab.h>
61 #include <linux/tty.h>
62 #include <linux/serial.h>
63 #include <linux/tty_driver.h>
64 #include <linux/tty_flip.h>
65 #include <linux/module.h>
66 #include <linux/mutex.h>
67 #include <linux/uaccess.h>
68 #include <linux/usb.h>
69 #include <linux/usb/cdc.h>
70 #include <asm/byteorder.h>
71 #include <asm/unaligned.h>
72 #include <linux/list.h>
74 #include "cdc-acm.h"
77 #define ACM_CLOSE_TIMEOUT 15 /* seconds to let writes drain */
80 * Version Information
82 #define DRIVER_VERSION "v0.26"
83 #define DRIVER_AUTHOR "Armin Fuerst, Pavel Machek, Johannes Erdfelt, Vojtech Pavlik, David Kubicek"
84 #define DRIVER_DESC "USB Abstract Control Model driver for USB modems and ISDN adapters"
86 static struct usb_driver acm_driver;
87 static struct tty_driver *acm_tty_driver;
88 static struct acm *acm_table[ACM_TTY_MINORS];
90 static DEFINE_MUTEX(open_mutex);
92 #define ACM_READY(acm) (acm && acm->dev && acm->port.count)
94 static const struct tty_port_operations acm_port_ops = {
97 #ifdef VERBOSE_DEBUG
98 #define verbose 1
99 #else
100 #define verbose 0
101 #endif
104 * Functions for ACM control messages.
107 static int acm_ctrl_msg(struct acm *acm, int request, int value,
108 void *buf, int len)
110 int retval = usb_control_msg(acm->dev, usb_sndctrlpipe(acm->dev, 0),
111 request, USB_RT_ACM, value,
112 acm->control->altsetting[0].desc.bInterfaceNumber,
113 buf, len, 5000);
114 dbg("acm_control_msg: rq: 0x%02x val: %#x len: %#x result: %d",
115 request, value, len, retval);
116 return retval < 0 ? retval : 0;
119 /* devices aren't required to support these requests.
120 * the cdc acm descriptor tells whether they do...
122 #define acm_set_control(acm, control) \
123 acm_ctrl_msg(acm, USB_CDC_REQ_SET_CONTROL_LINE_STATE, control, NULL, 0)
124 #define acm_set_line(acm, line) \
125 acm_ctrl_msg(acm, USB_CDC_REQ_SET_LINE_CODING, 0, line, sizeof *(line))
126 #define acm_send_break(acm, ms) \
127 acm_ctrl_msg(acm, USB_CDC_REQ_SEND_BREAK, ms, NULL, 0)
130 * Write buffer management.
131 * All of these assume proper locks taken by the caller.
134 static int acm_wb_alloc(struct acm *acm)
136 int i, wbn;
137 struct acm_wb *wb;
139 wbn = 0;
140 i = 0;
141 for (;;) {
142 wb = &acm->wb[wbn];
143 if (!wb->use) {
144 wb->use = 1;
145 return wbn;
147 wbn = (wbn + 1) % ACM_NW;
148 if (++i >= ACM_NW)
149 return -1;
153 static int acm_wb_is_avail(struct acm *acm)
155 int i, n;
156 unsigned long flags;
158 n = ACM_NW;
159 spin_lock_irqsave(&acm->write_lock, flags);
160 for (i = 0; i < ACM_NW; i++)
161 n -= acm->wb[i].use;
162 spin_unlock_irqrestore(&acm->write_lock, flags);
163 return n;
167 * Finish write. Caller must hold acm->write_lock
169 static void acm_write_done(struct acm *acm, struct acm_wb *wb)
171 wb->use = 0;
172 acm->transmitting--;
173 usb_autopm_put_interface_async(acm->control);
177 * Poke write.
179 * the caller is responsible for locking
182 static int acm_start_wb(struct acm *acm, struct acm_wb *wb)
184 int rc;
186 acm->transmitting++;
188 wb->urb->transfer_buffer = wb->buf;
189 wb->urb->transfer_dma = wb->dmah;
190 wb->urb->transfer_buffer_length = wb->len;
191 wb->urb->dev = acm->dev;
193 rc = usb_submit_urb(wb->urb, GFP_ATOMIC);
194 if (rc < 0) {
195 dbg("usb_submit_urb(write bulk) failed: %d", rc);
196 acm_write_done(acm, wb);
198 return rc;
201 static int acm_write_start(struct acm *acm, int wbn)
203 unsigned long flags;
204 struct acm_wb *wb = &acm->wb[wbn];
205 int rc;
207 spin_lock_irqsave(&acm->write_lock, flags);
208 if (!acm->dev) {
209 wb->use = 0;
210 spin_unlock_irqrestore(&acm->write_lock, flags);
211 return -ENODEV;
214 dbg("%s susp_count: %d", __func__, acm->susp_count);
215 usb_autopm_get_interface_async(acm->control);
216 if (acm->susp_count) {
217 if (!acm->delayed_wb)
218 acm->delayed_wb = wb;
219 else
220 usb_autopm_put_interface_async(acm->control);
221 spin_unlock_irqrestore(&acm->write_lock, flags);
222 return 0; /* A white lie */
224 usb_mark_last_busy(acm->dev);
226 rc = acm_start_wb(acm, wb);
227 spin_unlock_irqrestore(&acm->write_lock, flags);
229 return rc;
233 * attributes exported through sysfs
235 static ssize_t show_caps
236 (struct device *dev, struct device_attribute *attr, char *buf)
238 struct usb_interface *intf = to_usb_interface(dev);
239 struct acm *acm = usb_get_intfdata(intf);
241 return sprintf(buf, "%d", acm->ctrl_caps);
243 static DEVICE_ATTR(bmCapabilities, S_IRUGO, show_caps, NULL);
245 static ssize_t show_country_codes
246 (struct device *dev, struct device_attribute *attr, char *buf)
248 struct usb_interface *intf = to_usb_interface(dev);
249 struct acm *acm = usb_get_intfdata(intf);
251 memcpy(buf, acm->country_codes, acm->country_code_size);
252 return acm->country_code_size;
255 static DEVICE_ATTR(wCountryCodes, S_IRUGO, show_country_codes, NULL);
257 static ssize_t show_country_rel_date
258 (struct device *dev, struct device_attribute *attr, char *buf)
260 struct usb_interface *intf = to_usb_interface(dev);
261 struct acm *acm = usb_get_intfdata(intf);
263 return sprintf(buf, "%d", acm->country_rel_date);
266 static DEVICE_ATTR(iCountryCodeRelDate, S_IRUGO, show_country_rel_date, NULL);
268 * Interrupt handlers for various ACM device responses
271 /* control interface reports status changes with "interrupt" transfers */
272 static void acm_ctrl_irq(struct urb *urb)
274 struct acm *acm = urb->context;
275 struct usb_cdc_notification *dr = urb->transfer_buffer;
276 struct tty_struct *tty;
277 unsigned char *data;
278 int newctrl;
279 int retval;
280 int status = urb->status;
282 switch (status) {
283 case 0:
284 /* success */
285 break;
286 case -ECONNRESET:
287 case -ENOENT:
288 case -ESHUTDOWN:
289 /* this urb is terminated, clean up */
290 dbg("%s - urb shutting down with status: %d", __func__, status);
291 return;
292 default:
293 dbg("%s - nonzero urb status received: %d", __func__, status);
294 goto exit;
297 if (!ACM_READY(acm))
298 goto exit;
300 data = (unsigned char *)(dr + 1);
301 switch (dr->bNotificationType) {
302 case USB_CDC_NOTIFY_NETWORK_CONNECTION:
303 dbg("%s network", dr->wValue ?
304 "connected to" : "disconnected from");
305 break;
307 case USB_CDC_NOTIFY_SERIAL_STATE:
308 tty = tty_port_tty_get(&acm->port);
309 newctrl = get_unaligned_le16(data);
311 if (tty) {
312 if (!acm->clocal &&
313 (acm->ctrlin & ~newctrl & ACM_CTRL_DCD)) {
314 dbg("calling hangup");
315 tty_hangup(tty);
317 tty_kref_put(tty);
320 acm->ctrlin = newctrl;
322 dbg("input control lines: dcd%c dsr%c break%c ring%c framing%c parity%c overrun%c",
323 acm->ctrlin & ACM_CTRL_DCD ? '+' : '-',
324 acm->ctrlin & ACM_CTRL_DSR ? '+' : '-',
325 acm->ctrlin & ACM_CTRL_BRK ? '+' : '-',
326 acm->ctrlin & ACM_CTRL_RI ? '+' : '-',
327 acm->ctrlin & ACM_CTRL_FRAMING ? '+' : '-',
328 acm->ctrlin & ACM_CTRL_PARITY ? '+' : '-',
329 acm->ctrlin & ACM_CTRL_OVERRUN ? '+' : '-');
330 break;
332 default:
333 dbg("unknown notification %d received: index %d len %d data0 %d data1 %d",
334 dr->bNotificationType, dr->wIndex,
335 dr->wLength, data[0], data[1]);
336 break;
338 exit:
339 usb_mark_last_busy(acm->dev);
340 retval = usb_submit_urb(urb, GFP_ATOMIC);
341 if (retval)
342 dev_err(&urb->dev->dev, "%s - usb_submit_urb failed with "
343 "result %d", __func__, retval);
346 /* data interface returns incoming bytes, or we got unthrottled */
347 static void acm_read_bulk(struct urb *urb)
349 struct acm_rb *buf;
350 struct acm_ru *rcv = urb->context;
351 struct acm *acm = rcv->instance;
352 int status = urb->status;
354 dbg("Entering acm_read_bulk with status %d", status);
356 if (!ACM_READY(acm)) {
357 dev_dbg(&acm->data->dev, "Aborting, acm not ready");
358 return;
360 usb_mark_last_busy(acm->dev);
362 if (status)
363 dev_dbg(&acm->data->dev, "bulk rx status %d\n", status);
365 buf = rcv->buffer;
366 buf->size = urb->actual_length;
368 if (likely(status == 0)) {
369 spin_lock(&acm->read_lock);
370 acm->processing++;
371 list_add_tail(&rcv->list, &acm->spare_read_urbs);
372 list_add_tail(&buf->list, &acm->filled_read_bufs);
373 spin_unlock(&acm->read_lock);
374 } else {
375 /* we drop the buffer due to an error */
376 spin_lock(&acm->read_lock);
377 list_add_tail(&rcv->list, &acm->spare_read_urbs);
378 list_add(&buf->list, &acm->spare_read_bufs);
379 spin_unlock(&acm->read_lock);
380 /* nevertheless the tasklet must be kicked unconditionally
381 so the queue cannot dry up */
383 if (likely(!acm->susp_count))
384 tasklet_schedule(&acm->urb_task);
387 static void acm_rx_tasklet(unsigned long _acm)
389 struct acm *acm = (void *)_acm;
390 struct acm_rb *buf;
391 struct tty_struct *tty;
392 struct acm_ru *rcv;
393 unsigned long flags;
394 unsigned char throttled;
396 dbg("Entering acm_rx_tasklet");
398 if (!ACM_READY(acm)) {
399 dbg("acm_rx_tasklet: ACM not ready");
400 return;
403 spin_lock_irqsave(&acm->throttle_lock, flags);
404 throttled = acm->throttle;
405 spin_unlock_irqrestore(&acm->throttle_lock, flags);
406 if (throttled) {
407 dbg("acm_rx_tasklet: throttled");
408 return;
411 tty = tty_port_tty_get(&acm->port);
413 next_buffer:
414 spin_lock_irqsave(&acm->read_lock, flags);
415 if (list_empty(&acm->filled_read_bufs)) {
416 spin_unlock_irqrestore(&acm->read_lock, flags);
417 goto urbs;
419 buf = list_entry(acm->filled_read_bufs.next,
420 struct acm_rb, list);
421 list_del(&buf->list);
422 spin_unlock_irqrestore(&acm->read_lock, flags);
424 dbg("acm_rx_tasklet: procesing buf 0x%p, size = %d", buf, buf->size);
426 if (tty) {
427 spin_lock_irqsave(&acm->throttle_lock, flags);
428 throttled = acm->throttle;
429 spin_unlock_irqrestore(&acm->throttle_lock, flags);
430 if (!throttled) {
431 tty_buffer_request_room(tty, buf->size);
432 tty_insert_flip_string(tty, buf->base, buf->size);
433 tty_flip_buffer_push(tty);
434 } else {
435 tty_kref_put(tty);
436 dbg("Throttling noticed");
437 spin_lock_irqsave(&acm->read_lock, flags);
438 list_add(&buf->list, &acm->filled_read_bufs);
439 spin_unlock_irqrestore(&acm->read_lock, flags);
440 return;
444 spin_lock_irqsave(&acm->read_lock, flags);
445 list_add(&buf->list, &acm->spare_read_bufs);
446 spin_unlock_irqrestore(&acm->read_lock, flags);
447 goto next_buffer;
449 urbs:
450 tty_kref_put(tty);
452 while (!list_empty(&acm->spare_read_bufs)) {
453 spin_lock_irqsave(&acm->read_lock, flags);
454 if (list_empty(&acm->spare_read_urbs)) {
455 acm->processing = 0;
456 spin_unlock_irqrestore(&acm->read_lock, flags);
457 return;
459 rcv = list_entry(acm->spare_read_urbs.next,
460 struct acm_ru, list);
461 list_del(&rcv->list);
462 spin_unlock_irqrestore(&acm->read_lock, flags);
464 buf = list_entry(acm->spare_read_bufs.next,
465 struct acm_rb, list);
466 list_del(&buf->list);
468 rcv->buffer = buf;
470 if (acm->is_int_ep)
471 usb_fill_int_urb(rcv->urb, acm->dev,
472 acm->rx_endpoint,
473 buf->base,
474 acm->readsize,
475 acm_read_bulk, rcv, acm->bInterval);
476 else
477 usb_fill_bulk_urb(rcv->urb, acm->dev,
478 acm->rx_endpoint,
479 buf->base,
480 acm->readsize,
481 acm_read_bulk, rcv);
482 rcv->urb->transfer_dma = buf->dma;
483 rcv->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
485 /* This shouldn't kill the driver as unsuccessful URBs are
486 returned to the free-urbs-pool and resubmited ASAP */
487 spin_lock_irqsave(&acm->read_lock, flags);
488 if (acm->susp_count ||
489 usb_submit_urb(rcv->urb, GFP_ATOMIC) < 0) {
490 list_add(&buf->list, &acm->spare_read_bufs);
491 list_add(&rcv->list, &acm->spare_read_urbs);
492 acm->processing = 0;
493 spin_unlock_irqrestore(&acm->read_lock, flags);
494 return;
495 } else {
496 spin_unlock_irqrestore(&acm->read_lock, flags);
497 dbg("acm_rx_tasklet: sending urb 0x%p, rcv 0x%p, buf 0x%p", rcv->urb, rcv, buf);
500 spin_lock_irqsave(&acm->read_lock, flags);
501 acm->processing = 0;
502 spin_unlock_irqrestore(&acm->read_lock, flags);
505 /* data interface wrote those outgoing bytes */
506 static void acm_write_bulk(struct urb *urb)
508 struct acm_wb *wb = urb->context;
509 struct acm *acm = wb->instance;
510 unsigned long flags;
512 if (verbose || urb->status
513 || (urb->actual_length != urb->transfer_buffer_length))
514 dev_dbg(&acm->data->dev, "tx %d/%d bytes -- > %d\n",
515 urb->actual_length,
516 urb->transfer_buffer_length,
517 urb->status);
519 spin_lock_irqsave(&acm->write_lock, flags);
520 acm_write_done(acm, wb);
521 spin_unlock_irqrestore(&acm->write_lock, flags);
522 if (ACM_READY(acm))
523 schedule_work(&acm->work);
524 else
525 wake_up_interruptible(&acm->drain_wait);
528 static void acm_softint(struct work_struct *work)
530 struct acm *acm = container_of(work, struct acm, work);
531 struct tty_struct *tty;
533 dev_vdbg(&acm->data->dev, "tx work\n");
534 if (!ACM_READY(acm))
535 return;
536 tty = tty_port_tty_get(&acm->port);
537 tty_wakeup(tty);
538 tty_kref_put(tty);
542 * TTY handlers
545 static int acm_tty_open(struct tty_struct *tty, struct file *filp)
547 struct acm *acm;
548 int rv = -ENODEV;
549 int i;
550 dbg("Entering acm_tty_open.");
552 mutex_lock(&open_mutex);
554 acm = acm_table[tty->index];
555 if (!acm || !acm->dev)
556 goto err_out;
557 else
558 rv = 0;
560 set_bit(TTY_NO_WRITE_SPLIT, &tty->flags);
562 tty->driver_data = acm;
563 tty_port_tty_set(&acm->port, tty);
565 if (usb_autopm_get_interface(acm->control) < 0)
566 goto early_bail;
567 else
568 acm->control->needs_remote_wakeup = 1;
570 mutex_lock(&acm->mutex);
571 if (acm->port.count++) {
572 usb_autopm_put_interface(acm->control);
573 goto done;
576 acm->ctrlurb->dev = acm->dev;
577 if (usb_submit_urb(acm->ctrlurb, GFP_KERNEL)) {
578 dbg("usb_submit_urb(ctrl irq) failed");
579 goto bail_out;
582 if (0 > acm_set_control(acm, acm->ctrlout = ACM_CTRL_DTR | ACM_CTRL_RTS) &&
583 (acm->ctrl_caps & USB_CDC_CAP_LINE))
584 goto full_bailout;
586 usb_autopm_put_interface(acm->control);
588 INIT_LIST_HEAD(&acm->spare_read_urbs);
589 INIT_LIST_HEAD(&acm->spare_read_bufs);
590 INIT_LIST_HEAD(&acm->filled_read_bufs);
592 for (i = 0; i < acm->rx_buflimit; i++)
593 list_add(&(acm->ru[i].list), &acm->spare_read_urbs);
594 for (i = 0; i < acm->rx_buflimit; i++)
595 list_add(&(acm->rb[i].list), &acm->spare_read_bufs);
597 acm->throttle = 0;
599 set_bit(ASYNCB_INITIALIZED, &acm->port.flags);
600 rv = tty_port_block_til_ready(&acm->port, tty, filp);
601 tasklet_schedule(&acm->urb_task);
602 done:
603 mutex_unlock(&acm->mutex);
604 err_out:
605 mutex_unlock(&open_mutex);
606 return rv;
608 full_bailout:
609 usb_kill_urb(acm->ctrlurb);
610 bail_out:
611 usb_autopm_put_interface(acm->control);
612 acm->port.count--;
613 mutex_unlock(&acm->mutex);
614 early_bail:
615 mutex_unlock(&open_mutex);
616 tty_port_tty_set(&acm->port, NULL);
617 return -EIO;
620 static void acm_tty_unregister(struct acm *acm)
622 int i, nr;
624 nr = acm->rx_buflimit;
625 tty_unregister_device(acm_tty_driver, acm->minor);
626 usb_put_intf(acm->control);
627 acm_table[acm->minor] = NULL;
628 usb_free_urb(acm->ctrlurb);
629 for (i = 0; i < ACM_NW; i++)
630 usb_free_urb(acm->wb[i].urb);
631 for (i = 0; i < nr; i++)
632 usb_free_urb(acm->ru[i].urb);
633 kfree(acm->country_codes);
634 kfree(acm);
637 static int acm_tty_chars_in_buffer(struct tty_struct *tty);
639 static void acm_port_down(struct acm *acm, int drain)
641 int i, nr = acm->rx_buflimit;
642 mutex_lock(&open_mutex);
643 if (acm->dev) {
644 usb_autopm_get_interface(acm->control);
645 acm_set_control(acm, acm->ctrlout = 0);
646 /* try letting the last writes drain naturally */
647 if (drain) {
648 wait_event_interruptible_timeout(acm->drain_wait,
649 (ACM_NW == acm_wb_is_avail(acm)) || !acm->dev,
650 ACM_CLOSE_TIMEOUT * HZ);
652 usb_kill_urb(acm->ctrlurb);
653 for (i = 0; i < ACM_NW; i++)
654 usb_kill_urb(acm->wb[i].urb);
655 tasklet_disable(&acm->urb_task);
656 for (i = 0; i < nr; i++)
657 usb_kill_urb(acm->ru[i].urb);
658 tasklet_enable(&acm->urb_task);
659 acm->control->needs_remote_wakeup = 0;
660 usb_autopm_put_interface(acm->control);
662 mutex_unlock(&open_mutex);
665 static void acm_tty_hangup(struct tty_struct *tty)
667 struct acm *acm = tty->driver_data;
668 tty_port_hangup(&acm->port);
669 acm_port_down(acm, 0);
672 static void acm_tty_close(struct tty_struct *tty, struct file *filp)
674 struct acm *acm = tty->driver_data;
676 /* Perform the closing process and see if we need to do the hardware
677 shutdown */
678 if (!acm)
679 return;
680 if (tty_port_close_start(&acm->port, tty, filp) == 0) {
681 mutex_lock(&open_mutex);
682 if (!acm->dev) {
683 tty_port_tty_set(&acm->port, NULL);
684 acm_tty_unregister(acm);
685 tty->driver_data = NULL;
687 mutex_unlock(&open_mutex);
688 return;
690 acm_port_down(acm, 0);
691 tty_port_close_end(&acm->port, tty);
692 tty_port_tty_set(&acm->port, NULL);
695 static int acm_tty_write(struct tty_struct *tty,
696 const unsigned char *buf, int count)
698 struct acm *acm = tty->driver_data;
699 int stat;
700 unsigned long flags;
701 int wbn;
702 struct acm_wb *wb;
704 dbg("Entering acm_tty_write to write %d bytes,", count);
706 if (!ACM_READY(acm))
707 return -EINVAL;
708 if (!count)
709 return 0;
711 spin_lock_irqsave(&acm->write_lock, flags);
712 wbn = acm_wb_alloc(acm);
713 if (wbn < 0) {
714 spin_unlock_irqrestore(&acm->write_lock, flags);
715 return 0;
717 wb = &acm->wb[wbn];
719 count = (count > acm->writesize) ? acm->writesize : count;
720 dbg("Get %d bytes...", count);
721 memcpy(wb->buf, buf, count);
722 wb->len = count;
723 spin_unlock_irqrestore(&acm->write_lock, flags);
725 stat = acm_write_start(acm, wbn);
726 if (stat < 0)
727 return stat;
728 return count;
731 static int acm_tty_write_room(struct tty_struct *tty)
733 struct acm *acm = tty->driver_data;
734 if (!ACM_READY(acm))
735 return -EINVAL;
737 * Do not let the line discipline to know that we have a reserve,
738 * or it might get too enthusiastic.
740 return acm_wb_is_avail(acm) ? acm->writesize : 0;
743 static int acm_tty_chars_in_buffer(struct tty_struct *tty)
745 struct acm *acm = tty->driver_data;
746 if (!ACM_READY(acm))
747 return 0;
749 * This is inaccurate (overcounts), but it works.
751 return (ACM_NW - acm_wb_is_avail(acm)) * acm->writesize;
754 static void acm_tty_throttle(struct tty_struct *tty)
756 struct acm *acm = tty->driver_data;
757 if (!ACM_READY(acm))
758 return;
759 spin_lock_bh(&acm->throttle_lock);
760 acm->throttle = 1;
761 spin_unlock_bh(&acm->throttle_lock);
764 static void acm_tty_unthrottle(struct tty_struct *tty)
766 struct acm *acm = tty->driver_data;
767 if (!ACM_READY(acm))
768 return;
769 spin_lock_bh(&acm->throttle_lock);
770 acm->throttle = 0;
771 spin_unlock_bh(&acm->throttle_lock);
772 tasklet_schedule(&acm->urb_task);
775 static int acm_tty_break_ctl(struct tty_struct *tty, int state)
777 struct acm *acm = tty->driver_data;
778 int retval;
779 if (!ACM_READY(acm))
780 return -EINVAL;
781 retval = acm_send_break(acm, state ? 0xffff : 0);
782 if (retval < 0)
783 dbg("send break failed");
784 return retval;
787 static int acm_tty_tiocmget(struct tty_struct *tty, struct file *file)
789 struct acm *acm = tty->driver_data;
791 if (!ACM_READY(acm))
792 return -EINVAL;
794 return (acm->ctrlout & ACM_CTRL_DTR ? TIOCM_DTR : 0) |
795 (acm->ctrlout & ACM_CTRL_RTS ? TIOCM_RTS : 0) |
796 (acm->ctrlin & ACM_CTRL_DSR ? TIOCM_DSR : 0) |
797 (acm->ctrlin & ACM_CTRL_RI ? TIOCM_RI : 0) |
798 (acm->ctrlin & ACM_CTRL_DCD ? TIOCM_CD : 0) |
799 TIOCM_CTS;
802 static int acm_tty_tiocmset(struct tty_struct *tty, struct file *file,
803 unsigned int set, unsigned int clear)
805 struct acm *acm = tty->driver_data;
806 unsigned int newctrl;
808 if (!ACM_READY(acm))
809 return -EINVAL;
811 newctrl = acm->ctrlout;
812 set = (set & TIOCM_DTR ? ACM_CTRL_DTR : 0) |
813 (set & TIOCM_RTS ? ACM_CTRL_RTS : 0);
814 clear = (clear & TIOCM_DTR ? ACM_CTRL_DTR : 0) |
815 (clear & TIOCM_RTS ? ACM_CTRL_RTS : 0);
817 newctrl = (newctrl & ~clear) | set;
819 if (acm->ctrlout == newctrl)
820 return 0;
821 return acm_set_control(acm, acm->ctrlout = newctrl);
824 static int acm_tty_ioctl(struct tty_struct *tty, struct file *file,
825 unsigned int cmd, unsigned long arg)
827 struct acm *acm = tty->driver_data;
829 if (!ACM_READY(acm))
830 return -EINVAL;
832 return -ENOIOCTLCMD;
835 static const __u32 acm_tty_speed[] = {
836 0, 50, 75, 110, 134, 150, 200, 300, 600,
837 1200, 1800, 2400, 4800, 9600, 19200, 38400,
838 57600, 115200, 230400, 460800, 500000, 576000,
839 921600, 1000000, 1152000, 1500000, 2000000,
840 2500000, 3000000, 3500000, 4000000
843 static const __u8 acm_tty_size[] = {
844 5, 6, 7, 8
847 static void acm_tty_set_termios(struct tty_struct *tty,
848 struct ktermios *termios_old)
850 struct acm *acm = tty->driver_data;
851 struct ktermios *termios = tty->termios;
852 struct usb_cdc_line_coding newline;
853 int newctrl = acm->ctrlout;
855 if (!ACM_READY(acm))
856 return;
858 newline.dwDTERate = cpu_to_le32(tty_get_baud_rate(tty));
859 newline.bCharFormat = termios->c_cflag & CSTOPB ? 2 : 0;
860 newline.bParityType = termios->c_cflag & PARENB ?
861 (termios->c_cflag & PARODD ? 1 : 2) +
862 (termios->c_cflag & CMSPAR ? 2 : 0) : 0;
863 newline.bDataBits = acm_tty_size[(termios->c_cflag & CSIZE) >> 4];
864 /* FIXME: Needs to clear unsupported bits in the termios */
865 acm->clocal = ((termios->c_cflag & CLOCAL) != 0);
867 if (!newline.dwDTERate) {
868 newline.dwDTERate = acm->line.dwDTERate;
869 newctrl &= ~ACM_CTRL_DTR;
870 } else
871 newctrl |= ACM_CTRL_DTR;
873 if (newctrl != acm->ctrlout)
874 acm_set_control(acm, acm->ctrlout = newctrl);
876 if (memcmp(&acm->line, &newline, sizeof newline)) {
877 memcpy(&acm->line, &newline, sizeof newline);
878 dbg("set line: %d %d %d %d", le32_to_cpu(newline.dwDTERate),
879 newline.bCharFormat, newline.bParityType,
880 newline.bDataBits);
881 acm_set_line(acm, &acm->line);
886 * USB probe and disconnect routines.
889 /* Little helpers: write/read buffers free */
890 static void acm_write_buffers_free(struct acm *acm)
892 int i;
893 struct acm_wb *wb;
894 struct usb_device *usb_dev = interface_to_usbdev(acm->control);
896 for (wb = &acm->wb[0], i = 0; i < ACM_NW; i++, wb++)
897 usb_buffer_free(usb_dev, acm->writesize, wb->buf, wb->dmah);
900 static void acm_read_buffers_free(struct acm *acm)
902 struct usb_device *usb_dev = interface_to_usbdev(acm->control);
903 int i, n = acm->rx_buflimit;
905 for (i = 0; i < n; i++)
906 usb_buffer_free(usb_dev, acm->readsize,
907 acm->rb[i].base, acm->rb[i].dma);
910 /* Little helper: write buffers allocate */
911 static int acm_write_buffers_alloc(struct acm *acm)
913 int i;
914 struct acm_wb *wb;
916 for (wb = &acm->wb[0], i = 0; i < ACM_NW; i++, wb++) {
917 wb->buf = usb_buffer_alloc(acm->dev, acm->writesize, GFP_KERNEL,
918 &wb->dmah);
919 if (!wb->buf) {
920 while (i != 0) {
921 --i;
922 --wb;
923 usb_buffer_free(acm->dev, acm->writesize,
924 wb->buf, wb->dmah);
926 return -ENOMEM;
929 return 0;
932 static int acm_probe(struct usb_interface *intf,
933 const struct usb_device_id *id)
935 struct usb_cdc_union_desc *union_header = NULL;
936 struct usb_cdc_country_functional_desc *cfd = NULL;
937 unsigned char *buffer = intf->altsetting->extra;
938 int buflen = intf->altsetting->extralen;
939 struct usb_interface *control_interface;
940 struct usb_interface *data_interface;
941 struct usb_endpoint_descriptor *epctrl = NULL;
942 struct usb_endpoint_descriptor *epread = NULL;
943 struct usb_endpoint_descriptor *epwrite = NULL;
944 struct usb_device *usb_dev = interface_to_usbdev(intf);
945 struct acm *acm;
946 int minor;
947 int ctrlsize, readsize;
948 u8 *buf;
949 u8 ac_management_function = 0;
950 u8 call_management_function = 0;
951 int call_interface_num = -1;
952 int data_interface_num;
953 unsigned long quirks;
954 int num_rx_buf;
955 int i;
956 int combined_interfaces = 0;
958 /* normal quirks */
959 quirks = (unsigned long)id->driver_info;
960 num_rx_buf = (quirks == SINGLE_RX_URB) ? 1 : ACM_NR;
962 /* handle quirks deadly to normal probing*/
963 if (quirks == NO_UNION_NORMAL) {
964 data_interface = usb_ifnum_to_if(usb_dev, 1);
965 control_interface = usb_ifnum_to_if(usb_dev, 0);
966 goto skip_normal_probe;
969 /* normal probing*/
970 if (!buffer) {
971 dev_err(&intf->dev, "Weird descriptor references\n");
972 return -EINVAL;
975 if (!buflen) {
976 if (intf->cur_altsetting->endpoint->extralen &&
977 intf->cur_altsetting->endpoint->extra) {
978 dev_dbg(&intf->dev,
979 "Seeking extra descriptors on endpoint\n");
980 buflen = intf->cur_altsetting->endpoint->extralen;
981 buffer = intf->cur_altsetting->endpoint->extra;
982 } else {
983 dev_err(&intf->dev,
984 "Zero length descriptor references\n");
985 return -EINVAL;
989 while (buflen > 0) {
990 if (buffer[1] != USB_DT_CS_INTERFACE) {
991 dev_err(&intf->dev, "skipping garbage\n");
992 goto next_desc;
995 switch (buffer[2]) {
996 case USB_CDC_UNION_TYPE: /* we've found it */
997 if (union_header) {
998 dev_err(&intf->dev, "More than one "
999 "union descriptor, skipping ...\n");
1000 goto next_desc;
1002 union_header = (struct usb_cdc_union_desc *)buffer;
1003 break;
1004 case USB_CDC_COUNTRY_TYPE: /* export through sysfs*/
1005 cfd = (struct usb_cdc_country_functional_desc *)buffer;
1006 break;
1007 case USB_CDC_HEADER_TYPE: /* maybe check version */
1008 break; /* for now we ignore it */
1009 case USB_CDC_ACM_TYPE:
1010 ac_management_function = buffer[3];
1011 break;
1012 case USB_CDC_CALL_MANAGEMENT_TYPE:
1013 call_management_function = buffer[3];
1014 call_interface_num = buffer[4];
1015 if ((call_management_function & 3) != 3)
1016 dev_err(&intf->dev, "This device cannot do calls on its own. It is not a modem.\n");
1017 break;
1018 default:
1019 /* there are LOTS more CDC descriptors that
1020 * could legitimately be found here.
1022 dev_dbg(&intf->dev, "Ignoring descriptor: "
1023 "type %02x, length %d\n",
1024 buffer[2], buffer[0]);
1025 break;
1027 next_desc:
1028 buflen -= buffer[0];
1029 buffer += buffer[0];
1032 if (!union_header) {
1033 if (call_interface_num > 0) {
1034 dev_dbg(&intf->dev, "No union descriptor, using call management descriptor\n");
1035 data_interface = usb_ifnum_to_if(usb_dev, (data_interface_num = call_interface_num));
1036 control_interface = intf;
1037 } else {
1038 if (intf->cur_altsetting->desc.bNumEndpoints != 3) {
1039 dev_dbg(&intf->dev,"No union descriptor, giving up\n");
1040 return -ENODEV;
1041 } else {
1042 dev_warn(&intf->dev,"No union descriptor, testing for castrated device\n");
1043 combined_interfaces = 1;
1044 control_interface = data_interface = intf;
1045 goto look_for_collapsed_interface;
1048 } else {
1049 control_interface = usb_ifnum_to_if(usb_dev, union_header->bMasterInterface0);
1050 data_interface = usb_ifnum_to_if(usb_dev, (data_interface_num = union_header->bSlaveInterface0));
1051 if (!control_interface || !data_interface) {
1052 dev_dbg(&intf->dev, "no interfaces\n");
1053 return -ENODEV;
1057 if (data_interface_num != call_interface_num)
1058 dev_dbg(&intf->dev, "Separate call control interface. That is not fully supported.\n");
1060 if (control_interface == data_interface) {
1061 /* some broken devices designed for windows work this way */
1062 dev_warn(&intf->dev,"Control and data interfaces are not separated!\n");
1063 combined_interfaces = 1;
1064 /* a popular other OS doesn't use it */
1065 quirks |= NO_CAP_LINE;
1066 if (data_interface->cur_altsetting->desc.bNumEndpoints != 3) {
1067 dev_err(&intf->dev, "This needs exactly 3 endpoints\n");
1068 return -EINVAL;
1070 look_for_collapsed_interface:
1071 for (i = 0; i < 3; i++) {
1072 struct usb_endpoint_descriptor *ep;
1073 ep = &data_interface->cur_altsetting->endpoint[i].desc;
1075 if (usb_endpoint_is_int_in(ep))
1076 epctrl = ep;
1077 else if (usb_endpoint_is_bulk_out(ep))
1078 epwrite = ep;
1079 else if (usb_endpoint_is_bulk_in(ep))
1080 epread = ep;
1081 else
1082 return -EINVAL;
1084 if (!epctrl || !epread || !epwrite)
1085 return -ENODEV;
1086 else
1087 goto made_compressed_probe;
1090 skip_normal_probe:
1092 /*workaround for switched interfaces */
1093 if (data_interface->cur_altsetting->desc.bInterfaceClass
1094 != CDC_DATA_INTERFACE_TYPE) {
1095 if (control_interface->cur_altsetting->desc.bInterfaceClass
1096 == CDC_DATA_INTERFACE_TYPE) {
1097 struct usb_interface *t;
1098 dev_dbg(&intf->dev,
1099 "Your device has switched interfaces.\n");
1100 t = control_interface;
1101 control_interface = data_interface;
1102 data_interface = t;
1103 } else {
1104 return -EINVAL;
1108 /* Accept probe requests only for the control interface */
1109 if (!combined_interfaces && intf != control_interface)
1110 return -ENODEV;
1112 if (!combined_interfaces && usb_interface_claimed(data_interface)) {
1113 /* valid in this context */
1114 dev_dbg(&intf->dev, "The data interface isn't available\n");
1115 return -EBUSY;
1119 if (data_interface->cur_altsetting->desc.bNumEndpoints < 2)
1120 return -EINVAL;
1122 epctrl = &control_interface->cur_altsetting->endpoint[0].desc;
1123 epread = &data_interface->cur_altsetting->endpoint[0].desc;
1124 epwrite = &data_interface->cur_altsetting->endpoint[1].desc;
1127 /* workaround for switched endpoints */
1128 if (!usb_endpoint_dir_in(epread)) {
1129 /* descriptors are swapped */
1130 struct usb_endpoint_descriptor *t;
1131 dev_dbg(&intf->dev,
1132 "The data interface has switched endpoints\n");
1133 t = epread;
1134 epread = epwrite;
1135 epwrite = t;
1137 made_compressed_probe:
1138 dbg("interfaces are valid");
1139 for (minor = 0; minor < ACM_TTY_MINORS && acm_table[minor]; minor++);
1141 if (minor == ACM_TTY_MINORS) {
1142 dev_err(&intf->dev, "no more free acm devices\n");
1143 return -ENODEV;
1146 acm = kzalloc(sizeof(struct acm), GFP_KERNEL);
1147 if (acm == NULL) {
1148 dev_dbg(&intf->dev, "out of memory (acm kzalloc)\n");
1149 goto alloc_fail;
1152 ctrlsize = le16_to_cpu(epctrl->wMaxPacketSize);
1153 readsize = le16_to_cpu(epread->wMaxPacketSize) *
1154 (quirks == SINGLE_RX_URB ? 1 : 2);
1155 acm->combined_interfaces = combined_interfaces;
1156 acm->writesize = le16_to_cpu(epwrite->wMaxPacketSize) * 20;
1157 acm->control = control_interface;
1158 acm->data = data_interface;
1159 acm->minor = minor;
1160 acm->dev = usb_dev;
1161 acm->ctrl_caps = ac_management_function;
1162 if (quirks & NO_CAP_LINE)
1163 acm->ctrl_caps &= ~USB_CDC_CAP_LINE;
1164 acm->ctrlsize = ctrlsize;
1165 acm->readsize = readsize;
1166 acm->rx_buflimit = num_rx_buf;
1167 acm->urb_task.func = acm_rx_tasklet;
1168 acm->urb_task.data = (unsigned long) acm;
1169 INIT_WORK(&acm->work, acm_softint);
1170 init_waitqueue_head(&acm->drain_wait);
1171 spin_lock_init(&acm->throttle_lock);
1172 spin_lock_init(&acm->write_lock);
1173 spin_lock_init(&acm->read_lock);
1174 mutex_init(&acm->mutex);
1175 acm->rx_endpoint = usb_rcvbulkpipe(usb_dev, epread->bEndpointAddress);
1176 acm->is_int_ep = usb_endpoint_xfer_int(epread);
1177 if (acm->is_int_ep)
1178 acm->bInterval = epread->bInterval;
1179 tty_port_init(&acm->port);
1180 acm->port.ops = &acm_port_ops;
1182 buf = usb_buffer_alloc(usb_dev, ctrlsize, GFP_KERNEL, &acm->ctrl_dma);
1183 if (!buf) {
1184 dev_dbg(&intf->dev, "out of memory (ctrl buffer alloc)\n");
1185 goto alloc_fail2;
1187 acm->ctrl_buffer = buf;
1189 if (acm_write_buffers_alloc(acm) < 0) {
1190 dev_dbg(&intf->dev, "out of memory (write buffer alloc)\n");
1191 goto alloc_fail4;
1194 acm->ctrlurb = usb_alloc_urb(0, GFP_KERNEL);
1195 if (!acm->ctrlurb) {
1196 dev_dbg(&intf->dev, "out of memory (ctrlurb kmalloc)\n");
1197 goto alloc_fail5;
1199 for (i = 0; i < num_rx_buf; i++) {
1200 struct acm_ru *rcv = &(acm->ru[i]);
1202 rcv->urb = usb_alloc_urb(0, GFP_KERNEL);
1203 if (rcv->urb == NULL) {
1204 dev_dbg(&intf->dev,
1205 "out of memory (read urbs usb_alloc_urb)\n");
1206 goto alloc_fail6;
1209 rcv->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
1210 rcv->instance = acm;
1212 for (i = 0; i < num_rx_buf; i++) {
1213 struct acm_rb *rb = &(acm->rb[i]);
1215 rb->base = usb_buffer_alloc(acm->dev, readsize,
1216 GFP_KERNEL, &rb->dma);
1217 if (!rb->base) {
1218 dev_dbg(&intf->dev,
1219 "out of memory (read bufs usb_buffer_alloc)\n");
1220 goto alloc_fail7;
1223 for (i = 0; i < ACM_NW; i++) {
1224 struct acm_wb *snd = &(acm->wb[i]);
1226 snd->urb = usb_alloc_urb(0, GFP_KERNEL);
1227 if (snd->urb == NULL) {
1228 dev_dbg(&intf->dev,
1229 "out of memory (write urbs usb_alloc_urb)");
1230 goto alloc_fail8;
1233 if (usb_endpoint_xfer_int(epwrite))
1234 usb_fill_int_urb(snd->urb, usb_dev,
1235 usb_sndbulkpipe(usb_dev, epwrite->bEndpointAddress),
1236 NULL, acm->writesize, acm_write_bulk, snd, epwrite->bInterval);
1237 else
1238 usb_fill_bulk_urb(snd->urb, usb_dev,
1239 usb_sndbulkpipe(usb_dev, epwrite->bEndpointAddress),
1240 NULL, acm->writesize, acm_write_bulk, snd);
1241 snd->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
1242 snd->instance = acm;
1245 usb_set_intfdata(intf, acm);
1247 i = device_create_file(&intf->dev, &dev_attr_bmCapabilities);
1248 if (i < 0)
1249 goto alloc_fail8;
1251 if (cfd) { /* export the country data */
1252 acm->country_codes = kmalloc(cfd->bLength - 4, GFP_KERNEL);
1253 if (!acm->country_codes)
1254 goto skip_countries;
1255 acm->country_code_size = cfd->bLength - 4;
1256 memcpy(acm->country_codes, (u8 *)&cfd->wCountyCode0,
1257 cfd->bLength - 4);
1258 acm->country_rel_date = cfd->iCountryCodeRelDate;
1260 i = device_create_file(&intf->dev, &dev_attr_wCountryCodes);
1261 if (i < 0) {
1262 kfree(acm->country_codes);
1263 goto skip_countries;
1266 i = device_create_file(&intf->dev,
1267 &dev_attr_iCountryCodeRelDate);
1268 if (i < 0) {
1269 device_remove_file(&intf->dev, &dev_attr_wCountryCodes);
1270 kfree(acm->country_codes);
1271 goto skip_countries;
1275 skip_countries:
1276 usb_fill_int_urb(acm->ctrlurb, usb_dev,
1277 usb_rcvintpipe(usb_dev, epctrl->bEndpointAddress),
1278 acm->ctrl_buffer, ctrlsize, acm_ctrl_irq, acm,
1279 /* works around buggy devices */
1280 epctrl->bInterval ? epctrl->bInterval : 0xff);
1281 acm->ctrlurb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
1282 acm->ctrlurb->transfer_dma = acm->ctrl_dma;
1284 dev_info(&intf->dev, "ttyACM%d: USB ACM device\n", minor);
1286 acm_set_control(acm, acm->ctrlout);
1288 acm->line.dwDTERate = cpu_to_le32(9600);
1289 acm->line.bDataBits = 8;
1290 acm_set_line(acm, &acm->line);
1292 usb_driver_claim_interface(&acm_driver, data_interface, acm);
1293 usb_set_intfdata(data_interface, acm);
1295 usb_get_intf(control_interface);
1296 tty_register_device(acm_tty_driver, minor, &control_interface->dev);
1298 acm_table[minor] = acm;
1300 return 0;
1301 alloc_fail8:
1302 for (i = 0; i < ACM_NW; i++)
1303 usb_free_urb(acm->wb[i].urb);
1304 alloc_fail7:
1305 acm_read_buffers_free(acm);
1306 alloc_fail6:
1307 for (i = 0; i < num_rx_buf; i++)
1308 usb_free_urb(acm->ru[i].urb);
1309 usb_free_urb(acm->ctrlurb);
1310 alloc_fail5:
1311 acm_write_buffers_free(acm);
1312 alloc_fail4:
1313 usb_buffer_free(usb_dev, ctrlsize, acm->ctrl_buffer, acm->ctrl_dma);
1314 alloc_fail2:
1315 kfree(acm);
1316 alloc_fail:
1317 return -ENOMEM;
1320 static void stop_data_traffic(struct acm *acm)
1322 int i;
1323 dbg("Entering stop_data_traffic");
1325 tasklet_disable(&acm->urb_task);
1327 usb_kill_urb(acm->ctrlurb);
1328 for (i = 0; i < ACM_NW; i++)
1329 usb_kill_urb(acm->wb[i].urb);
1330 for (i = 0; i < acm->rx_buflimit; i++)
1331 usb_kill_urb(acm->ru[i].urb);
1333 tasklet_enable(&acm->urb_task);
1335 cancel_work_sync(&acm->work);
1338 static void acm_disconnect(struct usb_interface *intf)
1340 struct acm *acm = usb_get_intfdata(intf);
1341 struct usb_device *usb_dev = interface_to_usbdev(intf);
1342 struct tty_struct *tty;
1344 /* sibling interface is already cleaning up */
1345 if (!acm)
1346 return;
1348 mutex_lock(&open_mutex);
1349 if (acm->country_codes) {
1350 device_remove_file(&acm->control->dev,
1351 &dev_attr_wCountryCodes);
1352 device_remove_file(&acm->control->dev,
1353 &dev_attr_iCountryCodeRelDate);
1355 device_remove_file(&acm->control->dev, &dev_attr_bmCapabilities);
1356 acm->dev = NULL;
1357 usb_set_intfdata(acm->control, NULL);
1358 usb_set_intfdata(acm->data, NULL);
1360 stop_data_traffic(acm);
1362 acm_write_buffers_free(acm);
1363 usb_buffer_free(usb_dev, acm->ctrlsize, acm->ctrl_buffer,
1364 acm->ctrl_dma);
1365 acm_read_buffers_free(acm);
1367 if (!acm->combined_interfaces)
1368 usb_driver_release_interface(&acm_driver, intf == acm->control ?
1369 acm->data : acm->control);
1371 if (acm->port.count == 0) {
1372 acm_tty_unregister(acm);
1373 mutex_unlock(&open_mutex);
1374 return;
1377 mutex_unlock(&open_mutex);
1378 tty = tty_port_tty_get(&acm->port);
1379 if (tty) {
1380 tty_hangup(tty);
1381 tty_kref_put(tty);
1385 #ifdef CONFIG_PM
1386 static int acm_suspend(struct usb_interface *intf, pm_message_t message)
1388 struct acm *acm = usb_get_intfdata(intf);
1389 int cnt;
1391 if (message.event & PM_EVENT_AUTO) {
1392 int b;
1394 spin_lock_irq(&acm->read_lock);
1395 spin_lock(&acm->write_lock);
1396 b = acm->processing + acm->transmitting;
1397 spin_unlock(&acm->write_lock);
1398 spin_unlock_irq(&acm->read_lock);
1399 if (b)
1400 return -EBUSY;
1403 spin_lock_irq(&acm->read_lock);
1404 spin_lock(&acm->write_lock);
1405 cnt = acm->susp_count++;
1406 spin_unlock(&acm->write_lock);
1407 spin_unlock_irq(&acm->read_lock);
1409 if (cnt)
1410 return 0;
1412 we treat opened interfaces differently,
1413 we must guard against open
1415 mutex_lock(&acm->mutex);
1417 if (acm->port.count)
1418 stop_data_traffic(acm);
1420 mutex_unlock(&acm->mutex);
1421 return 0;
1424 static int acm_resume(struct usb_interface *intf)
1426 struct acm *acm = usb_get_intfdata(intf);
1427 struct acm_wb *wb;
1428 int rv = 0;
1429 int cnt;
1431 spin_lock_irq(&acm->read_lock);
1432 acm->susp_count -= 1;
1433 cnt = acm->susp_count;
1434 spin_unlock_irq(&acm->read_lock);
1436 if (cnt)
1437 return 0;
1439 mutex_lock(&acm->mutex);
1440 if (acm->port.count) {
1441 rv = usb_submit_urb(acm->ctrlurb, GFP_NOIO);
1443 spin_lock_irq(&acm->write_lock);
1444 if (acm->delayed_wb) {
1445 wb = acm->delayed_wb;
1446 acm->delayed_wb = NULL;
1447 spin_unlock_irq(&acm->write_lock);
1448 acm_start_wb(acm, wb);
1449 } else {
1450 spin_unlock_irq(&acm->write_lock);
1454 * delayed error checking because we must
1455 * do the write path at all cost
1457 if (rv < 0)
1458 goto err_out;
1460 tasklet_schedule(&acm->urb_task);
1463 err_out:
1464 mutex_unlock(&acm->mutex);
1465 return rv;
1468 #endif /* CONFIG_PM */
1470 #define NOKIA_PCSUITE_ACM_INFO(x) \
1471 USB_DEVICE_AND_INTERFACE_INFO(0x0421, x, \
1472 USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM, \
1473 USB_CDC_ACM_PROTO_VENDOR)
1476 * USB driver structure.
1479 static struct usb_device_id acm_ids[] = {
1480 /* quirky and broken devices */
1481 { USB_DEVICE(0x0870, 0x0001), /* Metricom GS Modem */
1482 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1484 { USB_DEVICE(0x0e8d, 0x0003), /* FIREFLY, MediaTek Inc; andrey.arapov@gmail.com */
1485 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1487 { USB_DEVICE(0x0e8d, 0x3329), /* MediaTek Inc GPS */
1488 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1490 { USB_DEVICE(0x0482, 0x0203), /* KYOCERA AH-K3001V */
1491 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1493 { USB_DEVICE(0x079b, 0x000f), /* BT On-Air USB MODEM */
1494 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1496 { USB_DEVICE(0x0ace, 0x1602), /* ZyDAS 56K USB MODEM */
1497 .driver_info = SINGLE_RX_URB,
1499 { USB_DEVICE(0x0ace, 0x1608), /* ZyDAS 56K USB MODEM */
1500 .driver_info = SINGLE_RX_URB, /* firmware bug */
1502 { USB_DEVICE(0x0ace, 0x1611), /* ZyDAS 56K USB MODEM - new version */
1503 .driver_info = SINGLE_RX_URB, /* firmware bug */
1505 { USB_DEVICE(0x22b8, 0x7000), /* Motorola Q Phone */
1506 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1508 { USB_DEVICE(0x0803, 0x3095), /* Zoom Telephonics Model 3095F USB MODEM */
1509 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1511 { USB_DEVICE(0x0572, 0x1321), /* Conexant USB MODEM CX93010 */
1512 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1514 { USB_DEVICE(0x0572, 0x1324), /* Conexant USB MODEM RD02-D400 */
1515 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1517 { USB_DEVICE(0x0572, 0x1328), /* Shiro / Aztech USB MODEM UM-3100 */
1518 .driver_info = NO_UNION_NORMAL, /* has no union descriptor */
1520 { USB_DEVICE(0x22b8, 0x6425), /* Motorola MOTOMAGX phones */
1522 { USB_DEVICE(0x0572, 0x1329), /* Hummingbird huc56s (Conexant) */
1523 .driver_info = NO_UNION_NORMAL, /* union descriptor misplaced on
1524 data interface instead of
1525 communications interface.
1526 Maybe we should define a new
1527 quirk for this. */
1529 { USB_DEVICE(0x1bbb, 0x0003), /* Alcatel OT-I650 */
1530 .driver_info = NO_UNION_NORMAL, /* reports zero length descriptor */
1533 /* Nokia S60 phones expose two ACM channels. The first is
1534 * a modem and is picked up by the standard AT-command
1535 * information below. The second is 'vendor-specific' but
1536 * is treated as a serial device at the S60 end, so we want
1537 * to expose it on Linux too. */
1538 { NOKIA_PCSUITE_ACM_INFO(0x042D), }, /* Nokia 3250 */
1539 { NOKIA_PCSUITE_ACM_INFO(0x04D8), }, /* Nokia 5500 Sport */
1540 { NOKIA_PCSUITE_ACM_INFO(0x04C9), }, /* Nokia E50 */
1541 { NOKIA_PCSUITE_ACM_INFO(0x0419), }, /* Nokia E60 */
1542 { NOKIA_PCSUITE_ACM_INFO(0x044D), }, /* Nokia E61 */
1543 { NOKIA_PCSUITE_ACM_INFO(0x0001), }, /* Nokia E61i */
1544 { NOKIA_PCSUITE_ACM_INFO(0x0475), }, /* Nokia E62 */
1545 { NOKIA_PCSUITE_ACM_INFO(0x0508), }, /* Nokia E65 */
1546 { NOKIA_PCSUITE_ACM_INFO(0x0418), }, /* Nokia E70 */
1547 { NOKIA_PCSUITE_ACM_INFO(0x0425), }, /* Nokia N71 */
1548 { NOKIA_PCSUITE_ACM_INFO(0x0486), }, /* Nokia N73 */
1549 { NOKIA_PCSUITE_ACM_INFO(0x04DF), }, /* Nokia N75 */
1550 { NOKIA_PCSUITE_ACM_INFO(0x000e), }, /* Nokia N77 */
1551 { NOKIA_PCSUITE_ACM_INFO(0x0445), }, /* Nokia N80 */
1552 { NOKIA_PCSUITE_ACM_INFO(0x042F), }, /* Nokia N91 & N91 8GB */
1553 { NOKIA_PCSUITE_ACM_INFO(0x048E), }, /* Nokia N92 */
1554 { NOKIA_PCSUITE_ACM_INFO(0x0420), }, /* Nokia N93 */
1555 { NOKIA_PCSUITE_ACM_INFO(0x04E6), }, /* Nokia N93i */
1556 { NOKIA_PCSUITE_ACM_INFO(0x04B2), }, /* Nokia 5700 XpressMusic */
1557 { NOKIA_PCSUITE_ACM_INFO(0x0134), }, /* Nokia 6110 Navigator (China) */
1558 { NOKIA_PCSUITE_ACM_INFO(0x046E), }, /* Nokia 6110 Navigator */
1559 { NOKIA_PCSUITE_ACM_INFO(0x002f), }, /* Nokia 6120 classic & */
1560 { NOKIA_PCSUITE_ACM_INFO(0x0088), }, /* Nokia 6121 classic */
1561 { NOKIA_PCSUITE_ACM_INFO(0x00fc), }, /* Nokia 6124 classic */
1562 { NOKIA_PCSUITE_ACM_INFO(0x0042), }, /* Nokia E51 */
1563 { NOKIA_PCSUITE_ACM_INFO(0x00b0), }, /* Nokia E66 */
1564 { NOKIA_PCSUITE_ACM_INFO(0x00ab), }, /* Nokia E71 */
1565 { NOKIA_PCSUITE_ACM_INFO(0x0481), }, /* Nokia N76 */
1566 { NOKIA_PCSUITE_ACM_INFO(0x0007), }, /* Nokia N81 & N81 8GB */
1567 { NOKIA_PCSUITE_ACM_INFO(0x0071), }, /* Nokia N82 */
1568 { NOKIA_PCSUITE_ACM_INFO(0x04F0), }, /* Nokia N95 & N95-3 NAM */
1569 { NOKIA_PCSUITE_ACM_INFO(0x0070), }, /* Nokia N95 8GB */
1570 { NOKIA_PCSUITE_ACM_INFO(0x00e9), }, /* Nokia 5320 XpressMusic */
1571 { NOKIA_PCSUITE_ACM_INFO(0x0099), }, /* Nokia 6210 Navigator, RM-367 */
1572 { NOKIA_PCSUITE_ACM_INFO(0x0128), }, /* Nokia 6210 Navigator, RM-419 */
1573 { NOKIA_PCSUITE_ACM_INFO(0x008f), }, /* Nokia 6220 Classic */
1574 { NOKIA_PCSUITE_ACM_INFO(0x00a0), }, /* Nokia 6650 */
1575 { NOKIA_PCSUITE_ACM_INFO(0x007b), }, /* Nokia N78 */
1576 { NOKIA_PCSUITE_ACM_INFO(0x0094), }, /* Nokia N85 */
1577 { NOKIA_PCSUITE_ACM_INFO(0x003a), }, /* Nokia N96 & N96-3 */
1578 { NOKIA_PCSUITE_ACM_INFO(0x00e9), }, /* Nokia 5320 XpressMusic */
1579 { NOKIA_PCSUITE_ACM_INFO(0x0108), }, /* Nokia 5320 XpressMusic 2G */
1580 { NOKIA_PCSUITE_ACM_INFO(0x01f5), }, /* Nokia N97, RM-505 */
1582 /* NOTE: non-Nokia COMM/ACM/0xff is likely MSFT RNDIS... NOT a modem! */
1584 /* control interfaces with various AT-command sets */
1585 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1586 USB_CDC_ACM_PROTO_AT_V25TER) },
1587 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1588 USB_CDC_ACM_PROTO_AT_PCCA101) },
1589 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1590 USB_CDC_ACM_PROTO_AT_PCCA101_WAKE) },
1591 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1592 USB_CDC_ACM_PROTO_AT_GSM) },
1593 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1594 USB_CDC_ACM_PROTO_AT_3G) },
1595 { USB_INTERFACE_INFO(USB_CLASS_COMM, USB_CDC_SUBCLASS_ACM,
1596 USB_CDC_ACM_PROTO_AT_CDMA) },
1601 MODULE_DEVICE_TABLE(usb, acm_ids);
1603 static struct usb_driver acm_driver = {
1604 .name = "cdc_acm",
1605 .probe = acm_probe,
1606 .disconnect = acm_disconnect,
1607 #ifdef CONFIG_PM
1608 .suspend = acm_suspend,
1609 .resume = acm_resume,
1610 #endif
1611 .id_table = acm_ids,
1612 #ifdef CONFIG_PM
1613 .supports_autosuspend = 1,
1614 #endif
1618 * TTY driver structures.
1621 static const struct tty_operations acm_ops = {
1622 .open = acm_tty_open,
1623 .close = acm_tty_close,
1624 .hangup = acm_tty_hangup,
1625 .write = acm_tty_write,
1626 .write_room = acm_tty_write_room,
1627 .ioctl = acm_tty_ioctl,
1628 .throttle = acm_tty_throttle,
1629 .unthrottle = acm_tty_unthrottle,
1630 .chars_in_buffer = acm_tty_chars_in_buffer,
1631 .break_ctl = acm_tty_break_ctl,
1632 .set_termios = acm_tty_set_termios,
1633 .tiocmget = acm_tty_tiocmget,
1634 .tiocmset = acm_tty_tiocmset,
1638 * Init / exit.
1641 static int __init acm_init(void)
1643 int retval;
1644 acm_tty_driver = alloc_tty_driver(ACM_TTY_MINORS);
1645 if (!acm_tty_driver)
1646 return -ENOMEM;
1647 acm_tty_driver->owner = THIS_MODULE,
1648 acm_tty_driver->driver_name = "acm",
1649 acm_tty_driver->name = "ttyACM",
1650 acm_tty_driver->major = ACM_TTY_MAJOR,
1651 acm_tty_driver->minor_start = 0,
1652 acm_tty_driver->type = TTY_DRIVER_TYPE_SERIAL,
1653 acm_tty_driver->subtype = SERIAL_TYPE_NORMAL,
1654 acm_tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
1655 acm_tty_driver->init_termios = tty_std_termios;
1656 acm_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD |
1657 HUPCL | CLOCAL;
1658 tty_set_operations(acm_tty_driver, &acm_ops);
1660 retval = tty_register_driver(acm_tty_driver);
1661 if (retval) {
1662 put_tty_driver(acm_tty_driver);
1663 return retval;
1666 retval = usb_register(&acm_driver);
1667 if (retval) {
1668 tty_unregister_driver(acm_tty_driver);
1669 put_tty_driver(acm_tty_driver);
1670 return retval;
1673 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
1674 DRIVER_DESC "\n");
1676 return 0;
1679 static void __exit acm_exit(void)
1681 usb_deregister(&acm_driver);
1682 tty_unregister_driver(acm_tty_driver);
1683 put_tty_driver(acm_tty_driver);
1686 module_init(acm_init);
1687 module_exit(acm_exit);
1689 MODULE_AUTHOR(DRIVER_AUTHOR);
1690 MODULE_DESCRIPTION(DRIVER_DESC);
1691 MODULE_LICENSE("GPL");
1692 MODULE_ALIAS_CHARDEV_MAJOR(ACM_TTY_MAJOR);