]> git.openfabrics.org - ~shefty/rdma-dev.git/commitdiff
Merge branch 'upstream-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/jgarzi...
authorLinus Torvalds <torvalds@linux-foundation.org>
Wed, 29 Jul 2009 19:29:39 +0000 (12:29 -0700)
committerLinus Torvalds <torvalds@linux-foundation.org>
Wed, 29 Jul 2009 19:29:39 +0000 (12:29 -0700)
* 'upstream-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/jgarzik/libata-dev:
  libata: accept late unlocking of HPA
  libata: Updates and fixes for pata_at91 driver
  ata_piix: Add new short cable ID
  ata_piix: Add new laptop short cable IDs
  ahci: add device IDs for Ibex Peak ahci controllers
  libata: remove superfluous NULL pointer checks
  libata: add missing NULL pointer check to ata_eh_reset()
  pata_pcmcia: add CNF-CDROM-ID

37 files changed:
Documentation/filesystems/sysfs.txt
drivers/base/firmware_class.c
drivers/base/sys.c
drivers/char/n_tty.c
drivers/char/pty.c
drivers/char/tty_buffer.c
drivers/staging/Kconfig
drivers/staging/Makefile
drivers/staging/android/lowmemorykiller.c
drivers/staging/serqt_usb2/serqt_usb2.c
drivers/staging/uc2322/Kconfig [deleted file]
drivers/staging/uc2322/Makefile [deleted file]
drivers/staging/uc2322/TODO [deleted file]
drivers/staging/uc2322/aten2011.c [deleted file]
drivers/staging/udlfb/udlfb.c
drivers/usb/core/config.c
drivers/usb/host/ehci-orion.c
drivers/usb/host/ohci-omap.c
drivers/usb/host/xhci-dbg.c
drivers/usb/host/xhci-hcd.c
drivers/usb/host/xhci-mem.c
drivers/usb/host/xhci-pci.c
drivers/usb/host/xhci-ring.c
drivers/usb/host/xhci.h
drivers/usb/misc/Kconfig
drivers/usb/musb/musb_core.c
drivers/usb/musb/musb_gadget_ep0.c
drivers/usb/musb/musb_regs.h
drivers/usb/serial/cp210x.c
drivers/usb/serial/ftdi_sio.c
drivers/usb/serial/ftdi_sio.h
drivers/usb/serial/mos7840.c
drivers/usb/serial/option.c
drivers/usb/storage/transport.c
fs/sysfs/dir.c
include/linux/tty.h
lib/dynamic_debug.c

index 7e81e37c0b1ec0ccbea30a92ffbf70f495ffdbd0..b245d524d5682afe30a194821ab62e619092ff3c 100644 (file)
@@ -23,7 +23,8 @@ interface.
 Using sysfs
 ~~~~~~~~~~~
 
-sysfs is always compiled in. You can access it by doing:
+sysfs is always compiled in if CONFIG_SYSFS is defined. You can access
+it by doing:
 
     mount -t sysfs sysfs /sys 
 
index f285f441fab9d20dbf050d61e4360759b0fbe1fb..7376367bcb8053dec4951945f916d47c882fd59a 100644 (file)
@@ -180,7 +180,6 @@ static ssize_t firmware_loading_store(struct device *dev,
                                goto err;
                        }
                        /* Pages will be freed by vfree() */
-                       fw_priv->pages = NULL;
                        fw_priv->page_array_size = 0;
                        fw_priv->nr_pages = 0;
                        complete(&fw_priv->completion);
index 79a9ae5238acc1b9fa06a2fed1ed70d2440a9416..0d903909af7e5366126baaa049d35c5ea26fe6b5 100644 (file)
@@ -275,9 +275,9 @@ int sysdev_register(struct sys_device *sysdev)
                                drv->add(sysdev);
                }
                mutex_unlock(&sysdev_drivers_lock);
+               kobject_uevent(&sysdev->kobj, KOBJ_ADD);
        }
 
-       kobject_uevent(&sysdev->kobj, KOBJ_ADD);
        return error;
 }
 
index ff47907ff1bf9f9ae8ddc3e073c06ae4f3a615df..973be2f441951ed0e68d658c1192c94524f33aff 100644 (file)
@@ -1583,6 +1583,7 @@ static int n_tty_open(struct tty_struct *tty)
 
 static inline int input_available_p(struct tty_struct *tty, int amt)
 {
+       tty_flush_to_ldisc(tty);
        if (tty->icanon) {
                if (tty->canon_data)
                        return 1;
index 3850a68f265ae56ef8fd601d1ca36bf12b339f31..6e6942c45f5b6cb76d6c1aaf91ed96fee9185ae7 100644 (file)
@@ -52,7 +52,6 @@ static void pty_close(struct tty_struct *tty, struct file *filp)
                return;
        tty->link->packet = 0;
        set_bit(TTY_OTHER_CLOSED, &tty->link->flags);
-       tty_flip_buffer_push(tty->link);
        wake_up_interruptible(&tty->link->read_wait);
        wake_up_interruptible(&tty->link->write_wait);
        if (tty->driver->subtype == PTY_TYPE_MASTER) {
@@ -208,7 +207,6 @@ static int pty_open(struct tty_struct *tty, struct file *filp)
        clear_bit(TTY_OTHER_CLOSED, &tty->link->flags);
        set_bit(TTY_THROTTLED, &tty->flags);
        retval = 0;
-       tty->low_latency = 1;
 out:
        return retval;
 }
index 810ee25d66a48fa5042c84b7f4cf47f0a870ef4e..3108991c5c8b60f312742ca4eaeb37e4c812ad4c 100644 (file)
@@ -461,6 +461,19 @@ static void flush_to_ldisc(struct work_struct *work)
        tty_ldisc_deref(disc);
 }
 
+/**
+ *     tty_flush_to_ldisc
+ *     @tty: tty to push
+ *
+ *     Push the terminal flip buffers to the line discipline.
+ *
+ *     Must not be called from IRQ context.
+ */
+void tty_flush_to_ldisc(struct tty_struct *tty)
+{
+       flush_to_ldisc(&tty->buf.work.work);
+}
+
 /**
  *     tty_flip_buffer_push    -       terminal
  *     @tty: tty to push
index 348bf61a8fec96a2f8daa0389ae6578d47a9c0dd..975ecddbce30b48a4b20ed5ac955a48d7f224405 100644 (file)
@@ -103,8 +103,6 @@ source "drivers/staging/pohmelfs/Kconfig"
 
 source "drivers/staging/stlc45xx/Kconfig"
 
-source "drivers/staging/uc2322/Kconfig"
-
 source "drivers/staging/b3dfg/Kconfig"
 
 source "drivers/staging/phison/Kconfig"
index 8d61d7b4debfb78c1279ceac0c4379ac10b6a94d..2241ae1b21ee1ad47927386c6c5e4e2af4f83f4f 100644 (file)
@@ -34,7 +34,6 @@ obj-$(CONFIG_ANDROID)         += android/
 obj-$(CONFIG_DST)              += dst/
 obj-$(CONFIG_POHMELFS)         += pohmelfs/
 obj-$(CONFIG_STLC45XX)         += stlc45xx/
-obj-$(CONFIG_USB_SERIAL_ATEN2011)      += uc2322/
 obj-$(CONFIG_B3DFG)            += b3dfg/
 obj-$(CONFIG_IDE_PHISON)       += phison/
 obj-$(CONFIG_PLAN9AUTH)                += p9auth/
index fe72240f5a9e3bf9af573286cbce6810950db00e..f934393f39597c7ee1fc2baebf503b90222d636c 100644 (file)
@@ -96,19 +96,21 @@ static int lowmem_shrink(int nr_to_scan, gfp_t gfp_mask)
 
        read_lock(&tasklist_lock);
        for_each_process(p) {
+               struct mm_struct *mm;
                int oom_adj;
 
                task_lock(p);
-               if (!p->mm) {
+               mm = p->mm;
+               if (!mm) {
                        task_unlock(p);
                        continue;
                }
-               oom_adj = p->oomkilladj;
+               oom_adj = mm->oom_adj;
                if (oom_adj < min_adj) {
                        task_unlock(p);
                        continue;
                }
-               tasksize = get_mm_rss(p->mm);
+               tasksize = get_mm_rss(mm);
                task_unlock(p);
                if (tasksize <= 0)
                        continue;
index a9bd4106beb78a3701f99fb46d8a162b68c8e9f9..0fdf8c6dc648a69eaeeac311b1e24a3cb51d85e9 100644 (file)
@@ -360,18 +360,18 @@ static void qt_read_bulk_callback(struct urb *urb)
        if (port_paranoia_check(port, __func__) != 0) {
                dbg("%s - port_paranoia_check, exiting\n", __func__);
                qt_port->ReadBulkStopped = 1;
-               return;
+               goto exit;
        }
 
        if (!serial) {
                dbg("%s - bad serial pointer, exiting\n", __func__);
-               return;
+               goto exit;
        }
        if (qt_port->closePending == 1) {
                /* Were closing , stop reading */
                dbg("%s - (qt_port->closepending == 1\n", __func__);
                qt_port->ReadBulkStopped = 1;
-               return;
+               goto exit;
        }
 
        /*
@@ -381,7 +381,7 @@ static void qt_read_bulk_callback(struct urb *urb)
         */
        if (qt_port->RxHolding == 1) {
                qt_port->ReadBulkStopped = 1;
-               return;
+               goto exit;
        }
 
        if (urb->status) {
@@ -389,7 +389,7 @@ static void qt_read_bulk_callback(struct urb *urb)
 
                dbg("%s - nonzero read bulk status received: %d\n",
                    __func__, urb->status);
-               return;
+               goto exit;
        }
 
        if (tty && RxCount) {
@@ -463,6 +463,8 @@ static void qt_read_bulk_callback(struct urb *urb)
        }
 
        schedule_work(&port->work);
+exit:
+       tty_kref_put(tty);
 }
 
 /*
@@ -736,6 +738,11 @@ static int qt_startup(struct usb_serial *serial)
                if (!qt_port) {
                        dbg("%s: kmalloc for quatech_port (%d) failed!.",
                            __func__, i);
+                       for(--i; i >= 0; i--) {
+                               port = serial->port[i];
+                               kfree(usb_get_serial_port_data(port));
+                               usb_set_serial_port_data(port, NULL);
+                       }
                        return -ENOMEM;
                }
                spin_lock_init(&qt_port->lock);
@@ -1041,7 +1048,7 @@ static void qt_block_until_empty(struct tty_struct *tty,
        }
 }
 
-static void qt_close( struct usb_serial_port *port)
+static void qt_close(struct usb_serial_port *port)
 {
        struct usb_serial *serial = port->serial;
        struct quatech_port *qt_port;
@@ -1068,6 +1075,7 @@ static void qt_close( struct usb_serial_port *port)
        /* wait up to for transmitter to empty */
        if (serial->dev)
                qt_block_until_empty(tty, qt_port);
+       tty_kref_put(tty);
 
        /* Close uart channel */
        status = qt_close_channel(serial, index);
