Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2  USB Driver layer for GSM modems
  3
  4  Copyright (C) 2005  Matthias Urlichs <smurf@smurf.noris.de>
  5
  6  This driver is free software; you can redistribute it and/or modify
  7  it under the terms of Version 2 of the GNU General Public License as
  8  published by the Free Software Foundation.
  9
 10  Portions copied from the Keyspan driver by Hugh Blemings <hugh@blemings.org>
 11
 12  History: see the git log.
 13
 14  Work sponsored by: Sigos GmbH, Germany <info@sigos.de>
 15
 16  This driver exists because the "normal" serial driver doesn't work too well
 17  with GSM modems. Issues:
 18  - data loss -- one single Receive URB is not nearly enough
 19  - controlling the baud rate doesn't make sense
 20*/
 21
 22#define DRIVER_VERSION "v0.7.2"
 23#define DRIVER_AUTHOR "Matthias Urlichs <smurf@smurf.noris.de>"
 24#define DRIVER_DESC "USB Driver for GSM modems"
 25
 26#include <linux/kernel.h>
 27#include <linux/jiffies.h>
 28#include <linux/errno.h>
 29#include <linux/slab.h>
 30#include <linux/tty.h>
 31#include <linux/tty_flip.h>
 32#include <linux/module.h>
 33#include <linux/bitops.h>
 34#include <linux/uaccess.h>
 35#include <linux/usb.h>
 36#include <linux/usb/serial.h>
 37#include <linux/serial.h>
 38#include "usb-wwan.h"
 39
 40static int debug;
 41
 42void usb_wwan_dtr_rts(struct usb_serial_port *port, int on)
 43{
 44	struct usb_serial *serial = port->serial;
 45	struct usb_wwan_port_private *portdata;
 46
 47	struct usb_wwan_intf_private *intfdata;
 48
 49	dbg("%s", __func__);
 50
 51	intfdata = port->serial->private;
 52
 53	if (!intfdata->send_setup)
 54		return;
 55
 56	portdata = usb_get_serial_port_data(port);
 57	mutex_lock(&serial->disc_mutex);
 58	portdata->rts_state = on;
 59	portdata->dtr_state = on;
 60	if (serial->dev)
 61		intfdata->send_setup(port);
 62	mutex_unlock(&serial->disc_mutex);
 63}
 64EXPORT_SYMBOL(usb_wwan_dtr_rts);
 65
 66void usb_wwan_set_termios(struct tty_struct *tty,
 67			  struct usb_serial_port *port,
 68			  struct ktermios *old_termios)
 69{
 70	struct usb_wwan_intf_private *intfdata = port->serial->private;
 71
 72	dbg("%s", __func__);
 73
 74	/* Doesn't support option setting */
 75	tty_termios_copy_hw(tty->termios, old_termios);
 76
 77	if (intfdata->send_setup)
 78		intfdata->send_setup(port);
 79}
 80EXPORT_SYMBOL(usb_wwan_set_termios);
 81
 82int usb_wwan_tiocmget(struct tty_struct *tty)
 83{
 84	struct usb_serial_port *port = tty->driver_data;
 85	unsigned int value;
 86	struct usb_wwan_port_private *portdata;
 87
 88	portdata = usb_get_serial_port_data(port);
 89
 90	value = ((portdata->rts_state) ? TIOCM_RTS : 0) |
 91	    ((portdata->dtr_state) ? TIOCM_DTR : 0) |
 92	    ((portdata->cts_state) ? TIOCM_CTS : 0) |
 93	    ((portdata->dsr_state) ? TIOCM_DSR : 0) |
 94	    ((portdata->dcd_state) ? TIOCM_CAR : 0) |
 95	    ((portdata->ri_state) ? TIOCM_RNG : 0);
 96
 97	return value;
 98}
 99EXPORT_SYMBOL(usb_wwan_tiocmget);
