drivers/usb/serial/usb_wwan.c

   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  */
  40 static 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
  70 void 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 }
  87 EXPORT_SYMBOL(usb_wwan_dtr_rts);
  88
  89 int 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 }
 106 EXPORT_SYMBOL(usb_wwan_tiocmget);
 107
 108 int 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 }
 133 EXPORT_SYMBOL(usb_wwan_tiocmset);
 134
 135 static 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
 154 static 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
 185 int 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 }
 207 EXPORT_SYMBOL(usb_wwan_ioctl);
 208
 209 int 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 }
 284 EXPORT_SYMBOL(usb_wwan_write);
 285
 286 static 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
 303                 /* don't resubmit on fatal errors */
 304                 if (status == -ESHUTDOWN || status == -ENOENT)
 305                         return;
 306         } else {
 307                 if (urb->actual_length) {
 308                         tty_insert_flip_string(&port->port, data,
 309                                         urb->actual_length);
 310                         tty_flip_buffer_push(&port->port);
 311                 } else
 312                         dev_dbg(dev, "%s: empty read urb received\n", __func__);
 313         }
 314         /* Resubmit urb so we continue receiving */
 315         err = usb_submit_urb(urb, GFP_ATOMIC);
 316         if (err) {
 317                 if (err != -EPERM && err != -ENODEV) {
 318                         dev_err(dev, "%s: resubmit read urb failed. (%d)\n",
 319                                 __func__, err);
 320                         /* busy also in error unless we are killed */
 321                         usb_mark_last_busy(port->serial->dev);
 322                 }
 323         } else {
 324                 usb_mark_last_busy(port->serial->dev);
 325         }
 326 }
 327
 328 static void usb_wwan_outdat_callback(struct urb *urb)
 329 {
 330         struct usb_serial_port *port;
 331         struct usb_wwan_port_private *portdata;
 332         struct usb_wwan_intf_private *intfdata;
 333         unsigned long flags;
 334         int i;
 335
 336         port = urb->context;
 337         intfdata = usb_get_serial_data(port->serial);
 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_irqsave(&intfdata->susp_lock, flags);
 343         intfdata->in_flight--;
 344         spin_unlock_irqrestore(&intfdata->susp_lock, flags);
 345
 346         for (i = 0; i < N_OUT_URB; ++i) {
 347                 if (portdata->out_urbs[i] == urb) {
 348                         smp_mb__before_atomic();
 349                         clear_bit(i, &portdata->out_busy);
 350                         break;
 351                 }
 352         }
 353 }
 354
 355 int 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         dev_dbg(&port->dev, "%s: %d\n", __func__, data_len);
 372         return data_len;
 373 }
 374 EXPORT_SYMBOL(usb_wwan_write_room);
 375
 376 int 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         dev_dbg(&port->dev, "%s: %d\n", __func__, data_len);
 394         return data_len;
 395 }
 396 EXPORT_SYMBOL(usb_wwan_chars_in_buffer);
 397
 398 int 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 = usb_get_serial_data(serial);
 408
 409         if (port->interrupt_in_urb) {
 410                 err = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
 411                 if (err) {
 412                         dev_err(&port->dev, "%s: submit int urb failed: %d\n",
 413                                 __func__, err);
 414                 }
 415         }
 416
 417         /* Start reading from the IN endpoint */
 418         for (i = 0; i < N_IN_URB; i++) {
 419                 urb = portdata->in_urbs[i];
 420                 if (!urb)
 421                         continue;
 422                 err = usb_submit_urb(urb, GFP_KERNEL);
 423                 if (err) {
 424                         dev_err(&port->dev,
 425                                 "%s: submit read urb %d failed: %d\n",
 426                                 __func__, i, err);
 427                 }
 428         }
 429
 430         spin_lock_irq(&intfdata->susp_lock);
 431         if (++intfdata->open_ports == 1)
 432                 serial->interface->needs_remote_wakeup = 1;
 433         spin_unlock_irq(&intfdata->susp_lock);
 434         /* this balances a get in the generic USB serial code */
 435         usb_autopm_put_interface(serial->interface);
 436
 437         return 0;
 438 }
 439 EXPORT_SYMBOL(usb_wwan_open);
 440
 441 static void unbusy_queued_urb(struct urb *urb,
 442                                         struct usb_wwan_port_private *portdata)
 443 {
 444         int i;
 445
 446         for (i = 0; i < N_OUT_URB; i++) {
 447                 if (urb == portdata->out_urbs[i]) {
 448                         clear_bit(i, &portdata->out_busy);
 449                         break;
 450                 }
 451         }
 452 }
 453
 454 void usb_wwan_close(struct usb_serial_port *port)
 455 {
 456         int i;
 457         struct usb_serial *serial = port->serial;
 458         struct usb_wwan_port_private *portdata;
 459         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 460         struct urb *urb;
 461
 462         portdata = usb_get_serial_port_data(port);
 463
 464         /*
 465          * Need to take susp_lock to make sure port is not already being
 466          * resumed, but no need to hold it due to initialized
 467          */
 468         spin_lock_irq(&intfdata->susp_lock);
 469         if (--intfdata->open_ports == 0)
 470                 serial->interface->needs_remote_wakeup = 0;
 471         spin_unlock_irq(&intfdata->susp_lock);
 472
 473         for (;;) {
 474                 urb = usb_get_from_anchor(&portdata->delayed);
 475                 if (!urb)
 476                         break;
 477                 unbusy_queued_urb(urb, portdata);
 478                 usb_autopm_put_interface_async(serial->interface);
 479         }
 480
 481         for (i = 0; i < N_IN_URB; i++)
 482                 usb_kill_urb(portdata->in_urbs[i]);
 483         for (i = 0; i < N_OUT_URB; i++)
 484                 usb_kill_urb(portdata->out_urbs[i]);
 485         usb_kill_urb(port->interrupt_in_urb);
 486
 487         usb_autopm_get_interface_no_resume(serial->interface);
 488 }
 489 EXPORT_SYMBOL(usb_wwan_close);
 490
 491 static struct urb *usb_wwan_setup_urb(struct usb_serial_port *port,
 492                                       int endpoint,
 493                                       int dir, void *ctx, char *buf, int len,
 494                                       void (*callback) (struct urb *))
 495 {
 496         struct usb_serial *serial = port->serial;
 497         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 498         struct urb *urb;
 499
 500         urb = usb_alloc_urb(0, GFP_KERNEL);     /* No ISO */
 501         if (!urb)
 502                 return NULL;
 503
 504         usb_fill_bulk_urb(urb, serial->dev,
 505                           usb_sndbulkpipe(serial->dev, endpoint) | dir,
 506                           buf, len, callback, ctx);
 507
 508         if (intfdata->use_zlp && dir == USB_DIR_OUT)
 509                 urb->transfer_flags |= URB_ZERO_PACKET;
 510
 511         return urb;
 512 }
 513
 514 int usb_wwan_port_probe(struct usb_serial_port *port)
 515 {
 516         struct usb_wwan_port_private *portdata;
 517         struct urb *urb;
 518         u8 *buffer;
 519         int i;
 520
 521         if (!port->bulk_in_size || !port->bulk_out_size)
 522                 return -ENODEV;
 523
 524         portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
 525         if (!portdata)
 526                 return -ENOMEM;
 527
 528         init_usb_anchor(&portdata->delayed);
 529
 530         for (i = 0; i < N_IN_URB; i++) {
 531                 buffer = (u8 *)__get_free_page(GFP_KERNEL);
 532                 if (!buffer)
 533                         goto bail_out_error;
 534                 portdata->in_buffer[i] = buffer;
 535
 536                 urb = usb_wwan_setup_urb(port, port->bulk_in_endpointAddress,
 537                                                 USB_DIR_IN, port,
 538                                                 buffer, IN_BUFLEN,
 539                                                 usb_wwan_indat_callback);
 540                 portdata->in_urbs[i] = urb;
 541         }
 542
 543         for (i = 0; i < N_OUT_URB; i++) {
 544                 buffer = kmalloc(OUT_BUFLEN, GFP_KERNEL);
 545                 if (!buffer)
 546                         goto bail_out_error2;
 547                 portdata->out_buffer[i] = buffer;
 548
 549                 urb = usb_wwan_setup_urb(port, port->bulk_out_endpointAddress,
 550                                                 USB_DIR_OUT, port,
 551                                                 buffer, OUT_BUFLEN,
 552                                                 usb_wwan_outdat_callback);
 553                 portdata->out_urbs[i] = urb;
 554         }
 555
 556         usb_set_serial_port_data(port, portdata);
 557
 558         return 0;
 559
 560 bail_out_error2:
 561         for (i = 0; i < N_OUT_URB; i++) {
 562                 usb_free_urb(portdata->out_urbs[i]);
 563                 kfree(portdata->out_buffer[i]);
 564         }
 565 bail_out_error:
 566         for (i = 0; i < N_IN_URB; i++) {
 567                 usb_free_urb(portdata->in_urbs[i]);
 568                 free_page((unsigned long)portdata->in_buffer[i]);
 569         }
 570         kfree(portdata);
 571
 572         return -ENOMEM;
 573 }
 574 EXPORT_SYMBOL_GPL(usb_wwan_port_probe);
 575
 576 int usb_wwan_port_remove(struct usb_serial_port *port)
 577 {
 578         int i;
 579         struct usb_wwan_port_private *portdata;
 580
 581         portdata = usb_get_serial_port_data(port);
 582         usb_set_serial_port_data(port, NULL);
 583
 584         for (i = 0; i < N_IN_URB; i++) {
 585                 usb_free_urb(portdata->in_urbs[i]);
 586                 free_page((unsigned long)portdata->in_buffer[i]);
 587         }
 588         for (i = 0; i < N_OUT_URB; i++) {
 589                 usb_free_urb(portdata->out_urbs[i]);
 590                 kfree(portdata->out_buffer[i]);
 591         }
 592
 593         kfree(portdata);
 594
 595         return 0;
 596 }
 597 EXPORT_SYMBOL(usb_wwan_port_remove);
 598
 599 #ifdef CONFIG_PM
 600 static void stop_urbs(struct usb_serial *serial)
 601 {
 602         int i, j;
 603         struct usb_serial_port *port;
 604         struct usb_wwan_port_private *portdata;
 605
 606         for (i = 0; i < serial->num_ports; ++i) {
 607                 port = serial->port[i];
 608                 portdata = usb_get_serial_port_data(port);
 609                 if (!portdata)
 610                         continue;
 611                 for (j = 0; j < N_IN_URB; j++)
 612                         usb_kill_urb(portdata->in_urbs[j]);
 613                 for (j = 0; j < N_OUT_URB; j++)
 614                         usb_kill_urb(portdata->out_urbs[j]);
 615                 usb_kill_urb(port->interrupt_in_urb);
 616         }
 617 }
 618
 619 int usb_wwan_suspend(struct usb_serial *serial, pm_message_t message)
 620 {
 621         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 622
 623         spin_lock_irq(&intfdata->susp_lock);
 624         if (PMSG_IS_AUTO(message)) {
 625                 if (intfdata->in_flight) {
 626                         spin_unlock_irq(&intfdata->susp_lock);
 627                         return -EBUSY;
 628                 }
 629         }
 630         intfdata->suspended = 1;
 631         spin_unlock_irq(&intfdata->susp_lock);
 632
 633         stop_urbs(serial);
 634
 635         return 0;
 636 }
 637 EXPORT_SYMBOL(usb_wwan_suspend);
 638
 639 /* Caller must hold susp_lock. */
 640 static int usb_wwan_submit_delayed_urbs(struct usb_serial_port *port)
 641 {
 642         struct usb_serial *serial = port->serial;
 643         struct usb_wwan_intf_private *data = usb_get_serial_data(serial);
 644         struct usb_wwan_port_private *portdata;
 645         struct urb *urb;
 646         int err_count = 0;
 647         int err;
 648
 649         portdata = usb_get_serial_port_data(port);
 650
 651         for (;;) {
 652                 urb = usb_get_from_anchor(&portdata->delayed);
 653                 if (!urb)
 654                         break;
 655
 656                 err = usb_submit_urb(urb, GFP_ATOMIC);
 657                 if (err) {
 658                         dev_err(&port->dev, "%s: submit urb failed: %d\n",
 659                                         __func__, err);
 660                         err_count++;
 661                         unbusy_queued_urb(urb, portdata);
 662                         usb_autopm_put_interface_async(serial->interface);
 663                         continue;
 664                 }
 665                 data->in_flight++;
 666         }
 667
 668         if (err_count)
 669                 return -EIO;
 670
 671         return 0;
 672 }
 673
 674 int usb_wwan_resume(struct usb_serial *serial)
 675 {
 676         int i, j;
 677         struct usb_serial_port *port;
 678         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 679         struct usb_wwan_port_private *portdata;
 680         struct urb *urb;
 681         int err;
 682         int err_count = 0;
 683
 684         spin_lock_irq(&intfdata->susp_lock);
 685         for (i = 0; i < serial->num_ports; i++) {
 686                 port = serial->port[i];
 687
 688                 if (!tty_port_initialized(&port->port))
 689                         continue;
 690
 691                 portdata = usb_get_serial_port_data(port);
 692
 693                 if (port->interrupt_in_urb) {
 694                         err = usb_submit_urb(port->interrupt_in_urb,
 695                                         GFP_ATOMIC);
 696                         if (err) {
 697                                 dev_err(&port->dev,
 698                                         "%s: submit int urb failed: %d\n",
 699                                         __func__, err);
 700                                 err_count++;
 701                         }
 702                 }
 703
 704                 err = usb_wwan_submit_delayed_urbs(port);
 705                 if (err)
 706                         err_count++;
 707
 708                 for (j = 0; j < N_IN_URB; j++) {
 709                         urb = portdata->in_urbs[j];
 710                         err = usb_submit_urb(urb, GFP_ATOMIC);
 711                         if (err < 0) {
 712                                 dev_err(&port->dev,
 713                                         "%s: submit read urb %d failed: %d\n",
 714                                         __func__, i, err);
 715                                 err_count++;
 716                         }
 717                 }
 718         }
 719         intfdata->suspended = 0;
 720         spin_unlock_irq(&intfdata->susp_lock);
 721
 722         if (err_count)
 723                 return -EIO;
 724
 725         return 0;
 726 }
 727 EXPORT_SYMBOL(usb_wwan_resume);
 728 #endif
 729
 730 MODULE_AUTHOR(DRIVER_AUTHOR);
 731 MODULE_DESCRIPTION(DRIVER_DESC);
 732 MODULE_LICENSE("GPL v2");