diff --git a/drivers/staging/uc2322/Kconfig b/drivers/staging/uc2322/Kconfig
deleted file mode 100644 (file)
index 2e0c6e7..0000000
+++ /dev/null
@@ -1,10 +0,0 @@
-config USB_SERIAL_ATEN2011
-       tristate "ATEN 2011 USB to serial device support"
-       depends on USB_SERIAL
-       default N
-       ---help---
-         Say Y here if you want to use a ATEN 2011 dual port USB to serial
-         adapter.
-
-         To compile this driver as a module, choose M here: the module will be
-         called aten2011.
diff --git a/drivers/staging/uc2322/Makefile b/drivers/staging/uc2322/Makefile
deleted file mode 100644 (file)
index 49c18d6..0000000
+++ /dev/null
@@ -1 +0,0 @@
-obj-$(CONFIG_USB_SERIAL_ATEN2011)      += aten2011.o
diff --git a/drivers/staging/uc2322/TODO b/drivers/staging/uc2322/TODO
deleted file mode 100644 (file)
index c189a64..0000000
+++ /dev/null
@@ -1,7 +0,0 @@
-TODO:
-       - checkpatch.pl cleanups
-       - remove dead and useless code (auditing the tty ioctls to
-         verify that they really are correct and needed.)
-
-Please send any patches to Greg Kroah-Hartman <greg@kroah.com> and
-Russell Lang <gsview@ghostgum.com.au>.
diff --git a/drivers/staging/uc2322/aten2011.c b/drivers/staging/uc2322/aten2011.c
deleted file mode 100644 (file)
index 39d0926..0000000
+++ /dev/null
@@ -1,2430 +0,0 @@
-/*
- * Aten 2011 USB serial driver for 4 port devices
- *
- * Copyright (C) 2000 Inside Out Networks
- * Copyright (C) 2001-2002, 2009 Greg Kroah-Hartman <greg@kroah.com>
- * Copyright (C) 2009 Novell Inc.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- */
-
-#include <linux/kernel.h>
-#include <linux/errno.h>
-#include <linux/init.h>
-#include <linux/slab.h>
-#include <linux/tty.h>
-#include <linux/tty_driver.h>
-#include <linux/tty_flip.h>
-#include <linux/module.h>
-#include <linux/serial.h>
-#include <linux/uaccess.h>
-#include <linux/usb.h>
-#include <linux/usb/serial.h>
-
-
-#define ZLP_REG1               0x3A    /* Zero_Flag_Reg1 58 */
-#define ZLP_REG2               0x3B    /* Zero_Flag_Reg2 59 */
-#define ZLP_REG3               0x3C    /* Zero_Flag_Reg3 60 */
-#define ZLP_REG4               0x3D    /* Zero_Flag_Reg4 61 */
-#define ZLP_REG5               0x3E    /* Zero_Flag_Reg5 62 */
-
-/* Interrupt Rotinue Defines   */
-#define SERIAL_IIR_RLS         0x06
-#define SERIAL_IIR_RDA         0x04
-#define SERIAL_IIR_CTI         0x0c
-#define SERIAL_IIR_THR         0x02
-#define SERIAL_IIR_MS          0x00
-
-/* Emulation of the bit mask on the LINE STATUS REGISTER.  */
-#define SERIAL_LSR_DR          0x0001
-#define SERIAL_LSR_OE          0x0002
-#define SERIAL_LSR_PE          0x0004
-#define SERIAL_LSR_FE          0x0008
-#define SERIAL_LSR_BI          0x0010
-#define SERIAL_LSR_THRE                0x0020
-#define SERIAL_LSR_TEMT                0x0040
-#define SERIAL_LSR_FIFOERR     0x0080
-
-/* MSR bit defines(place holders) */
-#define ATEN_MSR_DELTA_CTS     0x10
-#define ATEN_MSR_DELTA_DSR     0x20
-#define ATEN_MSR_DELTA_RI      0x40
-#define ATEN_MSR_DELTA_CD      0x80
-
-/* Serial Port register Address */
-#define RECEIVE_BUFFER_REGISTER                ((__u16)(0x00))
-#define TRANSMIT_HOLDING_REGISTER      ((__u16)(0x00))
-#define INTERRUPT_ENABLE_REGISTER      ((__u16)(0x01))
-#define INTERRUPT_IDENT_REGISTER       ((__u16)(0x02))
-#define FIFO_CONTROL_REGISTER          ((__u16)(0x02))
-#define LINE_CONTROL_REGISTER          ((__u16)(0x03))
-#define MODEM_CONTROL_REGISTER         ((__u16)(0x04))
-#define LINE_STATUS_REGISTER           ((__u16)(0x05))
-#define MODEM_STATUS_REGISTER          ((__u16)(0x06))
-#define SCRATCH_PAD_REGISTER           ((__u16)(0x07))
-#define DIVISOR_LATCH_LSB              ((__u16)(0x00))
-#define DIVISOR_LATCH_MSB              ((__u16)(0x01))
-
-#define SP1_REGISTER                   ((__u16)(0x00))
-#define CONTROL1_REGISTER              ((__u16)(0x01))
-#define CLK_MULTI_REGISTER             ((__u16)(0x02))
-#define CLK_START_VALUE_REGISTER       ((__u16)(0x03))
-#define DCR1_REGISTER                  ((__u16)(0x04))
-#define GPIO_REGISTER                  ((__u16)(0x07))
-
-#define SERIAL_LCR_DLAB                        ((__u16)(0x0080))
-
-/*
- * URB POOL related defines
- */
-#define NUM_URBS                       16      /* URB Count */
-#define URB_TRANSFER_BUFFER_SIZE       32      /* URB Size  */
-
-#define USB_VENDOR_ID_ATENINTL         0x0557
-#define ATENINTL_DEVICE_ID_2011                0x2011
-#define ATENINTL_DEVICE_ID_7820                0x7820
-
-static struct usb_device_id id_table[] = {
-       { USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_2011) },
-       { USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_7820) },
-       { } /* terminating entry */
-};
-MODULE_DEVICE_TABLE(usb, id_table);
-
-/* This structure holds all of the local port information */
-struct ATENINTL_port {
-       int             port_num;          /*Actual port number in the device(1,2,etc)*/
-       __u8            bulk_out_endpoint;      /* the bulk out endpoint handle */
-       unsigned char   *bulk_out_buffer;       /* buffer used for the bulk out endpoint */
-       struct urb      *write_urb;             /* write URB for this port */
-       __u8            bulk_in_endpoint;       /* the bulk in endpoint handle */
-       unsigned char   *bulk_in_buffer;        /* the buffer we use for the bulk in endpoint */
-       struct urb      *read_urb;              /* read URB for this port */
-       __u8            shadowLCR;              /* last LCR value received */
-       __u8            shadowMCR;              /* last MCR value received */
-       char            open;
-       char            chaseResponsePending;
-       wait_queue_head_t       wait_chase;             /* for handling sleeping while waiting for chase to finish */
-       wait_queue_head_t       wait_command;           /* for handling sleeping while waiting for command to finish */
-       struct async_icount     icount;
-       struct usb_serial_port  *port;                  /* loop back to the owner of this object */
-       /*Offsets*/
-       __u8            SpRegOffset;
-       __u8            ControlRegOffset;
-       __u8            DcrRegOffset;
-       /* for processing control URBS in interrupt context */
-       struct urb      *control_urb;
-       char            *ctrl_buf;
-       int             MsrLsr;
-
-       struct urb      *write_urb_pool[NUM_URBS];
-       /* we pass a pointer to this as the arguement sent to cypress_set_termios old_termios */
-       struct ktermios tmp_termios;        /* stores the old termios settings */
-       spinlock_t      lock;                   /* private lock */
-};
-
-/* This structure holds all of the individual serial device information */
-struct ATENINTL_serial {
-       __u8            interrupt_in_endpoint;          /* the interrupt endpoint handle */
-       unsigned char   *interrupt_in_buffer;           /* the buffer we use for the interrupt endpoint */
-       struct urb      *interrupt_read_urb;    /* our interrupt urb */
-       __u8            bulk_in_endpoint;       /* the bulk in endpoint handle */
-       unsigned char   *bulk_in_buffer;                /* the buffer we use for the bulk in endpoint */
-       struct urb      *read_urb;              /* our bulk read urb */
-       __u8            bulk_out_endpoint;      /* the bulk out endpoint handle */
-       struct usb_serial       *serial;        /* loop back to the owner of this object */
-       int     ATEN2011_spectrum_2or4ports;    /* this says the number of ports in the device */
-       /* Indicates about the no.of opened ports of an individual USB-serial adapater. */
-       unsigned int    NoOfOpenPorts;
-       /* a flag for Status endpoint polling */
-       unsigned char   status_polling_started;
-};
-
-static void ATEN2011_set_termios(struct tty_struct *tty,
-                                struct usb_serial_port *port,
-                                struct ktermios *old_termios);
-static void ATEN2011_change_port_settings(struct tty_struct *tty,
-                                         struct ATENINTL_port *ATEN2011_port,
-                                         struct ktermios *old_termios);
-
-/*************************************
- * Bit definitions for each register *
- *************************************/
-#define LCR_BITS_5             0x00    /* 5 bits/char */
-#define LCR_BITS_6             0x01    /* 6 bits/char */
-#define LCR_BITS_7             0x02    /* 7 bits/char */
-#define LCR_BITS_8             0x03    /* 8 bits/char */
-#define LCR_BITS_MASK          0x03    /* Mask for bits/char field */
-
-#define LCR_STOP_1             0x00    /* 1 stop bit */
-#define LCR_STOP_1_5           0x04    /* 1.5 stop bits (if 5   bits/char) */
-#define LCR_STOP_2             0x04    /* 2 stop bits   (if 6-8 bits/char) */
-#define LCR_STOP_MASK          0x04    /* Mask for stop bits field */
-
-#define LCR_PAR_NONE           0x00    /* No parity */
-#define LCR_PAR_ODD            0x08    /* Odd parity */
-#define LCR_PAR_EVEN           0x18    /* Even parity */
-#define LCR_PAR_MARK           0x28    /* Force parity bit to 1 */
-#define LCR_PAR_SPACE          0x38    /* Force parity bit to 0 */
-#define LCR_PAR_MASK           0x38    /* Mask for parity field */
-
-#define LCR_SET_BREAK          0x40    /* Set Break condition */
-#define LCR_DL_ENABLE          0x80    /* Enable access to divisor latch */
-
-#define MCR_DTR                        0x01    /* Assert DTR */
-#define MCR_RTS                        0x02    /* Assert RTS */
-#define MCR_OUT1               0x04    /* Loopback only: Sets state of RI */
-#define MCR_MASTER_IE          0x08    /* Enable interrupt outputs */
-#define MCR_LOOPBACK           0x10    /* Set internal (digital) loopback mode */
-#define MCR_XON_ANY            0x20    /* Enable any char to exit XOFF mode */
-
-#define ATEN2011_MSR_CTS       0x10    /* Current state of CTS */
-#define ATEN2011_MSR_DSR       0x20    /* Current state of DSR */
-#define ATEN2011_MSR_RI                0x40    /* Current state of RI */
-#define ATEN2011_MSR_CD                0x80    /* Current state of CD */
-
-
-static int debug;
-
-/*
- * Version Information
- */
-#define DRIVER_VERSION "2.0"
-#define DRIVER_DESC "ATENINTL 2011 USB Serial Adapter"
-
-/*
- * Defines used for sending commands to port
- */
-
-#define ATEN_WDR_TIMEOUT       (50)    /* default urb timeout */
-
-/* Requests */
-#define ATEN_RD_RTYPE          0xC0
-#define ATEN_WR_RTYPE          0x40
-#define ATEN_RDREQ             0x0D
-#define ATEN_WRREQ             0x0E
-#define ATEN_CTRL_TIMEOUT      500
-#define VENDOR_READ_LENGTH     (0x01)
-
-/* set to 1 for RS485 mode and 0 for RS232 mode */
-/* FIXME make this somehow dynamic and not build time specific */
-static int RS485mode;
-
-static int set_reg_sync(struct usb_serial_port *port, __u16 reg, __u16 val)
-{
-       struct usb_device *dev = port->serial->dev;
-       val = val & 0x00ff;
-
-       dbg("%s: is %x, value %x", __func__, reg, val);
-
-       return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ATEN_WRREQ,
-                              ATEN_WR_RTYPE, val, reg, NULL, 0,
-                              ATEN_WDR_TIMEOUT);
-}
-
-static int get_reg_sync(struct usb_serial_port *port, __u16 reg, __u16 *val)
-{
-       struct usb_device *dev = port->serial->dev;
-       int ret;
-
-       ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), ATEN_RDREQ,
-                             ATEN_RD_RTYPE, 0, reg, val, VENDOR_READ_LENGTH,
-                             ATEN_WDR_TIMEOUT);
-       dbg("%s: offset is %x, return val %x", __func__, reg, *val);
-       *val = (*val) & 0x00ff;
-       return ret;
-}
-
-static int set_uart_reg(struct usb_serial_port *port, __u16 reg, __u16 val)
-{
-       struct usb_device *dev = port->serial->dev;
-       struct ATENINTL_serial *a_serial;
-       __u16 minor;
-
-       a_serial = usb_get_serial_data(port->serial);
-       minor = port->serial->minor;
-       if (minor == SERIAL_TTY_NO_MINOR)
-               minor = 0;
-       val = val & 0x00ff;
-
-       /*
-        * For the UART control registers,
-        * the application number need to be Or'ed
-        */
-       if (a_serial->ATEN2011_spectrum_2or4ports == 4)
-               val |= (((__u16)port->number - minor) + 1) << 8;
-       else {
-               if (((__u16) port->number - minor) == 0)
-                       val |= (((__u16)port->number - minor) + 1) << 8;
-               else
-                       val |= (((__u16)port->number - minor) + 2) << 8;
-       }
-       dbg("%s: application number is %x", __func__, val);
-
-       return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ATEN_WRREQ,
-                              ATEN_WR_RTYPE, val, reg, NULL, 0,
-                              ATEN_WDR_TIMEOUT);
-}
-
-static int get_uart_reg(struct usb_serial_port *port, __u16 reg, __u16 *val)
-{
-       struct usb_device *dev = port->serial->dev;
-       int ret = 0;
-       __u16 wval;
-       struct ATENINTL_serial *a_serial;
-       __u16 minor = port->serial->minor;
-
-       a_serial = usb_get_serial_data(port->serial);
-       if (minor == SERIAL_TTY_NO_MINOR)
-               minor = 0;
-
-       /* wval is same as application number */
-       if (a_serial->ATEN2011_spectrum_2or4ports == 4)
-               wval = (((__u16)port->number - minor) + 1) << 8;
-       else {
-               if (((__u16) port->number - minor) == 0)
-                       wval = (((__u16) port->number - minor) + 1) << 8;
-               else
-                       wval = (((__u16) port->number - minor) + 2) << 8;
-       }
-       dbg("%s: application number is %x", __func__, wval);
-       ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), ATEN_RDREQ,
-                             ATEN_RD_RTYPE, wval, reg, val, VENDOR_READ_LENGTH,
-                             ATEN_WDR_TIMEOUT);
-       *val = (*val) & 0x00ff;
-       return ret;
-}
-
-static int handle_newMsr(struct ATENINTL_port *port, __u8 newMsr)
-{
-       struct ATENINTL_port *ATEN2011_port;
-       struct async_icount *icount;
-       ATEN2011_port = port;
-       icount = &ATEN2011_port->icount;
-       if (newMsr &
-           (ATEN_MSR_DELTA_CTS | ATEN_MSR_DELTA_DSR | ATEN_MSR_DELTA_RI |
-            ATEN_MSR_DELTA_CD)) {
-               icount = &ATEN2011_port->icount;
-
-               /* update input line counters */
-               if (newMsr & ATEN_MSR_DELTA_CTS)
-                       icount->cts++;
-               if (newMsr & ATEN_MSR_DELTA_DSR)
-                       icount->dsr++;
-               if (newMsr & ATEN_MSR_DELTA_CD)
-                       icount->dcd++;
-               if (newMsr & ATEN_MSR_DELTA_RI)
-                       icount->rng++;
-       }
-
-       return 0;
-}
-
-static int handle_newLsr(struct ATENINTL_port *port, __u8 newLsr)
-{
-       struct async_icount *icount;
-
-       dbg("%s - %02x", __func__, newLsr);
-
-       if (newLsr & SERIAL_LSR_BI) {
-               /*
-                * Parity and Framing errors only count if they occur exclusive
-                * of a break being received.
-                */
-               newLsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI);
-       }
-
-       /* update input line counters */
-       icount = &port->icount;
-       if (newLsr & SERIAL_LSR_BI)
-               icount->brk++;
-       if (newLsr & SERIAL_LSR_OE)
-               icount->overrun++;
-       if (newLsr & SERIAL_LSR_PE)
-               icount->parity++;
-       if (newLsr & SERIAL_LSR_FE)
-               icount->frame++;
-
-       return 0;
-}
-
-static void ATEN2011_control_callback(struct urb *urb)
-{
-       unsigned char *data;
-       struct ATENINTL_port *ATEN2011_port;
-       __u8 regval = 0x0;
-
-       switch (urb->status) {
-       case 0:
-               /* success */
-               break;
-       case -ECONNRESET:
-       case -ENOENT:
-       case -ESHUTDOWN:
-               /* this urb is terminated, clean up */
-               dbg("%s - urb shutting down with status: %d", __func__,
-                   urb->status);
-               return;
-       default:
-               dbg("%s - nonzero urb status received: %d", __func__,
-                   urb->status);
-               goto exit;
-       }
-
-       ATEN2011_port = (struct ATENINTL_port *)urb->context;
-
-       dbg("%s urb buffer size is %d", __func__, urb->actual_length);
-       dbg("%s ATEN2011_port->MsrLsr is %d port %d", __func__,
-               ATEN2011_port->MsrLsr, ATEN2011_port->port_num);
-       data = urb->transfer_buffer;
-       regval = (__u8) data[0];
-       dbg("%s data is %x", __func__, regval);
-       if (ATEN2011_port->MsrLsr == 0)
-               handle_newMsr(ATEN2011_port, regval);
-       else if (ATEN2011_port->MsrLsr == 1)
-               handle_newLsr(ATEN2011_port, regval);
-
-exit:
-       return;
-}
-
-static int ATEN2011_get_reg(struct ATENINTL_port *ATEN, __u16 Wval, __u16 reg,
-                           __u16 *val)
-{
-       struct usb_device *dev = ATEN->port->serial->dev;
-       struct usb_ctrlrequest *dr = NULL;
-       unsigned char *buffer = NULL;
-       int ret = 0;
-       buffer = (__u8 *) ATEN->ctrl_buf;
-
-       dr = (void *)(buffer + 2);
-       dr->bRequestType = ATEN_RD_RTYPE;
-       dr->bRequest = ATEN_RDREQ;
-       dr->wValue = cpu_to_le16(Wval);
-       dr->wIndex = cpu_to_le16(reg);
-       dr->wLength = cpu_to_le16(2);
-
-       usb_fill_control_urb(ATEN->control_urb, dev, usb_rcvctrlpipe(dev, 0),
-                            (unsigned char *)dr, buffer, 2,
-                            ATEN2011_control_callback, ATEN);
-       ATEN->control_urb->transfer_buffer_length = 2;
-       ret = usb_submit_urb(ATEN->control_urb, GFP_ATOMIC);
-       return ret;
-}
-
-static void ATEN2011_interrupt_callback(struct urb *urb)
-{
-       int result;
-       int length;
-       struct ATENINTL_port *ATEN2011_port;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct usb_serial *serial;
-       __u16 Data;
-       unsigned char *data;
-       __u8 sp[5], st;
-       int i;
-       __u16 wval;
-       int minor;
-
-       dbg("%s", " : Entering");
-
-       ATEN2011_serial = (struct ATENINTL_serial *)urb->context;
-
-       switch (urb->status) {
-       case 0:
-               /* success */
-               break;
-       case -ECONNRESET:
-       case -ENOENT:
-       case -ESHUTDOWN:
-               /* this urb is terminated, clean up */
-               dbg("%s - urb shutting down with status: %d", __func__,
-                   urb->status);
-               return;
-       default:
-               dbg("%s - nonzero urb status received: %d", __func__,
-                   urb->status);
-               goto exit;
-       }
-       length = urb->actual_length;
-       data = urb->transfer_buffer;
-
-       serial = ATEN2011_serial->serial;
-
-       /* ATENINTL get 5 bytes
-        * Byte 1 IIR Port 1 (port.number is 0)
-        * Byte 2 IIR Port 2 (port.number is 1)
-        * Byte 3 IIR Port 3 (port.number is 2)
-        * Byte 4 IIR Port 4 (port.number is 3)
-        * Byte 5 FIFO status for both */
-
-       if (length && length > 5) {
-               dbg("%s", "Wrong data !!!");
-               return;
-       }
-
-       /* MATRIX */
-       if (ATEN2011_serial->ATEN2011_spectrum_2or4ports == 4) {
-               sp[0] = (__u8) data[0];
-               sp[1] = (__u8) data[1];
-               sp[2] = (__u8) data[2];
-               sp[3] = (__u8) data[3];
-               st = (__u8) data[4];
-       } else {
-               sp[0] = (__u8) data[0];
-               sp[1] = (__u8) data[2];
-               /* sp[2]=(__u8)data[2]; */
-               /* sp[3]=(__u8)data[3]; */
-               st = (__u8) data[4];
-
-       }
-       for (i = 0; i < serial->num_ports; i++) {
-               ATEN2011_port = usb_get_serial_port_data(serial->port[i]);
-               minor = serial->minor;
-               if (minor == SERIAL_TTY_NO_MINOR)
-                       minor = 0;
-               if ((ATEN2011_serial->ATEN2011_spectrum_2or4ports == 2)
-                   && (i != 0))
-                       wval =
-                           (((__u16) serial->port[i]->number -
-                             (__u16) (minor)) + 2) << 8;
-               else
-                       wval =
-                           (((__u16) serial->port[i]->number -
-                             (__u16) (minor)) + 1) << 8;
-               if (ATEN2011_port->open != 0) {
-                       if (sp[i] & 0x01) {
-                               dbg("SP%d No Interrupt !!!", i);
-                       } else {
-                               switch (sp[i] & 0x0f) {
-                               case SERIAL_IIR_RLS:
-                                       dbg("Serial Port %d: Receiver status error or address bit detected in 9-bit mode", i);
-                                       ATEN2011_port->MsrLsr = 1;
-                                       ATEN2011_get_reg(ATEN2011_port, wval,
-                                                        LINE_STATUS_REGISTER,
-                                                        &Data);
-                                       break;
-                               case SERIAL_IIR_MS:
-                                       dbg("Serial Port %d: Modem status change", i);
-                                       ATEN2011_port->MsrLsr = 0;
-                                       ATEN2011_get_reg(ATEN2011_port, wval,
-                                                        MODEM_STATUS_REGISTER,
-                                                        &Data);
-                                       break;
-                               }
-                       }
-               }
-
-       }
-exit:
-       if (ATEN2011_serial->status_polling_started == 0)
-               return;
-
-       result = usb_submit_urb(urb, GFP_ATOMIC);
-       if (result) {
-               dev_err(&urb->dev->dev,
-                       "%s - Error %d submitting interrupt urb\n",
-                       __func__, result);
-       }
-
-       return;
-}
-
-static void ATEN2011_bulk_in_callback(struct urb *urb)
-{
-       int status;
-       unsigned char *data;
-       struct usb_serial *serial;
-       struct usb_serial_port *port;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct ATENINTL_port *ATEN2011_port;
-       struct tty_struct *tty;
-
-       if (urb->status) {
-               dbg("nonzero read bulk status received: %d", urb->status);
-               return;
-       }
-
-       ATEN2011_port = (struct ATENINTL_port *)urb->context;
-
-       port = (struct usb_serial_port *)ATEN2011_port->port;
-       serial = port->serial;
-
-       dbg("%s", "Entering...");
-
-       data = urb->transfer_buffer;
-       ATEN2011_serial = usb_get_serial_data(serial);
-
-       if (urb->actual_length) {
-               tty = tty_port_tty_get(&ATEN2011_port->port->port);
-               if (tty) {
-                       tty_buffer_request_room(tty, urb->actual_length);
-                       tty_insert_flip_string(tty, data, urb->actual_length);
-                       tty_flip_buffer_push(tty);
-                       tty_kref_put(tty);
-               }
-
-               ATEN2011_port->icount.rx += urb->actual_length;
-               dbg("ATEN2011_port->icount.rx is %d:",
-                       ATEN2011_port->icount.rx);
-       }
-
-       if (!ATEN2011_port->read_urb) {
-               dbg("%s", "URB KILLED !!!");
-               return;
-       }
-
-       if (ATEN2011_port->read_urb->status != -EINPROGRESS) {
-               ATEN2011_port->read_urb->dev = serial->dev;
-
-               status = usb_submit_urb(ATEN2011_port->read_urb, GFP_ATOMIC);
-               if (status)
-                       dbg("usb_submit_urb(read bulk) failed, status = %d", status);
-       }
-}
-
-static void ATEN2011_bulk_out_data_callback(struct urb *urb)
-{
-       struct ATENINTL_port *ATEN2011_port;
-       struct tty_struct *tty;
-
-       if (urb->status) {
-               dbg("nonzero write bulk status received:%d", urb->status);
-               return;
-       }
-
-       ATEN2011_port = (struct ATENINTL_port *)urb->context;
-
-       dbg("%s", "Entering .........");
-
-       tty = tty_port_tty_get(&ATEN2011_port->port->port);
-
-       if (tty && ATEN2011_port->open)
-               /* tell the tty driver that something has changed */
-               tty_wakeup(tty);
-
-       /* schedule_work(&ATEN2011_port->port->work); */
-       tty_kref_put(tty);
-
-}
-
-#ifdef ATENSerialProbe
-static int ATEN2011_serial_probe(struct usb_serial *serial,
-                                const struct usb_device_id *id)
-{
-
-       /*need to implement the mode_reg reading and updating\
-          structures usb_serial_ device_type\
-          (i.e num_ports, num_bulkin,bulkout etc) */
-       /* Also we can update the changes  attach */
-       return 1;
-}
-#endif
-
-static int ATEN2011_open(struct tty_struct *tty, struct usb_serial_port *port,
-                        struct file *filp)
-{
-       int response;
-       int j;
-       struct usb_serial *serial;
-       struct urb *urb;
-       __u16 Data;
-       int status;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct ATENINTL_port *ATEN2011_port;
-       struct ktermios tmp_termios;
-       int minor;
-
-       serial = port->serial;
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return -ENODEV;
-
-       ATEN2011_serial = usb_get_serial_data(serial);
-       if (ATEN2011_serial == NULL)
-               return -ENODEV;
-
-       /* increment the number of opened ports counter here */
-       ATEN2011_serial->NoOfOpenPorts++;
-
-       usb_clear_halt(serial->dev, port->write_urb->pipe);
-       usb_clear_halt(serial->dev, port->read_urb->pipe);
-
-       /* Initialising the write urb pool */
-       for (j = 0; j < NUM_URBS; ++j) {
-               urb = usb_alloc_urb(0, GFP_ATOMIC);
-               ATEN2011_port->write_urb_pool[j] = urb;
-
-               if (urb == NULL) {
-                       err("No more urbs???");
-                       continue;
-               }
-
-               urb->transfer_buffer = NULL;
-               urb->transfer_buffer =
-                   kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);
-               if (!urb->transfer_buffer) {
-                       err("%s-out of memory for urb buffers.", __func__);
-                       continue;
-               }
-       }
-
-/*****************************************************************************
- * Initialize ATEN2011 -- Write Init values to corresponding Registers
- *
- * Register Index
- * 1 : IER
- * 2 : FCR
- * 3 : LCR
- * 4 : MCR
- *
- * 0x08 : SP1/2 Control Reg
- *****************************************************************************/
-
-/* NEED to check the fallowing Block */
-
-       Data = 0x0;
-       status = get_reg_sync(port, ATEN2011_port->SpRegOffset, &Data);
-       if (status < 0) {
-               dbg("Reading Spreg failed");
-               return -1;
-       }
-       Data |= 0x80;
-       status = set_reg_sync(port, ATEN2011_port->SpRegOffset, Data);
-       if (status < 0) {
-               dbg("writing Spreg failed");
-               return -1;
-       }
-
-       Data &= ~0x80;
-       status = set_reg_sync(port, ATEN2011_port->SpRegOffset, Data);
-       if (status < 0) {
-               dbg("writing Spreg failed");
-               return -1;
-       }
-
-/* End of block to be checked */
-/**************************CHECK***************************/
-
-       if (RS485mode == 0)
-               Data = 0xC0;
-       else
-               Data = 0x00;
-       status = set_uart_reg(port, SCRATCH_PAD_REGISTER, Data);
-       if (status < 0) {
-               dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x", status);
-               return -1;
-       } else
-               dbg("SCRATCH_PAD_REGISTER Writing success status%d", status);
-
-/**************************CHECK***************************/
-
-       Data = 0x0;
-       status = get_reg_sync(port, ATEN2011_port->ControlRegOffset, &Data);
-       if (status < 0) {
-               dbg("Reading Controlreg failed");
-               return -1;
-       }
-       Data |= 0x08;           /* Driver done bit */
-       Data |= 0x20;           /* rx_disable */
-       status = 0;
-       status =
-           set_reg_sync(port, ATEN2011_port->ControlRegOffset, Data);
-       if (status < 0) {
-               dbg("writing Controlreg failed");
-               return -1;
-       }
-       /*
-        * do register settings here
-        * Set all regs to the device default values.
-        * First Disable all interrupts.
-        */
-
-       Data = 0x00;
-       status = set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
-       if (status < 0) {
-               dbg("disableing interrupts failed");
-               return -1;
-       }
-       /* Set FIFO_CONTROL_REGISTER to the default value */
-       Data = 0x00;
-       status = set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
-       if (status < 0) {
-               dbg("Writing FIFO_CONTROL_REGISTER  failed");
-               return -1;
-       }
-
-       Data = 0xcf;            /* chk */
-       status = set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
-       if (status < 0) {
-               dbg("Writing FIFO_CONTROL_REGISTER  failed");
-               return -1;
-       }
-
-       Data = 0x03;            /* LCR_BITS_8 */
-       status = set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-       ATEN2011_port->shadowLCR = Data;
-
-       Data = 0x0b;            /* MCR_DTR|MCR_RTS|MCR_MASTER_IE */
-       status = set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-       ATEN2011_port->shadowMCR = Data;
-
-#ifdef Check
-       Data = 0x00;
-       status = get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
-       ATEN2011_port->shadowLCR = Data;
-
-       Data |= SERIAL_LCR_DLAB;        /* data latch enable in LCR 0x80 */
-       status = set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-
-       Data = 0x0c;
-       status = set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
-
-       Data = 0x0;
-       status = set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
-
-       Data = 0x00;
-       status = get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
-
-/*      Data = ATEN2011_port->shadowLCR; */    /* data latch disable */
-       Data = Data & ~SERIAL_LCR_DLAB;
-       status = set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-       ATEN2011_port->shadowLCR = Data;
-#endif
-       /* clearing Bulkin and Bulkout Fifo */
-       Data = 0x0;
-       status = get_reg_sync(port, ATEN2011_port->SpRegOffset, &Data);
-
-       Data = Data | 0x0c;
-       status = set_reg_sync(port, ATEN2011_port->SpRegOffset, Data);
-
-       Data = Data & ~0x0c;
-       status = set_reg_sync(port, ATEN2011_port->SpRegOffset, Data);
-       /* Finally enable all interrupts */
-       Data = 0x0;
-       Data = 0x0c;
-       status = set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
-
-       /* clearing rx_disable */
-       Data = 0x0;
-       status = get_reg_sync(port, ATEN2011_port->ControlRegOffset, &Data);
-       Data = Data & ~0x20;
-       status = set_reg_sync(port, ATEN2011_port->ControlRegOffset, Data);
-
-       /* rx_negate */
-       Data = 0x0;
-       status = get_reg_sync(port, ATEN2011_port->ControlRegOffset, &Data);
-       Data = Data | 0x10;
-       status = 0;
-       status = set_reg_sync(port, ATEN2011_port->ControlRegOffset, Data);
-
-       /*
-        * Check to see if we've set up our endpoint info yet
-        * (can't set it up in ATEN2011_startup as the structures
-        * were not set up at that time.)
-        */
-       if (ATEN2011_serial->NoOfOpenPorts == 1) {
-               /* start the status polling here */
-               ATEN2011_serial->status_polling_started = 1;
-               /* If not yet set, Set here */
-               ATEN2011_serial->interrupt_in_buffer =
-                   serial->port[0]->interrupt_in_buffer;
-               ATEN2011_serial->interrupt_in_endpoint =
-                   serial->port[0]->interrupt_in_endpointAddress;
-               ATEN2011_serial->interrupt_read_urb =
-                   serial->port[0]->interrupt_in_urb;
-
-               /* set up interrupt urb */
-               usb_fill_int_urb(ATEN2011_serial->interrupt_read_urb,
-                                serial->dev,
-                                usb_rcvintpipe(serial->dev,
-                                               ATEN2011_serial->
-                                               interrupt_in_endpoint),
-                                ATEN2011_serial->interrupt_in_buffer,
-                                ATEN2011_serial->interrupt_read_urb->
-                                transfer_buffer_length,
-                                ATEN2011_interrupt_callback, ATEN2011_serial,
-                                ATEN2011_serial->interrupt_read_urb->interval);
-
-               /* start interrupt read for ATEN2011               *
-                * will continue as long as ATEN2011 is connected  */
-
-               response =
-                   usb_submit_urb(ATEN2011_serial->interrupt_read_urb,
-                                  GFP_KERNEL);
-               if (response) {
-                       dbg("%s - Error %d submitting interrupt urb",
-                               __func__, response);
-               }
-
-       }
-
-       /*
-        * See if we've set up our endpoint info yet
-        * (can't set it up in ATEN2011_startup as the
-        * structures were not set up at that time.)
-        */
-
-       dbg("port number is %d", port->number);
-       dbg("serial number is %d", port->serial->minor);
-       dbg("Bulkin endpoint is %d", port->bulk_in_endpointAddress);
-       dbg("BulkOut endpoint is %d", port->bulk_out_endpointAddress);
-       dbg("Interrupt endpoint is %d",
-               port->interrupt_in_endpointAddress);
-       dbg("port's number in the device is %d", ATEN2011_port->port_num);
-       ATEN2011_port->bulk_in_buffer = port->bulk_in_buffer;
-       ATEN2011_port->bulk_in_endpoint = port->bulk_in_endpointAddress;
-       ATEN2011_port->read_urb = port->read_urb;
-       ATEN2011_port->bulk_out_endpoint = port->bulk_out_endpointAddress;
-
-       minor = port->serial->minor;
-       if (minor == SERIAL_TTY_NO_MINOR)
-               minor = 0;
-
-       /* set up our bulk in urb */
-       if ((ATEN2011_serial->ATEN2011_spectrum_2or4ports == 2)
-           && (((__u16) port->number - (__u16) (minor)) != 0)) {
-               usb_fill_bulk_urb(ATEN2011_port->read_urb, serial->dev,
-                                 usb_rcvbulkpipe(serial->dev,
-                                                 (port->
-                                                  bulk_in_endpointAddress +
-                                                  2)), port->bulk_in_buffer,
-                                 ATEN2011_port->read_urb->
-                                 transfer_buffer_length,
-                                 ATEN2011_bulk_in_callback, ATEN2011_port);
-       } else
-               usb_fill_bulk_urb(ATEN2011_port->read_urb,
-                                 serial->dev,
-                                 usb_rcvbulkpipe(serial->dev,
-                                                 port->
-                                                 bulk_in_endpointAddress),
-                                 port->bulk_in_buffer,
-                                 ATEN2011_port->read_urb->
-                                 transfer_buffer_length,
-                                 ATEN2011_bulk_in_callback, ATEN2011_port);
-
-       dbg("ATEN2011_open: bulkin endpoint is %d",
-               port->bulk_in_endpointAddress);
-       response = usb_submit_urb(ATEN2011_port->read_urb, GFP_KERNEL);
-       if (response) {
-               err("%s - Error %d submitting control urb", __func__,
-                   response);
-       }
-
-       /* initialize our wait queues */
-       init_waitqueue_head(&ATEN2011_port->wait_chase);
-       init_waitqueue_head(&ATEN2011_port->wait_command);
-
-       /* initialize our icount structure */
-       memset(&(ATEN2011_port->icount), 0x00, sizeof(ATEN2011_port->icount));
-
-       /* initialize our port settings */
-       ATEN2011_port->shadowMCR = MCR_MASTER_IE;       /* Must set to enable ints! */
-       ATEN2011_port->chaseResponsePending = 0;
-       /* send a open port command */
-       ATEN2011_port->open = 1;
-       /* ATEN2011_change_port_settings(ATEN2011_port,old_termios); */
-       /* Setup termios */
-       ATEN2011_set_termios(tty, port, &tmp_termios);
-       ATEN2011_port->icount.tx = 0;
-       ATEN2011_port->icount.rx = 0;
-
-       dbg("usb_serial serial:%x       ATEN2011_port:%x\nATEN2011_serial:%x      usb_serial_port port:%x",
-            (unsigned int)serial, (unsigned int)ATEN2011_port,
-            (unsigned int)ATEN2011_serial, (unsigned int)port);
-
-       return 0;
-
-}
-
-static int ATEN2011_chars_in_buffer(struct tty_struct *tty)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       int i;
-       int chars = 0;
-       struct ATENINTL_port *ATEN2011_port;
-
-       /* dbg("%s"," ATEN2011_chars_in_buffer:entering ..........."); */
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-       if (ATEN2011_port == NULL) {
-               dbg("%s", "ATEN2011_break:leaving ...........");
-               return -1;
-       }
-
-       for (i = 0; i < NUM_URBS; ++i)
-               if (ATEN2011_port->write_urb_pool[i]->status == -EINPROGRESS)
-                       chars += URB_TRANSFER_BUFFER_SIZE;
-
-       dbg("%s - returns %d", __func__, chars);
-       return chars;
-
-}
-
-static void ATEN2011_block_until_tx_empty(struct tty_struct *tty,
-                                         struct ATENINTL_port *ATEN2011_port)
-{
-       int timeout = HZ / 10;
-       int wait = 30;
-       int count;
-
-       while (1) {
-               count = ATEN2011_chars_in_buffer(tty);
-
-               /* Check for Buffer status */
-               if (count <= 0)
-                       return;
-
-               /* Block the thread for a while */
-               interruptible_sleep_on_timeout(&ATEN2011_port->wait_chase,
-                                              timeout);
-
-               /* No activity.. count down section */
-               wait--;
-               if (wait == 0) {
-                       dbg("%s - TIMEOUT", __func__);
-                       return;
-               } else {
-                       /* Reset timout value back to seconds */
-                       wait = 30;
-               }
-       }
-}
-
-static void ATEN2011_close(struct tty_struct *tty, struct usb_serial_port *port,
-                          struct file *filp)
-{
-       struct usb_serial *serial;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct ATENINTL_port *ATEN2011_port;
-       int no_urbs;
-       __u16 Data;
-
-       dbg("%s", "ATEN2011_close:entering...");
-       serial = port->serial;
-
-       /* take the Adpater and port's private data */
-       ATEN2011_serial = usb_get_serial_data(serial);
-       ATEN2011_port = usb_get_serial_port_data(port);
-       if ((ATEN2011_serial == NULL) || (ATEN2011_port == NULL))
-               return;
-
-       if (serial->dev) {
-               /* flush and block(wait) until tx is empty */
-               ATEN2011_block_until_tx_empty(tty, ATEN2011_port);
-       }
-       /* kill the ports URB's */
-       for (no_urbs = 0; no_urbs < NUM_URBS; no_urbs++)
-               usb_kill_urb(ATEN2011_port->write_urb_pool[no_urbs]);
-       /* Freeing Write URBs */
-       for (no_urbs = 0; no_urbs < NUM_URBS; ++no_urbs) {
-               kfree(ATEN2011_port->write_urb_pool[no_urbs]->transfer_buffer);
-               usb_free_urb(ATEN2011_port->write_urb_pool[no_urbs]);
-       }
-       /* While closing port, shutdown all bulk read, write  *
-        * and interrupt read if they exists                  */
-       if (serial->dev) {
-               if (ATEN2011_port->write_urb) {
-                       dbg("%s", "Shutdown bulk write");
-                       usb_kill_urb(ATEN2011_port->write_urb);
-               }
-               if (ATEN2011_port->read_urb) {
-                       dbg("%s", "Shutdown bulk read");
-                       usb_kill_urb(ATEN2011_port->read_urb);
-               }
-               if ((&ATEN2011_port->control_urb)) {
-                       dbg("%s", "Shutdown control read");
-                       /* usb_kill_urb (ATEN2011_port->control_urb); */
-
-               }
-       }
-       /* if(ATEN2011_port->ctrl_buf != NULL) */
-               /* kfree(ATEN2011_port->ctrl_buf); */
-       /* decrement the no.of open ports counter of an individual USB-serial adapter. */
-       ATEN2011_serial->NoOfOpenPorts--;
-       dbg("NoOfOpenPorts in close%d:in port%d",
-               ATEN2011_serial->NoOfOpenPorts, port->number);
-       if (ATEN2011_serial->NoOfOpenPorts == 0) {
-               /* stop the stus polling here */
-               ATEN2011_serial->status_polling_started = 0;
-               if (ATEN2011_serial->interrupt_read_urb) {
-                       dbg("%s", "Shutdown interrupt_read_urb");
-                       /* ATEN2011_serial->interrupt_in_buffer=NULL; */
-                       /* usb_kill_urb (ATEN2011_serial->interrupt_read_urb); */
-               }
-       }
-       if (ATEN2011_port->write_urb) {
-               /* if this urb had a transfer buffer already (old tx) free it */
-               kfree(ATEN2011_port->write_urb->transfer_buffer);
-               usb_free_urb(ATEN2011_port->write_urb);
-       }
-
-       /* clear the MCR & IER */
-       Data = 0x00;
-       set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-       Data = 0x00;
-       set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
-
-       ATEN2011_port->open = 0;
-       dbg("%s", "Leaving ............");
-
-}
-
-static void ATEN2011_block_until_chase_response(struct tty_struct *tty,
-                                               struct ATENINTL_port
-                                               *ATEN2011_port)
-{
-       int timeout = 1 * HZ;
-       int wait = 10;
-       int count;
-
-       while (1) {
-               count = ATEN2011_chars_in_buffer(tty);
-
-               /* Check for Buffer status */
-               if (count <= 0) {
-                       ATEN2011_port->chaseResponsePending = 0;
-                       return;
-               }
-
-               /* Block the thread for a while */
-               interruptible_sleep_on_timeout(&ATEN2011_port->wait_chase,
-                                              timeout);
-               /* No activity.. count down section */
-               wait--;
-               if (wait == 0) {
-                       dbg("%s - TIMEOUT", __func__);
-                       return;
-               } else {
-                       /* Reset timout value back to seconds */
-                       wait = 10;
-               }
-       }
-
-}
-
-static void ATEN2011_break(struct tty_struct *tty, int break_state)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       unsigned char data;
-       struct usb_serial *serial;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct ATENINTL_port *ATEN2011_port;
-
-       dbg("%s", "Entering ...........");
-       dbg("ATEN2011_break: Start");
-
-       serial = port->serial;
-
-       ATEN2011_serial = usb_get_serial_data(serial);
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if ((ATEN2011_serial == NULL) || (ATEN2011_port == NULL))
-               return;
-
-       /* flush and chase */
-       ATEN2011_port->chaseResponsePending = 1;
-
-       if (serial->dev) {
-               /* flush and block until tx is empty */
-               ATEN2011_block_until_chase_response(tty, ATEN2011_port);
-       }
-
-       if (break_state == -1)
-               data = ATEN2011_port->shadowLCR | LCR_SET_BREAK;
-       else
-               data = ATEN2011_port->shadowLCR & ~LCR_SET_BREAK;
-
-       ATEN2011_port->shadowLCR = data;
-       dbg("ATEN2011_break ATEN2011_port->shadowLCR is %x",
-               ATEN2011_port->shadowLCR);
-       set_uart_reg(port, LINE_CONTROL_REGISTER, ATEN2011_port->shadowLCR);
-
-       return;
-}
-
-static int ATEN2011_write_room(struct tty_struct *tty)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       int i;
-       int room = 0;
-       struct ATENINTL_port *ATEN2011_port;
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-       if (ATEN2011_port == NULL) {
-               dbg("%s", "ATEN2011_break:leaving ...........");
-               return -1;
-       }
-
-       for (i = 0; i < NUM_URBS; ++i)
-               if (ATEN2011_port->write_urb_pool[i]->status != -EINPROGRESS)
-                       room += URB_TRANSFER_BUFFER_SIZE;
-
-       dbg("%s - returns %d", __func__, room);
-       return room;
-
-}
-
-static int ATEN2011_write(struct tty_struct *tty, struct usb_serial_port *port,
-                         const unsigned char *data, int count)
-{
-       int status;
-       int i;
-       int bytes_sent = 0;
-       int transfer_size;
-       int minor;
-
-       struct ATENINTL_port *ATEN2011_port;
-       struct usb_serial *serial;
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct urb *urb;
-       const unsigned char *current_position = data;
-       unsigned char *data1;
-       dbg("%s", "entering ...........");
-
-       serial = port->serial;
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-       if (ATEN2011_port == NULL) {
-               dbg("%s", "ATEN2011_port is NULL");
-               return -1;
-       }
-
-       ATEN2011_serial = usb_get_serial_data(serial);
-       if (ATEN2011_serial == NULL) {
-               dbg("%s", "ATEN2011_serial is NULL");
-               return -1;
-       }
-
-       /* try to find a free urb in the list */
-       urb = NULL;
-
-       for (i = 0; i < NUM_URBS; ++i) {
-               if (ATEN2011_port->write_urb_pool[i]->status != -EINPROGRESS) {
-                       urb = ATEN2011_port->write_urb_pool[i];
-                       dbg("URB:%d", i);
-                       break;
-               }
-       }
-
-       if (urb == NULL) {
-               dbg("%s - no more free urbs", __func__);
-               goto exit;
-       }
-
-       if (urb->transfer_buffer == NULL) {
-               urb->transfer_buffer =
-                   kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);
-
-               if (urb->transfer_buffer == NULL) {
-                       err("%s no more kernel memory...", __func__);
-                       goto exit;
-               }
-       }
-       transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE);
-
-       memcpy(urb->transfer_buffer, current_position, transfer_size);
-       /* usb_serial_debug_data (__FILE__, __func__, transfer_size, urb->transfer_buffer); */
-
-       /* fill urb with data and submit  */
-       minor = port->serial->minor;
-       if (minor == SERIAL_TTY_NO_MINOR)
-               minor = 0;
-       if ((ATEN2011_serial->ATEN2011_spectrum_2or4ports == 2)
-           && (((__u16) port->number - (__u16) (minor)) != 0)) {
-               usb_fill_bulk_urb(urb, ATEN2011_serial->serial->dev,
-                                 usb_sndbulkpipe(ATEN2011_serial->serial->dev,
-                                                 (port->
-                                                  bulk_out_endpointAddress) +
-                                                 2), urb->transfer_buffer,
-                                 transfer_size,
-                                 ATEN2011_bulk_out_data_callback,
-                                 ATEN2011_port);
-       } else
-
-               usb_fill_bulk_urb(urb,
-                                 ATEN2011_serial->serial->dev,
-                                 usb_sndbulkpipe(ATEN2011_serial->serial->dev,
-                                                 port->
-                                                 bulk_out_endpointAddress),
-                                 urb->transfer_buffer, transfer_size,
-                                 ATEN2011_bulk_out_data_callback,
-                                 ATEN2011_port);
-
-       data1 = urb->transfer_buffer;
-       dbg("bulkout endpoint is %d", port->bulk_out_endpointAddress);
-       /* for(i=0;i < urb->actual_length;i++) */
-               /* dbg("Data is %c ",data1[i]); */
-
-       /* send it down the pipe */
-       status = usb_submit_urb(urb, GFP_ATOMIC);
-
-       if (status) {
-               err("%s - usb_submit_urb(write bulk) failed with status = %d",
-                   __func__, status);
-               bytes_sent = status;
-               goto exit;
-       }
-       bytes_sent = transfer_size;
-       ATEN2011_port->icount.tx += transfer_size;
-       dbg("ATEN2011_port->icount.tx is %d:", ATEN2011_port->icount.tx);
-
-exit:
-       return bytes_sent;
-}
-
-static void ATEN2011_throttle(struct tty_struct *tty)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       struct ATENINTL_port *ATEN2011_port;
-       int status;
-
-       dbg("- port %d", port->number);
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return;
-
-       if (!ATEN2011_port->open) {
-               dbg("%s", "port not opened");
-               return;
-       }
-
-       dbg("%s", "Entering .......... ");
-
-       if (!tty) {
-               dbg("%s - no tty available", __func__);
-               return;
-       }
-
-       /* if we are implementing XON/XOFF, send the stop character */
-       if (I_IXOFF(tty)) {
-               unsigned char stop_char = STOP_CHAR(tty);
-               status = ATEN2011_write(tty, port, &stop_char, 1);
-               if (status <= 0)
-                       return;
-       }
-
-       /* if we are implementing RTS/CTS, toggle that line */
-       if (tty->termios->c_cflag & CRTSCTS) {
-               ATEN2011_port->shadowMCR &= ~MCR_RTS;
-               status = set_uart_reg(port, MODEM_CONTROL_REGISTER,
-                                     ATEN2011_port->shadowMCR);
-               if (status < 0)
-                       return;
-       }
-
-       return;
-}
-
-static void ATEN2011_unthrottle(struct tty_struct *tty)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       int status;
-       struct ATENINTL_port *ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return;
-
-       if (!ATEN2011_port->open) {
-               dbg("%s - port not opened", __func__);
-               return;
-       }
-
-       dbg("%s", "Entering .......... ");
-
-       if (!tty) {
-               dbg("%s - no tty available", __func__);
-               return;
-       }
-
-       /* if we are implementing XON/XOFF, send the start character */
-       if (I_IXOFF(tty)) {
-               unsigned char start_char = START_CHAR(tty);
-               status = ATEN2011_write(tty, port, &start_char, 1);
-               if (status <= 0)
-                       return;
-       }
-
-       /* if we are implementing RTS/CTS, toggle that line */
-       if (tty->termios->c_cflag & CRTSCTS) {
-               ATEN2011_port->shadowMCR |= MCR_RTS;
-               status = set_uart_reg(port, MODEM_CONTROL_REGISTER,
-                                     ATEN2011_port->shadowMCR);
-               if (status < 0)
-                       return;
-       }
-
-       return;
-}
-
-static int ATEN2011_tiocmget(struct tty_struct *tty, struct file *file)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       struct ATENINTL_port *ATEN2011_port;
-       unsigned int result;
-       __u16 msr;
-       __u16 mcr;
-       /* unsigned int mcr; */
-       int status = 0;
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       dbg("%s - port %d", __func__, port->number);
-
-       if (ATEN2011_port == NULL)
-               return -ENODEV;
-
-       status = get_uart_reg(port, MODEM_STATUS_REGISTER, &msr);
-       status = get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr);
-       /* mcr = ATEN2011_port->shadowMCR; */
-       /* COMMENT2: the Fallowing three line are commented for updating only MSR values */
-       result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
-           | ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
-           | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0)
-           | ((msr & ATEN2011_MSR_CTS) ? TIOCM_CTS : 0)
-           | ((msr & ATEN2011_MSR_CD) ? TIOCM_CAR : 0)
-           | ((msr & ATEN2011_MSR_RI) ? TIOCM_RI : 0)
-           | ((msr & ATEN2011_MSR_DSR) ? TIOCM_DSR : 0);
-
-       dbg("%s - 0x%04X", __func__, result);
-
-       return result;
-}
-
-static int ATEN2011_tiocmset(struct tty_struct *tty, struct file *file,
-                            unsigned int set, unsigned int clear)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       struct ATENINTL_port *ATEN2011_port;
-       unsigned int mcr;
-       unsigned int status;
-
-       dbg("%s - port %d", __func__, port->number);
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return -ENODEV;
-
-       mcr = ATEN2011_port->shadowMCR;
-       if (clear & TIOCM_RTS)
-               mcr &= ~MCR_RTS;
-       if (clear & TIOCM_DTR)
-               mcr &= ~MCR_DTR;
-       if (clear & TIOCM_LOOP)
-               mcr &= ~MCR_LOOPBACK;
-
-       if (set & TIOCM_RTS)
-               mcr |= MCR_RTS;
-       if (set & TIOCM_DTR)
-               mcr |= MCR_DTR;
-       if (set & TIOCM_LOOP)
-               mcr |= MCR_LOOPBACK;
-
-       ATEN2011_port->shadowMCR = mcr;
-
-       status = set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr);
-       if (status < 0) {
-               dbg("setting MODEM_CONTROL_REGISTER Failed");
-               return -1;
-       }
-
-       return 0;
-}
-
-static void ATEN2011_set_termios(struct tty_struct *tty,
-                                struct usb_serial_port *port,
-                                struct ktermios *old_termios)
-{
-       int status;
-       unsigned int cflag;
-       struct usb_serial *serial;
-       struct ATENINTL_port *ATEN2011_port;
-
-       dbg("ATEN2011_set_termios: START");
-
-       serial = port->serial;
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return;
-
-       if (!ATEN2011_port->open) {
-               dbg("%s - port not opened", __func__);
-               return;
-       }
-
-       dbg("%s", "setting termios - ");
-
-       cflag = tty->termios->c_cflag;
-
-       dbg("%s - cflag %08x iflag %08x", __func__,
-           tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag));
-
-       if (old_termios) {
-               dbg("%s - old clfag %08x old iflag %08x", __func__,
-                   old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag));
-       }
-
-       dbg("%s - port %d", __func__, port->number);
-
-       /* change the port settings to the new ones specified */
-
-       ATEN2011_change_port_settings(tty, ATEN2011_port, old_termios);
-
-       if (!ATEN2011_port->read_urb) {
-               dbg("%s", "URB KILLED !!!!!");
-               return;
-       }
-
-       if (ATEN2011_port->read_urb->status != -EINPROGRESS) {
-               ATEN2011_port->read_urb->dev = serial->dev;
-               status = usb_submit_urb(ATEN2011_port->read_urb, GFP_ATOMIC);
-               if (status) {
-                       dbg
-                           (" usb_submit_urb(read bulk) failed, status = %d",
-                            status);
-               }
-       }
-       return;
-}
-
-static int get_lsr_info(struct tty_struct *tty,
-                       struct ATENINTL_port *ATEN2011_port,
-                       unsigned int __user *value)
-{
-       int count;
-       unsigned int result = 0;
-
-       count = ATEN2011_chars_in_buffer(tty);
-       if (count == 0) {
-               dbg("%s -- Empty", __func__);
-               result = TIOCSER_TEMT;
-       }
-
-       if (copy_to_user(value, &result, sizeof(int)))
-               return -EFAULT;
-       return 0;
-}
-
-static int get_number_bytes_avail(struct tty_struct *tty,
-                                 struct ATENINTL_port *ATEN2011_port,
-                                 unsigned int __user *value)
-{
-       unsigned int result = 0;
-
-       if (!tty)
-               return -ENOIOCTLCMD;
-
-       result = tty->read_cnt;
-
-       dbg("%s(%d) = %d", __func__, ATEN2011_port->port->number, result);
-       if (copy_to_user(value, &result, sizeof(int)))
-               return -EFAULT;
-
-       return -ENOIOCTLCMD;
-}
-
-static int set_modem_info(struct ATENINTL_port *ATEN2011_port, unsigned int cmd,
-                         unsigned int __user *value)
-{
-       unsigned int mcr;
-       unsigned int arg;
-       __u16 Data;
-       int status;
-       struct usb_serial_port *port;
-
-       if (ATEN2011_port == NULL)
-               return -1;
-
-       port = (struct usb_serial_port *)ATEN2011_port->port;
-
-       mcr = ATEN2011_port->shadowMCR;
-
-       if (copy_from_user(&arg, value, sizeof(int)))
-               return -EFAULT;
-
-       switch (cmd) {
-       case TIOCMBIS:
-               if (arg & TIOCM_RTS)
-                       mcr |= MCR_RTS;
-               if (arg & TIOCM_DTR)
-                       mcr |= MCR_RTS;
-               if (arg & TIOCM_LOOP)
-                       mcr |= MCR_LOOPBACK;
-               break;
-
-       case TIOCMBIC:
-               if (arg & TIOCM_RTS)
-                       mcr &= ~MCR_RTS;
-               if (arg & TIOCM_DTR)
-                       mcr &= ~MCR_RTS;
-               if (arg & TIOCM_LOOP)
-                       mcr &= ~MCR_LOOPBACK;
-               break;
-
-       case TIOCMSET:
-               /* turn off the RTS and DTR and LOOPBACK
-                * and then only turn on what was asked to */
-               mcr &= ~(MCR_RTS | MCR_DTR | MCR_LOOPBACK);
-               mcr |= ((arg & TIOCM_RTS) ? MCR_RTS : 0);
-               mcr |= ((arg & TIOCM_DTR) ? MCR_DTR : 0);
-               mcr |= ((arg & TIOCM_LOOP) ? MCR_LOOPBACK : 0);
-               break;
-       }
-
-       ATEN2011_port->shadowMCR = mcr;
-
-       Data = ATEN2011_port->shadowMCR;
-       status = set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-       if (status < 0) {
-               dbg("setting MODEM_CONTROL_REGISTER Failed");
-               return -1;
-       }
-
-       return 0;
-}
-
-static int get_modem_info(struct ATENINTL_port *ATEN2011_port,
-                         unsigned int __user *value)
-{
-       unsigned int result = 0;
-       __u16 msr;
-       unsigned int mcr = ATEN2011_port->shadowMCR;
-       int status;
-
-       status = get_uart_reg(ATEN2011_port->port, MODEM_STATUS_REGISTER, &msr);
-       result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)      /* 0x002 */
-           |((mcr & MCR_RTS) ? TIOCM_RTS : 0)  /* 0x004 */
-           |((msr & ATEN2011_MSR_CTS) ? TIOCM_CTS : 0) /* 0x020 */
-           |((msr & ATEN2011_MSR_CD) ? TIOCM_CAR : 0)  /* 0x040 */
-           |((msr & ATEN2011_MSR_RI) ? TIOCM_RI : 0)   /* 0x080 */
-           |((msr & ATEN2011_MSR_DSR) ? TIOCM_DSR : 0);        /* 0x100 */
-
-       dbg("%s -- %x", __func__, result);
-
-       if (copy_to_user(value, &result, sizeof(int)))
-               return -EFAULT;
-       return 0;
-}
-
-static int get_serial_info(struct ATENINTL_port *ATEN2011_port,
-                          struct serial_struct __user *retinfo)
-{
-       struct serial_struct tmp;
-
-       if (ATEN2011_port == NULL)
-               return -1;
-
-       if (!retinfo)
-               return -EFAULT;
-
-       memset(&tmp, 0, sizeof(tmp));
-
-       tmp.type = PORT_16550A;
-       tmp.line = ATEN2011_port->port->serial->minor;
-       if (tmp.line == SERIAL_TTY_NO_MINOR)
-               tmp.line = 0;
-       tmp.port = ATEN2011_port->port->number;
-       tmp.irq = 0;
-       tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
-       tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE;
-       tmp.baud_base = 9600;
-       tmp.close_delay = 5 * HZ;
-       tmp.closing_wait = 30 * HZ;
-
-       if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
-               return -EFAULT;
-       return 0;
-}
-
-static int ATEN2011_ioctl(struct tty_struct *tty, struct file *file,
-                         unsigned int cmd, unsigned long arg)
-{
-       struct usb_serial_port *port = tty->driver_data;
-       struct ATENINTL_port *ATEN2011_port;
-       struct async_icount cnow;
-       struct async_icount cprev;
-       struct serial_icounter_struct icount;
-       int ATENret = 0;
-       unsigned int __user *user_arg = (unsigned int __user *)arg;
-
-       ATEN2011_port = usb_get_serial_port_data(port);
-
-       if (ATEN2011_port == NULL)
-               return -1;
-
-       dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd);
-
-       switch (cmd) {
-               /* return number of bytes available */
-
-       case TIOCINQ:
-               dbg("%s (%d) TIOCINQ", __func__, port->number);
-               return get_number_bytes_avail(tty, ATEN2011_port, user_arg);
-               break;
-
-       case TIOCOUTQ:
-               dbg("%s (%d) TIOCOUTQ", __func__, port->number);
-               return put_user(ATEN2011_chars_in_buffer(tty), user_arg);
-               break;
-
-       case TIOCSERGETLSR:
-               dbg("%s (%d) TIOCSERGETLSR", __func__, port->number);
-               return get_lsr_info(tty, ATEN2011_port, user_arg);
-               return 0;
-
-       case TIOCMBIS:
-       case TIOCMBIC:
-       case TIOCMSET:
-               dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", __func__,
-                   port->number);
-               ATENret = set_modem_info(ATEN2011_port, cmd, user_arg);
-               return ATENret;
-
-       case TIOCMGET:
-               dbg("%s (%d) TIOCMGET", __func__, port->number);
-               return get_modem_info(ATEN2011_port, user_arg);
-
-       case TIOCGSERIAL:
-               dbg("%s (%d) TIOCGSERIAL", __func__, port->number);
-               return get_serial_info(ATEN2011_port,
-                                      (struct serial_struct __user *)arg);
-
-       case TIOCSSERIAL:
-               dbg("%s (%d) TIOCSSERIAL", __func__, port->number);
-               break;
-
-       case TIOCMIWAIT:
-               dbg("%s (%d) TIOCMIWAIT", __func__, port->number);
-               cprev = ATEN2011_port->icount;
-               while (1) {
-                       /* see if a signal did it */
-                       if (signal_pending(current))
-                               return -ERESTARTSYS;
-                       cnow = ATEN2011_port->icount;
-                       if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
-                           cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
-                               return -EIO;    /* no change => error */
-                       if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
-                           ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
-                           ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
-                           ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
-                               return 0;
-                       }
-                       cprev = cnow;
-               }
-               /* NOTREACHED */
-               break;
-
-       case TIOCGICOUNT:
-               cnow = ATEN2011_port->icount;
-               icount.cts = cnow.cts;
-               icount.dsr = cnow.dsr;
-               icount.rng = cnow.rng;
-               icount.dcd = cnow.dcd;
-               icount.rx = cnow.rx;
-               icount.tx = cnow.tx;
-               icount.frame = cnow.frame;
-               icount.overrun = cnow.overrun;
-               icount.parity = cnow.parity;
-               icount.brk = cnow.brk;
-               icount.buf_overrun = cnow.buf_overrun;
-
-               dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __func__,
-                   port->number, icount.rx, icount.tx);
-               if (copy_to_user((void __user *)arg, &icount, sizeof(icount)))
-                       return -EFAULT;
-               return 0;
-
-       default:
-               break;
-       }
-
-       return -ENOIOCTLCMD;
-}
-
-static int ATEN2011_calc_baud_rate_divisor(int baudRate, int *divisor,
-                                          __u16 *clk_sel_val)
-{
-       dbg("%s - %d", __func__, baudRate);
-
-       if (baudRate <= 115200) {
-               *divisor = 115200 / baudRate;
-               *clk_sel_val = 0x0;
-       }
-       if ((baudRate > 115200) && (baudRate <= 230400)) {
-               *divisor = 230400 / baudRate;
-               *clk_sel_val = 0x10;
-       } else if ((baudRate > 230400) && (baudRate <= 403200)) {
-               *divisor = 403200 / baudRate;
-               *clk_sel_val = 0x20;
-       } else if ((baudRate > 403200) && (baudRate <= 460800)) {
-               *divisor = 460800 / baudRate;
-               *clk_sel_val = 0x30;
-       } else if ((baudRate > 460800) && (baudRate <= 806400)) {
-               *divisor = 806400 / baudRate;
-               *clk_sel_val = 0x40;
-       } else if ((baudRate > 806400) && (baudRate <= 921600)) {
-               *divisor = 921600 / baudRate;
-               *clk_sel_val = 0x50;
-       } else if ((baudRate > 921600) && (baudRate <= 1572864)) {
-               *divisor = 1572864 / baudRate;
-               *clk_sel_val = 0x60;
-       } else if ((baudRate > 1572864) && (baudRate <= 3145728)) {
-               *divisor = 3145728 / baudRate;
-               *clk_sel_val = 0x70;
-       }
-       return 0;
-}
-
-static int ATEN2011_send_cmd_write_baud_rate(struct ATENINTL_port
-                                            *ATEN2011_port, int baudRate)
-{
-       int divisor = 0;
-       int status;
-       __u16 Data;
-       unsigned char number;
-       __u16 clk_sel_val;
-       struct usb_serial_port *port;
-       int minor;
-
-       if (ATEN2011_port == NULL)
-               return -1;
-
-       port = (struct usb_serial_port *)ATEN2011_port->port;
-
-       dbg("%s", "Entering .......... ");
-
-       minor = ATEN2011_port->port->serial->minor;
-       if (minor == SERIAL_TTY_NO_MINOR)
-               minor = 0;
-       number = ATEN2011_port->port->number - minor;
-
-       dbg("%s - port = %d, baud = %d", __func__,
-           ATEN2011_port->port->number, baudRate);
-       /* reset clk_uart_sel in spregOffset */
-       if (baudRate > 115200) {
-#ifdef HW_flow_control
-               /*
-                * NOTE: need to see the pther register to modify
-                * setting h/w flow control bit to 1;
-                */
-               /* Data = ATEN2011_port->shadowMCR; */
-               Data = 0x2b;
-               ATEN2011_port->shadowMCR = Data;
-               status = set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-               if (status < 0) {
-                       dbg("Writing spreg failed in set_serial_baud");
-                       return -1;
-               }
-#endif
-
-       } else {
-#ifdef HW_flow_control
-               /* setting h/w flow control bit to 0; */
-               /* Data = ATEN2011_port->shadowMCR; */
-               Data = 0xb;
-               ATEN2011_port->shadowMCR = Data;
-               status = set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-               if (status < 0) {
-                       dbg("Writing spreg failed in set_serial_baud");
-                       return -1;
-               }
-#endif
-
-       }
-
-       if (1)                  /* baudRate <= 115200) */ {
-               clk_sel_val = 0x0;
-               Data = 0x0;
-               status =
-                   ATEN2011_calc_baud_rate_divisor(baudRate, &divisor,
-                                                   &clk_sel_val);
-               status = get_reg_sync(port, ATEN2011_port->SpRegOffset, &Data);
-               if (status < 0) {
-                       dbg("reading spreg failed in set_serial_baud");
-                       return -1;
-               }
-               Data = (Data & 0x8f) | clk_sel_val;
-               status = set_reg_sync(port, ATEN2011_port->SpRegOffset, Data);
-               if (status < 0) {
-                       dbg("Writing spreg failed in set_serial_baud");
-                       return -1;
-               }
-               /* Calculate the Divisor */
-
-               if (status) {
-                       err("%s - bad baud rate", __func__);
-                       dbg("%s", "bad baud rate");
-                       return status;
-               }
-               /* Enable access to divisor latch */
-               Data = ATEN2011_port->shadowLCR | SERIAL_LCR_DLAB;
-               ATEN2011_port->shadowLCR = Data;
-               set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-
-               /* Write the divisor */
-               Data = (unsigned char)(divisor & 0xff);
-               dbg("set_serial_baud Value to write DLL is %x", Data);
-               set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
-
-               Data = (unsigned char)((divisor & 0xff00) >> 8);
-               dbg("set_serial_baud Value to write DLM is %x", Data);
-               set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
-
-               /* Disable access to divisor latch */
-               Data = ATEN2011_port->shadowLCR & ~SERIAL_LCR_DLAB;
-               ATEN2011_port->shadowLCR = Data;
-               set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-
-       }
-
-       return status;
-}
-
-static void ATEN2011_change_port_settings(struct tty_struct *tty,
-                                         struct ATENINTL_port *ATEN2011_port,
-                                         struct ktermios *old_termios)
-{
-       int baud;
-       unsigned cflag;
-       unsigned iflag;
-       __u8 lData;
-       __u8 lParity;
-       __u8 lStop;
-       int status;
-       __u16 Data;
-       struct usb_serial_port *port;
-       struct usb_serial *serial;
-
-       if (ATEN2011_port == NULL)
-               return;
-
-       port = (struct usb_serial_port *)ATEN2011_port->port;
-
-       serial = port->serial;
-
-       dbg("%s - port %d", __func__, ATEN2011_port->port->number);
-
-       if (!ATEN2011_port->open) {
-               dbg("%s - port not opened", __func__);
-               return;
-       }
-
-       if ((!tty) || (!tty->termios)) {
-               dbg("%s - no tty structures", __func__);
-               return;
-       }
-
-       dbg("%s", "Entering .......... ");
-
-       lData = LCR_BITS_8;
-       lStop = LCR_STOP_1;
-       lParity = LCR_PAR_NONE;
-
-       cflag = tty->termios->c_cflag;
-       iflag = tty->termios->c_iflag;
-
-       /* Change the number of bits */
-
-       /* COMMENT1: the below Line"if(cflag & CSIZE)" is added for the errors we get for serial loop data test i.e serial_loopback.pl -v */
-       /* if(cflag & CSIZE) */
-       {
-               switch (cflag & CSIZE) {
-               case CS5:
-                       lData = LCR_BITS_5;
-                       break;
-
-               case CS6:
-                       lData = LCR_BITS_6;
-                       break;
-
-               case CS7:
-                       lData = LCR_BITS_7;
-                       break;
-               default:
-               case CS8:
-                       lData = LCR_BITS_8;
-                       break;
-               }
-       }
-       /* Change the Parity bit */
-       if (cflag & PARENB) {
-               if (cflag & PARODD) {
-                       lParity = LCR_PAR_ODD;
-                       dbg("%s - parity = odd", __func__);
-               } else {
-                       lParity = LCR_PAR_EVEN;
-                       dbg("%s - parity = even", __func__);
-               }
-
-       } else {
-               dbg("%s - parity = none", __func__);
-       }
-
-       if (cflag & CMSPAR)
-               lParity = lParity | 0x20;
-
-       /* Change the Stop bit */
-       if (cflag & CSTOPB) {
-               lStop = LCR_STOP_2;
-               dbg("%s - stop bits = 2", __func__);
-       } else {
-               lStop = LCR_STOP_1;
-               dbg("%s - stop bits = 1", __func__);
-       }
-
-       /* Update the LCR with the correct value */
-       ATEN2011_port->shadowLCR &=
-           ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK);
-       ATEN2011_port->shadowLCR |= (lData | lParity | lStop);
-
-       dbg
-           ("ATEN2011_change_port_settings ATEN2011_port->shadowLCR is %x",
-            ATEN2011_port->shadowLCR);
-       /* Disable Interrupts */
-       Data = 0x00;
-       set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
-
-       Data = 0x00;
-       set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
-
-       Data = 0xcf;
-       set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
-
-       /* Send the updated LCR value to the ATEN2011 */
-       Data = ATEN2011_port->shadowLCR;
-
-       set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
-
-       Data = 0x00b;
-       ATEN2011_port->shadowMCR = Data;
-       set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-       Data = 0x00b;
-       set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-
-       /* set up the MCR register and send it to the ATEN2011 */
-
-       ATEN2011_port->shadowMCR = MCR_MASTER_IE;
-       if (cflag & CBAUD)
-               ATEN2011_port->shadowMCR |= (MCR_DTR | MCR_RTS);
-
-       if (cflag & CRTSCTS)
-               ATEN2011_port->shadowMCR |= (MCR_XON_ANY);
-       else
-               ATEN2011_port->shadowMCR &= ~(MCR_XON_ANY);
-
-       Data = ATEN2011_port->shadowMCR;
-       set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
-
-       /* Determine divisor based on baud rate */
-       baud = tty_get_baud_rate(tty);
-
-       if (!baud) {
-               /* pick a default, any default... */
-               dbg("%s", "Picked default baud...");
-               baud = 9600;
-       }
-
-       dbg("%s - baud rate = %d", __func__, baud);
-       status = ATEN2011_send_cmd_write_baud_rate(ATEN2011_port, baud);
-
-       /* Enable Interrupts */
-       Data = 0x0c;
-       set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
-
-       if (ATEN2011_port->read_urb->status != -EINPROGRESS) {
-               ATEN2011_port->read_urb->dev = serial->dev;
-
-               status = usb_submit_urb(ATEN2011_port->read_urb, GFP_ATOMIC);
-
-               if (status) {
-                       dbg
-                           (" usb_submit_urb(read bulk) failed, status = %d",
-                            status);
-               }
-       }
-       dbg
-           ("ATEN2011_change_port_settings ATEN2011_port->shadowLCR is End %x",
-            ATEN2011_port->shadowLCR);
-
-       return;
-}
-
-static int ATEN2011_calc_num_ports(struct usb_serial *serial)
-{
-
-       __u16 Data = 0x00;
-       int ret = 0;
-       int ATEN2011_2or4ports;
-       ret = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
-                             ATEN_RDREQ, ATEN_RD_RTYPE, 0, GPIO_REGISTER,
-                             &Data, VENDOR_READ_LENGTH, ATEN_WDR_TIMEOUT);
-
-/* ghostgum: here is where the problem appears to bet */
-/* Which of the following are needed? */
-/* Greg used the serial->type->num_ports=2 */
-/* But the code in the ATEN2011_open relies on serial->num_ports=2 */
-       if ((Data & 0x01) == 0) {
-               ATEN2011_2or4ports = 2;
-               serial->type->num_ports = 2;
-               serial->num_ports = 2;
-       }
-       /* else if(serial->interface->cur_altsetting->desc.bNumEndpoints == 9) */
-       else {
-               ATEN2011_2or4ports = 4;
-               serial->type->num_ports = 4;
-               serial->num_ports = 4;
-
-       }
-
-       return ATEN2011_2or4ports;
-}
-
-static int ATEN2011_startup(struct usb_serial *serial)
-{
-       struct ATENINTL_serial *ATEN2011_serial;
-       struct ATENINTL_port *ATEN2011_port;
-       struct usb_device *dev;
-       int i, status;
-       int minor;
-
-       __u16 Data;
-       dbg("%s", " ATEN2011_startup :entering..........");
-
-       if (!serial) {
-               dbg("%s", "Invalid Handler");
-               return -1;
-       }
-
-       dev = serial->dev;
-
-       dbg("%s", "Entering...");
-
-       /* create our private serial structure */
-       ATEN2011_serial = kzalloc(sizeof(struct ATENINTL_serial), GFP_KERNEL);
-       if (ATEN2011_serial == NULL) {
-               err("%s - Out of memory", __func__);
-               return -ENOMEM;
-       }
-
-       /* resetting the private structure field values to zero */
-       memset(ATEN2011_serial, 0, sizeof(struct ATENINTL_serial));
-
-       ATEN2011_serial->serial = serial;
-       /* initilize status polling flag to 0 */
-       ATEN2011_serial->status_polling_started = 0;
-
-       usb_set_serial_data(serial, ATEN2011_serial);
-       ATEN2011_serial->ATEN2011_spectrum_2or4ports =
-           ATEN2011_calc_num_ports(serial);
-       /* we set up the pointers to the endpoints in the ATEN2011_open *
-        * function, as the structures aren't created yet.             */
-
-       /* set up port private structures */
-       for (i = 0; i < serial->num_ports; ++i) {
-               ATEN2011_port =
-                   kmalloc(sizeof(struct ATENINTL_port), GFP_KERNEL);
-               if (ATEN2011_port == NULL) {
-                       err("%s - Out of memory", __func__);
-                       usb_set_serial_data(serial, NULL);
-                       kfree(ATEN2011_serial);
-                       return -ENOMEM;
-               }
-               memset(ATEN2011_port, 0, sizeof(struct ATENINTL_port));
-
-               /*
-                * Initialize all port interrupt end point to port 0
-                * int endpoint. Our device has only one interrupt end point
-                * comman to all port
-                */
-               /* serial->port[i]->interrupt_in_endpointAddress = serial->port[0]->interrupt_in_endpointAddress; */
-
-               ATEN2011_port->port = serial->port[i];
-               usb_set_serial_port_data(serial->port[i], ATEN2011_port);
-
-               minor = serial->port[i]->serial->minor;
-               if (minor == SERIAL_TTY_NO_MINOR)
-                       minor = 0;
-               ATEN2011_port->port_num =
-                   ((serial->port[i]->number - minor) + 1);
-
-               if (ATEN2011_port->port_num == 1) {
-                       ATEN2011_port->SpRegOffset = 0x0;
-                       ATEN2011_port->ControlRegOffset = 0x1;
-                       ATEN2011_port->DcrRegOffset = 0x4;
-               } else if ((ATEN2011_port->port_num == 2)
-                          && (ATEN2011_serial->ATEN2011_spectrum_2or4ports ==
-                              4)) {
-                       ATEN2011_port->SpRegOffset = 0x8;
-                       ATEN2011_port->ControlRegOffset = 0x9;
-                       ATEN2011_port->DcrRegOffset = 0x16;
-               } else if ((ATEN2011_port->port_num == 2)
-                          && (ATEN2011_serial->ATEN2011_spectrum_2or4ports ==
-                              2)) {
-                       ATEN2011_port->SpRegOffset = 0xa;
-                       ATEN2011_port->ControlRegOffset = 0xb;
-                       ATEN2011_port->DcrRegOffset = 0x19;
-               } else if ((ATEN2011_port->port_num == 3)
-                          && (ATEN2011_serial->ATEN2011_spectrum_2or4ports ==
-                              4)) {
-                       ATEN2011_port->SpRegOffset = 0xa;
-                       ATEN2011_port->ControlRegOffset = 0xb;
-                       ATEN2011_port->DcrRegOffset = 0x19;
-               } else if ((ATEN2011_port->port_num == 4)
-                          && (ATEN2011_serial->ATEN2011_spectrum_2or4ports ==
-                              4)) {
-                       ATEN2011_port->SpRegOffset = 0xc;
-                       ATEN2011_port->ControlRegOffset = 0xd;
-                       ATEN2011_port->DcrRegOffset = 0x1c;
-               }
-
-               usb_set_serial_port_data(serial->port[i], ATEN2011_port);
-
-               /* enable rx_disable bit in control register */
-
-               status = get_reg_sync(serial->port[i],
-                                     ATEN2011_port->ControlRegOffset, &Data);
-               if (status < 0) {
-                       dbg("Reading ControlReg failed status-0x%x",
-                               status);
-                       break;
-               } else
-                       dbg
-                           ("ControlReg Reading success val is %x, status%d",
-                            Data, status);
-               Data |= 0x08;   /* setting driver done bit */
-               Data |= 0x04;   /* sp1_bit to have cts change reflect in modem status reg */
-
-               /* Data |= 0x20; */     /* rx_disable bit */
-               status = set_reg_sync(serial->port[i],
-                                     ATEN2011_port->ControlRegOffset, Data);
-               if (status < 0) {
-                       dbg
-                           ("Writing ControlReg failed(rx_disable) status-0x%x",
-                            status);
-                       break;
-               } else
-                       dbg
-                           ("ControlReg Writing success(rx_disable) status%d",
-                            status);
-
-               /*
-                * Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2
-                * and 0x24 in DCR3
-                */
-               Data = 0x01;
-               status = set_reg_sync(serial->port[i],
-                                     (__u16)(ATEN2011_port->DcrRegOffset + 0),
-                                     Data);
-               if (status < 0) {
-                       dbg("Writing DCR0 failed status-0x%x", status);
-                       break;
-               } else
-                       dbg("DCR0 Writing success status%d", status);
-
-               Data = 0x05;
-               status = set_reg_sync(serial->port[i],
-                                     (__u16)(ATEN2011_port->DcrRegOffset + 1),
-                                     Data);
-               if (status < 0) {
-                       dbg("Writing DCR1 failed status-0x%x", status);
-                       break;
-               } else
-                       dbg("DCR1 Writing success status%d", status);
-
-               Data = 0x24;
-               status = set_reg_sync(serial->port[i],
-                                     (__u16)(ATEN2011_port->DcrRegOffset + 2),
-                                     Data);
-               if (status < 0) {
-                       dbg("Writing DCR2 failed status-0x%x", status);
-                       break;
-               } else
-                       dbg("DCR2 Writing success status%d", status);
-
-               /* write values in clkstart0x0 and clkmulti 0x20 */
-               Data = 0x0;
-               status = set_reg_sync(serial->port[i], CLK_START_VALUE_REGISTER,
-                                     Data);
-               if (status < 0) {
-                       dbg
-                           ("Writing CLK_START_VALUE_REGISTER failed status-0x%x",
-                            status);
-                       break;
-               } else
-                       dbg
-                           ("CLK_START_VALUE_REGISTER Writing success status%d",
-                            status);
-
-               Data = 0x20;
-               status = set_reg_sync(serial->port[i], CLK_MULTI_REGISTER,
-                                     Data);
-               if (status < 0) {
-                       dbg
-                           ("Writing CLK_MULTI_REGISTER failed status-0x%x",
-                            status);
-                       break;
-               } else
-                       dbg("CLK_MULTI_REGISTER Writing success status%d",
-                               status);
-
-               /* Zero Length flag register */
-               if ((ATEN2011_port->port_num != 1)
-                   && (ATEN2011_serial->ATEN2011_spectrum_2or4ports == 2)) {
-
-                       Data = 0xff;
-                       status = set_reg_sync(serial->port[i],
-                                             (__u16)(ZLP_REG1 + ((__u16)ATEN2011_port->port_num)),
-                                             Data);
-                       dbg("ZLIP offset%x",
-                               (__u16) (ZLP_REG1 +
-                                        ((__u16) ATEN2011_port->port_num)));
-                       if (status < 0) {
-                               dbg
-                                   ("Writing ZLP_REG%d failed status-0x%x",
-                                    i + 2, status);
-                               break;
-                       } else
-                               dbg("ZLP_REG%d Writing success status%d",
-                                       i + 2, status);
-               } else {
-                       Data = 0xff;
-                       status = set_reg_sync(serial->port[i],
-                                             (__u16)(ZLP_REG1 + ((__u16)ATEN2011_port->port_num) - 0x1),
-                                             Data);
-                       dbg("ZLIP offset%x",
-                               (__u16) (ZLP_REG1 +
-                                        ((__u16) ATEN2011_port->port_num) -
-                                        0x1));
-                       if (status < 0) {
-                               dbg
-                                   ("Writing ZLP_REG%d failed status-0x%x",
-                                    i + 1, status);
-                               break;
-                       } else
-                               dbg("ZLP_REG%d Writing success status%d",
-                                       i + 1, status);
-
-               }
-               ATEN2011_port->control_urb = usb_alloc_urb(0, GFP_ATOMIC);
-               ATEN2011_port->ctrl_buf = kmalloc(16, GFP_KERNEL);
-
-       }
-
-       /* Zero Length flag enable */
-       Data = 0x0f;
-       status = set_reg_sync(serial->port[0], ZLP_REG5, Data);
-       if (status < 0) {
-               dbg("Writing ZLP_REG5 failed status-0x%x", status);
-               return -1;
-       } else
-               dbg("ZLP_REG5 Writing success status%d", status);
-
-       /* setting configuration feature to one */
-       usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
-                       (__u8) 0x03, 0x00, 0x01, 0x00, NULL, 0x00, 5 * HZ);
-       return 0;
-}
-
-static void ATEN2011_release(struct usb_serial *serial)
-{
-       int i;
-       struct ATENINTL_port *ATEN2011_port;
-
-       /* check for the ports to be closed,close the ports and disconnect */
-
-       /* free private structure allocated for serial port  *
-        * stop reads and writes on all ports                */
-
-       for (i = 0; i < serial->num_ports; ++i) {
-               ATEN2011_port = usb_get_serial_port_data(serial->port[i]);
-               kfree(ATEN2011_port->ctrl_buf);
-               usb_kill_urb(ATEN2011_port->control_urb);
-               kfree(ATEN2011_port);
-               usb_set_serial_port_data(serial->port[i], NULL);
-       }
-
-       /* free private structure allocated for serial device */
-
-       kfree(usb_get_serial_data(serial));
-       usb_set_serial_data(serial, NULL);
-}
-
-static struct usb_serial_driver aten_serial_driver = {
-       .driver = {
-               .owner =        THIS_MODULE,
-               .name =         "aten2011",
-               },
-       .description =          DRIVER_DESC,
-       .id_table =             id_table,
-       .open =                 ATEN2011_open,
-       .close =                ATEN2011_close,
-       .write =                ATEN2011_write,
-       .write_room =           ATEN2011_write_room,
-       .chars_in_buffer =      ATEN2011_chars_in_buffer,
-       .throttle =             ATEN2011_throttle,
-       .unthrottle =           ATEN2011_unthrottle,
-       .calc_num_ports =       ATEN2011_calc_num_ports,
-
-       .ioctl =                ATEN2011_ioctl,
-       .set_termios =          ATEN2011_set_termios,
-       .break_ctl =            ATEN2011_break,
-       .tiocmget =             ATEN2011_tiocmget,
-       .tiocmset =             ATEN2011_tiocmset,
-       .attach =               ATEN2011_startup,
-       .release =              ATEN2011_release,
-       .read_bulk_callback =   ATEN2011_bulk_in_callback,
-       .read_int_callback =    ATEN2011_interrupt_callback,
-};
-
-static struct usb_driver aten_driver = {
-       .name =         "aten2011",
-       .probe =        usb_serial_probe,
-       .disconnect =   usb_serial_disconnect,
-       .id_table =     id_table,
-};
-
-static int __init aten_init(void)
-{
-       int retval;
-
-       /* Register with the usb serial */
-       retval = usb_serial_register(&aten_serial_driver);
-       if (retval)
-               return retval;
-
-       printk(KERN_INFO KBUILD_MODNAME ":"
-              DRIVER_DESC " " DRIVER_VERSION "\n");
-
-       /* Register with the usb */
-       retval = usb_register(&aten_driver);
-       if (retval)
-               usb_serial_deregister(&aten_serial_driver);
-
-       return retval;
-}
-
-static void __exit aten_exit(void)
-{
-       usb_deregister(&aten_driver);
-       usb_serial_deregister(&aten_serial_driver);
-}
-
-module_init(aten_init);
-module_exit(aten_exit);
-
-/* Module information */
-MODULE_DESCRIPTION(DRIVER_DESC);
-MODULE_LICENSE("GPL");
-
-MODULE_PARM_DESC(debug, "Debug enabled or not");
index 0ab9d15f3439085c4d39bd2d1e5ecab694657a86..f5416af1e902a8a447dcffbbcb47d928deff4e3a 100644 (file)
@@ -21,6 +21,7 @@
 #include <linux/mm.h>
 #include <linux/fb.h>
 #include <linux/mutex.h>