100
101int usb_wwan_tiocmset(struct tty_struct *tty,
102		      unsigned int set, unsigned int clear)
103{
104	struct usb_serial_port *port = tty->driver_data;
105	struct usb_wwan_port_private *portdata;
106	struct usb_wwan_intf_private *intfdata;
107
108	portdata = usb_get_serial_port_data(port);
109	intfdata = port->serial->private;
110
111	if (!intfdata->send_setup)
112		return -EINVAL;
113
114	/* FIXME: what locks portdata fields ? */
115	if (set & TIOCM_RTS)
116		portdata->rts_state = 1;
117	if (set & TIOCM_DTR)
118		portdata->dtr_state = 1;
119
120	if (clear & TIOCM_RTS)
121		portdata->rts_state = 0;
122	if (clear & TIOCM_DTR)
123		portdata->dtr_state = 0;
124	return intfdata->send_setup(port);
125}
126EXPORT_SYMBOL(usb_wwan_tiocmset);
127
128static int get_serial_info(struct usb_serial_port *port,
129			   struct serial_struct __user *retinfo)
130{
131	struct serial_struct tmp;
132
133	if (!retinfo)
134		return -EFAULT;
135
136	memset(&tmp, 0, sizeof(tmp));
137	tmp.line            = port->serial->minor;
138	tmp.port            = port->number;
139	tmp.baud_base       = tty_get_baud_rate(port->port.tty);
140	tmp.close_delay	    = port->port.close_delay / 10;
141	tmp.closing_wait    = port->port.closing_wait == ASYNC_CLOSING_WAIT_NONE ?
142				 ASYNC_CLOSING_WAIT_NONE :
143				 port->port.closing_wait / 10;
144
145	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
146		return -EFAULT;
147	return 0;
148}
149
150static int set_serial_info(struct usb_serial_port *port,
151			   struct serial_struct __user *newinfo)
152{
153	struct serial_struct new_serial;
154	unsigned int closing_wait, close_delay;
155	int retval = 0;
156
157	if (copy_from_user(&new_serial, newinfo, sizeof(new_serial)))
158		return -EFAULT;
159
160	close_delay = new_serial.close_delay * 10;
161	closing_wait = new_serial.closing_wait == ASYNC_CLOSING_WAIT_NONE ?
162			ASYNC_CLOSING_WAIT_NONE : new_serial.closing_wait * 10;
163
164	mutex_lock(&port->port.mutex);
165
166	if (!capable(CAP_SYS_ADMIN)) {
167		if ((close_delay != port->port.close_delay) ||
168		    (closing_wait != port->port.closing_wait))
169			retval = -EPERM;
170		else
171			retval = -EOPNOTSUPP;
172	} else {
173		port->port.close_delay  = close_delay;
174		port->port.closing_wait = closing_wait;
175	}
176
177	mutex_unlock(&port->port.mutex);
178	return retval;
179}
180
181int usb_wwan_ioctl(struct tty_struct *tty,
182		   unsigned int cmd, unsigned long arg)
183{
184	struct usb_serial_port *port = tty->driver_data;
185
186	dbg("%s cmd 0x%04x", __func__, cmd);
187
188	switch (cmd) {
189	case TIOCGSERIAL:
190		return get_serial_info(port,
191				       (struct serial_struct __user *) arg);
192	case TIOCSSERIAL:
193		return set_serial_info(port,
194				       (struct serial_struct __user *) arg);
195	default:
196		break;
197	}
198
199	dbg("%s arg not supported", __func__);
200
201	return -ENOIOCTLCMD;
202}
203EXPORT_SYMBOL(usb_wwan_ioctl);
204
205/* Write */
206int usb_wwan_write(struct tty_struct *tty, struct usb_serial_port *port,
207		   const unsigned char *buf, int count)
208{
209	struct usb_wwan_port_private *portdata;
210	struct usb_wwan_intf_private *intfdata;
211	int i;
212	int left, todo;
213	struct urb *this_urb = NULL;	/* spurious */
214	int err;
215	unsigned long flags;
216
217	portdata = usb_get_serial_port_data(port);
218	intfdata = port->serial->private;
219
220	dbg("%s: write (%d chars)", __func__, count);
221
222	i = 0;
223	left = count;
224	for (i = 0; left > 0 && i < N_OUT_URB; i++) {
225		todo = left;
226		if (todo > OUT_BUFLEN)
227			todo = OUT_BUFLEN;
228
229		this_urb = portdata->out_urbs[i];
230		if (test_and_set_bit(i, &portdata->out_busy)) {
231			if (time_before(jiffies,
232					portdata->tx_start_time[i] + 10 * HZ))
233				continue;
234			usb_unlink_urb(this_urb);
235			continue;
236		}
237		dbg("%s: endpoint %d buf %d", __func__,
238		    usb_pipeendpoint(this_urb->pipe), i);
239
240		err = usb_autopm_get_interface_async(port->serial->interface);
241		if (err < 0)
242			break;
243
244		/* send the data */
245		memcpy(this_urb->transfer_buffer, buf, todo);
246		this_urb->transfer_buffer_length = todo;
247
248		spin_lock_irqsave(&intfdata->susp_lock, flags);
249		if (intfdata->suspended) {
250			usb_anchor_urb(this_urb, &portdata->delayed);
251			spin_unlock_irqrestore(&intfdata->susp_lock, flags);
252		} else {
253			intfdata->in_flight++;
254			spin_unlock_irqrestore(&intfdata->susp_lock, flags);
255			err = usb_submit_urb(this_urb, GFP_ATOMIC);
256			if (err) {
257				dbg("usb_submit_urb %p (write bulk) failed "
258				    "(%d)", this_urb, err);
 
259				clear_bit(i, &portdata->out_busy);
260				spin_lock_irqsave(&intfdata->susp_lock, flags);
261				intfdata->in_flight--;
262				spin_unlock_irqrestore(&intfdata->susp_lock,
263						       flags);
264				usb_autopm_put_interface_async(port->serial->interface);
265				break;
266			}
267		}
268
269		portdata->tx_start_time[i] = jiffies;
270		buf += todo;
271		left -= todo;
272	}
273
274	count -= left;
275	dbg("%s: wrote (did %d)", __func__, count);
276	return count;
277}
278EXPORT_SYMBOL(usb_wwan_write);
279
280static void usb_wwan_indat_callback(struct urb *urb)
281{
282	int err;
283	int endpoint;
284	struct usb_serial_port *port;
285	struct tty_struct *tty;
286	unsigned char *data = urb->transfer_buffer;
287	int status = urb->status;
288
289	dbg("%s: %p", __func__, urb);
290
291	endpoint = usb_pipeendpoint(urb->pipe);
292	port = urb->context;
 
293
294	if (status) {
295		dbg("%s: nonzero status: %d on endpoint %02x.",
296		    __func__, status, endpoint);
297	} else {
298		tty = tty_port_tty_get(&port->port);
299		if (tty) {
300			if (urb->actual_length) {
301				tty_insert_flip_string(tty, data,
302						urb->actual_length);
303				tty_flip_buffer_push(tty);
304			} else
305				dbg("%s: empty read urb received", __func__);
306			tty_kref_put(tty);
307		}
308
309		/* Resubmit urb so we continue receiving */
310		if (status != -ESHUTDOWN) {
311			err = usb_submit_urb(urb, GFP_ATOMIC);
312			if (err) {
313				if (err != -EPERM) {
314					printk(KERN_ERR "%s: resubmit read urb failed. "
315						"(%d)", __func__, err);
316					/* busy also in error unless we are killed */
317					usb_mark_last_busy(port->serial->dev);
318				}
319			} else {
320				usb_mark_last_busy(port->serial->dev);
321			}
322		}
323
 
324	}
325}
326
327static void usb_wwan_outdat_callback(struct urb *urb)
328{
329	struct usb_serial_port *port;
330	struct usb_wwan_port_private *portdata;
331	struct usb_wwan_intf_private *intfdata;
332	int i;
333
334	dbg("%s", __func__);
335
336	port = urb->context;
337	intfdata = port->serial->private;
338
339	usb_serial_port_softint(port);
340	usb_autopm_put_interface_async(port->serial->interface);
341	portdata = usb_get_serial_port_data(port);
342	spin_lock(&intfdata->susp_lock);
343	intfdata->in_flight--;
344	spin_unlock(&intfdata->susp_lock);
345
346	for (i = 0; i < N_OUT_URB; ++i) {
347		if (portdata->out_urbs[i] == urb) {
348			smp_mb__before_clear_bit();
349			clear_bit(i, &portdata->out_busy);
350			break;
351		}
352	}
353}
354
355int usb_wwan_write_room(struct tty_struct *tty)
356{
357	struct usb_serial_port *port = tty->driver_data;
358	struct usb_wwan_port_private *portdata;
359	int i;
360	int data_len = 0;
361	struct urb *this_urb;
362
363	portdata = usb_get_serial_port_data(port);
364
365	for (i = 0; i < N_OUT_URB; i++) {
366		this_urb = portdata->out_urbs[i];
367		if (this_urb && !test_bit(i, &portdata->out_busy))
368			data_len += OUT_BUFLEN;
369	}
370
371	dbg("%s: %d", __func__, data_len);
372	return data_len;
373}
374EXPORT_SYMBOL(usb_wwan_write_room);
375
376int usb_wwan_chars_in_buffer(struct tty_struct *tty)
377{
378	struct usb_serial_port *port = tty->driver_data;
379	struct usb_wwan_port_private *portdata;
380	int i;
381	int data_len = 0;
382	struct urb *this_urb;
383
384	portdata = usb_get_serial_port_data(port);
385
386	for (i = 0; i < N_OUT_URB; i++) {
387		this_urb = portdata->out_urbs[i];
388		/* FIXME: This locking is insufficient as this_urb may
389		   go unused during the test */
390		if (this_urb && test_bit(i, &portdata->out_busy))
391			data_len += this_urb->transfer_buffer_length;
392	}
393	dbg("%s: %d", __func__, data_len);
394	return data_len;
395}
396EXPORT_SYMBOL(usb_wwan_chars_in_buffer);
397
398int usb_wwan_open(struct tty_struct *tty, struct usb_serial_port *port)
399{
400	struct usb_wwan_port_private *portdata;
401	struct usb_wwan_intf_private *intfdata;
402	struct usb_serial *serial = port->serial;
403	int i, err;
404	struct urb *urb;
405
406	portdata = usb_get_serial_port_data(port);
407	intfdata = serial->private;
408
409	dbg("%s", __func__);
410
411	/* Start reading from the IN endpoint */
412	for (i = 0; i < N_IN_URB; i++) {
413		urb = portdata->in_urbs[i];
414		if (!urb)
415			continue;
416		err = usb_submit_urb(urb, GFP_KERNEL);
417		if (err) {
418			dbg("%s: submit urb %d failed (%d) %d",
419			    __func__, i, err, urb->transfer_buffer_length);
420		}
421	}
422
423	if (intfdata->send_setup)
424		intfdata->send_setup(port);
425
426	serial->interface->needs_remote_wakeup = 1;
427	spin_lock_irq(&intfdata->susp_lock);
428	portdata->opened = 1;
429	spin_unlock_irq(&intfdata->susp_lock);
430	/* this balances a get in the generic USB serial code */
431	usb_autopm_put_interface(serial->interface);
432
433	return 0;
434}
435EXPORT_SYMBOL(usb_wwan_open);
436
437void usb_wwan_close(struct usb_serial_port *port)
438{
439	int i;
440	struct usb_serial *serial = port->serial;
441	struct usb_wwan_port_private *portdata;
442	struct usb_wwan_intf_private *intfdata = port->serial->private;
443
444	dbg("%s", __func__);
445	portdata = usb_get_serial_port_data(port);
446
447	if (serial->dev) {
448		/* Stop reading/writing urbs */
449		spin_lock_irq(&intfdata->susp_lock);
450		portdata->opened = 0;
451		spin_unlock_irq(&intfdata->susp_lock);
452
453		for (i = 0; i < N_IN_URB; i++)
454			usb_kill_urb(portdata->in_urbs[i]);
455		for (i = 0; i < N_OUT_URB; i++)
456			usb_kill_urb(portdata->out_urbs[i]);
457		/* balancing - important as an error cannot be handled*/
458		usb_autopm_get_interface_no_resume(serial->interface);
459		serial->interface->needs_remote_wakeup = 0;
460	}
461}
462EXPORT_SYMBOL(usb_wwan_close);
463
464/* Helper functions used by usb_wwan_setup_urbs */
465static struct urb *usb_wwan_setup_urb(struct usb_serial *serial, int endpoint,
 
466				      int dir, void *ctx, char *buf, int len,
467				      void (*callback) (struct urb *))
468{
 
469	struct urb *urb;
470
471	if (endpoint == -1)
472		return NULL;	/* endpoint not needed */
473
474	urb = usb_alloc_urb(0, GFP_KERNEL);	/* No ISO */
475	if (urb == NULL) {
476		dbg("%s: alloc for endpoint %d failed.", __func__, endpoint);
477		return NULL;
478	}
479
480	/* Fill URB using supplied data. */
481	usb_fill_bulk_urb(urb, serial->dev,
482			  usb_sndbulkpipe(serial->dev, endpoint) | dir,
483			  buf, len, callback, ctx);
484
485	return urb;
486}
487
488/* Setup urbs */
489static void usb_wwan_setup_urbs(struct usb_serial *serial)
490{
491	int i, j;
492	struct usb_serial_port *port;
493	struct usb_wwan_port_private *portdata;
 
 
 
 
494
495	dbg("%s", __func__);
496
497	for (i = 0; i < serial->num_ports; i++) {
498		port = serial->port[i];
499		portdata = usb_get_serial_port_data(port);
500
501		/* Do indat endpoints first */
502		for (j = 0; j < N_IN_URB; ++j) {
503			portdata->in_urbs[j] = usb_wwan_setup_urb(serial,
504								  port->
505								  bulk_in_endpointAddress,
506								  USB_DIR_IN,
507								  port,
508								  portdata->
509								  in_buffer[j],
510								  IN_BUFLEN,
511								  usb_wwan_indat_callback);
512		}
513
514		/* outdat endpoints */
515		for (j = 0; j < N_OUT_URB; ++j) {
516			portdata->out_urbs[j] = usb_wwan_setup_urb(serial,
517								   port->
518								   bulk_out_endpointAddress,
519								   USB_DIR_OUT,
520								   port,
521								   portdata->
522								   out_buffer
523								   [j],
524								   OUT_BUFLEN,
525								   usb_wwan_outdat_callback);
526		}
527	}
528}
529
530int usb_wwan_startup(struct usb_serial *serial)
531{
532	int i, j, err;
533	struct usb_serial_port *port;
534	struct usb_wwan_port_private *portdata;
535	u8 *buffer;
536
537	dbg("%s", __func__);
538
539	/* Now setup per port private data */
540	for (i = 0; i < serial->num_ports; i++) {
541		port = serial->port[i];
542		portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
543		if (!portdata) {
544			dbg("%s: kmalloc for usb_wwan_port_private (%d) failed!.",
545			    __func__, i);
546			return 1;
547		}
548		init_usb_anchor(&portdata->delayed);
 
 
549
550		for (j = 0; j < N_IN_URB; j++) {
551			buffer = (u8 *) __get_free_page(GFP_KERNEL);
552			if (!buffer)
553				goto bail_out_error;
554			portdata->in_buffer[j] = buffer;
555		}
556
557		for (j = 0; j < N_OUT_URB; j++) {
558			buffer = kmalloc(OUT_BUFLEN, GFP_KERNEL);
559			if (!buffer)
560				goto bail_out_error2;
561			portdata->out_buffer[j] = buffer;
562		}
563
564		usb_set_serial_port_data(port, portdata);
565
566		if (!port->interrupt_in_urb)
567			continue;
568		err = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
569		if (err)
570			dbg("%s: submit irq_in urb failed %d", __func__, err);
 
571	}
572	usb_wwan_setup_urbs(serial);
573	return 0;
574
575bail_out_error2:
576	for (j = 0; j < N_OUT_URB; j++)
577		kfree(portdata->out_buffer[j]);
 
 
578bail_out_error:
579	for (j = 0; j < N_IN_URB; j++)
580		if (portdata->in_buffer[j])
581			free_page((unsigned long)portdata->in_buffer[j]);
 
582	kfree(portdata);
583	return 1;
 
584}
585EXPORT_SYMBOL(usb_wwan_startup);
586
587static void stop_read_write_urbs(struct usb_serial *serial)
588{
589	int i, j;
590	struct usb_serial_port *port;
591	struct usb_wwan_port_private *portdata;
592
593	/* Stop reading/writing urbs */
594	for (i = 0; i < serial->num_ports; ++i) {
595		port = serial->port[i];
596		portdata = usb_get_serial_port_data(port);
597		for (j = 0; j < N_IN_URB; j++)
598			usb_kill_urb(portdata->in_urbs[j]);
599		for (j = 0; j < N_OUT_URB; j++)
600			usb_kill_urb(portdata->out_urbs[j]);
601	}
602}
603
604void usb_wwan_disconnect(struct usb_serial *serial)
605{
606	dbg("%s", __func__);
 
 
 
 
 
 
 
 
607
608	stop_read_write_urbs(serial);
 
 
609}
610EXPORT_SYMBOL(usb_wwan_disconnect);
611
612void usb_wwan_release(struct usb_serial *serial)
 
