Linux Audio

Check our new training course

Linux kernel drivers training

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