+#include <linux/vmalloc.h>
 
 #include "udlfb.h"
 
index 24dfb33f90cb0fbc2268572ee0ed90ecc15efbb5..a16c538d0132958ab330b6993267663d45d4c4ef 100644 (file)
@@ -80,38 +80,18 @@ static int usb_parse_ss_endpoint_companion(struct device *ddev, int cfgno,
        int max_tx;
        int i;
 
-       /* Allocate space for the SS endpoint companion descriptor */
-       ep->ss_ep_comp = kzalloc(sizeof(struct usb_host_ss_ep_comp),
-                       GFP_KERNEL);
-       if (!ep->ss_ep_comp)
-               return -ENOMEM;
        desc = (struct usb_ss_ep_comp_descriptor *) buffer;
        if (desc->bDescriptorType != USB_DT_SS_ENDPOINT_COMP) {
                dev_warn(ddev, "No SuperSpeed endpoint companion for config %d "
                                " interface %d altsetting %d ep %d: "
                                "using minimum values\n",
                                cfgno, inum, asnum, ep->desc.bEndpointAddress);
-               ep->ss_ep_comp->desc.bLength = USB_DT_SS_EP_COMP_SIZE;
-               ep->ss_ep_comp->desc.bDescriptorType = USB_DT_SS_ENDPOINT_COMP;
-               ep->ss_ep_comp->desc.bMaxBurst = 0;
-               /*
-                * Leave bmAttributes as zero, which will mean no streams for
-                * bulk, and isoc won't support multiple bursts of packets.
-                * With bursts of only one packet, and a Mult of 1, the max
-                * amount of data moved per endpoint service interval is one
-                * packet.
-                */
-               if (usb_endpoint_xfer_isoc(&ep->desc) ||
-                               usb_endpoint_xfer_int(&ep->desc))
-                       ep->ss_ep_comp->desc.wBytesPerInterval =
-                               ep->desc.wMaxPacketSize;
                /*
                 * The next descriptor is for an Endpoint or Interface,
                 * no extra descriptors to copy into the companion structure,
                 * and we didn't eat up any of the buffer.
                 */
-               retval = 0;
-               goto valid;
+               return 0;
        }
        memcpy(&ep->ss_ep_comp->desc, desc, USB_DT_SS_EP_COMP_SIZE);
        desc = &ep->ss_ep_comp->desc;
@@ -320,6 +300,28 @@ static int usb_parse_endpoint(struct device *ddev, int cfgno, int inum,
                buffer += i;
                size -= i;
 
+               /* Allocate space for the SS endpoint companion descriptor */
+               endpoint->ss_ep_comp = kzalloc(sizeof(struct usb_host_ss_ep_comp),
+                               GFP_KERNEL);
+               if (!endpoint->ss_ep_comp)
+                       return -ENOMEM;
+
+               /* Fill in some default values (may be overwritten later) */
+               endpoint->ss_ep_comp->desc.bLength = USB_DT_SS_EP_COMP_SIZE;
+               endpoint->ss_ep_comp->desc.bDescriptorType = USB_DT_SS_ENDPOINT_COMP;
+               endpoint->ss_ep_comp->desc.bMaxBurst = 0;
+               /*
+                * Leave bmAttributes as zero, which will mean no streams for
+                * bulk, and isoc won't support multiple bursts of packets.
+                * With bursts of only one packet, and a Mult of 1, the max
+                * amount of data moved per endpoint service interval is one
+                * packet.
+                */
+               if (usb_endpoint_xfer_isoc(&endpoint->desc) ||
+                               usb_endpoint_xfer_int(&endpoint->desc))
+                       endpoint->ss_ep_comp->desc.wBytesPerInterval =
+                               endpoint->desc.wMaxPacketSize;
+
                if (size > 0) {
                        retval = usb_parse_ss_endpoint_companion(ddev, cfgno,
                                        inum, asnum, endpoint, num_ep, buffer,
@@ -329,6 +331,10 @@ static int usb_parse_endpoint(struct device *ddev, int cfgno, int inum,
                                retval = buffer - buffer0;
                        }
                } else {
+                       dev_warn(ddev, "config %d interface %d altsetting %d "
+                               "endpoint 0x%X has no "
+                               "SuperSpeed companion descriptor\n",
+                               cfgno, inum, asnum, d->bEndpointAddress);
                        retval = buffer - buffer0;
                }
        } else {
index dc2ac613a9d1c34e2942ff55bf639fcb9d0be29b..1d283e1b2b8de543e56f4e695e333383ee5d116d 100644 (file)
@@ -105,6 +105,7 @@ static int ehci_orion_setup(struct usb_hcd *hcd)
        struct ehci_hcd *ehci = hcd_to_ehci(hcd);
        int retval;
 
+       ehci_reset(ehci);
        retval = ehci_halt(ehci);
        if (retval)
                return retval;
@@ -118,7 +119,6 @@ static int ehci_orion_setup(struct usb_hcd *hcd)
 
        hcd->has_tt = 1;
 
-       ehci_reset(ehci);
        ehci_port_power(ehci, 0);
 
        return retval;
index f3aaba35e912fba4e021e3a6fcf7dd1c22d1153f..83cbecd2a1ed7177029d8f52b7a512b959f9e2b1 100644 (file)
@@ -282,6 +282,7 @@ static int ohci_omap_init(struct usb_hcd *hcd)
 static void ohci_omap_stop(struct usb_hcd *hcd)
 {
        dev_dbg(hcd->self.controller, "stopping USB Controller\n");
+       ohci_stop(hcd);
        omap_ohci_clock_power(0);
 }
 
index 2501c571f855263f21200265888d58602deac86f..705e34324156f069ce4d56f7e596732bbc2fcc93 100644 (file)
@@ -173,6 +173,7 @@ void xhci_print_ir_set(struct xhci_hcd *xhci, struct xhci_intr_reg *ir_set, int
 {
        void *addr;
        u32 temp;
+       u64 temp_64;
 
        addr = &ir_set->irq_pending;
        temp = xhci_readl(xhci, addr);
@@ -200,25 +201,15 @@ void xhci_print_ir_set(struct xhci_hcd *xhci, struct xhci_intr_reg *ir_set, int
                xhci_dbg(xhci, "  WARN: %p: ir_set.rsvd = 0x%x\n",
                                addr, (unsigned int)temp);
 
-       addr = &ir_set->erst_base[0];
-       temp = xhci_readl(xhci, addr);
-       xhci_dbg(xhci, "  %p: ir_set.erst_base[0] = 0x%x\n",
-                       addr, (unsigned int) temp);
-
-       addr = &ir_set->erst_base[1];
-       temp = xhci_readl(xhci, addr);
-       xhci_dbg(xhci, "  %p: ir_set.erst_base[1] = 0x%x\n",
-                       addr, (unsigned int) temp);
+       addr = &ir_set->erst_base;
+       temp_64 = xhci_read_64(xhci, addr);
+       xhci_dbg(xhci, "  %p: ir_set.erst_base = @%08llx\n",
+                       addr, temp_64);
 
-       addr = &ir_set->erst_dequeue[0];
-       temp = xhci_readl(xhci, addr);
-       xhci_dbg(xhci, "  %p: ir_set.erst_dequeue[0] = 0x%x\n",
-                       addr, (unsigned int) temp);
-
-       addr = &ir_set->erst_dequeue[1];
-       temp = xhci_readl(xhci, addr);
-       xhci_dbg(xhci, "  %p: ir_set.erst_dequeue[1] = 0x%x\n",
-                       addr, (unsigned int) temp);
+       addr = &ir_set->erst_dequeue;
+       temp_64 = xhci_read_64(xhci, addr);
+       xhci_dbg(xhci, "  %p: ir_set.erst_dequeue = @%08llx\n",
+                       addr, temp_64);
 }
 
 void xhci_print_run_regs(struct xhci_hcd *xhci)
@@ -268,8 +259,7 @@ void xhci_debug_trb(struct xhci_hcd *xhci, union xhci_trb *trb)
                xhci_dbg(xhci, "Link TRB:\n");
                xhci_print_trb_offsets(xhci, trb);
 
-               address = trb->link.segment_ptr[0] +
-                       (((u64) trb->link.segment_ptr[1]) << 32);
+               address = trb->link.segment_ptr;
                xhci_dbg(xhci, "Next ring segment DMA address = 0x%llx\n", address);
 
                xhci_dbg(xhci, "Interrupter target = 0x%x\n",
@@ -282,8 +272,7 @@ void xhci_debug_trb(struct xhci_hcd *xhci, union xhci_trb *trb)
                                (unsigned int) (trb->link.control & TRB_NO_SNOOP));
                break;
        case TRB_TYPE(TRB_TRANSFER):
-               address = trb->trans_event.buffer[0] +
-                       (((u64) trb->trans_event.buffer[1]) << 32);
+               address = trb->trans_event.buffer;
                /*
                 * FIXME: look at flags to figure out if it's an address or if
                 * the data is directly in the buffer field.
@@ -291,8 +280,7 @@ void xhci_debug_trb(struct xhci_hcd *xhci, union xhci_trb *trb)
                xhci_dbg(xhci, "DMA address or buffer contents= %llu\n", address);
                break;
        case TRB_TYPE(TRB_COMPLETION):
-               address = trb->event_cmd.cmd_trb[0] +
-                       (((u64) trb->event_cmd.cmd_trb[1]) << 32);
+               address = trb->event_cmd.cmd_trb;
                xhci_dbg(xhci, "Command TRB pointer = %llu\n", address);
                xhci_dbg(xhci, "Completion status = %u\n",
                                (unsigned int) GET_COMP_CODE(trb->event_cmd.status));
@@ -328,8 +316,8 @@ void xhci_debug_segment(struct xhci_hcd *xhci, struct xhci_segment *seg)
        for (i = 0; i < TRBS_PER_SEGMENT; ++i) {
                trb = &seg->trbs[i];
                xhci_dbg(xhci, "@%08x %08x %08x %08x %08x\n", addr,
-                               (unsigned int) trb->link.segment_ptr[0],
-                               (unsigned int) trb->link.segment_ptr[1],
+                               lower_32_bits(trb->link.segment_ptr),
+                               upper_32_bits(trb->link.segment_ptr),
                                (unsigned int) trb->link.intr_target,
                                (unsigned int) trb->link.control);
                addr += sizeof(*trb);
@@ -386,8 +374,8 @@ void xhci_dbg_erst(struct xhci_hcd *xhci, struct xhci_erst *erst)
                entry = &erst->entries[i];
                xhci_dbg(xhci, "@%08x %08x %08x %08x %08x\n",
                                (unsigned int) addr,
-                               (unsigned int) entry->seg_addr[0],
-                               (unsigned int) entry->seg_addr[1],
+                               lower_32_bits(entry->seg_addr),
+                               upper_32_bits(entry->seg_addr),
                                (unsigned int) entry->seg_size,
                                (unsigned int) entry->rsvd);
                addr += sizeof(*entry);
@@ -396,90 +384,147 @@ void xhci_dbg_erst(struct xhci_hcd *xhci, struct xhci_erst *erst)
 
 void xhci_dbg_cmd_ptrs(struct xhci_hcd *xhci)
 {
-       u32 val;
+       u64 val;
 
-       val = xhci_readl(xhci, &xhci->op_regs->cmd_ring[0]);
-       xhci_dbg(xhci, "// xHC command ring deq ptr low bits + flags = 0x%x\n", val);
-       val = xhci_readl(xhci, &xhci->op_regs->cmd_ring[1]);
-       xhci_dbg(xhci, "// xHC command ring deq ptr high bits = 0x%x\n", val);
+       val = xhci_read_64(xhci, &xhci->op_regs->cmd_ring);
+       xhci_dbg(xhci, "// xHC command ring deq ptr low bits + flags = @%08x\n",
+                       lower_32_bits(val));
+       xhci_dbg(xhci, "// xHC command ring deq ptr high bits = @%08x\n",
+                       upper_32_bits(val));
 }
 
-void xhci_dbg_ctx(struct xhci_hcd *xhci, struct xhci_device_control *ctx, dma_addr_t dma, unsigned int last_ep)
+/* Print the last 32 bytes for 64-byte contexts */
+static void dbg_rsvd64(struct xhci_hcd *xhci, u64 *ctx, dma_addr_t dma)
+{
+       int i;
+       for (i = 0; i < 4; ++i) {
+               xhci_dbg(xhci, "@%p (virt) @%08llx "
+                        "(dma) %#08llx - rsvd64[%d]\n",
+                        &ctx[4 + i], (unsigned long long)dma,
+                        ctx[4 + i], i);
+               dma += 8;
+       }
+}
+
+void xhci_dbg_slot_ctx(struct xhci_hcd *xhci, struct xhci_container_ctx *ctx)
 {
-       int i, j;
-       int last_ep_ctx = 31;
        /* Fields are 32 bits wide, DMA addresses are in bytes */
        int field_size = 32 / 8;
+       int i;
 
-       xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - drop flags\n",
-                       &ctx->drop_flags, (unsigned long long)dma,
-                       ctx->drop_flags);
-       dma += field_size;
-       xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - add flags\n",
-                       &ctx->add_flags, (unsigned long long)dma,
-                       ctx->add_flags);
-       dma += field_size;
-       for (i = 0; i > 6; ++i) {
-               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - rsvd[%d]\n",
-                               &ctx->rsvd[i], (unsigned long long)dma,
-                               ctx->rsvd[i], i);
-               dma += field_size;
-       }
+       struct xhci_slot_ctx *slot_ctx = xhci_get_slot_ctx(xhci, ctx);
+       dma_addr_t dma = ctx->dma + ((unsigned long)slot_ctx - (unsigned long)ctx);
+       int csz = HCC_64BYTE_CONTEXT(xhci->hcc_params);
 
        xhci_dbg(xhci, "Slot Context:\n");
        xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - dev_info\n",
-                       &ctx->slot.dev_info,
-                       (unsigned long long)dma, ctx->slot.dev_info);
+                       &slot_ctx->dev_info,
+                       (unsigned long long)dma, slot_ctx->dev_info);
        dma += field_size;
        xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - dev_info2\n",
-                       &ctx->slot.dev_info2,
-                       (unsigned long long)dma, ctx->slot.dev_info2);
+                       &slot_ctx->dev_info2,
+                       (unsigned long long)dma, slot_ctx->dev_info2);
        dma += field_size;
        xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - tt_info\n",