613{
614	int i, j;
615	struct usb_serial_port *port;
616	struct usb_wwan_port_private *portdata;
617
618	dbg("%s", __func__);
619
620	/* Now free them */
621	for (i = 0; i < serial->num_ports; ++i) {
622		port = serial->port[i];
623		portdata = usb_get_serial_port_data(port);
624
625		for (j = 0; j < N_IN_URB; j++) {
626			usb_free_urb(portdata->in_urbs[j]);
627			free_page((unsigned long)
628				  portdata->in_buffer[j]);
629			portdata->in_urbs[j] = NULL;
630		}
631		for (j = 0; j < N_OUT_URB; j++) {
632			usb_free_urb(portdata->out_urbs[j]);
633			kfree(portdata->out_buffer[j]);
634			portdata->out_urbs[j] = NULL;
635		}
636	}
637
638	/* Now free per port private data */
639	for (i = 0; i < serial->num_ports; i++) {
640		port = serial->port[i];
641		kfree(usb_get_serial_port_data(port));
642	}
643}
644EXPORT_SYMBOL(usb_wwan_release);
645
646#ifdef CONFIG_PM
647int usb_wwan_suspend(struct usb_serial *serial, pm_message_t message)
648{
649	struct usb_wwan_intf_private *intfdata = serial->private;
650	int b;
651
652	dbg("%s entered", __func__);
653
654	if (message.event & PM_EVENT_AUTO) {
655		spin_lock_irq(&intfdata->susp_lock);
656		b = intfdata->in_flight;
657		spin_unlock_irq(&intfdata->susp_lock);
658
659		if (b)
660			return -EBUSY;
661	}
662
663	spin_lock_irq(&intfdata->susp_lock);
664	intfdata->suspended = 1;
665	spin_unlock_irq(&intfdata->susp_lock);
666	stop_read_write_urbs(serial);
667
668	return 0;
669}
670EXPORT_SYMBOL(usb_wwan_suspend);
671
672static void unbusy_queued_urb(struct urb *urb, struct usb_wwan_port_private *portdata)
673{
674	int i;
675
676	for (i = 0; i < N_OUT_URB; i++) {
677		if (urb == portdata->out_urbs[i]) {
678			clear_bit(i, &portdata->out_busy);
679			break;
680		}
681	}
682}
683
684static void play_delayed(struct usb_serial_port *port)
685{
686	struct usb_wwan_intf_private *data;
687	struct usb_wwan_port_private *portdata;
688	struct urb *urb;
689	int err;
690
691	portdata = usb_get_serial_port_data(port);
692	data = port->serial->private;
693	while ((urb = usb_get_from_anchor(&portdata->delayed))) {
694		err = usb_submit_urb(urb, GFP_ATOMIC);
695		if (!err) {
696			data->in_flight++;
697		} else {
698			/* we have to throw away the rest */
699			do {
700				unbusy_queued_urb(urb, portdata);
701				usb_autopm_put_interface_no_suspend(port->serial->interface);
702			} while ((urb = usb_get_from_anchor(&portdata->delayed)));
703			break;
704		}
705	}
706}
707
708int usb_wwan_resume(struct usb_serial *serial)
709{
710	int i, j;
711	struct usb_serial_port *port;
712	struct usb_wwan_intf_private *intfdata = serial->private;
713	struct usb_wwan_port_private *portdata;
714	struct urb *urb;
715	int err = 0;
716
717	dbg("%s entered", __func__);
718	/* get the interrupt URBs resubmitted unconditionally */
719	for (i = 0; i < serial->num_ports; i++) {
720		port = serial->port[i];
721		if (!port->interrupt_in_urb) {
722			dbg("%s: No interrupt URB for port %d", __func__, i);
723			continue;
724		}
725		err = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO);
726		dbg("Submitted interrupt URB for port %d (result %d)", i, err);
727		if (err < 0) {
728			err("%s: Error %d for interrupt URB of port%d",
729			    __func__, err, i);
730			goto err_out;
731		}
732	}
733
734	for (i = 0; i < serial->num_ports; i++) {
735		/* walk all ports */
736		port = serial->port[i];
737		portdata = usb_get_serial_port_data(port);
738
739		/* skip closed ports */
740		spin_lock_irq(&intfdata->susp_lock);
741		if (!portdata->opened) {
742			spin_unlock_irq(&intfdata->susp_lock);
743			continue;
744		}
745
746		for (j = 0; j < N_IN_URB; j++) {
747			urb = portdata->in_urbs[j];
748			err = usb_submit_urb(urb, GFP_ATOMIC);
749			if (err < 0) {
750				err("%s: Error %d for bulk URB %d",
751				    __func__, err, i);
752				spin_unlock_irq(&intfdata->susp_lock);
753				goto err_out;
754			}
755		}
756		play_delayed(port);
757		spin_unlock_irq(&intfdata->susp_lock);
758	}
759	spin_lock_irq(&intfdata->susp_lock);
760	intfdata->suspended = 0;
761	spin_unlock_irq(&intfdata->susp_lock);
762err_out:
763	return err;
764}
765EXPORT_SYMBOL(usb_wwan_resume);
766#endif
767
768MODULE_AUTHOR(DRIVER_AUTHOR);
769MODULE_DESCRIPTION(DRIVER_DESC);
770MODULE_VERSION(DRIVER_VERSION);
771MODULE_LICENSE("GPL");
772
773module_param(debug, bool, S_IRUGO | S_IWUSR);
774MODULE_PARM_DESC(debug, "Debug messages");
v3.15
  1/*
  2  USB Driver layer for GSM modems
  3
  4  Copyright (C) 2005  Matthias Urlichs <smurf@smurf.noris.de>
  5
  6  This driver is free software; you can redistribute it and/or modify
  7  it under the terms of Version 2 of the GNU General Public License as
  8  published by the Free Software Foundation.
  9
 10  Portions copied from the Keyspan driver by Hugh Blemings <hugh@blemings.org>
 11
 12  History: see the git log.
 13
 14  Work sponsored by: Sigos GmbH, Germany <info@sigos.de>
 15
 16  This driver exists because the "normal" serial driver doesn't work too well
 17  with GSM modems. Issues:
 18  - data loss -- one single Receive URB is not nearly enough
 19  - controlling the baud rate doesn't make sense
 20*/
 21
 
 22#define DRIVER_AUTHOR "Matthias Urlichs <smurf@smurf.noris.de>"
 23#define DRIVER_DESC "USB Driver for GSM modems"
 24
 25#include <linux/kernel.h>
 26#include <linux/jiffies.h>
 27#include <linux/errno.h>
 28#include <linux/slab.h>
 29#include <linux/tty.h>
 30#include <linux/tty_flip.h>
 31#include <linux/module.h>
 32#include <linux/bitops.h>
 33#include <linux/uaccess.h>
 34#include <linux/usb.h>
 35#include <linux/usb/serial.h>
 36#include <linux/serial.h>
 37#include "usb-wwan.h"
 38
 
 
 39void usb_wwan_dtr_rts(struct usb_serial_port *port, int on)
 40{
 
 41	struct usb_wwan_port_private *portdata;
 
 42	struct usb_wwan_intf_private *intfdata;
 43
 
 
 44	intfdata = port->serial->private;
 45
 46	if (!intfdata->send_setup)
 47		return;
 48
 49	portdata = usb_get_serial_port_data(port);
 50	/* FIXME: locking */
 51	portdata->rts_state = on;
 52	portdata->dtr_state = on;
 53
 54	intfdata->send_setup(port);
 
 55}
 56EXPORT_SYMBOL(usb_wwan_dtr_rts);
 57
 58void usb_wwan_set_termios(struct tty_struct *tty,
 59			  struct usb_serial_port *port,
 60			  struct ktermios *old_termios)
 61{
 62	struct usb_wwan_intf_private *intfdata = port->serial->private;
 63
 
 
 64	/* Doesn't support option setting */
 65	tty_termios_copy_hw(&tty->termios, old_termios);
 66
 67	if (intfdata->send_setup)
 68		intfdata->send_setup(port);
 69}
 70EXPORT_SYMBOL(usb_wwan_set_termios);
 71
 72int usb_wwan_tiocmget(struct tty_struct *tty)
 73{
 74	struct usb_serial_port *port = tty->driver_data;
 75	unsigned int value;
 76	struct usb_wwan_port_private *portdata;
 77
 78	portdata = usb_get_serial_port_data(port);
 79
 80	value = ((portdata->rts_state) ? TIOCM_RTS : 0) |
 81	    ((portdata->dtr_state) ? TIOCM_DTR : 0) |
 82	    ((portdata->cts_state) ? TIOCM_CTS : 0) |
 83	    ((portdata->dsr_state) ? TIOCM_DSR : 0) |
 84	    ((portdata->dcd_state) ? TIOCM_CAR : 0) |
 85	    ((portdata->ri_state) ? TIOCM_RNG : 0);
 86
 87	return value;
 88}
 89EXPORT_SYMBOL(usb_wwan_tiocmget);
 90
 91int usb_wwan_tiocmset(struct tty_struct *tty,
 92		      unsigned int set, unsigned int clear)
 93{
 94	struct usb_serial_port *port = tty->driver_data;
 95	struct usb_wwan_port_private *portdata;
 96	struct usb_wwan_intf_private *intfdata;
 97
 98	portdata = usb_get_serial_port_data(port);
 99	intfdata = port->serial->private;
100
101	if (!intfdata->send_setup)
102		return -EINVAL;
103
104	/* FIXME: what locks portdata fields ? */
105	if (set & TIOCM_RTS)
106		portdata->rts_state = 1;
107	if (set & TIOCM_DTR)
108		portdata->dtr_state = 1;
109
110	if (clear & TIOCM_RTS)
111		portdata->rts_state = 0;
112	if (clear & TIOCM_DTR)
113		portdata->dtr_state = 0;
114	return intfdata->send_setup(port);
115}
116EXPORT_SYMBOL(usb_wwan_tiocmset);
117
118static int get_serial_info(struct usb_serial_port *port,
119			   struct serial_struct __user *retinfo)
120{
121	struct serial_struct tmp;
122
123	if (!retinfo)
124		return -EFAULT;
125
126	memset(&tmp, 0, sizeof(tmp));
127	tmp.line            = port->minor;
128	tmp.port            = port->port_number;
129	tmp.baud_base       = tty_get_baud_rate(port->port.tty);
130	tmp.close_delay	    = port->port.close_delay / 10;
131	tmp.closing_wait    = port->port.closing_wait == ASYNC_CLOSING_WAIT_NONE ?
132				 ASYNC_CLOSING_WAIT_NONE :
133				 port->port.closing_wait / 10;
134
135	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
136		return -EFAULT;
137	return 0;
138}
139
140static int set_serial_info(struct usb_serial_port *port,
141			   struct serial_struct __user *newinfo)
142{
143	struct serial_struct new_serial;
144	unsigned int closing_wait, close_delay;
145	int retval = 0;
146
147	if (copy_from_user(&new_serial, newinfo, sizeof(new_serial)))
148		return -EFAULT;
149
150	close_delay = new_serial.close_delay * 10;
151	closing_wait = new_serial.closing_wait == ASYNC_CLOSING_WAIT_NONE ?
152			ASYNC_CLOSING_WAIT_NONE : new_serial.closing_wait * 10;
153
154	mutex_lock(&port->port.mutex);
155
156	if (!capable(CAP_SYS_ADMIN)) {
157		if ((close_delay != port->port.close_delay) ||
158		    (closing_wait != port->port.closing_wait))
159			retval = -EPERM;
160		else
161			retval = -EOPNOTSUPP;
162	} else {
163		port->port.close_delay  = close_delay;
164		port->port.closing_wait = closing_wait;
165	}
166
167	mutex_unlock(&port->port.mutex);
168	return retval;
169}
170
171int usb_wwan_ioctl(struct tty_struct *tty,
172		   unsigned int cmd, unsigned long arg)
173{
174	struct usb_serial_port *port = tty->driver_data;
175
176	dev_dbg(&port->dev, "%s cmd 0x%04x\n", __func__, cmd);
177
178	switch (cmd) {
179	case TIOCGSERIAL:
180		return get_serial_info(port,
181				       (struct serial_struct __user *) arg);
182	case TIOCSSERIAL:
183		return set_serial_info(port,
184				       (struct serial_struct __user *) arg);
185	default:
186		break;
187	}
188
189	dev_dbg(&port->dev, "%s arg not supported\n", __func__);
190
191	return -ENOIOCTLCMD;
192}
193EXPORT_SYMBOL(usb_wwan_ioctl);
194
195/* Write */
196int usb_wwan_write(struct tty_struct *tty, struct usb_serial_port *port,
197		   const unsigned char *buf, int count)
198{
199	struct usb_wwan_port_private *portdata;
200	struct usb_wwan_intf_private *intfdata;
201	int i;
202	int left, todo;
203	struct urb *this_urb = NULL;	/* spurious */
204	int err;
205	unsigned long flags;
206
207	portdata = usb_get_serial_port_data(port);
208	intfdata = port->serial->private;
209
210	dev_dbg(&port->dev, "%s: write (%d chars)\n", __func__, count);
211
212	i = 0;
213	left = count;
214	for (i = 0; left > 0 && i < N_OUT_URB; i++) {
215		todo = left;
216		if (todo > OUT_BUFLEN)
217			todo = OUT_BUFLEN;
218
219		this_urb = portdata->out_urbs[i];
220		if (test_and_set_bit(i, &portdata->out_busy)) {
221			if (time_before(jiffies,
222					portdata->tx_start_time[i] + 10 * HZ))
223				continue;
224			usb_unlink_urb(this_urb);
225			continue;
226		}
227		dev_dbg(&port->dev, "%s: endpoint %d buf %d\n", __func__,
228			usb_pipeendpoint(this_urb->pipe), i);
229
230		err = usb_autopm_get_interface_async(port->serial->interface);
231		if (err < 0)
232			break;
233
234		/* send the data */
235		memcpy(this_urb->transfer_buffer, buf, todo);
236		this_urb->transfer_buffer_length = todo;
237
238		spin_lock_irqsave(&intfdata->susp_lock, flags);
239		if (intfdata->suspended) {
240			usb_anchor_urb(this_urb, &portdata->delayed);
241			spin_unlock_irqrestore(&intfdata->susp_lock, flags);
242		} else {
243			intfdata->in_flight++;
244			spin_unlock_irqrestore(&intfdata->susp_lock, flags);
245			err = usb_submit_urb(this_urb, GFP_ATOMIC);
246			if (err) {
247				dev_dbg(&port->dev,
248					"usb_submit_urb %p (write bulk) failed (%d)\n",
249					this_urb, err);
250				clear_bit(i, &portdata->out_busy);
251				spin_lock_irqsave(&intfdata->susp_lock, flags);
252				intfdata->in_flight--;
253				spin_unlock_irqrestore(&intfdata->susp_lock,
254						       flags);
255				usb_autopm_put_interface_async(port->serial->interface);
256				break;
257			}
258		}
259
260		portdata->tx_start_time[i] = jiffies;
261		buf += todo;
262		left -= todo;
263	}
264
265	count -= left;
266	dev_dbg(&port->dev, "%s: wrote (did %d)\n", __func__, count);
267	return count;
268}
269EXPORT_SYMBOL(usb_wwan_write);
270
271static void usb_wwan_indat_callback(struct urb *urb)
272{
273	int err;
274	int endpoint;
275	struct usb_serial_port *port;
276	struct device *dev;
277	unsigned char *data = urb->transfer_buffer;
278	int status = urb->status;
279
 
 
280	endpoint = usb_pipeendpoint(urb->pipe);
281	port = urb->context;
282	dev = &port->dev;
283
284	if (status) {
285		dev_dbg(dev, "%s: nonzero status: %d on endpoint %02x.\n",
286			__func__, status, endpoint);
287	} else {
288		if (urb->actual_length) {
289			tty_insert_flip_string(&port->port, data,
290					urb->actual_length);
291			tty_flip_buffer_push(&port->port);
292		} else
293			dev_dbg(dev, "%s: empty read urb received\n", __func__);
294	}
295	/* Resubmit urb so we continue receiving */
296	err = usb_submit_urb(urb, GFP_ATOMIC);
297	if (err) {
298		if (err != -EPERM) {
299			dev_err(dev, "%s: resubmit read urb failed. (%d)\n",
300				__func__, err);
301			/* busy also in error unless we are killed */
302			usb_mark_last_busy(port->serial->dev);
 
 
 
 
 
 
 
 
 
303		}
304	} else {
305		usb_mark_last_busy(port->serial->dev);
306	}
307}
308
309static void usb_wwan_outdat_callback(struct urb *urb)
310{
311	struct usb_serial_port *port;
312	struct usb_wwan_port_private *portdata;
313	struct usb_wwan_intf_private *intfdata;
314	int i;
315
 
 
316	port = urb->context;
317	intfdata = port->serial->private;
318
319	usb_serial_port_softint(port);
320	usb_autopm_put_interface_async(port->serial->interface);
321	portdata = usb_get_serial_port_data(port);
322	spin_lock(&intfdata->susp_lock);
323	intfdata->in_flight--;
324	spin_unlock(&intfdata->susp_lock);
325
326	for (i = 0; i < N_OUT_URB; ++i) {
327		if (portdata->out_urbs[i] == urb) {
328			smp_mb__before_clear_bit();
329			clear_bit(i, &portdata->out_busy);
330			break;
331		}
332	}
333}
334
335int usb_wwan_write_room(struct tty_struct *tty)
336{
337	struct usb_serial_port *port = tty->driver_data;
338	struct usb_wwan_port_private *portdata;
339	int i;
340	int data_len = 0;
341	struct urb *this_urb;
342
343	portdata = usb_get_serial_port_data(port);
344
345	for (i = 0; i < N_OUT_URB; i++) {
346		this_urb = portdata->out_urbs[i];
347		if (this_urb && !test_bit(i, &portdata->out_busy))
348			data_len += OUT_BUFLEN;
349	}
350
351	dev_dbg(&port->dev, "%s: %d\n", __func__, data_len);
352	return data_len;
353}
354EXPORT_SYMBOL(usb_wwan_write_room);
355
356int usb_wwan_chars_in_buffer(struct tty_struct *tty)
357{
358	struct usb_serial_port *port = tty->driver_data;
359	struct usb_wwan_port_private *portdata;
360	int i;
361	int data_len = 0;
362	struct urb *this_urb;
363
364	portdata = usb_get_serial_port_data(port);
365
366	for (i = 0; i < N_OUT_URB; i++) {
367		this_urb = portdata->out_urbs[i];
368		/* FIXME: This locking is insufficient as this_urb may
369		   go unused during the test */
370		if (this_urb && test_bit(i, &portdata->out_busy))
371			data_len += this_urb->transfer_buffer_length;
372	}
373	dev_dbg(&port->dev, "%s: %d\n", __func__, data_len);
374	return data_len;
375}
376EXPORT_SYMBOL(usb_wwan_chars_in_buffer);
377
378int usb_wwan_open(struct tty_struct *tty, struct usb_serial_port *port)
379{
380	struct usb_wwan_port_private *portdata;
381	struct usb_wwan_intf_private *intfdata;
382	struct usb_serial *serial = port->serial;
383	int i, err;
384	struct urb *urb;
385
386	portdata = usb_get_serial_port_data(port);
387	intfdata = serial->private;
388
 
 
389	/* Start reading from the IN endpoint */
390	for (i = 0; i < N_IN_URB; i++) {
391		urb = portdata->in_urbs[i];
392		if (!urb)
393			continue;
394		err = usb_submit_urb(urb, GFP_KERNEL);
395		if (err) {
396			dev_dbg(&port->dev, "%s: submit urb %d failed (%d) %d\n",
397				__func__, i, err, urb->transfer_buffer_length);
398		}
399	}
400
401	if (intfdata->send_setup)
402		intfdata->send_setup(port);
403
404	serial->interface->needs_remote_wakeup = 1;
405	spin_lock_irq(&intfdata->susp_lock);
406	portdata->opened = 1;
407	spin_unlock_irq(&intfdata->susp_lock);
408	/* this balances a get in the generic USB serial code */
409	usb_autopm_put_interface(serial->interface);
410
411	return 0;
412}
413EXPORT_SYMBOL(usb_wwan_open);
414
415void usb_wwan_close(struct usb_serial_port *port)
416{
417	int i;
418	struct usb_serial *serial = port->serial;
419	struct usb_wwan_port_private *portdata;
420	struct usb_wwan_intf_private *intfdata = port->serial->private;
421
 
422	portdata = usb_get_serial_port_data(port);
423
424	/* Stop reading/writing urbs */
425	spin_lock_irq(&intfdata->susp_lock);
426	portdata->opened = 0;
427	spin_unlock_irq(&intfdata->susp_lock);
 
428
429	for (i = 0; i < N_IN_URB; i++)
430		usb_kill_urb(portdata->in_urbs[i]);
431	for (i = 0; i < N_OUT_URB; i++)
432		usb_kill_urb(portdata->out_urbs[i]);
433
434	/* balancing - important as an error cannot be handled*/
435	usb_autopm_get_interface_no_resume(serial->interface);
436	serial->interface->needs_remote_wakeup = 0;
437}
438EXPORT_SYMBOL(usb_wwan_close);
439
440/* Helper functions used by usb_wwan_setup_urbs */
441static struct urb *usb_wwan_setup_urb(struct usb_serial_port *port,
442				      int endpoint,
443				      int dir, void *ctx, char *buf, int len,
444				      void (*callback) (struct urb *))
445{
446	struct usb_serial *serial = port->serial;
447	struct urb *urb;
448
 
 
 
449	urb = usb_alloc_urb(0, GFP_KERNEL);	/* No ISO */
450	if (!urb)
 
451		return NULL;
 
452
453	/* Fill URB using supplied data. */
454	usb_fill_bulk_urb(urb, serial->dev,
455			  usb_sndbulkpipe(serial->dev, endpoint) | dir,
456			  buf, len, callback, ctx);
457
458	return urb;
459}
460
461int usb_wwan_port_probe(struct usb_serial_port *port)
 
