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 the tty-port initialized
 467          * flag.
 468          */
 469         spin_lock_irq(&intfdata->susp_lock);
 470         if (--intfdata->open_ports == 0)
 471                 serial->interface->needs_remote_wakeup = 0;
 472         spin_unlock_irq(&intfdata->susp_lock);
 473
 474         for (;;) {
 475                 urb = usb_get_from_anchor(&portdata->delayed);
 476                 if (!urb)
 477                         break;
 478                 unbusy_queued_urb(urb, portdata);
 479                 usb_autopm_put_interface_async(serial->interface);
 480         }
 481
 482         for (i = 0; i < N_IN_URB; i++)
 483                 usb_kill_urb(portdata->in_urbs[i]);
 484         for (i = 0; i < N_OUT_URB; i++)
 485                 usb_kill_urb(portdata->out_urbs[i]);
 486         usb_kill_urb(port->interrupt_in_urb);
 487
 488         usb_autopm_get_interface_no_resume(serial->interface);
 489 }
 490 EXPORT_SYMBOL(usb_wwan_close);
 491
 492 static struct urb *usb_wwan_setup_urb(struct usb_serial_port *port,
 493                                       int endpoint,
 494                                       int dir, void *ctx, char *buf, int len,
 495                                       void (*callback) (struct urb *))
 496 {
 497         struct usb_serial *serial = port->serial;
 498         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 499         struct urb *urb;
 500
 501         urb = usb_alloc_urb(0, GFP_KERNEL);     /* No ISO */
 502         if (!urb)
 503                 return NULL;
 504
 505         usb_fill_bulk_urb(urb, serial->dev,
 506                           usb_sndbulkpipe(serial->dev, endpoint) | dir,
 507                           buf, len, callback, ctx);
 508
 509         if (intfdata->use_zlp && dir == USB_DIR_OUT)
 510                 urb->transfer_flags |= URB_ZERO_PACKET;
 511
 512         return urb;
 513 }
 514
 515 int usb_wwan_port_probe(struct usb_serial_port *port)
 516 {
 517         struct usb_wwan_port_private *portdata;
 518         struct urb *urb;
 519         u8 *buffer;
 520         int i;
 521
 522         if (!port->bulk_in_size || !port->bulk_out_size)
 523                 return -ENODEV;
 524
 525         portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
 526         if (!portdata)
 527                 return -ENOMEM;
 528
 529         init_usb_anchor(&portdata->delayed);
 530
 531         for (i = 0; i < N_IN_URB; i++) {
 532                 buffer = (u8 *)__get_free_page(GFP_KERNEL);
 533                 if (!buffer)
 534                         goto bail_out_error;
 535                 portdata->in_buffer[i] = buffer;
 536
 537                 urb = usb_wwan_setup_urb(port, port->bulk_in_endpointAddress,
 538                                                 USB_DIR_IN, port,
 539                                                 buffer, IN_BUFLEN,
 540                                                 usb_wwan_indat_callback);
 541                 portdata->in_urbs[i] = urb;
 542         }
 543
 544         for (i = 0; i < N_OUT_URB; i++) {
 545                 buffer = kmalloc(OUT_BUFLEN, GFP_KERNEL);
 546                 if (!buffer)
 547                         goto bail_out_error2;
 548                 portdata->out_buffer[i] = buffer;
 549
 550                 urb = usb_wwan_setup_urb(port, port->bulk_out_endpointAddress,
 551                                                 USB_DIR_OUT, port,
 552                                                 buffer, OUT_BUFLEN,
 553                                                 usb_wwan_outdat_callback);
 554                 portdata->out_urbs[i] = urb;
 555         }
 556
 557         usb_set_serial_port_data(port, portdata);
 558
 559         return 0;
 560
 561 bail_out_error2:
 562         for (i = 0; i < N_OUT_URB; i++) {
 563                 usb_free_urb(portdata->out_urbs[i]);
 564                 kfree(portdata->out_buffer[i]);
 565         }
 566 bail_out_error:
 567         for (i = 0; i < N_IN_URB; i++) {
 568                 usb_free_urb(portdata->in_urbs[i]);
 569                 free_page((unsigned long)portdata->in_buffer[i]);
 570         }
 571         kfree(portdata);
 572
 573         return -ENOMEM;
 574 }
 575 EXPORT_SYMBOL_GPL(usb_wwan_port_probe);
 576
 577 int usb_wwan_port_remove(struct usb_serial_port *port)
 578 {
 579         int i;
 580         struct usb_wwan_port_private *portdata;
 581
 582         portdata = usb_get_serial_port_data(port);
 583         usb_set_serial_port_data(port, NULL);
 584
 585         for (i = 0; i < N_IN_URB; i++) {
 586                 usb_free_urb(portdata->in_urbs[i]);
 587                 free_page((unsigned long)portdata->in_buffer[i]);
 588         }
 589         for (i = 0; i < N_OUT_URB; i++) {
 590                 usb_free_urb(portdata->out_urbs[i]);
 591                 kfree(portdata->out_buffer[i]);
 592         }
 593
 594         kfree(portdata);
 595
 596         return 0;
 597 }
 598 EXPORT_SYMBOL(usb_wwan_port_remove);
 599
 600 #ifdef CONFIG_PM
 601 static void stop_urbs(struct usb_serial *serial)
 602 {
 603         int i, j;
 604         struct usb_serial_port *port;
 605         struct usb_wwan_port_private *portdata;
 606
 607         for (i = 0; i < serial->num_ports; ++i) {
 608                 port = serial->port[i];
 609                 portdata = usb_get_serial_port_data(port);
 610                 if (!portdata)
 611                         continue;
 612                 for (j = 0; j < N_IN_URB; j++)
 613                         usb_kill_urb(portdata->in_urbs[j]);
 614                 for (j = 0; j < N_OUT_URB; j++)
 615                         usb_kill_urb(portdata->out_urbs[j]);
 616                 usb_kill_urb(port->interrupt_in_urb);
 617         }
 618 }
 619
 620 int usb_wwan_suspend(struct usb_serial *serial, pm_message_t message)
 621 {
 622         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 623
 624         spin_lock_irq(&intfdata->susp_lock);
 625         if (PMSG_IS_AUTO(message)) {
 626                 if (intfdata->in_flight) {
 627                         spin_unlock_irq(&intfdata->susp_lock);
 628                         return -EBUSY;
 629                 }
 630         }
 631         intfdata->suspended = 1;
 632         spin_unlock_irq(&intfdata->susp_lock);
 633
 634         stop_urbs(serial);
 635
 636         return 0;
 637 }
 638 EXPORT_SYMBOL(usb_wwan_suspend);
 639
 640 /* Caller must hold susp_lock. */
 641 static int usb_wwan_submit_delayed_urbs(struct usb_serial_port *port)
 642 {
 643         struct usb_serial *serial = port->serial;
 644         struct usb_wwan_intf_private *data = usb_get_serial_data(serial);
 645         struct usb_wwan_port_private *portdata;
 646         struct urb *urb;
 647         int err_count = 0;
 648         int err;
 649
 650         portdata = usb_get_serial_port_data(port);
 651
 652         for (;;) {
 653                 urb = usb_get_from_anchor(&portdata->delayed);
 654                 if (!urb)
 655                         break;
 656
 657                 err = usb_submit_urb(urb, GFP_ATOMIC);
 658                 if (err) {
 659                         dev_err(&port->dev, "%s: submit urb failed: %d\n",
 660                                         __func__, err);
 661                         err_count++;
 662                         unbusy_queued_urb(urb, portdata);
 663                         usb_autopm_put_interface_async(serial->interface);
 664                         continue;
 665                 }
 666                 data->in_flight++;
 667         }
 668
 669         if (err_count)
 670                 return -EIO;
 671
 672         return 0;
 673 }
 674
 675 int usb_wwan_resume(struct usb_serial *serial)
 676 {
 677         int i, j;
 678         struct usb_serial_port *port;
 679         struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
 680         struct usb_wwan_port_private *portdata;
 681         struct urb *urb;
 682         int err;
 683         int err_count = 0;
 684
 685         spin_lock_irq(&intfdata->susp_lock);
 686         for (i = 0; i < serial->num_ports; i++) {
 687                 port = serial->port[i];
 688
 689                 if (!tty_port_initialized(&port->port))
 690                         continue;
 691
 692                 portdata = usb_get_serial_port_data(port);
 693
 694                 if (port->interrupt_in_urb) {
 695                         err = usb_submit_urb(port->interrupt_in_urb,
 696                                         GFP_ATOMIC);
 697                         if (err) {
 698                                 dev_err(&port->dev,
 699                                         "%s: submit int urb failed: %d\n",
 700                                         __func__, err);
 701                                 err_count++;
 702                         }
 703                 }
 704
 705                 err = usb_wwan_submit_delayed_urbs(port);
 706                 if (err)
 707                         err_count++;
 708
 709                 for (j = 0; j < N_IN_URB; j++) {
 710                         urb = portdata->in_urbs[j];
 711                         err = usb_submit_urb(urb, GFP_ATOMIC);
 712                         if (err < 0) {
 713                                 dev_err(&port->dev,
 714                                         "%s: submit read urb %d failed: %d\n",
 715                                         __func__, i, err);
 716                                 err_count++;
 717                         }
 718                 }
 719         }
 720         intfdata->suspended = 0;
 721         spin_unlock_irq(&intfdata->susp_lock);
 722
 723         if (err_count)
 724                 return -EIO;
 725
 726         return 0;
 727 }
 728 EXPORT_SYMBOL(usb_wwan_resume);
 729 #endif
 730
 731 MODULE_AUTHOR(DRIVER_AUTHOR);
 732 MODULE_DESCRIPTION(DRIVER_DESC);
 733 MODULE_LICENSE("GPL v2");