-                       &ctx->slot.tt_info,
-                       (unsigned long long)dma, ctx->slot.tt_info);
+                       &slot_ctx->tt_info,
+                       (unsigned long long)dma, slot_ctx->tt_info);
        dma += field_size;
        xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - dev_state\n",
-                       &ctx->slot.dev_state,
-                       (unsigned long long)dma, ctx->slot.dev_state);
+                       &slot_ctx->dev_state,
+                       (unsigned long long)dma, slot_ctx->dev_state);
        dma += field_size;
-       for (i = 0; i > 4; ++i) {
+       for (i = 0; i < 4; ++i) {
                xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - rsvd[%d]\n",
-                               &ctx->slot.reserved[i], (unsigned long long)dma,
-                               ctx->slot.reserved[i], i);
+                               &slot_ctx->reserved[i], (unsigned long long)dma,
+                               slot_ctx->reserved[i], i);
                dma += field_size;
        }
 
+       if (csz)
+               dbg_rsvd64(xhci, (u64 *)slot_ctx, dma);
+}
+
+void xhci_dbg_ep_ctx(struct xhci_hcd *xhci,
+                    struct xhci_container_ctx *ctx,
+                    unsigned int last_ep)
+{
+       int i, j;
+       int last_ep_ctx = 31;
+       /* Fields are 32 bits wide, DMA addresses are in bytes */
+       int field_size = 32 / 8;
+       int csz = HCC_64BYTE_CONTEXT(xhci->hcc_params);
+
        if (last_ep < 31)
                last_ep_ctx = last_ep + 1;
        for (i = 0; i < last_ep_ctx; ++i) {
+               struct xhci_ep_ctx *ep_ctx = xhci_get_ep_ctx(xhci, ctx, i);
+               dma_addr_t dma = ctx->dma +
+                       ((unsigned long)ep_ctx - (unsigned long)ctx);
+
                xhci_dbg(xhci, "Endpoint %02d Context:\n", i);
                xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - ep_info\n",
-                               &ctx->ep[i].ep_info,
-                               (unsigned long long)dma, ctx->ep[i].ep_info);
+                               &ep_ctx->ep_info,
+                               (unsigned long long)dma, ep_ctx->ep_info);
                dma += field_size;
                xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - ep_info2\n",
-                               &ctx->ep[i].ep_info2,
-                               (unsigned long long)dma, ctx->ep[i].ep_info2);
-               dma += field_size;
-               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - deq[0]\n",
-                               &ctx->ep[i].deq[0],
-                               (unsigned long long)dma, ctx->ep[i].deq[0]);
-               dma += field_size;
-               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - deq[1]\n",
-                               &ctx->ep[i].deq[1],
-                               (unsigned long long)dma, ctx->ep[i].deq[1]);
+                               &ep_ctx->ep_info2,
+                               (unsigned long long)dma, ep_ctx->ep_info2);
                dma += field_size;
+               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08llx - deq\n",
+                               &ep_ctx->deq,
+                               (unsigned long long)dma, ep_ctx->deq);
+               dma += 2*field_size;
                xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - tx_info\n",
-                               &ctx->ep[i].tx_info,
-                               (unsigned long long)dma, ctx->ep[i].tx_info);
+                               &ep_ctx->tx_info,
+                               (unsigned long long)dma, ep_ctx->tx_info);
                dma += field_size;
                for (j = 0; j < 3; ++j) {
                        xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - rsvd[%d]\n",
-                                       &ctx->ep[i].reserved[j],
+                                       &ep_ctx->reserved[j],
                                        (unsigned long long)dma,
-                                       ctx->ep[i].reserved[j], j);
+                                       ep_ctx->reserved[j], j);
+                       dma += field_size;
+               }
+
+               if (csz)
+                       dbg_rsvd64(xhci, (u64 *)ep_ctx, dma);
+       }
+}
+
+void xhci_dbg_ctx(struct xhci_hcd *xhci,
+                 struct xhci_container_ctx *ctx,
+                 unsigned int last_ep)
+{
+       int i;
+       /* Fields are 32 bits wide, DMA addresses are in bytes */
+       int field_size = 32 / 8;
+       struct xhci_slot_ctx *slot_ctx;
+       dma_addr_t dma = ctx->dma;
+       int csz = HCC_64BYTE_CONTEXT(xhci->hcc_params);
+
+       if (ctx->type == XHCI_CTX_TYPE_INPUT) {
+               struct xhci_input_control_ctx *ctrl_ctx =
+                       xhci_get_input_control_ctx(xhci, ctx);
+               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - drop flags\n",
+                        &ctrl_ctx->drop_flags, (unsigned long long)dma,
+                        ctrl_ctx->drop_flags);
+               dma += field_size;
+               xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - add flags\n",
+                        &ctrl_ctx->add_flags, (unsigned long long)dma,
+                        ctrl_ctx->add_flags);
+               dma += field_size;
+               for (i = 0; i < 6; ++i) {
+                       xhci_dbg(xhci, "@%p (virt) @%08llx (dma) %#08x - rsvd2[%d]\n",
+                                &ctrl_ctx->rsvd2[i], (unsigned long long)dma,
+                                ctrl_ctx->rsvd2[i], i);
                        dma += field_size;
                }
+
+               if (csz)
+                       dbg_rsvd64(xhci, (u64 *)ctrl_ctx, dma);
        }
+
+       slot_ctx = xhci_get_slot_ctx(xhci, ctx);
+       xhci_dbg_slot_ctx(xhci, ctx);
+       xhci_dbg_ep_ctx(xhci, ctx, last_ep);
 }
index dba3e07ccd09a1098660fb5c4a17c921deefc483..816c39caca1cf6bf5e1ca9b4a9c8c5d03684fcf3 100644 (file)
@@ -103,7 +103,10 @@ int xhci_reset(struct xhci_hcd *xhci)
        u32 state;
 
        state = xhci_readl(xhci, &xhci->op_regs->status);
-       BUG_ON((state & STS_HALT) == 0);
+       if ((state & STS_HALT) == 0) {
+               xhci_warn(xhci, "Host controller not halted, aborting reset.\n");
+               return 0;
+       }
 
        xhci_dbg(xhci, "// Reset the HC\n");
        command = xhci_readl(xhci, &xhci->op_regs->command);
@@ -226,6 +229,7 @@ int xhci_init(struct usb_hcd *hcd)
 static void xhci_work(struct xhci_hcd *xhci)
 {
        u32 temp;
+       u64 temp_64;
 
        /*
         * Clear the op reg interrupt status first,
@@ -248,9 +252,9 @@ static void xhci_work(struct xhci_hcd *xhci)
        /* FIXME this should be a delayed service routine that clears the EHB */
        xhci_handle_event(xhci);
 
-       /* Clear the event handler busy flag; the event ring should be empty. */
-       temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
-       xhci_writel(xhci, temp & ~ERST_EHB, &xhci->ir_set->erst_dequeue[0]);
+       /* Clear the event handler busy flag (RW1C); the event ring should be empty. */
+       temp_64 = xhci_read_64(xhci, &xhci->ir_set->erst_dequeue);
+       xhci_write_64(xhci, temp_64 | ERST_EHB, &xhci->ir_set->erst_dequeue);
        /* Flush posted writes -- FIXME is this necessary? */
        xhci_readl(xhci, &xhci->ir_set->irq_pending);
 }