462{
 
 
463	struct usb_wwan_port_private *portdata;
464	struct urb *urb;
465	u8 *buffer;
466	int err;
467	int i;
468
469	if (!port->bulk_in_size || !port->bulk_out_size)
470		return -ENODEV;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
471
472	portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
473	if (!portdata)
474		return -ENOMEM;
 
 
 
475
476	init_usb_anchor(&portdata->delayed);
477
478	for (i = 0; i < N_IN_URB; i++) {
479		buffer = (u8 *)__get_free_page(GFP_KERNEL);
480		if (!buffer)
481			goto bail_out_error;
482		portdata->in_buffer[i] = buffer;
483
484		urb = usb_wwan_setup_urb(port, port->bulk_in_endpointAddress,
485						USB_DIR_IN, port,
486						buffer, IN_BUFLEN,
487						usb_wwan_indat_callback);
488		portdata->in_urbs[i] = urb;
489	}
490
491	for (i = 0; i < N_OUT_URB; i++) {
492		buffer = kmalloc(OUT_BUFLEN, GFP_KERNEL);
493		if (!buffer)
494			goto bail_out_error2;
495		portdata->out_buffer[i] = buffer;
 
496
497		urb = usb_wwan_setup_urb(port, port->bulk_out_endpointAddress,
498						USB_DIR_OUT, port,
499						buffer, OUT_BUFLEN,
500						usb_wwan_outdat_callback);
501		portdata->out_urbs[i] = urb;
502	}
503
504	usb_set_serial_port_data(port, portdata);
505
506	if (port->interrupt_in_urb) {
 
507		err = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
508		if (err)
509			dev_dbg(&port->dev, "%s: submit irq_in urb failed %d\n",
510				__func__, err);
511	}
512
513	return 0;
514
515bail_out_error2:
516	for (i = 0; i < N_OUT_URB; i++) {
517		usb_free_urb(portdata->out_urbs[i]);
518		kfree(portdata->out_buffer[i]);
519	}
520bail_out_error:
521	for (i = 0; i < N_IN_URB; i++) {
522		usb_free_urb(portdata->in_urbs[i]);
523		free_page((unsigned long)portdata->in_buffer[i]);
524	}
525	kfree(portdata);
526
527	return -ENOMEM;
528}
529EXPORT_SYMBOL_GPL(usb_wwan_port_probe);
530
531int usb_wwan_port_remove(struct usb_serial_port *port)
532{
533	int i;
 
534	struct usb_wwan_port_private *portdata;
535
536	portdata = usb_get_serial_port_data(port);
537	usb_set_serial_port_data(port, NULL);
 
 
 
 
 
 
 
 
538
539	/* Stop reading/writing urbs and free them */
540	for (i = 0; i < N_IN_URB; i++) {
541		usb_kill_urb(portdata->in_urbs[i]);
542		usb_free_urb(portdata->in_urbs[i]);
543		free_page((unsigned long)portdata->in_buffer[i]);
544	}
545	for (i = 0; i < N_OUT_URB; i++) {
546		usb_kill_urb(portdata->out_urbs[i]);
547		usb_free_urb(portdata->out_urbs[i]);
548		kfree(portdata->out_buffer[i]);
549	}
550
551	/* Now free port private data */
552	kfree(portdata);
553	return 0;
554}
555EXPORT_SYMBOL(usb_wwan_port_remove);
556
557#ifdef CONFIG_PM
558static void stop_read_write_urbs(struct usb_serial *serial)
559{
560	int i, j;
561	struct usb_serial_port *port;
562	struct usb_wwan_port_private *portdata;
563
564	/* Stop reading/writing urbs */
 
 
565	for (i = 0; i < serial->num_ports; ++i) {
566		port = serial->port[i];
567		portdata = usb_get_serial_port_data(port);
568		if (!portdata)
569			continue;
570		for (j = 0; j < N_IN_URB; j++)
571			usb_kill_urb(portdata->in_urbs[j]);
572		for (j = 0; j < N_OUT_URB; j++)
573			usb_kill_urb(portdata->out_urbs[j]);
 
 
 
 
 
 
 
 
 
 
 
 
574	}
575}
 
