[linux-yocto] [PATCH v2 16/39] drivers/usb/host: Changes to support the axxia BSP
Cristian Bercaru
cristian.bercaru at windriver.com
Thu May 21 02:40:41 PDT 2015
From: Charlie Paul <cpaul.windriver at gmail.com>
These files add the usb host funtionality to the
LSI axxia 5500 board.
Signed-off-by: Charlie Paul <cpaul.windriver at gmail.com>
---
drivers/usb/host/Kconfig | 19 ++
drivers/usb/host/ehci-ci13612.c | 384 +++++++++++++++++++++++++++++++++++++++
drivers/usb/host/ehci-ci13612.h | 48 +++++
drivers/usb/host/ehci-hcd.c | 176 ++++++++++--------
4 files changed, 548 insertions(+), 79 deletions(-)
create mode 100644 drivers/usb/host/ehci-ci13612.c
create mode 100644 drivers/usb/host/ehci-ci13612.h
diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig
index fafc628..9b5bd84 100644
--- a/drivers/usb/host/Kconfig
+++ b/drivers/usb/host/Kconfig
@@ -3,6 +3,12 @@
#
comment "USB Host Controller Drivers"
+config LSI_USB_SW_WORKAROUND
+ bool "LSI USB SW Workaround for ACP34xx devices"
+ default n
+ help
+ LSI USB SW Workaround for ACP34xx devices
+
config USB_C67X00_HCD
tristate "Cypress C67x00 HCD support"
help
@@ -355,6 +361,19 @@ config USB_ISP1362_HCD
To compile this driver as a module, choose M here: the
module will be called isp1362-hcd.
+config USB_CI13612_HCD
+ tristate "CI13612A HCD support"
+ depends on USB
+ ---help---
+ The CI13612A is an USB host/OTG/device controller. Enable this
+ option if your board has this chip. If unsure, say N.
+
+ This driver does not support isochronous transfers and doesn't
+ implement OTG nor USB device controllers.
+
+ To compile this driver as a module, choose M here: the
+ module will be called CI13612-hcd.
+
config USB_FUSBH200_HCD
tristate "FUSBH200 HCD support"
depends on USB
diff --git a/drivers/usb/host/ehci-ci13612.c b/drivers/usb/host/ehci-ci13612.c
new file mode 100644
index 0000000..81d954f
--- /dev/null
+++ b/drivers/usb/host/ehci-ci13612.c
@@ -0,0 +1,384 @@
+ /*
+ * drivers/usb/host/ehci-ci13612.c
+ *
+ * USB Host Controller Driver for LSI's ACP
+ *
+ * Copyright (C) 2010 LSI 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ */
+
+#include <linux/platform_device.h>
+#include <linux/irq.h>
+#include <linux/of_platform.h>
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/of_irq.h>
+#include <linux/uaccess.h>
+#include <linux/io.h>
+#include "ehci-ci13612.h"
+
+
+static int ci13612_ehci_halt(struct ehci_hcd *ehci);
+
+#ifdef CONFIG_LSI_USB_SW_WORKAROUND
+static void ci13612_usb_setup(struct usb_hcd *hcd)
+{
+ int USB_TXFIFOTHRES, VUSB_HS_TX_BURST;
+ u32 devicemode;
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
+ u32 txfulltuning = 0;
+
+ if ((of_find_compatible_node(NULL, NULL, "lsi,acp3500")
+ != NULL)
+ || (of_find_compatible_node(NULL, NULL, "lsi,axxia35xx")
+ != NULL)) {
+ writel(3, USB_SBUSCFG);
+ return;
+ }
+
+ /* Fix for HW errata 0002832: Settings of VUSB_HS_TX_BURST and
+ * TXFILLTUNING.
+ * TXFIFOTHRES should satisfy
+ * TXFIFOTHRES * VUSB_HS_TX_BURST >= MAXIMUM PACKET SIZE of packet
+ * relationship.
+ */
+ VUSB_HS_TX_BURST = readl(USB_HWTXBUF) & 0x0f;
+ USB_TXFIFOTHRES = (32 << 16);
+ txfulltuning = (txfulltuning & 0xffc0ffff) | USB_TXFIFOTHRES;
+ writel(txfulltuning, (void __iomem *)USB_TXFILLTUNING);
+
+ /* Fix for HW errata 9000556154: When operating in device mode Use
+ * Unspecified Length Bursts by setting SBUSCFG to 0x0, or use stream
+ * disable mode by setting USBMODE.SDIS to 0x1.
+ */
+ devicemode = ehci_readl(ehci, hcd->regs + 0x1A8);
+
+ if ((devicemode & 0x3) == 0x2) {
+ /* device mode */
+ writel(0x0, hcd->regs + 0x90);
+ } else if ((devicemode & 0x3) == 0x3) {
+ /* host mode */
+ writel(0x6, hcd->regs + 0x90);
+ }
+
+ pr_err("ehci-ci13612 (ci13612_usb_setup): VUSB_HS_TX_BURST = 0x%x,USB_TXFIFOTHRES = 0x%x\n",
+ VUSB_HS_TX_BURST, USB_TXFIFOTHRES);
+}
+#endif
+
+/* called after powerup, by probe or system-pm "wakeup" */
+static int ehci_ci13612_reinit(struct ehci_hcd *ehci)
+{
+
+#ifdef CONFIG_LSI_USB_SW_WORKAROUND
+ /* S/W workarounds are not needed in AXM55xx */
+ ci13612_usb_setup(ehci_to_hcd(ehci));
+#endif
+ return 0;
+}
+
+
+static int ci13612_ehci_init(struct usb_hcd *hcd)
+{
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
+ int retval = 0;
+ int len;
+
+ /* EHCI registers start at offset 0x100 */
+ ehci->caps = hcd->regs + 0x100;
+ ehci->regs = hcd->regs + 0x100
+ + HC_LENGTH(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
+ len = HC_LENGTH(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
+
+ /* configure other settings */
+ ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);
+ hcd->has_tt = 1;
+
+ ehci->sbrn = 0x20;
+
+ /* Reset is only allowed on a stopped controller */
+ ci13612_ehci_halt(ehci);
+
+ /* reset controller */
+ ehci_reset(ehci);
+
+ /* data structure init */
+ retval = ehci_init(hcd);
+ if (retval)
+ return retval;
+ hcd->self.sg_tablesize = 0;
+
+ retval = ehci_ci13612_reinit(ehci);
+
+ return retval;
+}
+
+#ifdef CONFIG_LSI_USB_SW_WORKAROUND
+/*
+ * ci13612_fixup_usbcmd_rs
+ *
+ * Fix HW errata 0003256: Do not enable USBCMD.RS for some time after the USB
+ * reset has been completed (PORTSCx.PR=0). This ensures that the host does not
+ * send the SOF until the ULPI post reset processing has been completed. Note:
+ * This workaround reduces the likelihood of this problem occuring, but it may
+ * not entirely eliminate it.
+ */
+static int
+ci13612_fixup_usbcmd_rs(struct ehci_hcd *ehci)
+{
+ u32 port_status;
+ /* This workaround is not applicable to 3500 */
+ if ((of_find_compatible_node(NULL, NULL, "lsi,acp3500")
+ != NULL)
+ || (of_find_compatible_node(NULL, NULL, "lsi,axxia35xx")
+ != NULL)) {
+ return 0;
+ }
+
+ port_status = ehci_readl(ehci, &ehci->regs->port_status[0]);
+ pr_info("ehci-ci13612: port_status = 0x%x\n", port_status);
+ if (port_status & 0x100) {
+ pr_err("ehci-ci13612: USB port is in reset status, not able to change HC status to run\n");
+ return -EFAULT;
+ }
+ return 0;
+}
+#else
+#define ci13612_fixup_usbcmd_rs(_ehci) (0)
+#endif
+
+
+#ifdef CONFIG_LSI_USB_SW_WORKAROUND
+/*
+ * ci13612_fixup_txpburst
+ *
+ * Fix for HW errata 9000373951: You can adjust the burst size and fill the
+ * level to minimize under-run possibilities. In the failing case, the transfer
+ * size was 96 bytes, the burst size was 16, and the fill threshold level was
+ * set to 2. Because of this, the Host core issued the Out token when it
+ * requested the second burst of data. If the burst size had been changed to 8,
+ * and the fill level set to 3, then the core would have pre-fetched the 96
+ * bytes before issuing the OUT token.
+ */
+static void
+ci13612_fixup_txpburst(struct ehci_hcd *ehci)
+{
+ unsigned burst_size;
+
+ /* This workaround is not applicable to 3500 */
+ if ((of_find_compatible_node(NULL, NULL, "lsi,acp3500")
+ != NULL)
+ || (of_find_compatible_node(NULL, NULL, "lsi,axxia35xx")
+ != NULL)) {
+ return;
+ }
+
+ burst_size = ehci_readl(ehci, &ehci->regs->reserved1[1]);
+ burst_size = (burst_size & 0xffff00ff) | 0x4000; /* TXPBURST */
+ ehci_writel(ehci, burst_size, &ehci->regs->reserved1[1]);
+}
+#else
+#define ci13612_fixup_txpburst(ehci) do { (void)ehci; } while (0)
+#endif
+
+static int ci13612_ehci_run(struct usb_hcd *hcd)
+{
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
+ int retval;
+ u32 tmp;
+
+ retval = ci13612_fixup_usbcmd_rs(ehci);
+ if (retval)
+ return retval;
+
+
+#ifndef CONFIG_LSI_USB_SW_WORKAROUND
+ /* Setup AMBA interface to force INCR16 busts when possible */
+ writel(3, USB_SBUSCFG);
+#endif
+
+ retval = ehci_run(hcd);
+ if (retval)
+ return retval;
+
+ ci13612_fixup_txpburst(ehci);
+
+#ifndef CONFIG_LSI_USB_SW_WORKAROUND
+ /* Set ITC (bits [23:16]) to zero for interrupt on every micro-frame */
+ tmp = ehci_readl(ehci, &ehci->regs->command);
+ tmp &= 0xFFFF;
+ ehci_writel(ehci, tmp & 0xFFFF, &ehci->regs->command);
+#endif
+
+ return retval;
+}
+
+static const struct hc_driver ci13612_hc_driver = {
+ .description = "ci13612_hcd",
+ .product_desc = "CI13612A EHCI USB Host Controller",
+ .hcd_priv_size = sizeof(struct ehci_hcd),
+ .irq = ehci_irq,
+ .flags = HCD_MEMORY | HCD_USB2,
+ .reset = ci13612_ehci_init,
+ .start = ci13612_ehci_run,
+ .stop = ehci_stop,
+ .shutdown = ehci_shutdown,
+ .urb_enqueue = ehci_urb_enqueue,
+ .urb_dequeue = ehci_urb_dequeue,
+ .endpoint_disable = ehci_endpoint_disable,
+ .get_frame_number = ehci_get_frame,
+ .hub_status_data = ehci_hub_status_data,
+ .hub_control = ehci_hub_control,
+#if defined(CONFIG_PM)
+ .bus_suspend = ehci_bus_suspend,
+ .bus_resume = ehci_bus_resume,
+#endif
+ .relinquish_port = ehci_relinquish_port,
+ .port_handed_over = ehci_port_handed_over,
+};
+
+static int ci13612_ehci_probe(struct platform_device *pdev)
+{
+ struct device_node *np = pdev->dev.of_node;
+ struct usb_hcd *hcd;
+ void __iomem *gpreg_base;
+ int irq;
+ int retval;
+ struct resource *res;
+
+ if (usb_disabled())
+ return -ENODEV;
+
+ irq = platform_get_irq(pdev, 0);
+ if (irq < 0) {
+ dev_dbg(&pdev->dev, "error getting irq number\n");
+ retval = irq;
+ goto fail_create_hcd;
+ }
+
+ if (0 != irq_set_irq_type(irq, IRQ_TYPE_LEVEL_HIGH)) {
+ dev_dbg(&pdev->dev, "set_irq_type() failed\n");
+ retval = -EBUSY;
+ goto fail_create_hcd;
+ }
+
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+ if (!res) {
+ dev_err(&pdev->dev, "Error: resource addr %s setup!\n",
+ dev_name(&pdev->dev));
+ return -ENODEV;
+ }
+
+
+#ifndef CONFIG_LSI_USB_SW_WORKAROUND
+ /* Device using 32-bit addressing */
+ pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
+ pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask;
+#endif
+
+ hcd = usb_create_hcd(&ci13612_hc_driver,
+ &pdev->dev, dev_name(&pdev->dev));
+ if (!hcd) {
+ retval = -ENOMEM;
+ goto fail_create_hcd;
+ }
+
+ hcd->rsrc_start = res->start;
+ hcd->rsrc_len = resource_size(res);
+
+ hcd->regs = of_iomap(np, 0);
+ if (!hcd->regs) {
+ dev_err(&pdev->dev, "of_iomap error\n");
+ retval = -ENOMEM;
+ goto fail_put_hcd;
+ }
+
+ gpreg_base = of_iomap(np, 1);
+ if (!gpreg_base) {
+ dev_warn(&pdev->dev, "of_iomap error can't map region 1\n");
+ retval = -ENOMEM;
+ goto fail_put_hcd;
+ } else {
+ /* Set address bits [39:32] to zero */
+ writel(0x0, gpreg_base + 0x8);
+#ifndef CONFIG_LSI_USB_SW_WORKAROUND
+ /* hprot cachable and bufferable */
+ writel(0xc, gpreg_base + 0x74);
+#endif
+ iounmap(gpreg_base);
+ }
+
+ retval = usb_add_hcd(hcd, irq, 0);
+ if (retval == 0) {
+ platform_set_drvdata(pdev, hcd);
+ return retval;
+ }
+
+fail_put_hcd:
+ usb_put_hcd(hcd);
+fail_create_hcd:
+ dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval);
+ return retval;
+}
+
+static int ci13612_ehci_remove(struct platform_device *pdev)
+{
+ struct usb_hcd *hcd = platform_get_drvdata(pdev);
+
+ usb_remove_hcd(hcd);
+ iounmap(hcd->regs);
+ usb_put_hcd(hcd);
+ platform_set_drvdata(pdev, NULL);
+
+ return 0;
+}
+
+static int ci13612_ehci_halt(struct ehci_hcd *ehci)
+{
+ u32 temp;
+
+ temp = ehci_readl(ehci, &ehci->regs->command);
+ temp &= ~CMD_RUN;
+ ehci_writel(ehci, temp, &ehci->regs->command);
+
+ return ehci_handshake(ehci, &ehci->regs->status,
+ STS_HALT, STS_HALT, 16 * 125);
+}
+
+MODULE_ALIAS("platform:ci13612-ehci");
+
+static struct of_device_id ci13612_match[] = {
+ {
+ .type = "usb",
+ .compatible = "lsi,acp-usb",
+ },
+ {
+ .type = "usb",
+ .compatible = "acp-usb",
+ },
+ {},
+};
+
+static struct platform_driver ci13612_ehci_driver = {
+ .probe = ci13612_ehci_probe,
+ .remove = ci13612_ehci_remove,
+ .driver = {
+ .name = "ci13612-ehci",
+ .of_match_table = ci13612_match,
+ },
+
+};
diff --git a/drivers/usb/host/ehci-ci13612.h b/drivers/usb/host/ehci-ci13612.h
new file mode 100644
index 0000000..7785bdd
--- /dev/null
+++ b/drivers/usb/host/ehci-ci13612.h
@@ -0,0 +1,48 @@
+/*
+ * Host interface registers
+ */
+
+/* define CI13612 USB registers here */
+#define CI13612_USB_BASE (hcd->regs)
+
+#define USB_ID (CI13612_USB_BASE + 0x0000)
+#define USB_HWGENERAL (CI13612_USB_BASE + 0x0004)
+#define USB_HWHOST (CI13612_USB_BASE + 0x0008)
+#define USB_HWDEVICE (CI13612_USB_BASE + 0x000C)
+#define USB_HWTXBUF (CI13612_USB_BASE + 0x0010)
+#define USB_HWRXBUF (CI13612_USB_BASE + 0x0014)
+#define USB_GPTIMER0LD (CI13612_USB_BASE + 0x0080)
+#define USB_GPTIMER0CTRL (CI13612_USB_BASE + 0x0084)
+#define USB_GPTIMER1LD (CI13612_USB_BASE + 0x0088)
+#define USB_GPTIMER1CTRL (CI13612_USB_BASE + 0x008c)
+#define USB_SBUSCFG (CI13612_USB_BASE + 0x0090)
+
+#define USB_CAPLENGTH (CI13612_USB_BASE + 0x0100) /* 8 bit */
+#define USB_HCIVERSION (CI13612_USB_BASE + 0x0102) /* 16 bit */
+#define USB_HCSPARAMS (CI13612_USB_BASE + 0x0104)
+#define USB_HCCPARAMS (CI13612_USB_BASE + 0x0108)
+#define USB_DCIVERSION (CI13612_USB_BASE + 0x0120) /* 16 bit */
+#define USB_DCCPARAMS (CI13612_USB_BASE + 0x0124)
+#define USB_USBCMD (CI13612_USB_BASE + 0x0140)
+#define USB_USBSTS (CI13612_USB_BASE + 0x0144)
+#define USB_USBINTR (CI13612_USB_BASE + 0x0148)
+#define USB_FRINDEX (CI13612_USB_BASE + 0x014C)
+#define USB_DEVICEADDR (CI13612_USB_BASE + 0x0154)
+#define USB_ENDPOINTLISTADDR (CI13612_USB_BASE + 0x0158)
+#define USB_TTCTRL (CI13612_USB_BASE + 0x015C)
+#define USB_BURSTSIZE (CI13612_USB_BASE + 0x0160)
+#define USB_TXFILLTUNING (CI13612_USB_BASE + 0x0164)
+#define USB_ICUSB (CI13612_USB_BASE + 0x016C)
+#define USB_ULPI_VIEWPORT (CI13612_USB_BASE + 0x0170)
+#define USB_ENDPTNAK (CI13612_USB_BASE + 0x0178)
+#define USB_ENDPTNAKEN (CI13612_USB_BASE + 0x017C)
+#define USB_CONFIGFLAG (CI13612_USB_BASE + 0x0180)
+#define USB_PORTSC (CI13612_USB_BASE + 0x0184)
+#define USB_OTGSC (CI13612_USB_BASE + 0x01A4)
+#define USB_USBMODE (CI13612_USB_BASE + 0x01A8)
+#define USB_ENDPTSETUPSTAT (CI13612_USB_BASE + 0x01AC)
+#define USB_ENDPTPRIME (CI13612_USB_BASE + 0x01B0)
+#define USB_ENDPTFLUSH (CI13612_USB_BASE + 0x01B4)
+#define USB_ENDPTSTAT (CI13612_USB_BASE + 0x01B8)
+#define USB_ENDPTCOMPLETE (CI13612_USB_BASE + 0x01BC)
+#define USB_ENDPTCTRL(n) (CI13612_USB_BASE + 0x01C0 + (4 * (n)))
diff --git a/drivers/usb/host/ehci-hcd.c b/drivers/usb/host/ehci-hcd.c
index 38bfeed..211d951 100644
--- a/drivers/usb/host/ehci-hcd.c
+++ b/drivers/usb/host/ehci-hcd.c
@@ -68,7 +68,7 @@
#define DRIVER_AUTHOR "David Brownell"
#define DRIVER_DESC "USB 2.0 'Enhanced' Host Controller (EHCI) Driver"
-static const char hcd_name [] = "ehci_hcd";
+static const char hcd_name[] = "ehci_hcd";
#undef EHCI_URB_TRACE
@@ -88,19 +88,19 @@ static const char hcd_name [] = "ehci_hcd";
#define EHCI_TUNE_FLS 1 /* (medium) 512-frame schedule */
/* Initial IRQ latency: faster than hw default */
-static int log2_irq_thresh = 0; // 0 to 6
-module_param (log2_irq_thresh, int, S_IRUGO);
-MODULE_PARM_DESC (log2_irq_thresh, "log2 IRQ latency, 1-64 microframes");
+static int log2_irq_thresh; /* 0 to 6 */
+module_param(log2_irq_thresh, int, S_IRUGO);
+MODULE_PARM_DESC(log2_irq_thresh, "log2 IRQ latency, 1-64 microframes");
/* initial park setting: slower than hw default */
-static unsigned park = 0;
-module_param (park, uint, S_IRUGO);
-MODULE_PARM_DESC (park, "park setting; 1-3 back-to-back async packets");
+static unsigned park;
+module_param(park, uint, S_IRUGO);
+MODULE_PARM_DESC(park, "park setting; 1-3 back-to-back async packets");
/* for flakey hardware, ignore overcurrent indicators */
-static bool ignore_oc = 0;
-module_param (ignore_oc, bool, S_IRUGO);
-MODULE_PARM_DESC (ignore_oc, "ignore bogus hardware overcurrent indications");
+static bool ignore_oc;
+module_param(ignore_oc, bool, S_IRUGO);
+MODULE_PARM_DESC(ignore_oc, "ignore bogus hardware overcurrent indications");
#define INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT)
@@ -169,7 +169,7 @@ int ehci_handshake(struct ehci_hcd *ehci, void __iomem *ptr,
result &= mask;
if (result == done)
return 0;
- udelay (1);
+ udelay(1);
usec--;
} while (usec > 0);
return -ETIMEDOUT;
@@ -177,7 +177,7 @@ int ehci_handshake(struct ehci_hcd *ehci, void __iomem *ptr,
EXPORT_SYMBOL_GPL(ehci_handshake);
/* check TDI/ARC silicon is in host mode */
-static int tdi_in_host_mode (struct ehci_hcd *ehci)
+static int tdi_in_host_mode(struct ehci_hcd *ehci)
{
u32 tmp;
@@ -189,7 +189,7 @@ static int tdi_in_host_mode (struct ehci_hcd *ehci)
* Force HC to halt state from unknown (EHCI spec section 2.3).
* Must be called with interrupts enabled and the lock not held.
*/
-static int ehci_halt (struct ehci_hcd *ehci)
+static int ehci_halt(struct ehci_hcd *ehci)
{
u32 temp;
@@ -220,7 +220,7 @@ static int ehci_halt (struct ehci_hcd *ehci)
}
/* put TDI/ARC silicon into EHCI mode */
-static void tdi_reset (struct ehci_hcd *ehci)
+static void tdi_reset(struct ehci_hcd *ehci)
{
u32 tmp;
@@ -239,7 +239,7 @@ static void tdi_reset (struct ehci_hcd *ehci)
* Reset a non-running (STS_HALT == 1) controller.
* Must be called with interrupts enabled and the lock not held.
*/
-static int ehci_reset (struct ehci_hcd *ehci)
+static int ehci_reset(struct ehci_hcd *ehci)
{
int retval;
u32 command = ehci_readl(ehci, &ehci->regs->command);
@@ -250,7 +250,7 @@ static int ehci_reset (struct ehci_hcd *ehci)
ehci->debug = NULL;
command |= CMD_RESET;
- dbg_cmd (ehci, "reset", command);
+ dbg_cmd(ehci, "reset", command);
ehci_writel(ehci, command, &ehci->regs->command);
ehci->rh_state = EHCI_RH_HALTED;
ehci->next_statechange = jiffies;
@@ -266,7 +266,7 @@ static int ehci_reset (struct ehci_hcd *ehci)
return retval;
if (ehci_is_TDI(ehci))
- tdi_reset (ehci);
+ tdi_reset(ehci);
if (ehci->debug)
dbgp_external_startup(ehci_to_hcd(ehci));
@@ -280,7 +280,7 @@ static int ehci_reset (struct ehci_hcd *ehci)
* Idle the controller (turn off the schedules).
* Must be called with interrupts enabled and the lock not held.
*/
-static void ehci_quiesce (struct ehci_hcd *ehci)
+static void ehci_quiesce(struct ehci_hcd *ehci)
{
u32 temp;
@@ -384,7 +384,7 @@ static void ehci_shutdown(struct usb_hcd *hcd)
* ehci_work is called from some interrupts, timers, and so on.
* it calls driver completion functions, after dropping ehci->lock.
*/
-static void ehci_work (struct ehci_hcd *ehci)
+static void ehci_work(struct ehci_hcd *ehci)
{
/* another CPU may drop ehci->lock during a schedule scan while
* it reports urb completions. this flag guards against bogus
@@ -418,11 +418,11 @@ static void ehci_work (struct ehci_hcd *ehci)
/*
* Called when the ehci_hcd module is removed.
*/
-static void ehci_stop (struct usb_hcd *hcd)
+static void ehci_stop(struct usb_hcd *hcd)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
- ehci_dbg (ehci, "stop\n");
+ ehci_dbg(ehci, "stop\n");
/* no more interrupts ... */
@@ -432,22 +432,22 @@ static void ehci_stop (struct usb_hcd *hcd)
ehci_quiesce(ehci);
ehci_silence_controller(ehci);
- ehci_reset (ehci);
+ ehci_reset(ehci);
hrtimer_cancel(&ehci->hrtimer);
remove_sysfs_files(ehci);
- remove_debug_files (ehci);
+ remove_debug_files(ehci);
/* root hub is shut down separately (first, when possible) */
- spin_lock_irq (&ehci->lock);
+ spin_lock_irq(&ehci->lock);
end_free_itds(ehci);
- spin_unlock_irq (&ehci->lock);
- ehci_mem_cleanup (ehci);
+ spin_unlock_irq(&ehci->lock);
+ ehci_mem_cleanup(ehci);
if (ehci->amd_pll_fix == 1)
usb_amd_dev_put();
- dbg_status (ehci, "ehci_stop completed",
+ dbg_status(ehci, "ehci_stop completed",
ehci_readl(ehci, &ehci->regs->status));
}
@@ -496,19 +496,27 @@ static int ehci_init(struct usb_hcd *hcd)
if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
/* periodic schedule size can be smaller than default */
switch (EHCI_TUNE_FLS) {
- case 0: ehci->periodic_size = 1024; break;
- case 1: ehci->periodic_size = 512; break;
- case 2: ehci->periodic_size = 256; break;
- default: BUG();
+ case 0:
+ ehci->periodic_size = 1024;
+ break;
+ case 1:
+ ehci->periodic_size = 512;
+ break;
+ case 2:
+ ehci->periodic_size = 256;
+ break;
+ default:
+ BUG();
}
}
- if ((retval = ehci_mem_init(ehci, GFP_KERNEL)) < 0)
+ retval = ehci_mem_init(ehci, GFP_KERNEL);
+ if (retval < 0)
return retval;
/* controllers may cache some of the periodic schedule ... */
- if (HCC_ISOC_CACHE(hcc_params)) // full frame cache
+ if (HCC_ISOC_CACHE(hcc_params)) /* full frame cache */
ehci->i_thresh = 0;
- else // N microframes cached
+ else /* N microframes cached */
ehci->i_thresh = 2 + HCC_ISOC_THRES(hcc_params);
/*
@@ -568,9 +576,9 @@ static int ehci_init(struct usb_hcd *hcd)
}
/* start HC running; it's halted, ehci_init() has been run (once) */
-static int ehci_run (struct usb_hcd *hcd)
+static int ehci_run(struct usb_hcd *hcd)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
u32 temp;
u32 hcc_params;
@@ -597,19 +605,21 @@ static int ehci_run (struct usb_hcd *hcd)
if (HCC_64BIT_ADDR(hcc_params)) {
ehci_writel(ehci, 0, &ehci->regs->segment);
#if 0
-// this is deeply broken on almost all architectures
+/* this is deeply broken on almost all architectures */
if (!dma_set_mask(hcd->self.controller, DMA_BIT_MASK(64)))
ehci_info(ehci, "enabled 64bit DMA\n");
#endif
}
- // Philips, Intel, and maybe others need CMD_RUN before the
- // root hub will detect new devices (why?); NEC doesn't
+ /*
+ * Philips, Intel, and maybe others need CMD_RUN before the
+ * root hub will detect new devices (why?); NEC doesn't
+ */
ehci->command &= ~(CMD_LRESET|CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET);
ehci->command |= CMD_RUN;
ehci_writel(ehci, ehci->command, &ehci->regs->command);
- dbg_cmd (ehci, "init", ehci->command);
+ dbg_cmd(ehci, "init", ehci->command);
/*
* Start, enabling full USB 2.0 functionality ... usb 1.1 devices
@@ -634,7 +644,7 @@ static int ehci_run (struct usb_hcd *hcd)
ehci->last_periodic_enable = ktime_get_real();
temp = HC_VERSION(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase));
- ehci_info (ehci,
+ ehci_info(ehci,
"USB %x.%x started, EHCI %x.%02x%s\n",
((ehci->sbrn & 0xf0)>>4), (ehci->sbrn & 0x0f),
temp >> 8, temp & 0xff,
@@ -685,9 +695,9 @@ EXPORT_SYMBOL_GPL(ehci_setup);
/*-------------------------------------------------------------------------*/
-static irqreturn_t ehci_irq (struct usb_hcd *hcd)
+static irqreturn_t ehci_irq(struct usb_hcd *hcd)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
u32 status, masked_status, pcd_status = 0, cmd;
int bh;
unsigned long flags;
@@ -704,7 +714,7 @@ static irqreturn_t ehci_irq (struct usb_hcd *hcd)
/* e.g. cardbus physical eject */
if (status == ~(u32) 0) {
- ehci_dbg (ehci, "device removed\n");
+ ehci_dbg(ehci, "device removed\n");
goto dead;
}
@@ -726,11 +736,11 @@ static irqreturn_t ehci_irq (struct usb_hcd *hcd)
bh = 0;
/* normal [4.15.1.2] or error [4.15.1.1] completion */
- if (likely ((status & (STS_INT|STS_ERR)) != 0)) {
- if (likely ((status & STS_ERR) == 0))
- COUNT (ehci->stats.normal);
+ if (likely((status & (STS_INT|STS_ERR)) != 0)) {
+ if (likely((status & STS_ERR) == 0))
+ COUNT(ehci->stats.normal);
else
- COUNT (ehci->stats.error);
+ COUNT(ehci->stats.error);
bh = 1;
}
@@ -760,7 +770,7 @@ static irqreturn_t ehci_irq (struct usb_hcd *hcd)
/* remote wakeup [4.3.1] */
if (status & STS_PCD) {
- unsigned i = HCS_N_PORTS (ehci->hcs_params);
+ unsigned i = HCS_N_PORTS(ehci->hcs_params);
u32 ppcd = ~0;
/* kick root hub later */
@@ -799,14 +809,14 @@ static irqreturn_t ehci_irq (struct usb_hcd *hcd)
*/
ehci->reset_done[i] = jiffies + msecs_to_jiffies(25);
set_bit(i, &ehci->resuming_ports);
- ehci_dbg (ehci, "port %d remote wakeup\n", i + 1);
+ ehci_dbg(ehci, "port %d remote wakeup\n", i + 1);
usb_hcd_start_port_resume(&hcd->self, i);
mod_timer(&hcd->rh_timer, ehci->reset_done[i]);
}
}
/* PCI errors [4.15.2.4] */
- if (unlikely ((status & STS_FATAL) != 0)) {
+ if (unlikely((status & STS_FATAL) != 0)) {
ehci_err(ehci, "fatal error\n");
dbg_cmd(ehci, "fatal", cmd);
dbg_status(ehci, "fatal", status);
@@ -826,7 +836,7 @@ dead:
}
if (bh)
- ehci_work (ehci);
+ ehci_work(ehci);
spin_unlock_irqrestore(&ehci->lock, flags);
if (pcd_status)
usb_hcd_poll_rh_status(hcd);
@@ -847,17 +857,17 @@ dead:
* NOTE: control, bulk, and interrupt share the same code to append TDs
* to a (possibly active) QH, and the same QH scanning code.
*/
-static int ehci_urb_enqueue (
+static int ehci_urb_enqueue(
struct usb_hcd *hcd,
struct urb *urb,
gfp_t mem_flags
) {
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
struct list_head qtd_list;
- INIT_LIST_HEAD (&qtd_list);
+ INIT_LIST_HEAD(&qtd_list);
- switch (usb_pipetype (urb->pipe)) {
+ switch (usb_pipetype(urb->pipe)) {
case PIPE_CONTROL:
/* qh_completions() code doesn't handle all the fault cases
* in multi-TD control transfers. Even 1KB is rare anyway.
@@ -867,20 +877,20 @@ static int ehci_urb_enqueue (
/* FALLTHROUGH */
/* case PIPE_BULK: */
default:
- if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags))
+ if (!qh_urb_transaction(ehci, urb, &qtd_list, mem_flags))
return -ENOMEM;
return submit_async(ehci, urb, &qtd_list, mem_flags);
case PIPE_INTERRUPT:
- if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags))
+ if (!qh_urb_transaction(ehci, urb, &qtd_list, mem_flags))
return -ENOMEM;
return intr_submit(ehci, urb, &qtd_list, mem_flags);
case PIPE_ISOCHRONOUS:
if (urb->dev->speed == USB_SPEED_HIGH)
- return itd_submit (ehci, urb, mem_flags);
+ return itd_submit(ehci, urb, mem_flags);
else
- return sitd_submit (ehci, urb, mem_flags);
+ return sitd_submit(ehci, urb, mem_flags);
}
}
@@ -890,12 +900,12 @@ static int ehci_urb_enqueue (
static int ehci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
struct ehci_qh *qh;
unsigned long flags;
int rc;
- spin_lock_irqsave (&ehci->lock, flags);
+ spin_lock_irqsave(&ehci->lock, flags);
rc = usb_hcd_check_unlink_urb(hcd, urb, status);
if (rc)
goto done;
@@ -930,18 +940,18 @@ static int ehci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
}
}
done:
- spin_unlock_irqrestore (&ehci->lock, flags);
+ spin_unlock_irqrestore(&ehci->lock, flags);
return rc;
}
/*-------------------------------------------------------------------------*/
-// bulk qh holds the data toggle
+/* bulk qh holds the data toggle */
static void
-ehci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep)
+ehci_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ep)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
unsigned long flags;
struct ehci_qh *qh;
@@ -949,7 +959,7 @@ ehci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep)
/* ASSERT: nobody can be submitting urbs for this any more */
rescan:
- spin_lock_irqsave (&ehci->lock, flags);
+ spin_lock_irqsave(&ehci->lock, flags);
qh = ep->hcpriv;
if (!qh)
goto done;
@@ -982,13 +992,13 @@ rescan:
case QH_STATE_UNLINK: /* wait for hw to finish? */
case QH_STATE_UNLINK_WAIT:
idle_timeout:
- spin_unlock_irqrestore (&ehci->lock, flags);
+ spin_unlock_irqrestore(&ehci->lock, flags);
schedule_timeout_uninterruptible(1);
goto rescan;
case QH_STATE_IDLE: /* fully unlinked */
if (qh->clearing_tt)
goto idle_timeout;
- if (list_empty (&qh->qtd_list)) {
+ if (list_empty(&qh->qtd_list)) {
if (qh->ps.bw_uperiod)
reserve_release_intr_bandwidth(ehci, qh, -1);
qh_destroy(ehci, qh);
@@ -999,14 +1009,14 @@ idle_timeout:
/* caller was supposed to have unlinked any requests;
* that's not our job. just leak this memory.
*/
- ehci_err (ehci, "qh %p (#%02x) state %d%s\n",
+ ehci_err(ehci, "qh %p (#%02x) state %d%s\n",
qh, ep->desc.bEndpointAddress, qh->qh_state,
- list_empty (&qh->qtd_list) ? "" : "(has tds)");
+ list_empty(&qh->qtd_list) ? "" : "(has tds)");
break;
}
done:
ep->hcpriv = NULL;
- spin_unlock_irqrestore (&ehci->lock, flags);
+ spin_unlock_irqrestore(&ehci->lock, flags);
}
static void
@@ -1049,9 +1059,10 @@ ehci_endpoint_reset(struct usb_hcd *hcd, struct usb_host_endpoint *ep)
spin_unlock_irqrestore(&ehci->lock, flags);
}
-static int ehci_get_frame (struct usb_hcd *hcd)
+static int ehci_get_frame(struct usb_hcd *hcd)
{
- struct ehci_hcd *ehci = hcd_to_ehci (hcd);
+ struct ehci_hcd *ehci = hcd_to_ehci(hcd);
+
return (ehci_read_frame_index(ehci) >> 3) % ehci->periodic_size;
}
@@ -1247,8 +1258,8 @@ EXPORT_SYMBOL_GPL(ehci_init_driver);
/*-------------------------------------------------------------------------*/
MODULE_DESCRIPTION(DRIVER_DESC);
-MODULE_AUTHOR (DRIVER_AUTHOR);
-MODULE_LICENSE ("GPL");
+MODULE_AUTHOR(DRIVER_AUTHOR);
+MODULE_LICENSE("GPL");
#ifdef CONFIG_USB_EHCI_FSL
#include "ehci-fsl.c"
@@ -1300,6 +1311,11 @@ MODULE_LICENSE ("GPL");
#define PLATFORM_DRIVER ehci_hcd_sead3_driver
#endif
+#ifdef CONFIG_USB_CI13612_HCD
+#include "ehci-ci13612.c"
+#define PLATFORM_DRIVER ci13612_ehci_driver
+#endif
+
static int __init ehci_hcd_init(void)
{
int retval = 0;
@@ -1307,11 +1323,11 @@ static int __init ehci_hcd_init(void)
if (usb_disabled())
return -ENODEV;
- printk(KERN_INFO "%s: " DRIVER_DESC "\n", hcd_name);
+ pr_info("%s: " DRIVER_DESC "\n", hcd_name);
set_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
if (test_bit(USB_UHCI_LOADED, &usb_hcds_loaded) ||
test_bit(USB_OHCI_LOADED, &usb_hcds_loaded))
- printk(KERN_WARNING "Warning! ehci_hcd should always be loaded"
+ pr_warn("Warning! ehci_hcd should always be loaded"
" before uhci_hcd and ohci_hcd, not after\n");
pr_debug("%s: block sizes: qh %Zd qtd %Zd itd %Zd sitd %Zd\n",
@@ -1330,7 +1346,9 @@ static int __init ehci_hcd_init(void)
#ifdef PLATFORM_DRIVER
retval = platform_driver_register(&PLATFORM_DRIVER);
if (retval < 0)
+ {
goto clean0;
+ }
#endif
#ifdef PS3_SYSTEM_BUS_DRIVER
--
1.7.9.5
More information about the linux-yocto
mailing list