@@ -266,19 +270,34 @@ irqreturn_t xhci_irq(struct usb_hcd *hcd)
 {
        struct xhci_hcd *xhci = hcd_to_xhci(hcd);
        u32 temp, temp2;
+       union xhci_trb *trb;
 
        spin_lock(&xhci->lock);
+       trb = xhci->event_ring->dequeue;
        /* Check if the xHC generated the interrupt, or the irq is shared */
        temp = xhci_readl(xhci, &xhci->op_regs->status);
        temp2 = xhci_readl(xhci, &xhci->ir_set->irq_pending);
+       if (temp == 0xffffffff && temp2 == 0xffffffff)
+               goto hw_died;
+
        if (!(temp & STS_EINT) && !ER_IRQ_PENDING(temp2)) {
                spin_unlock(&xhci->lock);
                return IRQ_NONE;
        }
+       xhci_dbg(xhci, "op reg status = %08x\n", temp);
+       xhci_dbg(xhci, "ir set irq_pending = %08x\n", temp2);
+       xhci_dbg(xhci, "Event ring dequeue ptr:\n");
+       xhci_dbg(xhci, "@%llx %08x %08x %08x %08x\n",
+                       (unsigned long long)xhci_trb_virt_to_dma(xhci->event_ring->deq_seg, trb),
+                       lower_32_bits(trb->link.segment_ptr),
+                       upper_32_bits(trb->link.segment_ptr),
+                       (unsigned int) trb->link.intr_target,
+                       (unsigned int) trb->link.control);
 
        if (temp & STS_FATAL) {
                xhci_warn(xhci, "WARNING: Host System Error\n");
                xhci_halt(xhci);
+hw_died:
                xhci_to_hcd(xhci)->state = HC_STATE_HALT;
                spin_unlock(&xhci->lock);
                return -ESHUTDOWN;
@@ -295,6 +314,7 @@ void xhci_event_ring_work(unsigned long arg)
 {
        unsigned long flags;
        int temp;
+       u64 temp_64;
        struct xhci_hcd *xhci = (struct xhci_hcd *) arg;
        int i, j;
 
@@ -311,9 +331,9 @@ void xhci_event_ring_work(unsigned long arg)
        xhci_dbg(xhci, "Event ring:\n");
        xhci_debug_segment(xhci, xhci->event_ring->deq_seg);
        xhci_dbg_ring_ptrs(xhci, xhci->event_ring);
-       temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
-       temp &= ERST_PTR_MASK;
-       xhci_dbg(xhci, "ERST deq = 0x%x\n", temp);
+       temp_64 = xhci_read_64(xhci, &xhci->ir_set->erst_dequeue);
+       temp_64 &= ~ERST_PTR_MASK;
+       xhci_dbg(xhci, "ERST deq = 64'h%0lx\n", (long unsigned int) temp_64);
        xhci_dbg(xhci, "Command ring:\n");
        xhci_debug_segment(xhci, xhci->cmd_ring->deq_seg);
        xhci_dbg_ring_ptrs(xhci, xhci->cmd_ring);
@@ -356,6 +376,7 @@ void xhci_event_ring_work(unsigned long arg)
 int xhci_run(struct usb_hcd *hcd)
 {
        u32 temp;
+       u64 temp_64;
        struct xhci_hcd *xhci = hcd_to_xhci(hcd);
        void (*doorbell)(struct xhci_hcd *) = NULL;
 
@@ -382,6 +403,20 @@ int xhci_run(struct usb_hcd *hcd)
        add_timer(&xhci->event_ring_timer);
 #endif
 
+       xhci_dbg(xhci, "Command ring memory map follows:\n");
+       xhci_debug_ring(xhci, xhci->cmd_ring);
+       xhci_dbg_ring_ptrs(xhci, xhci->cmd_ring);
+       xhci_dbg_cmd_ptrs(xhci);
+
+       xhci_dbg(xhci, "ERST memory map follows:\n");
+       xhci_dbg_erst(xhci, &xhci->erst);
+       xhci_dbg(xhci, "Event ring:\n");
+       xhci_debug_ring(xhci, xhci->event_ring);
+       xhci_dbg_ring_ptrs(xhci, xhci->event_ring);
+       temp_64 = xhci_read_64(xhci, &xhci->ir_set->erst_dequeue);
+       temp_64 &= ~ERST_PTR_MASK;
+       xhci_dbg(xhci, "ERST deq = 64'h%0lx\n", (long unsigned int) temp_64);
+
        xhci_dbg(xhci, "// Set the interrupt modulation register\n");
        temp = xhci_readl(xhci, &xhci->ir_set->irq_control);
        temp &= ~ER_IRQ_INTERVAL_MASK;
@@ -406,22 +441,6 @@ int xhci_run(struct usb_hcd *hcd)
        if (NUM_TEST_NOOPS > 0)
                doorbell = xhci_setup_one_noop(xhci);
 
-       xhci_dbg(xhci, "Command ring memory map follows:\n");
-       xhci_debug_ring(xhci, xhci->cmd_ring);
-       xhci_dbg_ring_ptrs(xhci, xhci->cmd_ring);
-       xhci_dbg_cmd_ptrs(xhci);
-
-       xhci_dbg(xhci, "ERST memory map follows:\n");
-       xhci_dbg_erst(xhci, &xhci->erst);
-       xhci_dbg(xhci, "Event ring:\n");
-       xhci_debug_ring(xhci, xhci->event_ring);
-       xhci_dbg_ring_ptrs(xhci, xhci->event_ring);
-       temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
-       temp &= ERST_PTR_MASK;
-       xhci_dbg(xhci, "ERST deq = 0x%x\n", temp);
-       temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[1]);
-       xhci_dbg(xhci, "ERST deq upper = 0x%x\n", temp);
-
        temp = xhci_readl(xhci, &xhci->op_regs->command);
        temp |= (CMD_RUN);
        xhci_dbg(xhci, "// Turn on HC, cmd = 0x%x.\n",
@@ -601,10 +620,13 @@ int xhci_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags)
                goto exit;
        }
        if (usb_endpoint_xfer_control(&urb->ep->desc))
-               ret = xhci_queue_ctrl_tx(xhci, mem_flags, urb,
+               /* We have a spinlock and interrupts disabled, so we must pass
+                * atomic context to this function, which may allocate memory.
+                */
+               ret = xhci_queue_ctrl_tx(xhci, GFP_ATOMIC, urb,
                                slot_id, ep_index);
        else if (usb_endpoint_xfer_bulk(&urb->ep->desc))
-               ret = xhci_queue_bulk_tx(xhci, mem_flags, urb,
+               ret = xhci_queue_bulk_tx(xhci, GFP_ATOMIC, urb,
                                slot_id, ep_index);
        else
                ret = -EINVAL;
@@ -661,8 +683,12 @@ int xhci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
                goto done;
 
        xhci_dbg(xhci, "Cancel URB %p\n", urb);
+       xhci_dbg(xhci, "Event ring:\n");
+       xhci_debug_ring(xhci, xhci->event_ring);
        ep_index = xhci_get_endpoint_index(&urb->ep->desc);
        ep_ring = xhci->devs[urb->dev->slot_id]->ep_rings[ep_index];
+       xhci_dbg(xhci, "Endpoint ring:\n");
+       xhci_debug_ring(xhci, ep_ring);
        td = (struct xhci_td *) urb->hcpriv;
 
        ep_ring->cancels_pending++;
@@ -696,7 +722,9 @@ int xhci_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
                struct usb_host_endpoint *ep)
 {
        struct xhci_hcd *xhci;
-       struct xhci_device_control *in_ctx;
+       struct xhci_container_ctx *in_ctx, *out_ctx;
+       struct xhci_input_control_ctx *ctrl_ctx;
+       struct xhci_slot_ctx *slot_ctx;
        unsigned int last_ctx;
        unsigned int ep_index;
        struct xhci_ep_ctx *ep_ctx;
@@ -724,31 +752,34 @@ int xhci_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
        }
 
        in_ctx = xhci->devs[udev->slot_id]->in_ctx;
+       out_ctx = xhci->devs[udev->slot_id]->out_ctx;
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, in_ctx);
        ep_index = xhci_get_endpoint_index(&ep->desc);
-       ep_ctx = &xhci->devs[udev->slot_id]->out_ctx->ep[ep_index];
+       ep_ctx = xhci_get_ep_ctx(xhci, out_ctx, ep_index);
        /* If the HC already knows the endpoint is disabled,
         * or the HCD has noted it is disabled, ignore this request
         */
        if ((ep_ctx->ep_info & EP_STATE_MASK) == EP_STATE_DISABLED ||
-                       in_ctx->drop_flags & xhci_get_endpoint_flag(&ep->desc)) {
+                       ctrl_ctx->drop_flags & xhci_get_endpoint_flag(&ep->desc)) {
                xhci_warn(xhci, "xHCI %s called with disabled ep %p\n",
                                __func__, ep);
                return 0;
        }
 
-       in_ctx->drop_flags |= drop_flag;
-       new_drop_flags = in_ctx->drop_flags;
+       ctrl_ctx->drop_flags |= drop_flag;
+       new_drop_flags = ctrl_ctx->drop_flags;
 
-       in_ctx->add_flags = ~drop_flag;
-       new_add_flags = in_ctx->add_flags;
+       ctrl_ctx->add_flags = ~drop_flag;
+       new_add_flags = ctrl_ctx->add_flags;
 
-       last_ctx = xhci_last_valid_endpoint(in_ctx->add_flags);
+       last_ctx = xhci_last_valid_endpoint(ctrl_ctx->add_flags);
+       slot_ctx = xhci_get_slot_ctx(xhci, in_ctx);
        /* Update the last valid endpoint context, if we deleted the last one */
-       if ((in_ctx->slot.dev_info & LAST_CTX_MASK) > LAST_CTX(last_ctx)) {
-               in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
-               in_ctx->slot.dev_info |= LAST_CTX(last_ctx);
+       if ((slot_ctx->dev_info & LAST_CTX_MASK) > LAST_CTX(last_ctx)) {
+               slot_ctx->dev_info &= ~LAST_CTX_MASK;
+               slot_ctx->dev_info |= LAST_CTX(last_ctx);
        }
-       new_slot_info = in_ctx->slot.dev_info;
+       new_slot_info = slot_ctx->dev_info;
 
        xhci_endpoint_zero(xhci, xhci->devs[udev->slot_id], ep);
 
@@ -778,17 +809,22 @@ int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
                struct usb_host_endpoint *ep)
 {
        struct xhci_hcd *xhci;
-       struct xhci_device_control *in_ctx;
+       struct xhci_container_ctx *in_ctx, *out_ctx;
        unsigned int ep_index;
        struct xhci_ep_ctx *ep_ctx;
+       struct xhci_slot_ctx *slot_ctx;
+       struct xhci_input_control_ctx *ctrl_ctx;
        u32 added_ctxs;
        unsigned int last_ctx;
        u32 new_add_flags, new_drop_flags, new_slot_info;
        int ret = 0;
 
        ret = xhci_check_args(hcd, udev, ep, 1, __func__);
-       if (ret <= 0)
+       if (ret <= 0) {
+               /* So we won't queue a reset ep command for a root hub */
+               ep->hcpriv = NULL;
                return ret;
+       }
        xhci = hcd_to_xhci(hcd);
 
        added_ctxs = xhci_get_endpoint_flag(&ep->desc);
@@ -810,12 +846,14 @@ int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
        }
 
        in_ctx = xhci->devs[udev->slot_id]->in_ctx;
+       out_ctx = xhci->devs[udev->slot_id]->out_ctx;
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, in_ctx);
        ep_index = xhci_get_endpoint_index(&ep->desc);
-       ep_ctx = &xhci->devs[udev->slot_id]->out_ctx->ep[ep_index];
+       ep_ctx = xhci_get_ep_ctx(xhci, out_ctx, ep_index);
        /* If the HCD has already noted the endpoint is enabled,
         * ignore this request.
         */
-       if (in_ctx->add_flags & xhci_get_endpoint_flag(&ep->desc)) {
+       if (ctrl_ctx->add_flags & xhci_get_endpoint_flag(&ep->desc)) {
                xhci_warn(xhci, "xHCI %s called with enabled ep %p\n",
                                __func__, ep);
                return 0;
@@ -833,8 +871,8 @@ int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
                return -ENOMEM;
        }
 
-       in_ctx->add_flags |= added_ctxs;
-       new_add_flags = in_ctx->add_flags;
+       ctrl_ctx->add_flags |= added_ctxs;
+       new_add_flags = ctrl_ctx->add_flags;
 
        /* If xhci_endpoint_disable() was called for this endpoint, but the
         * xHC hasn't been notified yet through the check_bandwidth() call,
@@ -842,14 +880,18 @@ int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
         * descriptors.  We must drop and re-add this endpoint, so we leave the
         * drop flags alone.
         */
-       new_drop_flags = in_ctx->drop_flags;
+       new_drop_flags = ctrl_ctx->drop_flags;
 
+       slot_ctx = xhci_get_slot_ctx(xhci, in_ctx);
        /* Update the last valid endpoint context, if we just added one past */
-       if ((in_ctx->slot.dev_info & LAST_CTX_MASK) < LAST_CTX(last_ctx)) {
-               in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
-               in_ctx->slot.dev_info |= LAST_CTX(last_ctx);
+       if ((slot_ctx->dev_info & LAST_CTX_MASK) < LAST_CTX(last_ctx)) {
+               slot_ctx->dev_info &= ~LAST_CTX_MASK;
+               slot_ctx->dev_info |= LAST_CTX(last_ctx);
        }
-       new_slot_info = in_ctx->slot.dev_info;
+       new_slot_info = slot_ctx->dev_info;
+
+       /* Store the usb_device pointer for later use */
+       ep->hcpriv = udev;
 
        xhci_dbg(xhci, "add ep 0x%x, slot id %d, new drop flags = %#x, new add flags = %#x, new slot info = %#x\n",
                        (unsigned int) ep->desc.bEndpointAddress,
@@ -860,9 +902,11 @@ int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
        return 0;
 }
 
-static void xhci_zero_in_ctx(struct xhci_virt_device *virt_dev)
+static void xhci_zero_in_ctx(struct xhci_hcd *xhci, struct xhci_virt_device *virt_dev)
 {
+       struct xhci_input_control_ctx *ctrl_ctx;
        struct xhci_ep_ctx *ep_ctx;
+       struct xhci_slot_ctx *slot_ctx;
        int i;
 
        /* When a device's add flag and drop flag are zero, any subsequent
@@ -870,17 +914,18 @@ static void xhci_zero_in_ctx(struct xhci_virt_device *virt_dev)
         * untouched.  Make sure we don't leave any old state in the input
         * endpoint contexts.
         */
-       virt_dev->in_ctx->drop_flags = 0;
-       virt_dev->in_ctx->add_flags = 0;
-       virt_dev->in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, virt_dev->in_ctx);
+       ctrl_ctx->drop_flags = 0;
+       ctrl_ctx->add_flags = 0;
+       slot_ctx = xhci_get_slot_ctx(xhci, virt_dev->in_ctx);
+       slot_ctx->dev_info &= ~LAST_CTX_MASK;
        /* Endpoint 0 is always valid */
-       virt_dev->in_ctx->slot.dev_info |= LAST_CTX(1);
+       slot_ctx->dev_info |= LAST_CTX(1);
        for (i = 1; i < 31; ++i) {
-               ep_ctx = &virt_dev->in_ctx->ep[i];
+               ep_ctx = xhci_get_ep_ctx(xhci, virt_dev->in_ctx, i);
                ep_ctx->ep_info = 0;
                ep_ctx->ep_info2 = 0;
-               ep_ctx->deq[0] = 0;
-               ep_ctx->deq[1] = 0;
+               ep_ctx->deq = 0;
                ep_ctx->tx_info = 0;
        }
 }
@@ -903,6 +948,8 @@ int xhci_check_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
        unsigned long flags;
        struct xhci_hcd *xhci;
        struct xhci_virt_device *virt_dev;
+       struct xhci_input_control_ctx *ctrl_ctx;
+       struct xhci_slot_ctx *slot_ctx;
 
        ret = xhci_check_args(hcd, udev, NULL, 0, __func__);
        if (ret <= 0)
@@ -918,16 +965,18 @@ int xhci_check_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
        virt_dev = xhci->devs[udev->slot_id];
 
        /* See section 4.6.6 - A0 = 1; A1 = D0 = D1 = 0 */
-       virt_dev->in_ctx->add_flags |= SLOT_FLAG;
-       virt_dev->in_ctx->add_flags &= ~EP0_FLAG;
-       virt_dev->in_ctx->drop_flags &= ~SLOT_FLAG;
-       virt_dev->in_ctx->drop_flags &= ~EP0_FLAG;
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, virt_dev->in_ctx);
+       ctrl_ctx->add_flags |= SLOT_FLAG;
+       ctrl_ctx->add_flags &= ~EP0_FLAG;
+       ctrl_ctx->drop_flags &= ~SLOT_FLAG;
+       ctrl_ctx->drop_flags &= ~EP0_FLAG;
        xhci_dbg(xhci, "New Input Control Context:\n");
-       xhci_dbg_ctx(xhci, virt_dev->in_ctx, virt_dev->in_ctx_dma,
-                       LAST_CTX_TO_EP_NUM(virt_dev->in_ctx->slot.dev_info));
+       slot_ctx = xhci_get_slot_ctx(xhci, virt_dev->in_ctx);
+       xhci_dbg_ctx(xhci, virt_dev->in_ctx,
+                       LAST_CTX_TO_EP_NUM(slot_ctx->dev_info));
 
        spin_lock_irqsave(&xhci->lock, flags);
-       ret = xhci_queue_configure_endpoint(xhci, virt_dev->in_ctx_dma,
+       ret = xhci_queue_configure_endpoint(xhci, virt_dev->in_ctx->dma,
                        udev->slot_id);
        if (ret < 0) {
                spin_unlock_irqrestore(&xhci->lock, flags);
@@ -982,10 +1031,10 @@ int xhci_check_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
        }
 
        xhci_dbg(xhci, "Output context after successful config ep cmd:\n");
-       xhci_dbg_ctx(xhci, virt_dev->out_ctx, virt_dev->out_ctx_dma,
-                       LAST_CTX_TO_EP_NUM(virt_dev->in_ctx->slot.dev_info));
+       xhci_dbg_ctx(xhci, virt_dev->out_ctx,
+                       LAST_CTX_TO_EP_NUM(slot_ctx->dev_info));
 
-       xhci_zero_in_ctx(virt_dev);
+       xhci_zero_in_ctx(xhci, virt_dev);
        /* Free any old rings */
        for (i = 1; i < 31; ++i) {
                if (virt_dev->new_ep_rings[i]) {
@@ -1023,7 +1072,67 @@ void xhci_reset_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
                        virt_dev->new_ep_rings[i] = NULL;
                }
        }
-       xhci_zero_in_ctx(virt_dev);
+       xhci_zero_in_ctx(xhci, virt_dev);
+}
+
+/* Deal with stalled endpoints.  The core should have sent the control message
+ * to clear the halt condition.  However, we need to make the xHCI hardware
+ * reset its sequence number, since a device will expect a sequence number of
+ * zero after the halt condition is cleared.
+ * Context: in_interrupt
+ */
+void xhci_endpoint_reset(struct usb_hcd *hcd,
+               struct usb_host_endpoint *ep)
+{
+       struct xhci_hcd *xhci;
+       struct usb_device *udev;
+       unsigned int ep_index;
+       unsigned long flags;
+       int ret;
+       struct xhci_dequeue_state deq_state;
+       struct xhci_ring *ep_ring;
+
+       xhci = hcd_to_xhci(hcd);
+       udev = (struct usb_device *) ep->hcpriv;
+       /* Called with a root hub endpoint (or an endpoint that wasn't added
+        * with xhci_add_endpoint()
+        */
+       if (!ep->hcpriv)
+               return;
+       ep_index = xhci_get_endpoint_index(&ep->desc);
+       ep_ring = xhci->devs[udev->slot_id]->ep_rings[ep_index];
+       if (!ep_ring->stopped_td) {
+               xhci_dbg(xhci, "Endpoint 0x%x not halted, refusing to reset.\n",
+                               ep->desc.bEndpointAddress);
+               return;
+       }
+
+       xhci_dbg(xhci, "Queueing reset endpoint command\n");
+       spin_lock_irqsave(&xhci->lock, flags);
+       ret = xhci_queue_reset_ep(xhci, udev->slot_id, ep_index);
+       /*
+        * Can't change the ring dequeue pointer until it's transitioned to the
+        * stopped state, which is only upon a successful reset endpoint
+        * command.  Better hope that last command worked!
+        */
+       if (!ret) {
+               xhci_dbg(xhci, "Cleaning up stalled endpoint ring\n");
+               /* We need to move the HW's dequeue pointer past this TD,
+                * or it will attempt to resend it on the next doorbell ring.
+                */
+               xhci_find_new_dequeue_state(xhci, udev->slot_id,
+                               ep_index, ep_ring->stopped_td, &deq_state);
+               xhci_dbg(xhci, "Queueing new dequeue state\n");
+               xhci_queue_new_dequeue_state(xhci, ep_ring,
+                               udev->slot_id,
+                               ep_index, &deq_state);
+               kfree(ep_ring->stopped_td);
+               xhci_ring_cmd_db(xhci);
+       }
+       spin_unlock_irqrestore(&xhci->lock, flags);
+
+       if (ret)
+               xhci_warn(xhci, "FIXME allocate a new ring segment\n");
 }
 
 /*
@@ -1120,7 +1229,9 @@ int xhci_address_device(struct usb_hcd *hcd, struct usb_device *udev)
        struct xhci_virt_device *virt_dev;
        int ret = 0;
        struct xhci_hcd *xhci = hcd_to_xhci(hcd);
-       u32 temp;
+       struct xhci_slot_ctx *slot_ctx;
+       struct xhci_input_control_ctx *ctrl_ctx;
+       u64 temp_64;
 
        if (!udev->slot_id) {
                xhci_dbg(xhci, "Bad Slot ID %d\n", udev->slot_id);
@@ -1133,10 +1244,12 @@ int xhci_address_device(struct usb_hcd *hcd, struct usb_device *udev)
        if (!udev->config)
                xhci_setup_addressable_virt_dev(xhci, udev);
        /* Otherwise, assume the core has the device configured how it wants */
+       xhci_dbg(xhci, "Slot ID %d Input Context:\n", udev->slot_id);
+       xhci_dbg_ctx(xhci, virt_dev->in_ctx, 2);
 
        spin_lock_irqsave(&xhci->lock, flags);
-       ret = xhci_queue_address_device(xhci, virt_dev->in_ctx_dma,
-                       udev->slot_id);
+       ret = xhci_queue_address_device(xhci, virt_dev->in_ctx->dma,
+                                       udev->slot_id);
        if (ret) {
                spin_unlock_irqrestore(&xhci->lock, flags);
                xhci_dbg(xhci, "FIXME: allocate a command ring segment\n");
@@ -1176,41 +1289,37 @@ int xhci_address_device(struct usb_hcd *hcd, struct usb_device *udev)
        default:
                xhci_err(xhci, "ERROR: unexpected command completion "
                                "code 0x%x.\n", virt_dev->cmd_status);
+               xhci_dbg(xhci, "Slot ID %d Output Context:\n", udev->slot_id);
+               xhci_dbg_ctx(xhci, virt_dev->out_ctx, 2);
                ret = -EINVAL;
                break;
        }
        if (ret) {
                return ret;
        }
-       temp = xhci_readl(xhci, &xhci->op_regs->dcbaa_ptr[0]);
-       xhci_dbg(xhci, "Op regs DCBAA ptr[0] = %#08x\n", temp);
-       temp = xhci_readl(xhci, &xhci->op_regs->dcbaa_ptr[1]);
-       xhci_dbg(xhci, "Op regs DCBAA ptr[1] = %#08x\n", temp);
-       xhci_dbg(xhci, "Slot ID %d dcbaa entry[0] @%p = %#08x\n",
-                       udev->slot_id,
-                       &xhci->dcbaa->dev_context_ptrs[2*udev->slot_id],
-                       xhci->dcbaa->dev_context_ptrs[2*udev->slot_id]);
-       xhci_dbg(xhci, "Slot ID %d dcbaa entry[1] @%p = %#08x\n",
+       temp_64 = xhci_read_64(xhci, &xhci->op_regs->dcbaa_ptr);
+       xhci_dbg(xhci, "Op regs DCBAA ptr = %#016llx\n", temp_64);
+       xhci_dbg(xhci, "Slot ID %d dcbaa entry @%p = %#016llx\n",
                        udev->slot_id,
-                       &xhci->dcbaa->dev_context_ptrs[2*udev->slot_id+1],
-                       xhci->dcbaa->dev_context_ptrs[2*udev->slot_id+1]);
+                       &xhci->dcbaa->dev_context_ptrs[udev->slot_id],
+                       (unsigned long long)
+                               xhci->dcbaa->dev_context_ptrs[udev->slot_id]);
        xhci_dbg(xhci, "Output Context DMA address = %#08llx\n",
-                       (unsigned long long)virt_dev->out_ctx_dma);
+                       (unsigned long long)virt_dev->out_ctx->dma);
        xhci_dbg(xhci, "Slot ID %d Input Context:\n", udev->slot_id);
-       xhci_dbg_ctx(xhci, virt_dev->in_ctx, virt_dev->in_ctx_dma, 2);
+       xhci_dbg_ctx(xhci, virt_dev->in_ctx, 2);
        xhci_dbg(xhci, "Slot ID %d Output Context:\n", udev->slot_id);
-       xhci_dbg_ctx(xhci, virt_dev->out_ctx, virt_dev->out_ctx_dma, 2);
+       xhci_dbg_ctx(xhci, virt_dev->out_ctx, 2);
        /*
         * USB core uses address 1 for the roothubs, so we add one to the
         * address given back to us by the HC.
         */
-       udev->devnum = (virt_dev->out_ctx->slot.dev_state & DEV_ADDR_MASK) + 1;
+       slot_ctx = xhci_get_slot_ctx(xhci, virt_dev->out_ctx);
+       udev->devnum = (slot_ctx->dev_state & DEV_ADDR_MASK) + 1;
        /* Zero the input context control for later use */
-       virt_dev->in_ctx->add_flags = 0;
-       virt_dev->in_ctx->drop_flags = 0;
-       /* Mirror flags in the output context for future ep enable/disable */
-       virt_dev->out_ctx->add_flags = SLOT_FLAG | EP0_FLAG;
-       virt_dev->out_ctx->drop_flags = 0;
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, virt_dev->in_ctx);
+       ctrl_ctx->add_flags = 0;
+       ctrl_ctx->drop_flags = 0;
 
        xhci_dbg(xhci, "Device address = %d\n", udev->devnum);
        /* XXX Meh, not sure if anyone else but choose_address uses this. */
@@ -1252,7 +1361,6 @@ static int __init xhci_hcd_init(void)
        /* xhci_device_control has eight fields, and also
         * embeds one xhci_slot_ctx and 31 xhci_ep_ctx
         */
-       BUILD_BUG_ON(sizeof(struct xhci_device_control) != (8+8+8*31)*32/8);
        BUILD_BUG_ON(sizeof(struct xhci_stream_ctx) != 4*32/8);
        BUILD_BUG_ON(sizeof(union xhci_trb) != 4*32/8);
        BUILD_BUG_ON(sizeof(struct xhci_erst_entry) != 4*32/8);