576
 
577int usb_wwan_suspend(struct usb_serial *serial, pm_message_t message)
578{
579	struct usb_wwan_intf_private *intfdata = serial->private;
580	int b;
581
582	if (PMSG_IS_AUTO(message)) {
 
 
583		spin_lock_irq(&intfdata->susp_lock);
584		b = intfdata->in_flight;
585		spin_unlock_irq(&intfdata->susp_lock);
586
587		if (b)
588			return -EBUSY;
589	}
590
591	spin_lock_irq(&intfdata->susp_lock);
592	intfdata->suspended = 1;
593	spin_unlock_irq(&intfdata->susp_lock);
594	stop_read_write_urbs(serial);
595
596	return 0;
597}
598EXPORT_SYMBOL(usb_wwan_suspend);
599
600static void unbusy_queued_urb(struct urb *urb, struct usb_wwan_port_private *portdata)
601{
602	int i;
603
604	for (i = 0; i < N_OUT_URB; i++) {
605		if (urb == portdata->out_urbs[i]) {
606			clear_bit(i, &portdata->out_busy);
607			break;
608		}
609	}
610}
611
612static void play_delayed(struct usb_serial_port *port)
613{
614	struct usb_wwan_intf_private *data;
615	struct usb_wwan_port_private *portdata;
616	struct urb *urb;
617	int err;
618
619	portdata = usb_get_serial_port_data(port);
620	data = port->serial->private;
621	while ((urb = usb_get_from_anchor(&portdata->delayed))) {
622		err = usb_submit_urb(urb, GFP_ATOMIC);
623		if (!err) {
624			data->in_flight++;
625		} else {
626			/* we have to throw away the rest */
627			do {
628				unbusy_queued_urb(urb, portdata);
629				usb_autopm_put_interface_no_suspend(port->serial->interface);
630			} while ((urb = usb_get_from_anchor(&portdata->delayed)));
631			break;
632		}
633	}
634}
635
636int usb_wwan_resume(struct usb_serial *serial)
637{
638	int i, j;
639	struct usb_serial_port *port;
640	struct usb_wwan_intf_private *intfdata = serial->private;
641	struct usb_wwan_port_private *portdata;
642	struct urb *urb;
643	int err = 0;
644
 
645	/* get the interrupt URBs resubmitted unconditionally */
646	for (i = 0; i < serial->num_ports; i++) {
647		port = serial->port[i];
648		if (!port->interrupt_in_urb) {
649			dev_dbg(&port->dev, "%s: No interrupt URB for port\n", __func__);
650			continue;
651		}
652		err = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO);
653		dev_dbg(&port->dev, "Submitted interrupt URB for port (result %d)\n", err);
654		if (err < 0) {
655			dev_err(&port->dev, "%s: Error %d for interrupt URB\n",
656				__func__, err);
657			goto err_out;
658		}
659	}
660
661	for (i = 0; i < serial->num_ports; i++) {
662		/* walk all ports */
663		port = serial->port[i];
664		portdata = usb_get_serial_port_data(port);
665
666		/* skip closed ports */
667		spin_lock_irq(&intfdata->susp_lock);
668		if (!portdata || !portdata->opened) {
669			spin_unlock_irq(&intfdata->susp_lock);
670			continue;
671		}
672
673		for (j = 0; j < N_IN_URB; j++) {
674			urb = portdata->in_urbs[j];
675			err = usb_submit_urb(urb, GFP_ATOMIC);
676			if (err < 0) {
677				dev_err(&port->dev, "%s: Error %d for bulk URB %d\n",
678					__func__, err, i);
679				spin_unlock_irq(&intfdata->susp_lock);
680				goto err_out;
681			}
682		}
683		play_delayed(port);
684		spin_unlock_irq(&intfdata->susp_lock);
685	}
686	spin_lock_irq(&intfdata->susp_lock);
687	intfdata->suspended = 0;
688	spin_unlock_irq(&intfdata->susp_lock);
689err_out:
690	return err;
691}
692EXPORT_SYMBOL(usb_wwan_resume);
693#endif
694
695MODULE_AUTHOR(DRIVER_AUTHOR);
696MODULE_DESCRIPTION(DRIVER_DESC);
 
697MODULE_LICENSE("GPL");