index c8a72de1c5087c58a9fd7f5fba56d9073c1af040..e6b9a1c6002d3da5b43c65161cca881d18a8e214 100644 (file)
@@ -88,7 +88,7 @@ static void xhci_link_segments(struct xhci_hcd *xhci, struct xhci_segment *prev,
                return;
        prev->next = next;
        if (link_trbs) {
-               prev->trbs[TRBS_PER_SEGMENT-1].link.segment_ptr[0] = next->dma;
+               prev->trbs[TRBS_PER_SEGMENT-1].link.segment_ptr = next->dma;
 
                /* Set the last TRB in the segment to have a TRB type ID of Link TRB */
                val = prev->trbs[TRBS_PER_SEGMENT-1].link.control;
@@ -189,6 +189,63 @@ fail:
        return 0;
 }
 
+#define CTX_SIZE(_hcc) (HCC_64BYTE_CONTEXT(_hcc) ? 64 : 32)
+
+struct xhci_container_ctx *xhci_alloc_container_ctx(struct xhci_hcd *xhci,
+                                                   int type, gfp_t flags)
+{
+       struct xhci_container_ctx *ctx = kzalloc(sizeof(*ctx), flags);
+       if (!ctx)
+               return NULL;
+
+       BUG_ON((type != XHCI_CTX_TYPE_DEVICE) && (type != XHCI_CTX_TYPE_INPUT));
+       ctx->type = type;
+       ctx->size = HCC_64BYTE_CONTEXT(xhci->hcc_params) ? 2048 : 1024;
+       if (type == XHCI_CTX_TYPE_INPUT)
+               ctx->size += CTX_SIZE(xhci->hcc_params);
+
+       ctx->bytes = dma_pool_alloc(xhci->device_pool, flags, &ctx->dma);
+       memset(ctx->bytes, 0, ctx->size);
+       return ctx;
+}
+
+void xhci_free_container_ctx(struct xhci_hcd *xhci,
+                            struct xhci_container_ctx *ctx)
+{
+       dma_pool_free(xhci->device_pool, ctx->bytes, ctx->dma);
+       kfree(ctx);
+}
+
+struct xhci_input_control_ctx *xhci_get_input_control_ctx(struct xhci_hcd *xhci,
+                                             struct xhci_container_ctx *ctx)
+{
+       BUG_ON(ctx->type != XHCI_CTX_TYPE_INPUT);
+       return (struct xhci_input_control_ctx *)ctx->bytes;
+}
+
+struct xhci_slot_ctx *xhci_get_slot_ctx(struct xhci_hcd *xhci,
+                                       struct xhci_container_ctx *ctx)
+{
+       if (ctx->type == XHCI_CTX_TYPE_DEVICE)
+               return (struct xhci_slot_ctx *)ctx->bytes;
+
+       return (struct xhci_slot_ctx *)
+               (ctx->bytes + CTX_SIZE(xhci->hcc_params));
+}
+
+struct xhci_ep_ctx *xhci_get_ep_ctx(struct xhci_hcd *xhci,
+                                   struct xhci_container_ctx *ctx,
+                                   unsigned int ep_index)
+{
+       /* increment ep index by offset of start of ep ctx array */
+       ep_index++;
+       if (ctx->type == XHCI_CTX_TYPE_INPUT)
+               ep_index++;
+
+       return (struct xhci_ep_ctx *)
+               (ctx->bytes + (ep_index * CTX_SIZE(xhci->hcc_params)));
+}
+
 /* All the xhci_tds in the ring's TD list should be freed at this point */
 void xhci_free_virt_device(struct xhci_hcd *xhci, int slot_id)
 {
@@ -200,8 +257,7 @@ void xhci_free_virt_device(struct xhci_hcd *xhci, int slot_id)
                return;
 
        dev = xhci->devs[slot_id];
-       xhci->dcbaa->dev_context_ptrs[2*slot_id] = 0;
-       xhci->dcbaa->dev_context_ptrs[2*slot_id + 1] = 0;
+       xhci->dcbaa->dev_context_ptrs[slot_id] = 0;
        if (!dev)
                return;
 
@@ -210,11 +266,10 @@ void xhci_free_virt_device(struct xhci_hcd *xhci, int slot_id)
                        xhci_ring_free(xhci, dev->ep_rings[i]);
 
        if (dev->in_ctx)
-               dma_pool_free(xhci->device_pool,
-                               dev->in_ctx, dev->in_ctx_dma);
+               xhci_free_container_ctx(xhci, dev->in_ctx);
        if (dev->out_ctx)
-               dma_pool_free(xhci->device_pool,
-                               dev->out_ctx, dev->out_ctx_dma);
+               xhci_free_container_ctx(xhci, dev->out_ctx);
+
        kfree(xhci->devs[slot_id]);
        xhci->devs[slot_id] = 0;
 }
@@ -222,7 +277,6 @@ void xhci_free_virt_device(struct xhci_hcd *xhci, int slot_id)
 int xhci_alloc_virt_device(struct xhci_hcd *xhci, int slot_id,
                struct usb_device *udev, gfp_t flags)
 {
-       dma_addr_t      dma;
        struct xhci_virt_device *dev;
 
        /* Slot ID 0 is reserved */
@@ -236,23 +290,21 @@ int xhci_alloc_virt_device(struct xhci_hcd *xhci, int slot_id,
                return 0;
        dev = xhci->devs[slot_id];
 
-       /* Allocate the (output) device context that will be used in the HC */
-       dev->out_ctx = dma_pool_alloc(xhci->device_pool, flags, &dma);
+       /* Allocate the (output) device context that will be used in the HC. */
+       dev->out_ctx = xhci_alloc_container_ctx(xhci, XHCI_CTX_TYPE_DEVICE, flags);
        if (!dev->out_ctx)
                goto fail;
-       dev->out_ctx_dma = dma;
+
        xhci_dbg(xhci, "Slot %d output ctx = 0x%llx (dma)\n", slot_id,
-                       (unsigned long long)dma);
-       memset(dev->out_ctx, 0, sizeof(*dev->out_ctx));
+                       (unsigned long long)dev->out_ctx->dma);
 
        /* Allocate the (input) device context for address device command */
-       dev->in_ctx = dma_pool_alloc(xhci->device_pool, flags, &dma);
+       dev->in_ctx = xhci_alloc_container_ctx(xhci, XHCI_CTX_TYPE_INPUT, flags);
        if (!dev->in_ctx)
                goto fail;
-       dev->in_ctx_dma = dma;
+
        xhci_dbg(xhci, "Slot %d input ctx = 0x%llx (dma)\n", slot_id,
-                       (unsigned long long)dma);
-       memset(dev->in_ctx, 0, sizeof(*dev->in_ctx));
+                       (unsigned long long)dev->in_ctx->dma);
 
        /* Allocate endpoint 0 ring */
        dev->ep_rings[0] = xhci_ring_alloc(xhci, 1, true, flags);
@@ -261,17 +313,12 @@ int xhci_alloc_virt_device(struct xhci_hcd *xhci, int slot_id,
 
        init_completion(&dev->cmd_completion);
 
-       /*
-        * Point to output device context in dcbaa; skip the output control
-        * context, which is eight 32 bit fields (or 32 bytes long)
-        */
-       xhci->dcbaa->dev_context_ptrs[2*slot_id] =
-               (u32) dev->out_ctx_dma + (32);
+       /* Point to output device context in dcbaa. */
+       xhci->dcbaa->dev_context_ptrs[slot_id] = dev->out_ctx->dma;
        xhci_dbg(xhci, "Set slot id %d dcbaa entry %p to 0x%llx\n",
                        slot_id,
-                       &xhci->dcbaa->dev_context_ptrs[2*slot_id],
-                       (unsigned long long)dev->out_ctx_dma);
-       xhci->dcbaa->dev_context_ptrs[2*slot_id + 1] = 0;
+                       &xhci->dcbaa->dev_context_ptrs[slot_id],
+                       (unsigned long long) xhci->dcbaa->dev_context_ptrs[slot_id]);
 
        return 1;
 fail:
@@ -285,6 +332,8 @@ int xhci_setup_addressable_virt_dev(struct xhci_hcd *xhci, struct usb_device *ud
        struct xhci_virt_device *dev;
        struct xhci_ep_ctx      *ep0_ctx;
        struct usb_device       *top_dev;
+       struct xhci_slot_ctx    *slot_ctx;
+       struct xhci_input_control_ctx *ctrl_ctx;
 
        dev = xhci->devs[udev->slot_id];
        /* Slot ID 0 is reserved */
@@ -293,27 +342,29 @@ int xhci_setup_addressable_virt_dev(struct xhci_hcd *xhci, struct usb_device *ud
                                udev->slot_id);
                return -EINVAL;
        }
-       ep0_ctx = &dev->in_ctx->ep[0];
+       ep0_ctx = xhci_get_ep_ctx(xhci, dev->in_ctx, 0);
+       ctrl_ctx = xhci_get_input_control_ctx(xhci, dev->in_ctx);
+       slot_ctx = xhci_get_slot_ctx(xhci, dev->in_ctx);
 
        /* 2) New slot context and endpoint 0 context are valid*/
-       dev->in_ctx->add_flags = SLOT_FLAG | EP0_FLAG;
+       ctrl_ctx->add_flags = SLOT_FLAG | EP0_FLAG;
 
        /* 3) Only the control endpoint is valid - one endpoint context */
-       dev->in_ctx->slot.dev_info |= LAST_CTX(1);
+       slot_ctx->dev_info |= LAST_CTX(1);
 
        switch (udev->speed) {
        case USB_SPEED_SUPER:
-               dev->in_ctx->slot.dev_info |= (u32) udev->route;
-               dev->in_ctx->slot.dev_info |= (u32) SLOT_SPEED_SS;
+               slot_ctx->dev_info |= (u32) udev->route;
+               slot_ctx->dev_info |= (u32) SLOT_SPEED_SS;
                break;
        case USB_SPEED_HIGH:
-               dev->in_ctx->slot.dev_info |= (u32) SLOT_SPEED_HS;
+               slot_ctx->dev_info |= (u32) SLOT_SPEED_HS;
                break;
        case USB_SPEED_FULL:
-               dev->in_ctx->slot.dev_info |= (u32) SLOT_SPEED_FS;
+               slot_ctx->dev_info |= (u32) SLOT_SPEED_FS;
                break;
        case USB_SPEED_LOW:
-               dev->in_ctx->slot.dev_info |= (u32) SLOT_SPEED_LS;
+               slot_ctx->dev_info |= (u32) SLOT_SPEED_LS;
                break;
        case USB_SPEED_VARIABLE:
                xhci_dbg(xhci, "FIXME xHCI doesn't support wireless speeds\n");
@@ -327,7 +378,7 @@ int xhci_setup_addressable_virt_dev(struct xhci_hcd *xhci, struct usb_device *ud
        for (top_dev = udev; top_dev->parent && top_dev->parent->parent;
                        top_dev = top_dev->parent)
                /* Found device below root hub */;
-       dev->in_ctx->slot.dev_info2 |= (u32) ROOT_HUB_PORT(top_dev->portnum);
+       slot_ctx->dev_info2 |= (u32) ROOT_HUB_PORT(top_dev->portnum);
        xhci_dbg(xhci, "Set root hub portnum to %d\n", top_dev->portnum);
 
        /* Is this a LS/FS device under a HS hub? */
@@ -337,8 +388,8 @@ int xhci_setup_addressable_virt_dev(struct xhci_hcd *xhci, struct usb_device *ud
         */
        if ((udev->speed == USB_SPEED_LOW || udev->speed == USB_SPEED_FULL) &&
                        udev->tt) {
-               dev->in_ctx->slot.tt_info = udev->tt->hub->slot_id;
-               dev->in_ctx->slot.tt_info |= udev->ttport << 8;
+               slot_ctx->tt_info = udev->tt->hub->slot_id;
+               slot_ctx->tt_info |= udev->ttport << 8;
        }
        xhci_dbg(xhci, "udev->tt = %p\n", udev->tt);
        xhci_dbg(xhci, "udev->ttport = 0x%x\n", udev->ttport);
@@ -360,10 +411,9 @@ int xhci_setup_addressable_virt_dev(struct xhci_hcd *xhci, struct usb_device *ud
        ep0_ctx->ep_info2 |= MAX_BURST(0);
        ep0_ctx->ep_info2 |= ERROR_COUNT(3);
 
-       ep0_ctx->deq[0] =
+       ep0_ctx->deq =
                dev->ep_rings[0]->first_seg->dma;
-       ep0_ctx->deq[0] |= dev->ep_rings[0]->cycle_state;
-       ep0_ctx->deq[1] = 0;
+       ep0_ctx->deq |= dev->ep_rings[0]->cycle_state;
 
        /* Steps 7 and 8 were done in xhci_alloc_virt_device() */
 
@@ -470,25 +520,26 @@ int xhci_endpoint_init(struct xhci_hcd *xhci,
        unsigned int max_burst;
 
        ep_index = xhci_get_endpoint_index(&ep->desc);
-       ep_ctx = &virt_dev->in_ctx->ep[ep_index];
+       ep_ctx = xhci_get_ep_ctx(xhci, virt_dev->in_ctx, ep_index);
 
        /* Set up the endpoint ring */
        virt_dev->new_ep_rings[ep_index] = xhci_ring_alloc(xhci, 1, true, mem_flags);
        if (!virt_dev->new_ep_rings[ep_index])
                return -ENOMEM;
        ep_ring = virt_dev->new_ep_rings[ep_index];
-       ep_ctx->deq[0] = ep_ring->first_seg->dma | ep_ring->cycle_state;
-       ep_ctx->deq[1] = 0;
+       ep_ctx->deq = ep_ring->first_seg->dma | ep_ring->cycle_state;
 
        ep_ctx->ep_info = xhci_get_endpoint_interval(udev, ep);
 
        /* FIXME dig Mult and streams info out of ep companion desc */
 
-       /* Allow 3 retries for everything but isoc */
+       /* Allow 3 retries for everything but isoc;
+        * error count = 0 means infinite retries.
+        */
        if (!usb_endpoint_xfer_isoc(&ep->desc))
                ep_ctx->ep_info2 = ERROR_COUNT(3);
        else
-               ep_ctx->ep_info2 = ERROR_COUNT(0);
+               ep_ctx->ep_info2 = ERROR_COUNT(1);
 
        ep_ctx->ep_info2 |= xhci_get_endpoint_type(udev, ep);
 
@@ -498,7 +549,12 @@ int xhci_endpoint_init(struct xhci_hcd *xhci,
                max_packet = ep->desc.wMaxPacketSize;
                ep_ctx->ep_info2 |= MAX_PACKET(max_packet);
                /* dig out max burst from ep companion desc */
-               max_packet = ep->ss_ep_comp->desc.bMaxBurst;
+               if (!ep->ss_ep_comp) {
+                       xhci_warn(xhci, "WARN no SS endpoint companion descriptor.\n");
+                       max_packet = 0;
+               } else {
+                       max_packet = ep->ss_ep_comp->desc.bMaxBurst;
+               }
                ep_ctx->ep_info2 |= MAX_BURST(max_packet);
                break;
        case USB_SPEED_HIGH:
@@ -531,18 +587,114 @@ void xhci_endpoint_zero(struct xhci_hcd *xhci,
        struct xhci_ep_ctx *ep_ctx;
 
        ep_index = xhci_get_endpoint_index(&ep->desc);
-       ep_ctx = &virt_dev->in_ctx->ep[ep_index];
+       ep_ctx = xhci_get_ep_ctx(xhci, virt_dev->in_ctx, ep_index);
 
        ep_ctx->ep_info = 0;
        ep_ctx->ep_info2 = 0;
-       ep_ctx->deq[0] = 0;
-       ep_ctx->deq[1] = 0;
+       ep_ctx->deq = 0;
        ep_ctx->tx_info = 0;
        /* Don't free the endpoint ring until the set interface or configuration
         * request succeeds.
         */
 }
 
+/* Set up the scratchpad buffer array and scratchpad buffers, if needed. */
+static int scratchpad_alloc(struct xhci_hcd *xhci, gfp_t flags)
+{
+       int i;
+       struct device *dev = xhci_to_hcd(xhci)->self.controller;
+       int num_sp = HCS_MAX_SCRATCHPAD(xhci->hcs_params2);
+
+       xhci_dbg(xhci, "Allocating %d scratchpad buffers\n", num_sp);
+
+       if (!num_sp)
+               return 0;
+
+       xhci->scratchpad = kzalloc(sizeof(*xhci->scratchpad), flags);
+       if (!xhci->scratchpad)
+               goto fail_sp;
+
+       xhci->scratchpad->sp_array =
+               pci_alloc_consistent(to_pci_dev(dev),
+                                    num_sp * sizeof(u64),
+                                    &xhci->scratchpad->sp_dma);
+       if (!xhci->scratchpad->sp_array)
+               goto fail_sp2;
+
+       xhci->scratchpad->sp_buffers = kzalloc(sizeof(void *) * num_sp, flags);
+       if (!xhci->scratchpad->sp_buffers)
+               goto fail_sp3;
+
+       xhci->scratchpad->sp_dma_buffers =
+               kzalloc(sizeof(dma_addr_t) * num_sp, flags);
+
+       if (!xhci->scratchpad->sp_dma_buffers)
+               goto fail_sp4;
+
+       xhci->dcbaa->dev_context_ptrs[0] = xhci->scratchpad->sp_dma;
+       for (i = 0; i < num_sp; i++) {
+               dma_addr_t dma;
+               void *buf = pci_alloc_consistent(to_pci_dev(dev),
+                                                xhci->page_size, &dma);
+               if (!buf)
+                       goto fail_sp5;
+
+               xhci->scratchpad->sp_array[i] = dma;
+               xhci->scratchpad->sp_buffers[i] = buf;
+               xhci->scratchpad->sp_dma_buffers[i] = dma;
+       }
+
+       return 0;
+
+ fail_sp5:
+       for (i = i - 1; i >= 0; i--) {
+               pci_free_consistent(to_pci_dev(dev), xhci->page_size,
+                                   xhci->scratchpad->sp_buffers[i],
+                                   xhci->scratchpad->sp_dma_buffers[i]);
+       }
+       kfree(xhci->scratchpad->sp_dma_buffers);
+
+ fail_sp4:
+       kfree(xhci->scratchpad->sp_buffers);
+
+ fail_sp3:
+       pci_free_consistent(to_pci_dev(dev), num_sp * sizeof(u64),
+                           xhci->scratchpad->sp_array,
+                           xhci->scratchpad->sp_dma);
+
+ fail_sp2:
+       kfree(xhci->scratchpad);
+       xhci->scratchpad = NULL;
+
+ fail_sp:
+       return -ENOMEM;
+}
+
+static void scratchpad_free(struct xhci_hcd *xhci)
+{
+       int num_sp;
+       int i;
+       struct pci_dev  *pdev = to_pci_dev(xhci_to_hcd(xhci)->self.controller);
+
+       if (!xhci->scratchpad)
+               return;
+
+       num_sp = HCS_MAX_SCRATCHPAD(xhci->hcs_params2);
+
+       for (i = 0; i < num_sp; i++) {
+               pci_free_consistent(pdev, xhci->page_size,
+                                   xhci->scratchpad->sp_buffers[i],
+                                   xhci->scratchpad->sp_dma_buffers[i]);
+       }
+       kfree(xhci->scratchpad->sp_dma_buffers);
+       kfree(xhci->scratchpad->sp_buffers);
+       pci_free_consistent(pdev, num_sp * sizeof(u64),
+                           xhci->scratchpad->sp_array,
+                           xhci->scratchpad->sp_dma);
+       kfree(xhci->scratchpad);
+       xhci->scratchpad = NULL;
+}
+
 void xhci_mem_cleanup(struct xhci_hcd *xhci)
 {
        struct pci_dev  *pdev = to_pci_dev(xhci_to_hcd(xhci)->self.controller);
@@ -551,10 +703,8 @@ void xhci_mem_cleanup(struct xhci_hcd *xhci)
 
        /* Free the Event Ring Segment Table and the actual Event Ring */
        xhci_writel(xhci, 0, &xhci->ir_set->erst_size);
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_base[0]);
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_base[1]);
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_dequeue[0]);
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_dequeue[1]);
+       xhci_write_64(xhci, 0, &xhci->ir_set->erst_base);
+       xhci_write_64(xhci, 0, &xhci->ir_set->erst_dequeue);
        size = sizeof(struct xhci_erst_entry)*(xhci->erst.num_entries);
        if (xhci->erst.entries)
                pci_free_consistent(pdev, size,
@@ -566,8 +716,7 @@ void xhci_mem_cleanup(struct xhci_hcd *xhci)
        xhci->event_ring = NULL;
        xhci_dbg(xhci, "Freed event ring\n");
 
-       xhci_writel(xhci, 0, &xhci->op_regs->cmd_ring[0]);
-       xhci_writel(xhci, 0, &xhci->op_regs->cmd_ring[1]);
+       xhci_write_64(xhci, 0, &xhci->op_regs->cmd_ring);
        if (xhci->cmd_ring)
                xhci_ring_free(xhci, xhci->cmd_ring);
        xhci->cmd_ring = NULL;
@@ -586,8 +735,7 @@ void xhci_mem_cleanup(struct xhci_hcd *xhci)
        xhci->device_pool = NULL;
        xhci_dbg(xhci, "Freed device context pool\n");
 
-       xhci_writel(xhci, 0, &xhci->op_regs->dcbaa_ptr[0]);
-       xhci_writel(xhci, 0, &xhci->op_regs->dcbaa_ptr[1]);
+       xhci_write_64(xhci, 0, &xhci->op_regs->dcbaa_ptr);
        if (xhci->dcbaa)
                pci_free_consistent(pdev, sizeof(*xhci->dcbaa),
                                xhci->dcbaa, xhci->dcbaa->dma);
@@ -595,6 +743,7 @@ void xhci_mem_cleanup(struct xhci_hcd *xhci)
 
        xhci->page_size = 0;
        xhci->page_shift = 0;
+       scratchpad_free(xhci);
 }
 
 int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
@@ -602,6 +751,7 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
        dma_addr_t      dma;
        struct device   *dev = xhci_to_hcd(xhci)->self.controller;
        unsigned int    val, val2;
+       u64             val_64;
        struct xhci_segment     *seg;
        u32 page_size;
        int i;
@@ -647,8 +797,7 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
        xhci->dcbaa->dma = dma;
        xhci_dbg(xhci, "// Device context base array address = 0x%llx (DMA), %p (virt)\n",
                        (unsigned long long)xhci->dcbaa->dma, xhci->dcbaa);
-       xhci_writel(xhci, dma, &xhci->op_regs->dcbaa_ptr[0]);
-       xhci_writel(xhci, (u32) 0, &xhci->op_regs->dcbaa_ptr[1]);
+       xhci_write_64(xhci, dma, &xhci->op_regs->dcbaa_ptr);
 
        /*
         * Initialize the ring segment pool.  The ring must be a contiguous
@@ -658,11 +807,10 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
         */
        xhci->segment_pool = dma_pool_create("xHCI ring segments", dev,
                        SEGMENT_SIZE, 64, xhci->page_size);
+
        /* See Table 46 and Note on Figure 55 */
-       /* FIXME support 64-byte contexts */
        xhci->device_pool = dma_pool_create("xHCI input/output contexts", dev,
-                       sizeof(struct xhci_device_control),
-                       64, xhci->page_size);
+                       2112, 64, xhci->page_size);
        if (!xhci->segment_pool || !xhci->device_pool)
                goto fail;
 
@@ -675,14 +823,12 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
                        (unsigned long long)xhci->cmd_ring->first_seg->dma);
 
        /* Set the address in the Command Ring Control register */
-       val = xhci_readl(xhci, &xhci->op_regs->cmd_ring[0]);
-       val = (val & ~CMD_RING_ADDR_MASK) |
-               (xhci->cmd_ring->first_seg->dma & CMD_RING_ADDR_MASK) |
+       val_64 = xhci_read_64(xhci, &xhci->op_regs->cmd_ring);
+       val_64 = (val_64 & (u64) CMD_RING_RSVD_BITS) |
+               (xhci->cmd_ring->first_seg->dma & (u64) ~CMD_RING_RSVD_BITS) |
                xhci->cmd_ring->cycle_state;
-       xhci_dbg(xhci, "// Setting command ring address low bits to 0x%x\n", val);
-       xhci_writel(xhci, val, &xhci->op_regs->cmd_ring[0]);
-       xhci_dbg(xhci, "// Setting command ring address high bits to 0x0\n");
-       xhci_writel(xhci, (u32) 0, &xhci->op_regs->cmd_ring[1]);
+       xhci_dbg(xhci, "// Setting command ring address to 0x%x\n", val);
+       xhci_write_64(xhci, val_64, &xhci->op_regs->cmd_ring);
        xhci_dbg_cmd_ptrs(xhci);
 
        val = xhci_readl(xhci, &xhci->cap_regs->db_off);
@@ -722,8 +868,7 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
        /* set ring base address and size for each segment table entry */
        for (val = 0, seg = xhci->event_ring->first_seg; val < ERST_NUM_SEGS; val++) {
                struct xhci_erst_entry *entry = &xhci->erst.entries[val];
-               entry->seg_addr[0] = seg->dma;
-               entry->seg_addr[1] = 0;
+               entry->seg_addr = seg->dma;
                entry->seg_size = TRBS_PER_SEGMENT;
                entry->rsvd = 0;
                seg = seg->next;
@@ -741,11 +886,10 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
        /* set the segment table base address */
        xhci_dbg(xhci, "// Set ERST base address for ir_set 0 = 0x%llx\n",
                        (unsigned long long)xhci->erst.erst_dma_addr);
-       val = xhci_readl(xhci, &xhci->ir_set->erst_base[0]);
-       val &= ERST_PTR_MASK;
-       val |= (xhci->erst.erst_dma_addr & ~ERST_PTR_MASK);
-       xhci_writel(xhci, val, &xhci->ir_set->erst_base[0]);
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_base[1]);
+       val_64 = xhci_read_64(xhci, &xhci->ir_set->erst_base);
+       val_64 &= ERST_PTR_MASK;
+       val_64 |= (xhci->erst.erst_dma_addr & (u64) ~ERST_PTR_MASK);
+       xhci_write_64(xhci, val_64, &xhci->ir_set->erst_base);
 
        /* Set the event ring dequeue address */
        xhci_set_hc_event_deq(xhci);
@@ -761,7 +905,11 @@ int xhci_mem_init(struct xhci_hcd *xhci, gfp_t flags)
        for (i = 0; i < MAX_HC_SLOTS; ++i)
                xhci->devs[i] = 0;
 
+       if (scratchpad_alloc(xhci, flags))
+               goto fail;
+
        return 0;
+
 fail:
        xhci_warn(xhci, "Couldn't initialize memory\n");
        xhci_mem_cleanup(xhci);
index 1462709e26c0411cfc69d13b93641f2764eeb096..592fe7e623f7a0d8f863a5d72a67dae42c4ea7aa 100644 (file)
@@ -117,6 +117,7 @@ static const struct hc_driver xhci_pci_hc_driver = {
        .free_dev =             xhci_free_dev,
        .add_endpoint =         xhci_add_endpoint,
        .drop_endpoint =        xhci_drop_endpoint,
+       .endpoint_reset =       xhci_endpoint_reset,
        .check_bandwidth =      xhci_check_bandwidth,
        .reset_bandwidth =      xhci_reset_bandwidth,
        .address_device =       xhci_address_device,
index 02d81985c4544071b2abc9899a6661d802629b6b..aa88a067148bb70584bdaaaf9c56ccb39b32d3c3 100644 (file)
@@ -135,6 +135,7 @@ static void next_trb(struct xhci_hcd *xhci,
 static void inc_deq(struct xhci_hcd *xhci, struct xhci_ring *ring, bool consumer)
 {
        union xhci_trb *next = ++(ring->dequeue);
+       unsigned long long addr;
 
        ring->deq_updates++;
        /* Update the dequeue pointer further if that was a link TRB or we're at
@@ -152,6 +153,13 @@ static void inc_deq(struct xhci_hcd *xhci, struct xhci_ring *ring, bool consumer
                ring->dequeue = ring->deq_seg->trbs;
                next = ring->dequeue;
        }
+       addr = (unsigned long long) xhci_trb_virt_to_dma(ring->deq_seg, ring->dequeue);
+       if (ring == xhci->event_ring)
+               xhci_dbg(xhci, "Event ring deq = 0x%llx (DMA)\n", addr);
+       else if (ring == xhci->cmd_ring)
+               xhci_dbg(xhci, "Command ring deq = 0x%llx (DMA)\n", addr);
+       else
+               xhci_dbg(xhci, "Ring deq = 0x%llx (DMA)\n", addr);
 }
 
 /*
@@ -171,6 +179,7 @@ static void inc_enq(struct xhci_hcd *xhci, struct xhci_ring *ring, bool consumer
 {
        u32 chain;
        union xhci_trb *next;
+       unsigned long long addr;
 
        chain = ring->enqueue->generic.field[3] & TRB_CHAIN;
        next = ++(ring->enqueue);
@@ -204,6 +213,13 @@ static void inc_enq(struct xhci_hcd *xhci, struct xhci_ring *ring, bool consumer
                ring->enqueue = ring->enq_seg->trbs;
                next = ring->enqueue;
        }
+       addr = (unsigned long long) xhci_trb_virt_to_dma(ring->enq_seg, ring->enqueue);
+       if (ring == xhci->event_ring)
+               xhci_dbg(xhci, "Event ring enq = 0x%llx (DMA)\n", addr);
+       else if (ring == xhci->cmd_ring)
+               xhci_dbg(xhci, "Command ring enq = 0x%llx (DMA)\n", addr);
+       else
+               xhci_dbg(xhci, "Ring enq = 0x%llx (DMA)\n", addr);
 }
 
 /*
@@ -237,7 +253,7 @@ static int room_on_ring(struct xhci_hcd *xhci, struct xhci_ring *ring,
 
 void xhci_set_hc_event_deq(struct xhci_hcd *xhci)
 {
-       u32 temp;
+       u64 temp;
        dma_addr_t deq;
 
        deq = xhci_trb_virt_to_dma(xhci->event_ring->deq_seg,
@@ -246,13 +262,15 @@ void xhci_set_hc_event_deq(struct xhci_hcd *xhci)
                xhci_warn(xhci, "WARN something wrong with SW event ring "
                                "dequeue ptr.\n");
        /* Update HC event ring dequeue pointer */
-       temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
+       temp = xhci_read_64(xhci, &xhci->ir_set->erst_dequeue);
        temp &= ERST_PTR_MASK;
-       if (!in_interrupt())
-               xhci_dbg(xhci, "// Write event ring dequeue pointer\n");
-       xhci_writel(xhci, 0, &xhci->ir_set->erst_dequeue[1]);
-       xhci_writel(xhci, (deq & ~ERST_PTR_MASK) | temp,
-                       &xhci->ir_set->erst_dequeue[0]);
+       /* Don't clear the EHB bit (which is RW1C) because
+        * there might be more events to service.
+        */
+       temp &= ~ERST_EHB;
+       xhci_dbg(xhci, "// Write event ring dequeue pointer, preserving EHB bit\n");
+       xhci_write_64(xhci, ((u64) deq & (u64) ~ERST_PTR_MASK) | temp,
+                       &xhci->ir_set->erst_dequeue);
 }
 
 /* Ring the host controller doorbell after placing a command on the ring */
@@ -279,7 +297,8 @@ static void ring_ep_doorbell(struct xhci_hcd *xhci,
        /* Don't ring the doorbell for this endpoint if there are pending
         * cancellations because the we don't want to interrupt processing.
         */
-       if (!ep_ring->cancels_pending && !(ep_ring->state & SET_DEQ_PENDING)) {
+       if (!ep_ring->cancels_pending && !(ep_ring->state & SET_DEQ_PENDING)
+                       && !(ep_ring->state & EP_HALTED)) {
                field = xhci_readl(xhci, db_addr) & DB_MASK;
                xhci_writel(xhci, field | EPI_TO_DB(ep_index), db_addr);
                /* Flush PCI posted writes - FIXME Matthew Wilcox says this
@@ -316,12 +335,6 @@ static struct xhci_segment *find_trb_seg(
        return cur_seg;
 }
 
-struct dequeue_state {
-       struct xhci_segment *new_deq_seg;
-       union xhci_trb *new_deq_ptr;
-       int new_cycle_state;
-};
-
 /*
  * Move the xHC's endpoint ring dequeue pointer past cur_td.
  * Record the new state of the xHC's endpoint ring dequeue segment,
@@ -336,24 +349,30 @@ struct dequeue_state {
  *  - Finally we move the dequeue state one TRB further, toggling the cycle bit
  *    if we've moved it past a link TRB with the toggle cycle bit set.
  */
-static void find_new_dequeue_state(struct xhci_hcd *xhci,
+void xhci_find_new_dequeue_state(struct xhci_hcd *xhci,
                unsigned int slot_id, unsigned int ep_index,
-               struct xhci_td *cur_td, struct dequeue_state *state)
+               struct xhci_td *cur_td, struct xhci_dequeue_state *state)
 {
        struct xhci_virt_device *dev = xhci->devs[slot_id];
        struct xhci_ring *ep_ring = dev->ep_rings[ep_index];
        struct xhci_generic_trb *trb;
+       struct xhci_ep_ctx *ep_ctx;
+       dma_addr_t addr;
 
        state->new_cycle_state = 0;
+       xhci_dbg(xhci, "Finding segment containing stopped TRB.\n");
        state->new_deq_seg = find_trb_seg(cur_td->start_seg,
                        ep_ring->stopped_trb,
                        &state->new_cycle_state);
        if (!state->new_deq_seg)
                BUG();
        /* Dig out the cycle state saved by the xHC during the stop ep cmd */
-       state->new_cycle_state = 0x1 & dev->out_ctx->ep[ep_index].deq[0];
+       xhci_dbg(xhci, "Finding endpoint context\n");
+       ep_ctx = xhci_get_ep_ctx(xhci, dev->out_ctx, ep_index);
+       state->new_cycle_state = 0x1 & ep_ctx->deq;
 
        state->new_deq_ptr = cur_td->last_trb;
+       xhci_dbg(xhci, "Finding segment containing last TRB in TD.\n");
        state->new_deq_seg = find_trb_seg(state->new_deq_seg,
                        state->new_deq_ptr,
                        &state->new_cycle_state);
@@ -367,6 +386,12 @@ static void find_new_dequeue_state(struct xhci_hcd *xhci,
        next_trb(xhci, ep_ring, &state->new_deq_seg, &state->new_deq_ptr);
 
        /* Don't update the ring cycle state for the producer (us). */
+       xhci_dbg(xhci, "New dequeue segment = %p (virtual)\n",
+                       state->new_deq_seg);
+       addr = xhci_trb_virt_to_dma(state->new_deq_seg, state->new_deq_ptr);
+       xhci_dbg(xhci, "New dequeue pointer = 0x%llx (DMA)\n",
+                       (unsigned long long) addr);
+       xhci_dbg(xhci, "Setting dequeue pointer in internal ring state.\n");
        ep_ring->dequeue = state->new_deq_ptr;
        ep_ring->deq_seg = state->new_deq_seg;
 }
@@ -416,6 +441,30 @@ static int queue_set_tr_deq(struct xhci_hcd *xhci, int slot_id,
                unsigned int ep_index, struct xhci_segment *deq_seg,
                union xhci_trb *deq_ptr, u32 cycle_state);
 
+void xhci_queue_new_dequeue_state(struct xhci_hcd *xhci,
+               struct xhci_ring *ep_ring, unsigned int slot_id,
+               unsigned int ep_index, struct xhci_dequeue_state *deq_state)
+{
+       xhci_dbg(xhci, "Set TR Deq Ptr cmd, new deq seg = %p (0x%llx dma), "
+                       "new deq ptr = %p (0x%llx dma), new cycle = %u\n",
+                       deq_state->new_deq_seg,
+                       (unsigned long long)deq_state->new_deq_seg->dma,
+                       deq_state->new_deq_ptr,
+                       (unsigned long long)xhci_trb_virt_to_dma(deq_state->new_deq_seg, deq_state->new_deq_ptr),
+                       deq_state->new_cycle_state);
+       queue_set_tr_deq(xhci, slot_id, ep_index,
+                       deq_state->new_deq_seg,
+                       deq_state->new_deq_ptr,
+                       (u32) deq_state->new_cycle_state);
+       /* Stop the TD queueing code from ringing the doorbell until
+        * this command completes.  The HC won't set the dequeue pointer
+        * if the ring is running, and ringing the doorbell starts the
+        * ring running.
+        */
+       ep_ring->state |= SET_DEQ_PENDING;
+       xhci_ring_cmd_db(xhci);
+}
+
 /*
  * When we get a command completion for a Stop Endpoint Command, we need to
  * unlink any cancelled TDs from the ring.  There are two ways to do that:
@@ -436,7 +485,7 @@ static void handle_stopped_endpoint(struct xhci_hcd *xhci,
        struct xhci_td *cur_td = 0;
        struct xhci_td *last_unlinked_td;
 
-       struct dequeue_state deq_state;
+       struct xhci_dequeue_state deq_state;
 #ifdef CONFIG_USB_HCD_STAT
        ktime_t stop_time = ktime_get();
 #endif
@@ -464,7 +513,7 @@ static void handle_stopped_endpoint(struct xhci_hcd *xhci,
                 * move the xHC endpoint ring dequeue pointer past this TD.
                 */
                if (cur_td == ep_ring->stopped_td)
-                       find_new_dequeue_state(xhci, slot_id, ep_index, cur_td,
+                       xhci_find_new_dequeue_state(xhci, slot_id, ep_index, cur_td,
                                        &deq_state);
                else
                        td_to_noop(xhci, ep_ring, cur_td);
@@ -480,24 +529,8 @@ static void handle_stopped_endpoint(struct xhci_hcd *xhci,
 
        /* If necessary, queue a Set Transfer Ring Dequeue Pointer command */
        if (deq_state.new_deq_ptr && deq_state.new_deq_seg) {
-               xhci_dbg(xhci, "Set TR Deq Ptr cmd, new deq seg = %p (0x%llx dma), "
-                               "new deq ptr = %p (0x%llx dma), new cycle = %u\n",
-                               deq_state.new_deq_seg,
-                               (unsigned long long)deq_state.new_deq_seg->dma,
-                               deq_state.new_deq_ptr,
-                               (unsigned long long)xhci_trb_virt_to_dma(deq_state.new_deq_seg, deq_state.new_deq_ptr),
-                               deq_state.new_cycle_state);
-               queue_set_tr_deq(xhci, slot_id, ep_index,
-                               deq_state.new_deq_seg,
-                               deq_state.new_deq_ptr,
-                               (u32) deq_state.new_cycle_state);
-               /* Stop the TD queueing code from ringing the doorbell until
-                * this command completes.  The HC won't set the dequeue pointer
-                * if the ring is running, and ringing the doorbell starts the
-                * ring running.
-                */
-               ep_ring->state |= SET_DEQ_PENDING;
-               xhci_ring_cmd_db(xhci);
+               xhci_queue_new_dequeue_state(xhci, ep_ring,
+                               slot_id, ep_index, &deq_state);
        } else {
                /* Otherwise just ring the doorbell to restart the ring */
                ring_ep_doorbell(xhci, slot_id, ep_index);
@@ -551,11 +584,15 @@ static void handle_set_deq_completion(struct xhci_hcd *xhci,
        unsigned int ep_index;
        struct xhci_ring *ep_ring;
        struct xhci_virt_device *dev;
+       struct xhci_ep_ctx *ep_ctx;
+       struct xhci_slot_ctx *slot_ctx;
 
        slot_id = TRB_TO_SLOT_ID(trb->generic.field[3]);
        ep_index = TRB_TO_EP_INDEX(trb->generic.field[3]);
        dev = xhci->devs[slot_id];
        ep_ring = dev->ep_rings[ep_index];
+       ep_ctx = xhci_get_ep_ctx(xhci, dev->out_ctx, ep_index);
+       slot_ctx = xhci_get_slot_ctx(xhci, dev->out_ctx);
 
        if (GET_COMP_CODE(event->status) != COMP_SUCCESS) {
                unsigned int ep_state;
@@ -569,9 +606,9 @@ static void handle_set_deq_completion(struct xhci_hcd *xhci,
                case COMP_CTX_STATE:
                        xhci_warn(xhci, "WARN Set TR Deq Ptr cmd failed due "
                                        "to incorrect slot or ep state.\n");
-                       ep_state = dev->out_ctx->ep[ep_index].ep_info;
+                       ep_state = ep_ctx->ep_info;
                        ep_state &= EP_STATE_MASK;
-                       slot_state = dev->out_ctx->slot.dev_state;
+                       slot_state = slot_ctx->dev_state;
                        slot_state = GET_SLOT_STATE(slot_state);
                        xhci_dbg(xhci, "Slot state = %u, EP state = %u\n",
                                        slot_state, ep_state);
@@ -593,16 +630,33 @@ static void handle_set_deq_completion(struct xhci_hcd *xhci,
                 * cancelling URBs, which might not be an error...
                 */
        } else {
-               xhci_dbg(xhci, "Successful Set TR Deq Ptr cmd, deq[0] = 0x%x, "
-                               "deq[1] = 0x%x.\n",
-                               dev->out_ctx->ep[ep_index].deq[0],
-                               dev->out_ctx->ep[ep_index].deq[1]);
+               xhci_dbg(xhci, "Successful Set TR Deq Ptr cmd, deq = @%08llx\n",
+                               ep_ctx->deq);
        }
 
        ep_ring->state &= ~SET_DEQ_PENDING;
        ring_ep_doorbell(xhci, slot_id, ep_index);
 }
 
+static void handle_reset_ep_completion(struct xhci_hcd *xhci,
+               struct xhci_event_cmd *event,
+               union xhci_trb *trb)
+{
+       int slot_id;
+       unsigned int ep_index;
+
+       slot_id = TRB_TO_SLOT_ID(trb->generic.field[3]);
+       ep_index = TRB_TO_EP_INDEX(trb->generic.field[3]);
+       /* This command will only fail if the endpoint wasn't halted,
+        * but we don't care.
+        */
+       xhci_dbg(xhci, "Ignoring reset ep completion code of %u\n",
+                       (unsigned int) GET_COMP_CODE(event->status));
+
+       /* Clear our internal halted state and restart the ring */
+       xhci->devs[slot_id]->ep_rings[ep_index]->state &= ~EP_HALTED;
+       ring_ep_doorbell(xhci, slot_id, ep_index);
+}
 
 static void handle_cmd_completion(struct xhci_hcd *xhci,
                struct xhci_event_cmd *event)
@@ -611,7 +665,7 @@ static void handle_cmd_completion(struct xhci_hcd *xhci,
        u64 cmd_dma;
        dma_addr_t cmd_dequeue_dma;
 
-       cmd_dma = (((u64) event->cmd_trb[1]) << 32) + event->cmd_trb[0];
+       cmd_dma = event->cmd_trb;
        cmd_dequeue_dma = xhci_trb_virt_to_dma(xhci->cmd_ring->deq_seg,
                        xhci->cmd_ring->dequeue);
        /* Is the command ring deq ptr out of sync with the deq seg ptr? */
@@ -653,6 +707,9 @@ static void handle_cmd_completion(struct xhci_hcd *xhci,
        case TRB_TYPE(TRB_CMD_NOOP):
                ++xhci->noops_handled;
                break;
+       case TRB_TYPE(TRB_RESET_EP):
+               handle_reset_ep_completion(xhci, event, xhci->cmd_ring->dequeue);
+               break;
        default:
                /* Skip over unknown commands on the event ring */
                xhci->error_bitmask |= 1 << 6;
@@ -756,7 +813,9 @@ static int handle_tx_event(struct xhci_hcd *xhci,
        union xhci_trb *event_trb;
        struct urb *urb = 0;
        int status = -EINPROGRESS;
+       struct xhci_ep_ctx *ep_ctx;
 
+       xhci_dbg(xhci, "In %s\n", __func__);
        xdev = xhci->devs[TRB_TO_SLOT_ID(event->flags)];
        if (!xdev) {
                xhci_err(xhci, "ERROR Transfer event pointed to bad slot\n");
@@ -765,17 +824,17 @@ static int handle_tx_event(struct xhci_hcd *xhci,
 
        /* Endpoint ID is 1 based, our index is zero based */
        ep_index = TRB_TO_EP_ID(event->flags) - 1;
+       xhci_dbg(xhci, "%s - ep index = %d\n", __func__, ep_index);
        ep_ring = xdev->ep_rings[ep_index];
-       if (!ep_ring || (xdev->out_ctx->ep[ep_index].ep_info & EP_STATE_MASK) == EP_STATE_DISABLED) {
+       ep_ctx = xhci_get_ep_ctx(xhci, xdev->out_ctx, ep_index);
+       if (!ep_ring || (ep_ctx->ep_info & EP_STATE_MASK) == EP_STATE_DISABLED) {
                xhci_err(xhci, "ERROR Transfer event pointed to disabled endpoint\n");
                return -ENODEV;
        }
 
-       event_dma = event->buffer[0];
-       if (event->buffer[1] != 0)
-               xhci_warn(xhci, "WARN ignoring upper 32-bits of 64-bit TRB dma address\n");
-
+       event_dma = event->buffer;
        /* This TRB should be in the TD at the head of this ring's TD list */
+       xhci_dbg(xhci, "%s - checking for list empty\n", __func__);
        if (list_empty(&ep_ring->td_list)) {
                xhci_warn(xhci, "WARN Event TRB for slot %d ep %d with no TDs queued?\n",
                                TRB_TO_SLOT_ID(event->flags), ep_index);
@@ -785,11 +844,14 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                urb = NULL;
                goto cleanup;
        }
+       xhci_dbg(xhci, "%s - getting list entry\n", __func__);
        td = list_entry(ep_ring->td_list.next, struct xhci_td, td_list);
 
        /* Is this a TRB in the currently executing TD? */
+       xhci_dbg(xhci, "%s - looking for TD\n", __func__);
        event_seg = trb_in_td(ep_ring->deq_seg, ep_ring->dequeue,
                        td->last_trb, event_dma);
+       xhci_dbg(xhci, "%s - found event_seg = %p\n", __func__, event_seg);
        if (!event_seg) {
                /* HC is busted, give up! */
                xhci_err(xhci, "ERROR Transfer event TRB DMA ptr not part of current TD\n");
@@ -798,10 +860,10 @@ static int handle_tx_event(struct xhci_hcd *xhci,
        event_trb = &event_seg->trbs[(event_dma - event_seg->dma) / sizeof(*event_trb)];
        xhci_dbg(xhci, "Event TRB with TRB type ID %u\n",
                        (unsigned int) (event->flags & TRB_TYPE_BITMASK)>>10);
-       xhci_dbg(xhci, "Offset 0x00 (buffer[0]) = 0x%x\n",
-                       (unsigned int) event->buffer[0]);
-       xhci_dbg(xhci, "Offset 0x04 (buffer[0]) = 0x%x\n",
-                       (unsigned int) event->buffer[1]);
+       xhci_dbg(xhci, "Offset 0x00 (buffer lo) = 0x%x\n",
+                       lower_32_bits(event->buffer));
+       xhci_dbg(xhci, "Offset 0x04 (buffer hi) = 0x%x\n",
+                       upper_32_bits(event->buffer));
        xhci_dbg(xhci, "Offset 0x08 (transfer length) = 0x%x\n",
                        (unsigned int) event->transfer_len);
        xhci_dbg(xhci, "Offset 0x0C (flags) = 0x%x\n",
@@ -823,6 +885,7 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                break;
        case COMP_STALL:
                xhci_warn(xhci, "WARN: Stalled endpoint\n");
+               ep_ring->state |= EP_HALTED;
                status = -EPIPE;
                break;
        case COMP_TRB_ERR:
@@ -833,6 +896,10 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                xhci_warn(xhci, "WARN: transfer error on endpoint\n");
                status = -EPROTO;
                break;
+       case COMP_BABBLE:
+               xhci_warn(xhci, "WARN: babble error on endpoint\n");
+               status = -EOVERFLOW;
+               break;
        case COMP_DB_ERR:
                xhci_warn(xhci, "WARN: HC couldn't access mem fast enough\n");
                status = -ENOSR;
@@ -874,15 +941,26 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                if (event_trb != ep_ring->dequeue) {
                        /* The event was for the status stage */
                        if (event_trb == td->last_trb) {
-                               td->urb->actual_length =
-                                       td->urb->transfer_buffer_length;
+                               if (td->urb->actual_length != 0) {
+                                       /* Don't overwrite a previously set error code */
+                                       if (status == -EINPROGRESS || status == 0)
+                                               /* Did we already see a short data stage? */
+                                               status = -EREMOTEIO;
+                               } else {
+                                       td->urb->actual_length =
+                                               td->urb->transfer_buffer_length;
+                               }
                        } else {
                        /* Maybe the event was for the data stage? */
-                               if (GET_COMP_CODE(event->transfer_len) != COMP_STOP_INVAL)
+                               if (GET_COMP_CODE(event->transfer_len) != COMP_STOP_INVAL) {
                                        /* We didn't stop on a link TRB in the middle */
                                        td->urb->actual_length =
                                                td->urb->transfer_buffer_length -
                                                TRB_LEN(event->transfer_len);
+                                       xhci_dbg(xhci, "Waiting for status stage event\n");
+                                       urb = NULL;
+                                       goto cleanup;
+                               }
                        }
                }
        } else {
@@ -929,16 +1007,20 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                                                        TRB_LEN(event->transfer_len));
                                        td->urb->actual_length = 0;
                                }
-                               if (td->urb->transfer_flags & URB_SHORT_NOT_OK)
-                                       status = -EREMOTEIO;
-                               else
-                                       status = 0;
+                               /* Don't overwrite a previously set error code */
+                               if (status == -EINPROGRESS) {
+                                       if (td->urb->transfer_flags & URB_SHORT_NOT_OK)
+                                               status = -EREMOTEIO;
+                                       else
+                                               status = 0;
+                               }
                        } else {
                                td->urb->actual_length = td->urb->transfer_buffer_length;
                                /* Ignore a short packet completion if the
                                 * untransferred length was zero.
                                 */
-                               status = 0;
+                               if (status == -EREMOTEIO)
+                                       status = 0;
                        }
                } else {
                        /* Slow path - walk the list, starting from the dequeue
@@ -965,19 +1047,30 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                                        TRB_LEN(event->transfer_len);
                }
        }
-       /* The Endpoint Stop Command completion will take care of
-        * any stopped TDs.  A stopped TD may be restarted, so don't update the
-        * ring dequeue pointer or take this TD off any lists yet.
-        */
        if (GET_COMP_CODE(event->transfer_len) == COMP_STOP_INVAL ||
                        GET_COMP_CODE(event->transfer_len) == COMP_STOP) {
+               /* The Endpoint Stop Command completion will take care of any
+                * stopped TDs.  A stopped TD may be restarted, so don't update
+                * the ring dequeue pointer or take this TD off any lists yet.
+                */
                ep_ring->stopped_td = td;
                ep_ring->stopped_trb = event_trb;
        } else {
-               /* Update ring dequeue pointer */
-               while (ep_ring->dequeue != td->last_trb)
+               if (GET_COMP_CODE(event->transfer_len) == COMP_STALL) {
+                       /* The transfer is completed from the driver's
+                        * perspective, but we need to issue a set dequeue
+                        * command for this stalled endpoint to move the dequeue
+                        * pointer past the TD.  We can't do that here because
+                        * the halt condition must be cleared first.
+                        */
+                       ep_ring->stopped_td = td;
+                       ep_ring->stopped_trb = event_trb;
+               } else {
+                       /* Update ring dequeue pointer */
+                       while (ep_ring->dequeue != td->last_trb)
+                               inc_deq(xhci, ep_ring, false);
                        inc_deq(xhci, ep_ring, false);
-               inc_deq(xhci, ep_ring, false);
+               }
 
                /* Clean up the endpoint's TD list */
                urb = td->urb;
@@ -987,7 +1080,10 @@ static int handle_tx_event(struct xhci_hcd *xhci,
                        list_del(&td->cancelled_td_list);
                        ep_ring->cancels_pending--;
                }
-               kfree(td);
+               /* Leave the TD around for the reset endpoint function to use */
+               if (GET_COMP_CODE(event->transfer_len) != COMP_STALL) {
+                       kfree(td);
+               }
                urb->hcpriv = NULL;
        }
 cleanup:
@@ -997,6 +1093,8 @@ cleanup:
        /* FIXME for multi-TD URBs (who have buffers bigger than 64MB) */
        if (urb) {
                usb_hcd_unlink_urb_from_ep(xhci_to_hcd(xhci), urb);
+               xhci_dbg(xhci, "Giveback URB %p, len = %d, status = %d\n",
+                               urb, td->urb->actual_length, status);
                spin_unlock(&xhci->lock);
                usb_hcd_giveback_urb(xhci_to_hcd(xhci), urb, status);
                spin_lock(&xhci->lock);
@@ -1014,6 +1112,7 @@ void xhci_handle_event(struct xhci_hcd *xhci)
        int update_ptrs = 1;
        int ret;
 
+       xhci_dbg(xhci, "In %s\n", __func__);
        if (!xhci->event_ring || !xhci->event_ring->dequeue) {
                xhci->error_bitmask |= 1 << 1;
                return;
@@ -1026,18 +1125,25 @@ void xhci_handle_event(struct xhci_hcd *xhci)
                xhci->error_bitmask |= 1 << 2;
                return;
        }
+       xhci_dbg(xhci, "%s - OS owns TRB\n", __func__);
 
        /* FIXME: Handle more event types. */
        switch ((event->event_cmd.flags & TRB_TYPE_BITMASK)) {
        case TRB_TYPE(TRB_COMPLETION):
+               xhci_dbg(xhci, "%s - calling handle_cmd_completion\n", __func__);
                handle_cmd_completion(xhci, &event->event_cmd);
+               xhci_dbg(xhci, "%s - returned from handle_cmd_completion\n", __func__);
                break;
        case TRB_TYPE(TRB_PORT_STATUS):
+               xhci_dbg(xhci, "%s - calling handle_port_status\n", __func__);
                handle_port_status(xhci, event);
+               xhci_dbg(xhci, "%s - returned from handle_port_status\n", __func__);
                update_ptrs = 0;
                break;
        case TRB_TYPE(TRB_TRANSFER):
+               xhci_dbg(xhci, "%s - calling handle_tx_event\n", __func__);
                ret = handle_tx_event(xhci, &event->trans_event);
+               xhci_dbg(xhci, "%s - returned from handle_tx_event\n", __func__);
                if (ret < 0)
                        xhci->error_bitmask |= 1 << 9;
                else
@@ -1093,13 +1199,13 @@ static int prepare_ring(struct xhci_hcd *xhci, struct xhci_ring *ep_ring,
                 */
                xhci_warn(xhci, "WARN urb submitted to disabled ep\n");
                return -ENOENT;
-       case EP_STATE_HALTED:
        case EP_STATE_ERROR:
-               xhci_warn(xhci, "WARN waiting for halt or error on ep "
-                               "to be cleared\n");
+               xhci_warn(xhci, "WARN waiting for error on ep to be cleared\n");
                /* FIXME event handling code for error needs to clear it */
                /* XXX not sure if this should be -ENOENT or not */
                return -EINVAL;
+       case EP_STATE_HALTED:
+               xhci_dbg(xhci, "WARN halted endpoint, queueing URB anyway.\n");
        case EP_STATE_STOPPED:
        case EP_STATE_RUNNING:
                break;
@@ -1128,9 +1234,9 @@ static int prepare_transfer(struct xhci_hcd *xhci,
                gfp_t mem_flags)
 {
        int ret;
-
+       struct xhci_ep_ctx *ep_ctx = xhci_get_ep_ctx(xhci, xdev->out_ctx, ep_index);
        ret = prepare_ring(xhci, xdev->ep_rings[ep_index],
-                       xdev->out_ctx->ep[ep_index].ep_info & EP_STATE_MASK,
+                       ep_ctx->ep_info & EP_STATE_MASK,
                        num_trbs, mem_flags);
        if (ret)
                return ret;
@@ -1285,6 +1391,7 @@ static int queue_bulk_sg_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
        /* Queue the first TRB, even if it's zero-length */
        do {
                u32 field = 0;
+               u32 length_field = 0;
 
                /* Don't change the cycle bit of the first TRB until later */
                if (first_trb)
@@ -1314,10 +1421,13 @@ static int queue_bulk_sg_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
                                        (unsigned int) (addr + TRB_MAX_BUFF_SIZE) & ~(TRB_MAX_BUFF_SIZE - 1),
                                        (unsigned int) addr + trb_buff_len);
                }
+               length_field = TRB_LEN(trb_buff_len) |
+                       TD_REMAINDER(urb->transfer_buffer_length - running_total) |
+                       TRB_INTR_TARGET(0);
                queue_trb(xhci, ep_ring, false,
-                               (u32) addr,
-                               (u32) ((u64) addr >> 32),
-                               TRB_LEN(trb_buff_len) | TRB_INTR_TARGET(0),
+                               lower_32_bits(addr),
+                               upper_32_bits(addr),
+                               length_field,
                                /* We always want to know if the TRB was short,
                                 * or we won't get an event when it completes.
                                 * (Unless we use event data TRBs, which are a
@@ -1365,7 +1475,7 @@ int xhci_queue_bulk_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
        struct xhci_generic_trb *start_trb;
        bool first_trb;
        int start_cycle;
-       u32 field;
+       u32 field, length_field;
 
        int running_total, trb_buff_len, ret;
        u64 addr;
@@ -1443,10 +1553,13 @@ int xhci_queue_bulk_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
                        td->last_trb = ep_ring->enqueue;
                        field |= TRB_IOC;
                }
+               length_field = TRB_LEN(trb_buff_len) |
+                       TD_REMAINDER(urb->transfer_buffer_length - running_total) |
+                       TRB_INTR_TARGET(0);
                queue_trb(xhci, ep_ring, false,
-                               (u32) addr,
-                               (u32) ((u64) addr >> 32),
-                               TRB_LEN(trb_buff_len) | TRB_INTR_TARGET(0),
+                               lower_32_bits(addr),
+                               upper_32_bits(addr),
+                               length_field,
                                /* We always want to know if the TRB was short,
                                 * or we won't get an event when it completes.
                                 * (Unless we use event data TRBs, which are a
@@ -1478,7 +1591,7 @@ int xhci_queue_ctrl_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
        struct usb_ctrlrequest *setup;
        struct xhci_generic_trb *start_trb;
        int start_cycle;
-       u32 field;
+       u32 field, length_field;
        struct xhci_td *td;
 
        ep_ring = xhci->devs[slot_id]->ep_rings[ep_index];
@@ -1528,13 +1641,16 @@ int xhci_queue_ctrl_tx(struct xhci_hcd *xhci, gfp_t mem_flags,
 
        /* If there's data, queue data TRBs */
        field = 0;
+       length_field = TRB_LEN(urb->transfer_buffer_length) |
+               TD_REMAINDER(urb->transfer_buffer_length) |
+               TRB_INTR_TARGET(0);
        if (urb->transfer_buffer_length > 0) {
                if (setup->bRequestType & USB_DIR_IN)
                        field |= TRB_DIR_IN;
                queue_trb(xhci, ep_ring, false,
                                lower_32_bits(urb->transfer_dma),
                                upper_32_bits(urb->transfer_dma),
-                               TRB_LEN(urb->transfer_buffer_length) | TRB_INTR_TARGET(0),
+                               length_field,
                                /* Event on short tx */
                                field | TRB_ISP | TRB_TYPE(TRB_DATA) | ep_ring->cycle_state);
        }
@@ -1603,7 +1719,8 @@ int xhci_queue_slot_control(struct xhci_hcd *xhci, u32 trb_type, u32 slot_id)
 int xhci_queue_address_device(struct xhci_hcd *xhci, dma_addr_t in_ctx_ptr,
                u32 slot_id)
 {
-       return queue_command(xhci, in_ctx_ptr, 0, 0,
+       return queue_command(xhci, lower_32_bits(in_ctx_ptr),
+                       upper_32_bits(in_ctx_ptr), 0,
                        TRB_TYPE(TRB_ADDR_DEV) | SLOT_ID_FOR_TRB(slot_id));
 }
 
@@ -1611,7 +1728,8 @@ int xhci_queue_address_device(struct xhci_hcd *xhci, dma_addr_t in_ctx_ptr,
 int xhci_queue_configure_endpoint(struct xhci_hcd *xhci, dma_addr_t in_ctx_ptr,
                u32 slot_id)
 {
-       return queue_command(xhci, in_ctx_ptr, 0, 0,
+       return queue_command(xhci, lower_32_bits(in_ctx_ptr),
+                       upper_32_bits(in_ctx_ptr), 0,
                        TRB_TYPE(TRB_CONFIG_EP) | SLOT_ID_FOR_TRB(slot_id));
 }
 
@@ -1639,10 +1757,23 @@ static int queue_set_tr_deq(struct xhci_hcd *xhci, int slot_id,
        u32 type = TRB_TYPE(TRB_SET_DEQ);
 
        addr = xhci_trb_virt_to_dma(deq_seg, deq_ptr);
-       if (addr == 0)
+       if (addr == 0) {
                xhci_warn(xhci, "WARN Cannot submit Set TR Deq Ptr\n");
                xhci_warn(xhci, "WARN deq seg = %p, deq pt = %p\n",
                                deq_seg, deq_ptr);
-       return queue_command(xhci, (u32) addr | cycle_state, 0, 0,
+               return 0;
+       }
+       return queue_command(xhci, lower_32_bits(addr) | cycle_state,
+                       upper_32_bits(addr), 0,
                        trb_slot_id | trb_ep_index | type);
 }
+
+int xhci_queue_reset_ep(struct xhci_hcd *xhci, int slot_id,
+               unsigned int ep_index)
+{
+       u32 trb_slot_id = SLOT_ID_FOR_TRB(slot_id);
+       u32 trb_ep_index = EP_ID_FOR_TRB(ep_index);
+       u32 type = TRB_TYPE(TRB_RESET_EP);
+
+       return queue_command(xhci, 0, 0, 0, trb_slot_id | trb_ep_index | type);
+}
index 8936eeb5588b9d39a9625c2323285db4aa9dbfa9..d31d32206ba318fbf28ea23a105a0bfa81f82f92 100644 (file)
@@ -25,6 +25,7 @@
 
 #include <linux/usb.h>
 #include <linux/timer.h>
+#include <linux/kernel.h>
 
 #include "../core/hcd.h"
 /* Code sharing between pci-quirks and xhci hcd */
  * xHCI register interface.
  * This corresponds to the eXtensible Host Controller Interface (xHCI)
  * Revision 0.95 specification
- *
- * Registers should always be accessed with double word or quad word accesses.
- *
- * Some xHCI implementations may support 64-bit address pointers.  Registers
- * with 64-bit address pointers should be written to with dword accesses by
- * writing the low dword first (ptr[0]), then the high dword (ptr[1]) second.
- * xHCI implementations that do not support 64-bit address pointers will ignore
- * the high dword, and write order is irrelevant.
  */
 
 /**
@@ -96,6 +89,7 @@ struct xhci_cap_regs {
 #define HCS_ERST_MAX(p)                (((p) >> 4) & 0xf)
 /* bit 26 Scratchpad restore - for save/restore HW state - not used yet */
 /* bits 27:31 number of Scratchpad buffers SW must allocate for the HW */
+#define HCS_MAX_SCRATCHPAD(p)   (((p) >> 27) & 0x1f)
 
 /* HCSPARAMS3 - hcs_params3 - bitmasks */
 /* bits 0:7, Max U1 to U0 latency for the roothub ports */
@@ -166,10 +160,10 @@ struct xhci_op_regs {
        u32     reserved1;
        u32     reserved2;
        u32     dev_notification;
-       u32     cmd_ring[2];
+       u64     cmd_ring;
        /* rsvd: offset 0x20-2F */
        u32     reserved3[4];
-       u32     dcbaa_ptr[2];
+       u64     dcbaa_ptr;
        u32     config_reg;
        /* rsvd: offset 0x3C-3FF */
        u32     reserved4[241];
@@ -254,7 +248,7 @@ struct xhci_op_regs {
 #define CMD_RING_RUNNING       (1 << 3)
 /* bits 4:5 reserved and should be preserved */
 /* Command Ring pointer - bit mask for the lower 32 bits. */
-#define CMD_RING_ADDR_MASK     (0xffffffc0)
+#define CMD_RING_RSVD_BITS     (0x3f)
 
 /* CONFIG - Configure Register - config_reg bitmasks */
 /* bits 0:7 - maximum number of device slots enabled (NumSlotsEn) */
@@ -382,8 +376,8 @@ struct xhci_intr_reg {
        u32     irq_control;
        u32     erst_size;
        u32     rsvd;
-       u32     erst_base[2];
-       u32     erst_dequeue[2];
+       u64     erst_base;
+       u64     erst_dequeue;
 };
 
 /* irq_pending bitmasks */
@@ -452,6 +446,27 @@ struct xhci_doorbell_array {
 #define EPI_TO_DB(p)           (((p) + 1) & 0xff)
 
 
+/**
+ * struct xhci_container_ctx
+ * @type: Type of context.  Used to calculated offsets to contained contexts.
+ * @size: Size of the context data
+ * @bytes: The raw context data given to HW
+ * @dma: dma address of the bytes
+ *
+ * Represents either a Device or Input context.  Holds a pointer to the raw
+ * memory used for the context (bytes) and dma address of it (dma).
+ */
+struct xhci_container_ctx {
+       unsigned type;
+#define XHCI_CTX_TYPE_DEVICE  0x1
+#define XHCI_CTX_TYPE_INPUT   0x2
+
+       int size;
+
+       u8 *bytes;
+       dma_addr_t dma;
+};
+
 /**
  * struct xhci_slot_ctx
  * @dev_info:  Route string, device speed, hub info, and last valid endpoint
@@ -538,7 +553,7 @@ struct xhci_slot_ctx {
 struct xhci_ep_ctx {
        u32     ep_info;
        u32     ep_info2;
-       u32     deq[2];
+       u64     deq;
        u32     tx_info;
        /* offset 0x14 - 0x1f reserved for HC internal use */
        u32     reserved[3];
@@ -589,18 +604,16 @@ struct xhci_ep_ctx {
 
 
 /**
- * struct xhci_device_control
- * Input/Output context; see section 6.2.5.
+ * struct xhci_input_control_context
+ * Input control context; see section 6.2.5.
  *
  * @drop_context:      set the bit of the endpoint context you want to disable
  * @add_context:       set the bit of the endpoint context you want to enable
  */
-struct xhci_device_control {
+struct xhci_input_control_ctx {
        u32     drop_flags;
        u32     add_flags;
-       u32     rsvd[6];
-       struct xhci_slot_ctx    slot;
-       struct xhci_ep_ctx      ep[31];
+       u32     rsvd2[6];
 };
 
 /* drop context bitmasks */
@@ -608,7 +621,6 @@ struct xhci_device_control {
 /* add context bitmasks */
 #define        ADD_EP(x)       (0x1 << x)
 
-
 struct xhci_virt_device {
        /*
         * Commands to the hardware are passed an "input context" that
@@ -618,11 +630,10 @@ struct xhci_virt_device {
         * track of input and output contexts separately because
         * these commands might fail and we don't trust the hardware.
         */
-       struct xhci_device_control      *out_ctx;
-       dma_addr_t                      out_ctx_dma;
+       struct xhci_container_ctx       *out_ctx;
        /* Used for addressing devices and configuration changes */
-       struct xhci_device_control      *in_ctx;
-       dma_addr_t                      in_ctx_dma;
+       struct xhci_container_ctx       *in_ctx;
+
        /* FIXME when stream support is added */
        struct xhci_ring                *ep_rings[31];
        /* Temporary storage in case the configure endpoint command fails and we
@@ -641,7 +652,7 @@ struct xhci_virt_device {
  */
 struct xhci_device_context_array {
        /* 64-bit device addresses; we only write 32-bit addresses */
-       u32                     dev_context_ptrs[2*MAX_HC_SLOTS];
+       u64                     dev_context_ptrs[MAX_HC_SLOTS];
        /* private xHCD pointers */
        dma_addr_t      dma;
 };
@@ -654,7 +665,7 @@ struct xhci_device_context_array {
 
 struct xhci_stream_ctx {
        /* 64-bit stream ring address, cycle state, and stream type */
-       u32     stream_ring[2];
+       u64     stream_ring;
        /* offset 0x14 - 0x1f reserved for HC internal use */
        u32     reserved[2];
 };
@@ -662,7 +673,7 @@ struct xhci_stream_ctx {
 
 struct xhci_transfer_event {
        /* 64-bit buffer address, or immediate data */
-       u32     buffer[2];
+       u64     buffer;
        u32     transfer_len;
        /* This field is interpreted differently based on the type of TRB */
        u32     flags;
@@ -744,7 +755,7 @@ struct xhci_transfer_event {
 
 struct xhci_link_trb {
        /* 64-bit segment pointer*/
-       u32 segment_ptr[2];
+       u64 segment_ptr;
        u32 intr_target;
        u32 control;
 };
@@ -755,7 +766,7 @@ struct xhci_link_trb {
 /* Command completion event TRB */
 struct xhci_event_cmd {
        /* Pointer to command TRB, or the value passed by the event data trb */
-       u32 cmd_trb[2];
+       u64 cmd_trb;
        u32 status;
        u32 flags;
 };
@@ -848,8 +859,8 @@ union xhci_trb {
 #define TRB_CONFIG_EP          12
 /* Evaluate Context Command */
 #define TRB_EVAL_CONTEXT       13
-/* Reset Transfer Ring Command */
-#define TRB_RESET_RING         14
+/* Reset Endpoint Command */
+#define TRB_RESET_EP           14
 /* Stop Transfer Ring Command */
 #define TRB_STOP_RING          15
 /* Set Transfer Ring Dequeue Pointer Command */
@@ -929,6 +940,7 @@ struct xhci_ring {
        unsigned int            cancels_pending;
        unsigned int            state;
 #define SET_DEQ_PENDING                (1 << 0)
+#define EP_HALTED              (1 << 1)
        /* The TRB that was last reported in a stopped endpoint ring */
        union xhci_trb          *stopped_trb;
        struct xhci_td          *stopped_td;
@@ -940,9 +952,15 @@ struct xhci_ring {
        u32                     cycle_state;
 };
 
+struct xhci_dequeue_state {
+       struct xhci_segment *new_deq_seg;
+       union xhci_trb *new_deq_ptr;
+       int new_cycle_state;
+};
+
 struct xhci_erst_entry {
        /* 64-bit event ring segment address */
-       u32     seg_addr[2];
+       u64     seg_addr;
        u32     seg_size;
        /* Set to zero */
        u32     rsvd;
@@ -957,6 +975,13 @@ struct xhci_erst {
        unsigned int            erst_size;
 };
 
+struct xhci_scratchpad {
+       u64 *sp_array;
+       dma_addr_t sp_dma;
+       void **sp_buffers;
+       dma_addr_t *sp_dma_buffers;
+};
+
 /*
  * Each segment table entry is 4*32bits long.  1K seems like an ok size:
  * (1K bytes * 8bytes/bit) / (4*32 bits) = 64 segment entries in the table,
@@ -1011,6 +1036,9 @@ struct xhci_hcd {
        struct xhci_ring        *cmd_ring;
        struct xhci_ring        *event_ring;
        struct xhci_erst        erst;
+       /* Scratchpad */
+       struct xhci_scratchpad  *scratchpad;
+
        /* slot enabling and address device helpers */
        struct completion       addr_dev;
        int slot_id;
@@ -1071,13 +1099,43 @@ static inline unsigned int xhci_readl(const struct xhci_hcd *xhci,
 static inline void xhci_writel(struct xhci_hcd *xhci,
                const unsigned int val, __u32 __iomem *regs)
 {
-       if (!in_interrupt())
-               xhci_dbg(xhci,
-                        "`MEM_WRITE_DWORD(3'b000, 32'h%p, 32'h%0x, 4'hf);\n",
-                        regs, val);
+       xhci_dbg(xhci,
+                       "`MEM_WRITE_DWORD(3'b000, 32'h%p, 32'h%0x, 4'hf);\n",
+                       regs, val);
        writel(val, regs);
 }
 
+/*
+ * Registers should always be accessed with double word or quad word accesses.
+ *
+ * Some xHCI implementations may support 64-bit address pointers.  Registers
+ * with 64-bit address pointers should be written to with dword accesses by
+ * writing the low dword first (ptr[0]), then the high dword (ptr[1]) second.
+ * xHCI implementations that do not support 64-bit address pointers will ignore
+ * the high dword, and write order is irrelevant.
+ */
+static inline u64 xhci_read_64(const struct xhci_hcd *xhci,
+               __u64 __iomem *regs)
+{
+       __u32 __iomem *ptr = (__u32 __iomem *) regs;
+       u64 val_lo = readl(ptr);
+       u64 val_hi = readl(ptr + 1);
+       return val_lo + (val_hi << 32);
+}
+static inline void xhci_write_64(struct xhci_hcd *xhci,
+               const u64 val, __u64 __iomem *regs)
+{
+       __u32 __iomem *ptr = (__u32 __iomem *) regs;
+       u32 val_lo = lower_32_bits(val);
+       u32 val_hi = upper_32_bits(val);
+
+       xhci_dbg(xhci,
+                       "`MEM_WRITE_DWORD(3'b000, 64'h%p, 64'h%0lx, 4'hf);\n",
+                       regs, (long unsigned int) val);
+       writel(val_lo, ptr);
+       writel(val_hi, ptr + 1);
+}
+
 /* xHCI debugging */
 void xhci_print_ir_set(struct xhci_hcd *xhci, struct xhci_intr_reg *ir_set, int set_num);
 void xhci_print_registers(struct xhci_hcd *xhci);
@@ -1090,7 +1148,7 @@ void xhci_debug_ring(struct xhci_hcd *xhci, struct xhci_ring *ring);
 void xhci_dbg_erst(struct xhci_hcd *xhci, struct xhci_erst *erst);
 void xhci_dbg_cmd_ptrs(struct xhci_hcd *xhci);
 void xhci_dbg_ring_ptrs(struct xhci_hcd *xhci, struct xhci_ring *ring);
-void xhci_dbg_ctx(struct xhci_hcd *xhci, struct xhci_device_control *ctx, dma_addr_t dma, unsigned int last_ep);
+void xhci_dbg_ctx(struct xhci_hcd *xhci, struct xhci_container_ctx *ctx, unsigned int last_ep);
 
 /* xHCI memory managment */
 void xhci_mem_cleanup(struct xhci_hcd *xhci);
@@ -1128,6 +1186,7 @@ int xhci_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags);
 int xhci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status);
 int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev, struct usb_host_endpoint *ep);
 int xhci_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev, struct usb_host_endpoint *ep);
+void xhci_endpoint_reset(struct usb_hcd *hcd, struct usb_host_endpoint *ep);
 int xhci_check_bandwidth(struct usb_hcd *hcd, struct usb_device *udev);
 void xhci_reset_bandwidth(struct usb_hcd *hcd, struct usb_device *udev);
 
@@ -1148,10 +1207,23 @@ int xhci_queue_bulk_tx(struct xhci_hcd *xhci, gfp_t mem_flags, struct urb *urb,
                int slot_id, unsigned int ep_index);
 int xhci_queue_configure_endpoint(struct xhci_hcd *xhci, dma_addr_t in_ctx_ptr,
                u32 slot_id);
+int xhci_queue_reset_ep(struct xhci_hcd *xhci, int slot_id,
+               unsigned int ep_index);
+void xhci_find_new_dequeue_state(struct xhci_hcd *xhci,
+               unsigned int slot_id, unsigned int ep_index,
+               struct xhci_td *cur_td, struct xhci_dequeue_state *state);
+void xhci_queue_new_dequeue_state(struct xhci_hcd *xhci,
+               struct xhci_ring *ep_ring, unsigned int slot_id,
+               unsigned int ep_index, struct xhci_dequeue_state *deq_state);
 
 /* xHCI roothub code */
 int xhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, u16 wIndex,
                char *buf, u16 wLength);
 int xhci_hub_status_data(struct usb_hcd *hcd, char *buf);
 
+/* xHCI contexts */
+struct xhci_input_control_ctx *xhci_get_input_control_ctx(struct xhci_hcd *xhci, struct xhci_container_ctx *ctx);
+struct xhci_slot_ctx *xhci_get_slot_ctx(struct xhci_hcd *xhci, struct xhci_container_ctx *ctx);
+struct xhci_ep_ctx *xhci_get_ep_ctx(struct xhci_hcd *xhci, struct xhci_container_ctx *ctx, unsigned int ep_index);
+
 #endif /* __LINUX_XHCI_HCD_H */
index a68d91a11bee32422dd1296ff539b7b036228b73..abe3aa67ed0033d59a6735d9d61e3ec97529ad01 100644 (file)
@@ -220,7 +220,7 @@ config USB_IOWARRIOR
 
 config USB_TEST
        tristate "USB testing driver"
-       depends on USB && USB_DEVICEFS
+       depends on USB
        help
          This driver is for testing host controller software.  It is used
          with specialized device firmware for regression and stress testing,
index 554a414f65d1104cbbbeeaed2885f2a209faf42d..c7c1ca0494cda359096b1eeeb281a55b80f2c994 100644 (file)
@@ -1326,7 +1326,6 @@ static int __init musb_core_init(u16 musb_type, struct musb *musb)
        int             i;
 
        /* log core options (read using indexed model) */
-       musb_ep_select(mbase, 0);
        reg = musb_read_configdata(mbase);
 
        strcpy(aInfo, (reg & MUSB_CONFIGDATA_UTMIDW) ? "UTMI-16" : "UTMI-8");
@@ -1990,7 +1989,7 @@ bad_config:
        if (status < 0)
                goto fail2;
 
-#ifdef CONFIG_USB_OTG
+#ifdef CONFIG_USB_MUSB_OTG
        setup_timer(&musb->otg_timer, musb_otg_timer_func, (unsigned long) musb);
 #endif
 
index 40ed50ecedff6ed84a72d4342616a6f07e36f362..7a6778675ad3a8d5a76d1f8de9477a8c48309d12 100644 (file)
@@ -407,7 +407,7 @@ stall:
                                        csr |= MUSB_RXCSR_P_SENDSTALL
                                                | MUSB_RXCSR_FLUSHFIFO
                                                | MUSB_RXCSR_CLRDATATOG
-                                               | MUSB_TXCSR_P_WZC_BITS;
+                                               | MUSB_RXCSR_P_WZC_BITS;
                                        musb_writew(regs, MUSB_RXCSR,
                                                        csr);
                                }
index de3b2f18db4469943b0e7ce3b437ff98d53e0022..fbfd3fd9ce1f876f4949b15b1de016e7877d1348 100644 (file)
@@ -323,6 +323,7 @@ static inline void  musb_write_rxfifoadd(void __iomem *mbase, u16 c_off)
 
 static inline u8 musb_read_configdata(void __iomem *mbase)
 {
+       musb_writeb(mbase, MUSB_INDEX, 0);
        return musb_readb(mbase, 0x10 + MUSB_CONFIGDATA);
 }
 
index e9a40b820fd4b28eac8053e40efa4082f7880b46..985cbcf48bda83317d235395fbbca689f5649ee1 100644 (file)
@@ -80,6 +80,7 @@ static struct usb_device_id id_table [] = {
        { USB_DEVICE(0x10C4, 0x80F6) }, /* Suunto sports instrument */
        { USB_DEVICE(0x10C4, 0x8115) }, /* Arygon NFC/Mifare Reader */
        { USB_DEVICE(0x10C4, 0x813D) }, /* Burnside Telecom Deskmobile */
+       { USB_DEVICE(0x10C4, 0x813F) }, /* Tams Master Easy Control */
        { USB_DEVICE(0x10C4, 0x814A) }, /* West Mountain Radio RIGblaster P&P */
        { USB_DEVICE(0x10C4, 0x814B) }, /* West Mountain Radio RIGtalk */
        { USB_DEVICE(0x10C4, 0x815E) }, /* Helicomm IP-Link 1220-DVM */
@@ -96,7 +97,9 @@ static struct usb_device_id id_table [] = {
        { USB_DEVICE(0x10c4, 0x8293) }, /* Telegesys ETRX2USB */
        { USB_DEVICE(0x10C4, 0x82F9) }, /* Procyon AVS */
        { USB_DEVICE(0x10C4, 0x8341) }, /* Siemens MC35PU GPRS Modem */
+       { USB_DEVICE(0x10C4, 0x8382) }, /* Cygnal Integrated Products, Inc. */
        { USB_DEVICE(0x10C4, 0x83A8) }, /* Amber Wireless AMB2560 */
+       { USB_DEVICE(0x10C4, 0x8411) }, /* Kyocera GPS Module */
        { USB_DEVICE(0x10C4, 0x846E) }, /* BEI USB Sensor Interface (VCP) */
        { USB_DEVICE(0x10C4, 0xEA60) }, /* Silicon Labs factory default */
        { USB_DEVICE(0x10C4, 0xEA61) }, /* Silicon Labs factory default */
index 60c64cc5be2ae9dbbcef5720dc537af008839f67..b574878c78b27b633a056d96cf3eb36a25d098b6 100644 (file)
@@ -698,6 +698,7 @@ static struct usb_device_id id_table_combined [] = {
        { USB_DEVICE(MARVELL_VID, MARVELL_SHEEVAPLUG_PID),
                .driver_info = (kernel_ulong_t)&ftdi_jtag_quirk },
        { USB_DEVICE(LARSENBRUSGAARD_VID, LB_ALTITRACK_PID) },
+       { USB_DEVICE(GN_OTOMETRICS_VID, AURICAL_USB_PID) },
        { },                                    /* Optional parameter entry */
        { }                                     /* Terminating entry */
 };
index c9fbd74150929d6849b773bf10d5cb8b7d92ffe1..24dbd99e87d722a95beac152af27a475c46cac2b 100644 (file)
 
 #define FTDI_TURTELIZER_PID    0xBDC8 /* JTAG/RS-232 adapter by egnite GmBH */
 
+/*
+ * GN Otometrics (http://www.otometrics.com)
+ * Submitted by Ville Sundberg.
+ */
+#define GN_OTOMETRICS_VID      0x0c33  /* Vendor ID */
+#define AURICAL_USB_PID                0x0010  /* Aurical USB Audiometer */
+
 /*
  *   BmRequestType:  1100 0000b
  *   bRequest:       FTDI_E2_READ
index c31940a307f8d3fbdb9ad223380fd36262e4927e..270009afdf77043f2e60034b8d29182dad053edf 100644 (file)
 #define BANDB_DEVICE_ID_USOPTL4_4       0xAC44
 #define BANDB_DEVICE_ID_USOPTL4_2       0xAC42
 
-/* This driver also supports the ATEN UC2324 device since it is mos7840 based
- *  - if I knew the device id it would also support the ATEN UC2322 */
+/* This driver also supports
+ * ATEN UC2324 device using Moschip MCS7840
+ * ATEN UC2322 device using Moschip MCS7820
+ */
 #define USB_VENDOR_ID_ATENINTL         0x0557
 #define ATENINTL_DEVICE_ID_UC2324      0x2011
+#define ATENINTL_DEVICE_ID_UC2322      0x7820
 
 /* Interrupt Routine Defines    */
 
@@ -177,6 +180,7 @@ static struct usb_device_id moschip_port_id_table[] = {
        {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
        {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
        {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
+       {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
        {}                      /* terminating entry */
 };
 
@@ -186,6 +190,7 @@ static __devinitdata struct usb_device_id moschip_id_table_combined[] = {
        {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
        {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
        {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
+       {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
        {}                      /* terminating entry */
 };
 
index 98262dd552bb58c8b4d3b487b7dfb285cc9d64da..c784ddbe7b614cf13b4e57ab1fbd6ad2efdf3121 100644 (file)
@@ -66,8 +66,10 @@ static int  option_tiocmget(struct tty_struct *tty, struct file *file);
 static int  option_tiocmset(struct tty_struct *tty, struct file *file,
                                unsigned int set, unsigned int clear);
 static int  option_send_setup(struct usb_serial_port *port);
+#ifdef CONFIG_PM
 static int  option_suspend(struct usb_serial *serial, pm_message_t message);
 static int  option_resume(struct usb_serial *serial);
+#endif
 
 /* Vendor and product IDs */
 #define OPTION_VENDOR_ID                       0x0AF0
@@ -205,6 +207,7 @@ static int  option_resume(struct usb_serial *serial);
 #define NOVATELWIRELESS_PRODUCT_MC727          0x4100
 #define NOVATELWIRELESS_PRODUCT_MC950D         0x4400
 #define NOVATELWIRELESS_PRODUCT_U727           0x5010
+#define NOVATELWIRELESS_PRODUCT_MC727_NEW      0x5100
 #define NOVATELWIRELESS_PRODUCT_MC760          0x6000
 #define NOVATELWIRELESS_PRODUCT_OVMC760                0x6002
 
@@ -259,11 +262,6 @@ static int  option_resume(struct usb_serial *serial);
 #define AXESSTEL_VENDOR_ID                     0x1726
 #define AXESSTEL_PRODUCT_MV110H                        0x1000
 
-#define ONDA_VENDOR_ID                         0x19d2
-#define ONDA_PRODUCT_MSA501HS                  0x0001
-#define ONDA_PRODUCT_ET502HS                   0x0002
-#define ONDA_PRODUCT_MT503HS                   0x2000
-
 #define BANDRICH_VENDOR_ID                     0x1A8D
 #define BANDRICH_PRODUCT_C100_1                        0x1002
 #define BANDRICH_PRODUCT_C100_2                        0x1003
@@ -301,6 +299,7 @@ static int  option_resume(struct usb_serial *serial);
 #define ZTE_PRODUCT_MF628                      0x0015
 #define ZTE_PRODUCT_MF626                      0x0031
 #define ZTE_PRODUCT_CDMA_TECH                  0xfffe
+#define ZTE_PRODUCT_AC8710                     0xfff1
 
 #define BENQ_VENDOR_ID                         0x04a5
 #define BENQ_PRODUCT_H10                       0x4068
@@ -322,6 +321,11 @@ static int  option_resume(struct usb_serial *serial);
 #define ALINK_VENDOR_ID                                0x1e0e
 #define ALINK_PRODUCT_3GU                      0x9200
 
+/* ALCATEL PRODUCTS */
+#define ALCATEL_VENDOR_ID                      0x1bbb
+#define ALCATEL_PRODUCT_X060S                  0x0000
+
+
 static struct usb_device_id option_ids[] = {
        { USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_COLT) },
        { USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA) },
@@ -438,6 +442,7 @@ static struct usb_device_id option_ids[] = {
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_EU870D) }, /* Novatel EU850D/EU860D/EU870D */
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_MC950D) }, /* Novatel MC930D/MC950D */
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_MC727) }, /* Novatel MC727/U727/USB727 */
+       { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_MC727_NEW) }, /* Novatel MC727/U727/USB727 refresh */
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_U727) }, /* Novatel MC727/U727/USB727 */
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_MC760) }, /* Novatel MC760/U760/USB760 */
        { USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, NOVATELWIRELESS_PRODUCT_OVMC760) }, /* Novatel Ovation MC760 */
@@ -474,42 +479,6 @@ static struct usb_device_id option_ids[] = {
        { USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_500A) },
        { USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_620UW) },
        { USB_DEVICE(AXESSTEL_VENDOR_ID, AXESSTEL_PRODUCT_MV110H) },
-       { USB_DEVICE(ONDA_VENDOR_ID, ONDA_PRODUCT_MSA501HS) },
-       { USB_DEVICE(ONDA_VENDOR_ID, ONDA_PRODUCT_ET502HS) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0003) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0004) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0005) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0006) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0007) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0008) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0009) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000a) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000b) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000c) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000d) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000e) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x000f) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0010) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0011) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0012) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0013) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0014) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0015) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0016) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0017) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0018) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0019) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0020) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0021) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0022) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0023) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0024) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0025) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0026) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0027) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0028) },
-       { USB_DEVICE(ONDA_VENDOR_ID, 0x0029) },
-       { USB_DEVICE(ONDA_VENDOR_ID, ONDA_PRODUCT_MT503HS) },
        { USB_DEVICE(YISO_VENDOR_ID, YISO_PRODUCT_U893) },
        { USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_1) },
        { USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_2) },
@@ -534,10 +503,75 @@ static struct usb_device_id option_ids[] = {
        { USB_DEVICE(QUALCOMM_VENDOR_ID, 0x6613)}, /* Onda H600/ZTE MF330 */
        { USB_DEVICE(MAXON_VENDOR_ID, 0x6280) }, /* BP3-USB & BP3-EXT HSDPA */
        { USB_DEVICE(TELIT_VENDOR_ID, TELIT_PRODUCT_UC864E) },
-       { USB_DEVICE(ZTE_VENDOR_ID, ZTE_PRODUCT_MF622) },
-       { USB_DEVICE(ZTE_VENDOR_ID, ZTE_PRODUCT_MF626) },
-       { USB_DEVICE(ZTE_VENDOR_ID, ZTE_PRODUCT_MF628) },
-       { USB_DEVICE(ZTE_VENDOR_ID, ZTE_PRODUCT_CDMA_TECH) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, ZTE_PRODUCT_MF622, 0xff, 0xff, 0xff) }, /* ZTE WCDMA products */
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0002, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0003, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0004, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0005, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0006, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0007, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0008, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0009, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000a, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000b, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000c, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000d, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000e, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x000f, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0010, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0011, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0012, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0013, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, ZTE_PRODUCT_MF628, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0016, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0017, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0018, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0019, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0020, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0021, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0022, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0023, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0024, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0025, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0026, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0028, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0029, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0030, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, ZTE_PRODUCT_MF626, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0032, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0033, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0037, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0039, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0042, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0043, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0048, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0049, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0051, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0052, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0054, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0055, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0057, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0058, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0061, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0062, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0063, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0064, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0066, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0069, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0076, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0078, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0082, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0086, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x2002, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x2003, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0014, 0xff, 0xff, 0xff) }, /* ZTE CDMA products */
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0027, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0059, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0060, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0070, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, 0x0073, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, ZTE_PRODUCT_CDMA_TECH, 0xff, 0xff, 0xff) },
+       { USB_DEVICE_AND_INTERFACE_INFO(ZTE_VENDOR_ID, ZTE_PRODUCT_AC8710, 0xff, 0xff, 0xff) },
        { USB_DEVICE(BENQ_VENDOR_ID, BENQ_PRODUCT_H10) },
        { USB_DEVICE(DLINK_VENDOR_ID, DLINK_PRODUCT_DWM_652) },
        { USB_DEVICE(QISDA_VENDOR_ID, QISDA_PRODUCT_H21_4512) },
@@ -547,6 +581,7 @@ static struct usb_device_id option_ids[] = {
        { USB_DEVICE(TOSHIBA_VENDOR_ID, TOSHIBA_PRODUCT_HSDPA_MINICARD ) }, /* Toshiba 3G HSDPA == Novatel Expedite EU870D MiniCard */
        { USB_DEVICE(ALINK_VENDOR_ID, 0x9000) },
        { USB_DEVICE_AND_INTERFACE_INFO(ALINK_VENDOR_ID, ALINK_PRODUCT_3GU, 0xff, 0xff, 0xff) },
+       { USB_DEVICE(ALCATEL_VENDOR_ID, ALCATEL_PRODUCT_X060S) },
        { } /* Terminating entry */
 };
 MODULE_DEVICE_TABLE(usb, option_ids);
@@ -555,8 +590,10 @@ static struct usb_driver option_driver = {
        .name       = "option",
        .probe      = usb_serial_probe,
        .disconnect = usb_serial_disconnect,
+#ifdef CONFIG_PM
        .suspend    = usb_serial_suspend,
        .resume     = usb_serial_resume,
+#endif
        .id_table   = option_ids,
        .no_dynamic_id =        1,
 };
@@ -588,8 +625,10 @@ static struct usb_serial_driver option_1port_device = {
        .disconnect        = option_disconnect,
        .release           = option_release,
        .read_int_callback = option_instat_callback,
+#ifdef CONFIG_PM
        .suspend           = option_suspend,
        .resume            = option_resume,
+#endif
 };
 
 static int debug;
@@ -831,7 +870,6 @@ static void option_instat_callback(struct urb *urb)
        int status = urb->status;
        struct usb_serial_port *port =  urb->context;
        struct option_port_private *portdata = usb_get_serial_port_data(port);
-       struct usb_serial *serial = port->serial;
 
        dbg("%s", __func__);
        dbg("%s: urb %p port %p has data %p", __func__, urb, port, portdata);
@@ -927,7 +965,6 @@ static int option_open(struct tty_struct *tty,
                        struct usb_serial_port *port, struct file *filp)
 {
        struct option_port_private *portdata;
-       struct usb_serial *serial = port->serial;
        int i, err;
        struct urb *urb;
 
@@ -1187,6 +1224,7 @@ static void option_release(struct usb_serial *serial)
        }
 }
 
+#ifdef CONFIG_PM
 static int option_suspend(struct usb_serial *serial, pm_message_t message)
 {
        dbg("%s entered", __func__);
@@ -1245,6 +1283,7 @@ static int option_resume(struct usb_serial *serial)
        }
        return 0;
 }
+#endif
 
 MODULE_AUTHOR(DRIVER_AUTHOR);
 MODULE_DESCRIPTION(DRIVER_DESC);
index fcb320217218109d60147b5bb5dc297f65b96da0..e20dc525d17763642f65a07835a4a2ca462f1a4a 100644 (file)
@@ -961,7 +961,7 @@ int usb_stor_Bulk_max_lun(struct us_data *us)
                                 US_BULK_GET_MAX_LUN, 
                                 USB_DIR_IN | USB_TYPE_CLASS | 
                                 USB_RECIP_INTERFACE,
-                                0, us->ifnum, us->iobuf, 1, HZ);
+                                0, us->ifnum, us->iobuf, 1, 10*HZ);
 
        US_DEBUGP("GetMaxLUN command result is %d, data is %d\n", 
                  result, us->iobuf[0]);
index d88d0fac9fa5f185afd13b1f36b11f58baec672d..14f2d71ea3ce8b7077b0da8774bc554b912cd0fb 100644 (file)
@@ -939,8 +939,10 @@ again:
        /* Remove from old parent's list and insert into new parent's list. */
        sysfs_unlink_sibling(sd);
        sysfs_get(new_parent_sd);
+       drop_nlink(old_parent->d_inode);
        sysfs_put(sd->s_parent);
        sd->s_parent = new_parent_sd;
+       inc_nlink(new_parent->d_inode);
        sysfs_link_sibling(sd);
 
  out_unlock:
index 1488d8c81aac6587c9edc8002f39f89d104391cf..e8c6c9136c97c4ab95fd6d39784b86e88baf80c8 100644 (file)
@@ -394,6 +394,7 @@ extern void __do_SAK(struct tty_struct *tty);
 extern void disassociate_ctty(int priv);
 extern void no_tty(void);
 extern void tty_flip_buffer_push(struct tty_struct *tty);
+extern void tty_flush_to_ldisc(struct tty_struct *tty);
 extern void tty_buffer_free_all(struct tty_struct *tty);
 extern void tty_buffer_flush(struct tty_struct *tty);
 extern void tty_buffer_init(struct tty_struct *tty);
index 833139ce1e225cc1bef2286b3e04d2133219f8ef..e22c148e4b7fff7605e605689561df66d018c6fa 100644 (file)
@@ -164,7 +164,7 @@ static void ddebug_change(const struct ddebug_query *query,
 
                        if (!newflags)
                                dt->num_enabled--;
-                       else if (!dp-flags)
+                       else if (!dp->flags)
                                dt->num_enabled++;
                        dp->flags = newflags;
                        if (newflags) {