[PATCH 1/4] gemini: Add kernel v6.1 patches

Linus Walleij linus.walleij at linaro.org
Wed May 31 14:21:29 PDT 2023


This adds a bunch of patches for the v6.1 Gemini kernel.

For v5.15 this was down to a single upstream patch, but for
kernel v6.2 I reworked the USB code for FOTG210, so instead of
carrying over the half-baked and incomplete patch from v5.15
I just backported all the v6.2 patches, 31 in total, as it
creates full device USB mode for e.g. D-Link DNS-313.

Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
---
 ...pio-vbus-usb-Add-device-tree-probing.patch |    71 +
 ...llect-pieces-of-dual-mode-controller.patch | 16029 ++++++++++++++++
 ...-usb-fotg210-Compile-into-one-module.patch |   342 +
 ...usb-fotg210-Select-subdriver-by-mode.patch |    71 +
 ...b-fotg2-add-Gemini-specific-handling.patch |   139 +
 ...210-Fix-Kconfig-for-USB-host-modules.patch |    54 +
 ...FOTG210-should-depend-on-ARCH_GEMINI.patch |    29 +
 ...dev-pointer-in-probe-and-dev_message.patch |    64 +
 ...10-udc-Support-optional-external-PHY.patch |   162 +
 .../0010-fotg210-udc-Handle-PCLK.patch        |    94 +
 ...0-udc-Get-IRQ-using-platform_get_irq.patch |    72 +
 ...g210-udc-Remove-a-useless-assignment.patch |    42 +
 ...fix-potential-memory-leak-in-fotg210.patch |    61 +
 .../0014-usb-fotg210-fix-OTG-only-build.patch |    42 +
 ...fix-error-return-code-in-fotg210_udc.patch |    31 +
 ...-usb-fotg210-List-different-variants.patch |    28 +
 ...g210-Acquire-memory-resource-in-core.patch |   253 +
 ...-fotg210-Move-clock-handling-to-core.patch |   203 +
 ...-fotg210-Check-role-register-in-core.patch |    57 +
 ...dc-Assign-of_node-and-speed-on-start.patch |    37 +
 ...b-fotg210-udc-Implement-VBUS-session.patch |   101 +
 ...oduce-and-use-a-fotg210_ack_int-func.patch |   137 +
 ...10-udc-Improve-device-initialization.patch |    66 +
 ...use-sysfs_emit-to-instead-of-scnprin.patch |    35 +
 ...i-Push-down-flash-address-size-cells.patch |    68 +
 ...ni-wbd111-Use-RedBoot-partion-parser.patch |    57 +
 ...ni-wbd222-Use-RedBoot-partion-parser.patch |    57 +
 ...ARM-dts-gemini-Fix-USB-block-version.patch |    34 +
 ...mini-Enable-DNS313-FOTG210-as-periph.patch |    58 +
 ...-DIR-685-partition-table-for-OpenWrt.patch |    37 +
 30 files changed, 18531 insertions(+)
 create mode 100644 target/linux/gemini/patches-6.1/0001-usb-phy-phy-gpio-vbus-usb-Add-device-tree-probing.patch
 create mode 100644 target/linux/gemini/patches-6.1/0002-usb-fotg210-Collect-pieces-of-dual-mode-controller.patch
 create mode 100644 target/linux/gemini/patches-6.1/0003-usb-fotg210-Compile-into-one-module.patch
 create mode 100644 target/linux/gemini/patches-6.1/0004-usb-fotg210-Select-subdriver-by-mode.patch
 create mode 100644 target/linux/gemini/patches-6.1/0005-usb-fotg2-add-Gemini-specific-handling.patch
 create mode 100644 target/linux/gemini/patches-6.1/0006-usb-fotg210-Fix-Kconfig-for-USB-host-modules.patch
 create mode 100644 target/linux/gemini/patches-6.1/0007-usb-USB_FOTG210-should-depend-on-ARCH_GEMINI.patch
 create mode 100644 target/linux/gemini/patches-6.1/0008-fotg210-udc-Use-dev-pointer-in-probe-and-dev_message.patch
 create mode 100644 target/linux/gemini/patches-6.1/0009-fotg210-udc-Support-optional-external-PHY.patch
 create mode 100644 target/linux/gemini/patches-6.1/0010-fotg210-udc-Handle-PCLK.patch
 create mode 100644 target/linux/gemini/patches-6.1/0011-fotg210-udc-Get-IRQ-using-platform_get_irq.patch
 create mode 100644 target/linux/gemini/patches-6.1/0012-usb-fotg210-udc-Remove-a-useless-assignment.patch
 create mode 100644 target/linux/gemini/patches-6.1/0013-usb-fotg210-udc-fix-potential-memory-leak-in-fotg210.patch
 create mode 100644 target/linux/gemini/patches-6.1/0014-usb-fotg210-fix-OTG-only-build.patch
 create mode 100644 target/linux/gemini/patches-6.1/0015-usb-fotg210-udc-fix-error-return-code-in-fotg210_udc.patch
 create mode 100644 target/linux/gemini/patches-6.1/0016-usb-fotg210-List-different-variants.patch
 create mode 100644 target/linux/gemini/patches-6.1/0017-usb-fotg210-Acquire-memory-resource-in-core.patch
 create mode 100644 target/linux/gemini/patches-6.1/0018-usb-fotg210-Move-clock-handling-to-core.patch
 create mode 100644 target/linux/gemini/patches-6.1/0019-usb-fotg210-Check-role-register-in-core.patch
 create mode 100644 target/linux/gemini/patches-6.1/0020-usb-fotg210-udc-Assign-of_node-and-speed-on-start.patch
 create mode 100644 target/linux/gemini/patches-6.1/0021-usb-fotg210-udc-Implement-VBUS-session.patch
 create mode 100644 target/linux/gemini/patches-6.1/0022-fotg210-udc-Introduce-and-use-a-fotg210_ack_int-func.patch
 create mode 100644 target/linux/gemini/patches-6.1/0023-fotg210-udc-Improve-device-initialization.patch
 create mode 100644 target/linux/gemini/patches-6.1/0024-usb-fotg210-hcd-use-sysfs_emit-to-instead-of-scnprin.patch
 create mode 100644 target/linux/gemini/patches-6.1/0025-ARM-dts-gemini-Push-down-flash-address-size-cells.patch
 create mode 100644 target/linux/gemini/patches-6.1/0026-ARM-dts-gemini-wbd111-Use-RedBoot-partion-parser.patch
 create mode 100644 target/linux/gemini/patches-6.1/0027-ARM-dts-gemini-wbd222-Use-RedBoot-partion-parser.patch
 create mode 100644 target/linux/gemini/patches-6.1/0028-ARM-dts-gemini-Fix-USB-block-version.patch
 create mode 100644 target/linux/gemini/patches-6.1/0029-ARM-dts-gemini-Enable-DNS313-FOTG210-as-periph.patch
 create mode 100644 target/linux/gemini/patches-6.1/300-ARM-dts-Augment-DIR-685-partition-table-for-OpenWrt.patch

diff --git a/target/linux/gemini/patches-6.1/0001-usb-phy-phy-gpio-vbus-usb-Add-device-tree-probing.patch b/target/linux/gemini/patches-6.1/0001-usb-phy-phy-gpio-vbus-usb-Add-device-tree-probing.patch
new file mode 100644
index 000000000000..1adacae8781d
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0001-usb-phy-phy-gpio-vbus-usb-Add-device-tree-probing.patch
@@ -0,0 +1,71 @@
+From d5a026cc8306ccd3e99e1455c87e38f8e6fa18df Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 7 Nov 2022 00:05:06 +0100
+Subject: [PATCH 01/29] usb: phy: phy-gpio-vbus-usb: Add device tree probing
+
+Make it possible to probe the GPIO VBUS detection driver
+from the device tree compatible for GPIO USB B connectors.
+
+Since this driver is using the "gpio-usb-b-connector"
+compatible, it is important to discern it from the role
+switch connector driver (which does not provide a phy),
+so we add some Kconfig text and depend on !USB_CONN_GPIO.
+
+Cc: Rob Herring <robh at kernel.org>
+Cc: Prashant Malani <pmalani at chromium.org>
+Cc: Felipe Balbi <balbi at kernel.org>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221106230506.1646101-1-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/phy/Kconfig             |  6 +++++-
+ drivers/usb/phy/phy-gpio-vbus-usb.c | 12 ++++++++++++
+ 2 files changed, 17 insertions(+), 1 deletion(-)
+
+--- a/drivers/usb/phy/Kconfig
++++ b/drivers/usb/phy/Kconfig
+@@ -93,12 +93,16 @@ config USB_GPIO_VBUS
+ 	tristate "GPIO based peripheral-only VBUS sensing 'transceiver'"
+ 	depends on GPIOLIB || COMPILE_TEST
+ 	depends on USB_GADGET || !USB_GADGET # if USB_GADGET=m, this can't be 'y'
++	depends on !USB_CONN_GPIO
+ 	select USB_PHY
+ 	help
+ 	  Provides simple GPIO VBUS sensing for controllers with an
+ 	  internal transceiver via the usb_phy interface, and
+ 	  optionally control of a D+ pullup GPIO as well as a VBUS
+-	  current limit regulator.
++	  current limit regulator. This driver is for devices that do
++	  NOT support role switch. OTG devices that can do role switch
++	  (master/peripheral) shall use the USB based connection
++	  detection driver USB_CONN_GPIO.
+ 
+ config OMAP_OTG
+ 	tristate "OMAP USB OTG controller driver"
+--- a/drivers/usb/phy/phy-gpio-vbus-usb.c
++++ b/drivers/usb/phy/phy-gpio-vbus-usb.c
+@@ -366,12 +366,24 @@ static const struct dev_pm_ops gpio_vbus
+ 
+ MODULE_ALIAS("platform:gpio-vbus");
+ 
++/*
++ * NOTE: this driver matches against "gpio-usb-b-connector" for
++ * devices that do NOT support role switch.
++ */
++static const struct of_device_id gpio_vbus_of_match[] = {
++	{
++		.compatible = "gpio-usb-b-connector",
++	},
++	{},
++};
++
+ static struct platform_driver gpio_vbus_driver = {
+ 	.driver = {
+ 		.name  = "gpio-vbus",
+ #ifdef CONFIG_PM
+ 		.pm = &gpio_vbus_dev_pm_ops,
+ #endif
++		.of_match_table = gpio_vbus_of_match,
+ 	},
+ 	.probe		= gpio_vbus_probe,
+ 	.remove		= gpio_vbus_remove,
diff --git a/target/linux/gemini/patches-6.1/0002-usb-fotg210-Collect-pieces-of-dual-mode-controller.patch b/target/linux/gemini/patches-6.1/0002-usb-fotg210-Collect-pieces-of-dual-mode-controller.patch
new file mode 100644
index 000000000000..069791952a51
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0002-usb-fotg210-Collect-pieces-of-dual-mode-controller.patch
@@ -0,0 +1,16029 @@
+From 30367636930864f71b2bd462adedcf8484313864 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 23 Oct 2022 16:47:06 +0200
+Subject: [PATCH 02/29] usb: fotg210: Collect pieces of dual mode controller
+
+The Faraday FOTG210 is a dual-mode OTG USB controller that can
+act as host, peripheral or both. To be able to probe from one
+hardware description and to follow the pattern of other dual-
+mode controllers such as MUSB or MTU3 we need to collect the
+two, currently completely separate drivers in the same
+directory.
+
+After this, users need to select the main symbol USB_FOTG210
+and then each respective subdriver. We pave the road to
+compile both drivers into the same kernel and select the
+one we want to use at probe() time, and possibly add OTG
+support in the end.
+
+This patch doesn't do much more than create the new symbol
+and collect the drivers in one place. We also add a comment
+for the section of dual-mode controllers in the Kconfig
+file so people can see what these selections are about.
+
+Also add myself as maintainer as there has been little
+response on my patches to these drivers.
+
+Cc: Fabian Vogt <fabian at ritter-vogt.de>
+Cc: Yuan-Hsin Chen <yhchen at faraday-tech.com>
+Cc: Felipe Balbi <balbi at kernel.org>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221023144708.3596563-1-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ MAINTAINERS                                   |  6 ++++
+ drivers/usb/Kconfig                           |  4 +++
+ drivers/usb/Makefile                          |  2 ++
+ drivers/usb/fotg210/Kconfig                   | 36 +++++++++++++++++++
+ drivers/usb/fotg210/Makefile                  |  3 ++
+ drivers/usb/{host => fotg210}/fotg210-hcd.c   |  2 +-
+ .../{host/fotg210.h => fotg210/fotg210-hcd.h} |  0
+ .../usb/{gadget/udc => fotg210}/fotg210-udc.c |  2 +-
+ .../udc/fotg210.h => fotg210/fotg210-udc.h}   |  0
+ drivers/usb/gadget/udc/Kconfig                | 11 ------
+ drivers/usb/gadget/udc/Makefile               |  1 -
+ drivers/usb/host/Kconfig                      | 11 ------
+ drivers/usb/host/Makefile                     |  1 -
+ 13 files changed, 53 insertions(+), 26 deletions(-)
+ create mode 100644 drivers/usb/fotg210/Kconfig
+ create mode 100644 drivers/usb/fotg210/Makefile
+ rename drivers/usb/{host => fotg210}/fotg210-hcd.c (99%)
+ rename drivers/usb/{host/fotg210.h => fotg210/fotg210-hcd.h} (100%)
+ rename drivers/usb/{gadget/udc => fotg210}/fotg210-udc.c (99%)
+ rename drivers/usb/{gadget/udc/fotg210.h => fotg210/fotg210-udc.h} (100%)
+
+--- a/MAINTAINERS
++++ b/MAINTAINERS
+@@ -7869,6 +7869,12 @@ F:	fs/notify/fanotify/
+ F:	include/linux/fanotify.h
+ F:	include/uapi/linux/fanotify.h
+ 
++FARADAY FOTG210 USB2 DUAL-ROLE CONTROLLER
++M:	Linus Walleij <linus.walleij at linaro.org>
++L:	linux-usb at vger.kernel.org
++S:	Maintained
++F:	drivers/usb/fotg210/
++
+ FARSYNC SYNCHRONOUS DRIVER
+ M:	Kevin Curtis <kevin.curtis at farsite.co.uk>
+ S:	Supported
+--- a/drivers/usb/Kconfig
++++ b/drivers/usb/Kconfig
+@@ -111,8 +111,12 @@ source "drivers/usb/usbip/Kconfig"
+ 
+ endif
+ 
++comment "USB dual-mode controller drivers"
++
+ source "drivers/usb/cdns3/Kconfig"
+ 
++source "drivers/usb/fotg210/Kconfig"
++
+ source "drivers/usb/mtu3/Kconfig"
+ 
+ source "drivers/usb/musb/Kconfig"
+--- a/drivers/usb/Makefile
++++ b/drivers/usb/Makefile
+@@ -17,6 +17,8 @@ obj-$(CONFIG_USB_CDNS_SUPPORT)	+= cdns3/
+ obj-$(CONFIG_USB_CDNS3)		+= cdns3/
+ obj-$(CONFIG_USB_CDNSP_PCI)	+= cdns3/
+ 
++obj-$(CONFIG_USB_FOTG210)	+= fotg210/
++
+ obj-$(CONFIG_USB_MON)		+= mon/
+ obj-$(CONFIG_USB_MTU3)		+= mtu3/
+ 
+--- /dev/null
++++ b/drivers/usb/fotg210/Kconfig
+@@ -0,0 +1,36 @@
++# SPDX-License-Identifier: GPL-2.0
++
++config USB_FOTG210
++	tristate "Faraday FOTG210 USB2 Dual Role controller"
++	depends on USB || USB_GADGET
++	depends on HAS_DMA && HAS_IOMEM
++	default ARCH_GEMINI
++	help
++	  Faraday FOTG210 is a dual-mode USB controller that can act
++	  in both host controller and peripheral controller mode.
++
++if USB_FOTG210
++
++config USB_FOTG210_HCD
++	tristate "Faraday FOTG210 USB Host Controller support"
++	depends on USB
++	help
++	  Faraday FOTG210 is an OTG controller which can be configured as
++	  an USB2.0 host. It is designed to meet USB2.0 EHCI specification
++	  with minor modification.
++
++	  To compile this driver as a module, choose M here: the
++	  module will be called fotg210-hcd.
++
++config USB_FOTG210_UDC
++	depends on USB_GADGET
++	tristate "Faraday FOTG210 USB Peripheral Controller support"
++	help
++	   Faraday USB2.0 OTG controller which can be configured as
++	   high speed or full speed USB device. This driver suppports
++	   Bulk Transfer so far.
++
++	   Say "y" to link the driver statically, or "m" to build a
++	   dynamically linked module called "fotg210-udc".
++
++endif
+--- /dev/null
++++ b/drivers/usb/fotg210/Makefile
+@@ -0,0 +1,3 @@
++# SPDX-License-Identifier: GPL-2.0
++obj-$(CONFIG_USB_FOTG210_HCD)	+= fotg210-hcd.o
++obj-$(CONFIG_USB_FOTG210_UDC)	+= fotg210-udc.o
+--- a/drivers/usb/host/fotg210-hcd.c
++++ /dev/null
+@@ -1,5727 +0,0 @@
+-// SPDX-License-Identifier: GPL-2.0+
+-/* Faraday FOTG210 EHCI-like driver
+- *
+- * Copyright (c) 2013 Faraday Technology Corporation
+- *
+- * Author: Yuan-Hsin Chen <yhchen at faraday-tech.com>
+- *	   Feng-Hsin Chiang <john453 at faraday-tech.com>
+- *	   Po-Yu Chuang <ratbert.chuang at gmail.com>
+- *
+- * Most of code borrowed from the Linux-3.7 EHCI driver
+- */
+-#include <linux/module.h>
+-#include <linux/of.h>
+-#include <linux/device.h>
+-#include <linux/dmapool.h>
+-#include <linux/kernel.h>
+-#include <linux/delay.h>
+-#include <linux/ioport.h>
+-#include <linux/sched.h>
+-#include <linux/vmalloc.h>
+-#include <linux/errno.h>
+-#include <linux/init.h>
+-#include <linux/hrtimer.h>
+-#include <linux/list.h>
+-#include <linux/interrupt.h>
+-#include <linux/usb.h>
+-#include <linux/usb/hcd.h>
+-#include <linux/moduleparam.h>
+-#include <linux/dma-mapping.h>
+-#include <linux/debugfs.h>
+-#include <linux/slab.h>
+-#include <linux/uaccess.h>
+-#include <linux/platform_device.h>
+-#include <linux/io.h>
+-#include <linux/iopoll.h>
+-#include <linux/clk.h>
+-
+-#include <asm/byteorder.h>
+-#include <asm/irq.h>
+-#include <asm/unaligned.h>
+-
+-#define DRIVER_AUTHOR "Yuan-Hsin Chen"
+-#define DRIVER_DESC "FOTG210 Host Controller (EHCI) Driver"
+-static const char hcd_name[] = "fotg210_hcd";
+-
+-#undef FOTG210_URB_TRACE
+-#define FOTG210_STATS
+-
+-/* magic numbers that can affect system performance */
+-#define FOTG210_TUNE_CERR	3 /* 0-3 qtd retries; 0 == don't stop */
+-#define FOTG210_TUNE_RL_HS	4 /* nak throttle; see 4.9 */
+-#define FOTG210_TUNE_RL_TT	0
+-#define FOTG210_TUNE_MULT_HS	1 /* 1-3 transactions/uframe; 4.10.3 */
+-#define FOTG210_TUNE_MULT_TT	1
+-
+-/* Some drivers think it's safe to schedule isochronous transfers more than 256
+- * ms into the future (partly as a result of an old bug in the scheduling
+- * code).  In an attempt to avoid trouble, we will use a minimum scheduling
+- * length of 512 frames instead of 256.
+- */
+-#define FOTG210_TUNE_FLS 1 /* (medium) 512-frame schedule */
+-
+-/* Initial IRQ latency:  faster than hw default */
+-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;
+-module_param(park, uint, S_IRUGO);
+-MODULE_PARM_DESC(park, "park setting; 1-3 back-to-back async packets");
+-
+-/* for link power management(LPM) feature */
+-static unsigned int hird;
+-module_param(hird, int, S_IRUGO);
+-MODULE_PARM_DESC(hird, "host initiated resume duration, +1 for each 75us");
+-
+-#define INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT)
+-
+-#include "fotg210.h"
+-
+-#define fotg210_dbg(fotg210, fmt, args...) \
+-	dev_dbg(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
+-#define fotg210_err(fotg210, fmt, args...) \
+-	dev_err(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
+-#define fotg210_info(fotg210, fmt, args...) \
+-	dev_info(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
+-#define fotg210_warn(fotg210, fmt, args...) \
+-	dev_warn(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
+-
+-/* check the values in the HCSPARAMS register (host controller _Structural_
+- * parameters) see EHCI spec, Table 2-4 for each value
+- */
+-static void dbg_hcs_params(struct fotg210_hcd *fotg210, char *label)
+-{
+-	u32 params = fotg210_readl(fotg210, &fotg210->caps->hcs_params);
+-
+-	fotg210_dbg(fotg210, "%s hcs_params 0x%x ports=%d\n", label, params,
+-			HCS_N_PORTS(params));
+-}
+-
+-/* check the values in the HCCPARAMS register (host controller _Capability_
+- * parameters) see EHCI Spec, Table 2-5 for each value
+- */
+-static void dbg_hcc_params(struct fotg210_hcd *fotg210, char *label)
+-{
+-	u32 params = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
+-
+-	fotg210_dbg(fotg210, "%s hcc_params %04x uframes %s%s\n", label,
+-			params,
+-			HCC_PGM_FRAMELISTLEN(params) ? "256/512/1024" : "1024",
+-			HCC_CANPARK(params) ? " park" : "");
+-}
+-
+-static void __maybe_unused
+-dbg_qtd(const char *label, struct fotg210_hcd *fotg210, struct fotg210_qtd *qtd)
+-{
+-	fotg210_dbg(fotg210, "%s td %p n%08x %08x t%08x p0=%08x\n", label, qtd,
+-			hc32_to_cpup(fotg210, &qtd->hw_next),
+-			hc32_to_cpup(fotg210, &qtd->hw_alt_next),
+-			hc32_to_cpup(fotg210, &qtd->hw_token),
+-			hc32_to_cpup(fotg210, &qtd->hw_buf[0]));
+-	if (qtd->hw_buf[1])
+-		fotg210_dbg(fotg210, "  p1=%08x p2=%08x p3=%08x p4=%08x\n",
+-				hc32_to_cpup(fotg210, &qtd->hw_buf[1]),
+-				hc32_to_cpup(fotg210, &qtd->hw_buf[2]),
+-				hc32_to_cpup(fotg210, &qtd->hw_buf[3]),
+-				hc32_to_cpup(fotg210, &qtd->hw_buf[4]));
+-}
+-
+-static void __maybe_unused
+-dbg_qh(const char *label, struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	struct fotg210_qh_hw *hw = qh->hw;
+-
+-	fotg210_dbg(fotg210, "%s qh %p n%08x info %x %x qtd %x\n", label, qh,
+-			hw->hw_next, hw->hw_info1, hw->hw_info2,
+-			hw->hw_current);
+-
+-	dbg_qtd("overlay", fotg210, (struct fotg210_qtd *) &hw->hw_qtd_next);
+-}
+-
+-static void __maybe_unused
+-dbg_itd(const char *label, struct fotg210_hcd *fotg210, struct fotg210_itd *itd)
+-{
+-	fotg210_dbg(fotg210, "%s[%d] itd %p, next %08x, urb %p\n", label,
+-			itd->frame, itd, hc32_to_cpu(fotg210, itd->hw_next),
+-			itd->urb);
+-
+-	fotg210_dbg(fotg210,
+-			"  trans: %08x %08x %08x %08x %08x %08x %08x %08x\n",
+-			hc32_to_cpu(fotg210, itd->hw_transaction[0]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[1]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[2]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[3]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[4]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[5]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[6]),
+-			hc32_to_cpu(fotg210, itd->hw_transaction[7]));
+-
+-	fotg210_dbg(fotg210,
+-			"  buf:   %08x %08x %08x %08x %08x %08x %08x\n",
+-			hc32_to_cpu(fotg210, itd->hw_bufp[0]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[1]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[2]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[3]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[4]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[5]),
+-			hc32_to_cpu(fotg210, itd->hw_bufp[6]));
+-
+-	fotg210_dbg(fotg210, "  index: %d %d %d %d %d %d %d %d\n",
+-			itd->index[0], itd->index[1], itd->index[2],
+-			itd->index[3], itd->index[4], itd->index[5],
+-			itd->index[6], itd->index[7]);
+-}
+-
+-static int __maybe_unused
+-dbg_status_buf(char *buf, unsigned len, const char *label, u32 status)
+-{
+-	return scnprintf(buf, len, "%s%sstatus %04x%s%s%s%s%s%s%s%s%s%s",
+-			label, label[0] ? " " : "", status,
+-			(status & STS_ASS) ? " Async" : "",
+-			(status & STS_PSS) ? " Periodic" : "",
+-			(status & STS_RECL) ? " Recl" : "",
+-			(status & STS_HALT) ? " Halt" : "",
+-			(status & STS_IAA) ? " IAA" : "",
+-			(status & STS_FATAL) ? " FATAL" : "",
+-			(status & STS_FLR) ? " FLR" : "",
+-			(status & STS_PCD) ? " PCD" : "",
+-			(status & STS_ERR) ? " ERR" : "",
+-			(status & STS_INT) ? " INT" : "");
+-}
+-
+-static int __maybe_unused
+-dbg_intr_buf(char *buf, unsigned len, const char *label, u32 enable)
+-{
+-	return scnprintf(buf, len, "%s%sintrenable %02x%s%s%s%s%s%s",
+-			label, label[0] ? " " : "", enable,
+-			(enable & STS_IAA) ? " IAA" : "",
+-			(enable & STS_FATAL) ? " FATAL" : "",
+-			(enable & STS_FLR) ? " FLR" : "",
+-			(enable & STS_PCD) ? " PCD" : "",
+-			(enable & STS_ERR) ? " ERR" : "",
+-			(enable & STS_INT) ? " INT" : "");
+-}
+-
+-static const char *const fls_strings[] = { "1024", "512", "256", "??" };
+-
+-static int dbg_command_buf(char *buf, unsigned len, const char *label,
+-		u32 command)
+-{
+-	return scnprintf(buf, len,
+-			"%s%scommand %07x %s=%d ithresh=%d%s%s%s period=%s%s %s",
+-			label, label[0] ? " " : "", command,
+-			(command & CMD_PARK) ? " park" : "(park)",
+-			CMD_PARK_CNT(command),
+-			(command >> 16) & 0x3f,
+-			(command & CMD_IAAD) ? " IAAD" : "",
+-			(command & CMD_ASE) ? " Async" : "",
+-			(command & CMD_PSE) ? " Periodic" : "",
+-			fls_strings[(command >> 2) & 0x3],
+-			(command & CMD_RESET) ? " Reset" : "",
+-			(command & CMD_RUN) ? "RUN" : "HALT");
+-}
+-
+-static char *dbg_port_buf(char *buf, unsigned len, const char *label, int port,
+-		u32 status)
+-{
+-	char *sig;
+-
+-	/* signaling state */
+-	switch (status & (3 << 10)) {
+-	case 0 << 10:
+-		sig = "se0";
+-		break;
+-	case 1 << 10:
+-		sig = "k";
+-		break; /* low speed */
+-	case 2 << 10:
+-		sig = "j";
+-		break;
+-	default:
+-		sig = "?";
+-		break;
+-	}
+-
+-	scnprintf(buf, len, "%s%sport:%d status %06x %d sig=%s%s%s%s%s%s%s%s",
+-			label, label[0] ? " " : "", port, status,
+-			status >> 25, /*device address */
+-			sig,
+-			(status & PORT_RESET) ? " RESET" : "",
+-			(status & PORT_SUSPEND) ? " SUSPEND" : "",
+-			(status & PORT_RESUME) ? " RESUME" : "",
+-			(status & PORT_PEC) ? " PEC" : "",
+-			(status & PORT_PE) ? " PE" : "",
+-			(status & PORT_CSC) ? " CSC" : "",
+-			(status & PORT_CONNECT) ? " CONNECT" : "");
+-
+-	return buf;
+-}
+-
+-/* functions have the "wrong" filename when they're output... */
+-#define dbg_status(fotg210, label, status) {			\
+-	char _buf[80];						\
+-	dbg_status_buf(_buf, sizeof(_buf), label, status);	\
+-	fotg210_dbg(fotg210, "%s\n", _buf);			\
+-}
+-
+-#define dbg_cmd(fotg210, label, command) {			\
+-	char _buf[80];						\
+-	dbg_command_buf(_buf, sizeof(_buf), label, command);	\
+-	fotg210_dbg(fotg210, "%s\n", _buf);			\
+-}
+-
+-#define dbg_port(fotg210, label, port, status) {			       \
+-	char _buf[80];							       \
+-	fotg210_dbg(fotg210, "%s\n",					       \
+-			dbg_port_buf(_buf, sizeof(_buf), label, port, status));\
+-}
+-
+-/* troubleshooting help: expose state in debugfs */
+-static int debug_async_open(struct inode *, struct file *);
+-static int debug_periodic_open(struct inode *, struct file *);
+-static int debug_registers_open(struct inode *, struct file *);
+-static int debug_async_open(struct inode *, struct file *);
+-
+-static ssize_t debug_output(struct file*, char __user*, size_t, loff_t*);
+-static int debug_close(struct inode *, struct file *);
+-
+-static const struct file_operations debug_async_fops = {
+-	.owner		= THIS_MODULE,
+-	.open		= debug_async_open,
+-	.read		= debug_output,
+-	.release	= debug_close,
+-	.llseek		= default_llseek,
+-};
+-static const struct file_operations debug_periodic_fops = {
+-	.owner		= THIS_MODULE,
+-	.open		= debug_periodic_open,
+-	.read		= debug_output,
+-	.release	= debug_close,
+-	.llseek		= default_llseek,
+-};
+-static const struct file_operations debug_registers_fops = {
+-	.owner		= THIS_MODULE,
+-	.open		= debug_registers_open,
+-	.read		= debug_output,
+-	.release	= debug_close,
+-	.llseek		= default_llseek,
+-};
+-
+-static struct dentry *fotg210_debug_root;
+-
+-struct debug_buffer {
+-	ssize_t (*fill_func)(struct debug_buffer *);	/* fill method */
+-	struct usb_bus *bus;
+-	struct mutex mutex;	/* protect filling of buffer */
+-	size_t count;		/* number of characters filled into buffer */
+-	char *output_buf;
+-	size_t alloc_size;
+-};
+-
+-static inline char speed_char(u32 scratch)
+-{
+-	switch (scratch & (3 << 12)) {
+-	case QH_FULL_SPEED:
+-		return 'f';
+-
+-	case QH_LOW_SPEED:
+-		return 'l';
+-
+-	case QH_HIGH_SPEED:
+-		return 'h';
+-
+-	default:
+-		return '?';
+-	}
+-}
+-
+-static inline char token_mark(struct fotg210_hcd *fotg210, __hc32 token)
+-{
+-	__u32 v = hc32_to_cpu(fotg210, token);
+-
+-	if (v & QTD_STS_ACTIVE)
+-		return '*';
+-	if (v & QTD_STS_HALT)
+-		return '-';
+-	if (!IS_SHORT_READ(v))
+-		return ' ';
+-	/* tries to advance through hw_alt_next */
+-	return '/';
+-}
+-
+-static void qh_lines(struct fotg210_hcd *fotg210, struct fotg210_qh *qh,
+-		char **nextp, unsigned *sizep)
+-{
+-	u32 scratch;
+-	u32 hw_curr;
+-	struct fotg210_qtd *td;
+-	unsigned temp;
+-	unsigned size = *sizep;
+-	char *next = *nextp;
+-	char mark;
+-	__le32 list_end = FOTG210_LIST_END(fotg210);
+-	struct fotg210_qh_hw *hw = qh->hw;
+-
+-	if (hw->hw_qtd_next == list_end) /* NEC does this */
+-		mark = '@';
+-	else
+-		mark = token_mark(fotg210, hw->hw_token);
+-	if (mark == '/') { /* qh_alt_next controls qh advance? */
+-		if ((hw->hw_alt_next & QTD_MASK(fotg210)) ==
+-		    fotg210->async->hw->hw_alt_next)
+-			mark = '#'; /* blocked */
+-		else if (hw->hw_alt_next == list_end)
+-			mark = '.'; /* use hw_qtd_next */
+-		/* else alt_next points to some other qtd */
+-	}
+-	scratch = hc32_to_cpup(fotg210, &hw->hw_info1);
+-	hw_curr = (mark == '*') ? hc32_to_cpup(fotg210, &hw->hw_current) : 0;
+-	temp = scnprintf(next, size,
+-			"qh/%p dev%d %cs ep%d %08x %08x(%08x%c %s nak%d)",
+-			qh, scratch & 0x007f,
+-			speed_char(scratch),
+-			(scratch >> 8) & 0x000f,
+-			scratch, hc32_to_cpup(fotg210, &hw->hw_info2),
+-			hc32_to_cpup(fotg210, &hw->hw_token), mark,
+-			(cpu_to_hc32(fotg210, QTD_TOGGLE) & hw->hw_token)
+-				? "data1" : "data0",
+-			(hc32_to_cpup(fotg210, &hw->hw_alt_next) >> 1) & 0x0f);
+-	size -= temp;
+-	next += temp;
+-
+-	/* hc may be modifying the list as we read it ... */
+-	list_for_each_entry(td, &qh->qtd_list, qtd_list) {
+-		scratch = hc32_to_cpup(fotg210, &td->hw_token);
+-		mark = ' ';
+-		if (hw_curr == td->qtd_dma)
+-			mark = '*';
+-		else if (hw->hw_qtd_next == cpu_to_hc32(fotg210, td->qtd_dma))
+-			mark = '+';
+-		else if (QTD_LENGTH(scratch)) {
+-			if (td->hw_alt_next == fotg210->async->hw->hw_alt_next)
+-				mark = '#';
+-			else if (td->hw_alt_next != list_end)
+-				mark = '/';
+-		}
+-		temp = snprintf(next, size,
+-				"\n\t%p%c%s len=%d %08x urb %p",
+-				td, mark, ({ char *tmp;
+-				switch ((scratch>>8)&0x03) {
+-				case 0:
+-					tmp = "out";
+-					break;
+-				case 1:
+-					tmp = "in";
+-					break;
+-				case 2:
+-					tmp = "setup";
+-					break;
+-				default:
+-					tmp = "?";
+-					break;
+-				 } tmp; }),
+-				(scratch >> 16) & 0x7fff,
+-				scratch,
+-				td->urb);
+-		if (size < temp)
+-			temp = size;
+-		size -= temp;
+-		next += temp;
+-		if (temp == size)
+-			goto done;
+-	}
+-
+-	temp = snprintf(next, size, "\n");
+-	if (size < temp)
+-		temp = size;
+-
+-	size -= temp;
+-	next += temp;
+-
+-done:
+-	*sizep = size;
+-	*nextp = next;
+-}
+-
+-static ssize_t fill_async_buffer(struct debug_buffer *buf)
+-{
+-	struct usb_hcd *hcd;
+-	struct fotg210_hcd *fotg210;
+-	unsigned long flags;
+-	unsigned temp, size;
+-	char *next;
+-	struct fotg210_qh *qh;
+-
+-	hcd = bus_to_hcd(buf->bus);
+-	fotg210 = hcd_to_fotg210(hcd);
+-	next = buf->output_buf;
+-	size = buf->alloc_size;
+-
+-	*next = 0;
+-
+-	/* dumps a snapshot of the async schedule.
+-	 * usually empty except for long-term bulk reads, or head.
+-	 * one QH per line, and TDs we know about
+-	 */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	for (qh = fotg210->async->qh_next.qh; size > 0 && qh;
+-			qh = qh->qh_next.qh)
+-		qh_lines(fotg210, qh, &next, &size);
+-	if (fotg210->async_unlink && size > 0) {
+-		temp = scnprintf(next, size, "\nunlink =\n");
+-		size -= temp;
+-		next += temp;
+-
+-		for (qh = fotg210->async_unlink; size > 0 && qh;
+-				qh = qh->unlink_next)
+-			qh_lines(fotg210, qh, &next, &size);
+-	}
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-
+-	return strlen(buf->output_buf);
+-}
+-
+-/* count tds, get ep direction */
+-static unsigned output_buf_tds_dir(char *buf, struct fotg210_hcd *fotg210,
+-		struct fotg210_qh_hw *hw, struct fotg210_qh *qh, unsigned size)
+-{
+-	u32 scratch = hc32_to_cpup(fotg210, &hw->hw_info1);
+-	struct fotg210_qtd *qtd;
+-	char *type = "";
+-	unsigned temp = 0;
+-
+-	/* count tds, get ep direction */
+-	list_for_each_entry(qtd, &qh->qtd_list, qtd_list) {
+-		temp++;
+-		switch ((hc32_to_cpu(fotg210, qtd->hw_token) >> 8) & 0x03) {
+-		case 0:
+-			type = "out";
+-			continue;
+-		case 1:
+-			type = "in";
+-			continue;
+-		}
+-	}
+-
+-	return scnprintf(buf, size, "(%c%d ep%d%s [%d/%d] q%d p%d)",
+-			speed_char(scratch), scratch & 0x007f,
+-			(scratch >> 8) & 0x000f, type, qh->usecs,
+-			qh->c_usecs, temp, (scratch >> 16) & 0x7ff);
+-}
+-
+-#define DBG_SCHED_LIMIT 64
+-static ssize_t fill_periodic_buffer(struct debug_buffer *buf)
+-{
+-	struct usb_hcd *hcd;
+-	struct fotg210_hcd *fotg210;
+-	unsigned long flags;
+-	union fotg210_shadow p, *seen;
+-	unsigned temp, size, seen_count;
+-	char *next;
+-	unsigned i;
+-	__hc32 tag;
+-
+-	seen = kmalloc_array(DBG_SCHED_LIMIT, sizeof(*seen), GFP_ATOMIC);
+-	if (!seen)
+-		return 0;
+-
+-	seen_count = 0;
+-
+-	hcd = bus_to_hcd(buf->bus);
+-	fotg210 = hcd_to_fotg210(hcd);
+-	next = buf->output_buf;
+-	size = buf->alloc_size;
+-
+-	temp = scnprintf(next, size, "size = %d\n", fotg210->periodic_size);
+-	size -= temp;
+-	next += temp;
+-
+-	/* dump a snapshot of the periodic schedule.
+-	 * iso changes, interrupt usually doesn't.
+-	 */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	for (i = 0; i < fotg210->periodic_size; i++) {
+-		p = fotg210->pshadow[i];
+-		if (likely(!p.ptr))
+-			continue;
+-
+-		tag = Q_NEXT_TYPE(fotg210, fotg210->periodic[i]);
+-
+-		temp = scnprintf(next, size, "%4d: ", i);
+-		size -= temp;
+-		next += temp;
+-
+-		do {
+-			struct fotg210_qh_hw *hw;
+-
+-			switch (hc32_to_cpu(fotg210, tag)) {
+-			case Q_TYPE_QH:
+-				hw = p.qh->hw;
+-				temp = scnprintf(next, size, " qh%d-%04x/%p",
+-						p.qh->period,
+-						hc32_to_cpup(fotg210,
+-							&hw->hw_info2)
+-							/* uframe masks */
+-							& (QH_CMASK | QH_SMASK),
+-						p.qh);
+-				size -= temp;
+-				next += temp;
+-				/* don't repeat what follows this qh */
+-				for (temp = 0; temp < seen_count; temp++) {
+-					if (seen[temp].ptr != p.ptr)
+-						continue;
+-					if (p.qh->qh_next.ptr) {
+-						temp = scnprintf(next, size,
+-								" ...");
+-						size -= temp;
+-						next += temp;
+-					}
+-					break;
+-				}
+-				/* show more info the first time around */
+-				if (temp == seen_count) {
+-					temp = output_buf_tds_dir(next,
+-							fotg210, hw,
+-							p.qh, size);
+-
+-					if (seen_count < DBG_SCHED_LIMIT)
+-						seen[seen_count++].qh = p.qh;
+-				} else
+-					temp = 0;
+-				tag = Q_NEXT_TYPE(fotg210, hw->hw_next);
+-				p = p.qh->qh_next;
+-				break;
+-			case Q_TYPE_FSTN:
+-				temp = scnprintf(next, size,
+-						" fstn-%8x/%p",
+-						p.fstn->hw_prev, p.fstn);
+-				tag = Q_NEXT_TYPE(fotg210, p.fstn->hw_next);
+-				p = p.fstn->fstn_next;
+-				break;
+-			case Q_TYPE_ITD:
+-				temp = scnprintf(next, size,
+-						" itd/%p", p.itd);
+-				tag = Q_NEXT_TYPE(fotg210, p.itd->hw_next);
+-				p = p.itd->itd_next;
+-				break;
+-			}
+-			size -= temp;
+-			next += temp;
+-		} while (p.ptr);
+-
+-		temp = scnprintf(next, size, "\n");
+-		size -= temp;
+-		next += temp;
+-	}
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	kfree(seen);
+-
+-	return buf->alloc_size - size;
+-}
+-#undef DBG_SCHED_LIMIT
+-
+-static const char *rh_state_string(struct fotg210_hcd *fotg210)
+-{
+-	switch (fotg210->rh_state) {
+-	case FOTG210_RH_HALTED:
+-		return "halted";
+-	case FOTG210_RH_SUSPENDED:
+-		return "suspended";
+-	case FOTG210_RH_RUNNING:
+-		return "running";
+-	case FOTG210_RH_STOPPING:
+-		return "stopping";
+-	}
+-	return "?";
+-}
+-
+-static ssize_t fill_registers_buffer(struct debug_buffer *buf)
+-{
+-	struct usb_hcd *hcd;
+-	struct fotg210_hcd *fotg210;
+-	unsigned long flags;
+-	unsigned temp, size, i;
+-	char *next, scratch[80];
+-	static const char fmt[] = "%*s\n";
+-	static const char label[] = "";
+-
+-	hcd = bus_to_hcd(buf->bus);
+-	fotg210 = hcd_to_fotg210(hcd);
+-	next = buf->output_buf;
+-	size = buf->alloc_size;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	if (!HCD_HW_ACCESSIBLE(hcd)) {
+-		size = scnprintf(next, size,
+-				"bus %s, device %s\n"
+-				"%s\n"
+-				"SUSPENDED(no register access)\n",
+-				hcd->self.controller->bus->name,
+-				dev_name(hcd->self.controller),
+-				hcd->product_desc);
+-		goto done;
+-	}
+-
+-	/* Capability Registers */
+-	i = HC_VERSION(fotg210, fotg210_readl(fotg210,
+-			&fotg210->caps->hc_capbase));
+-	temp = scnprintf(next, size,
+-			"bus %s, device %s\n"
+-			"%s\n"
+-			"EHCI %x.%02x, rh state %s\n",
+-			hcd->self.controller->bus->name,
+-			dev_name(hcd->self.controller),
+-			hcd->product_desc,
+-			i >> 8, i & 0x0ff, rh_state_string(fotg210));
+-	size -= temp;
+-	next += temp;
+-
+-	/* FIXME interpret both types of params */
+-	i = fotg210_readl(fotg210, &fotg210->caps->hcs_params);
+-	temp = scnprintf(next, size, "structural params 0x%08x\n", i);
+-	size -= temp;
+-	next += temp;
+-
+-	i = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
+-	temp = scnprintf(next, size, "capability params 0x%08x\n", i);
+-	size -= temp;
+-	next += temp;
+-
+-	/* Operational Registers */
+-	temp = dbg_status_buf(scratch, sizeof(scratch), label,
+-			fotg210_readl(fotg210, &fotg210->regs->status));
+-	temp = scnprintf(next, size, fmt, temp, scratch);
+-	size -= temp;
+-	next += temp;
+-
+-	temp = dbg_command_buf(scratch, sizeof(scratch), label,
+-			fotg210_readl(fotg210, &fotg210->regs->command));
+-	temp = scnprintf(next, size, fmt, temp, scratch);
+-	size -= temp;
+-	next += temp;
+-
+-	temp = dbg_intr_buf(scratch, sizeof(scratch), label,
+-			fotg210_readl(fotg210, &fotg210->regs->intr_enable));
+-	temp = scnprintf(next, size, fmt, temp, scratch);
+-	size -= temp;
+-	next += temp;
+-
+-	temp = scnprintf(next, size, "uframe %04x\n",
+-			fotg210_read_frame_index(fotg210));
+-	size -= temp;
+-	next += temp;
+-
+-	if (fotg210->async_unlink) {
+-		temp = scnprintf(next, size, "async unlink qh %p\n",
+-				fotg210->async_unlink);
+-		size -= temp;
+-		next += temp;
+-	}
+-
+-#ifdef FOTG210_STATS
+-	temp = scnprintf(next, size,
+-			"irq normal %ld err %ld iaa %ld(lost %ld)\n",
+-			fotg210->stats.normal, fotg210->stats.error,
+-			fotg210->stats.iaa, fotg210->stats.lost_iaa);
+-	size -= temp;
+-	next += temp;
+-
+-	temp = scnprintf(next, size, "complete %ld unlink %ld\n",
+-			fotg210->stats.complete, fotg210->stats.unlink);
+-	size -= temp;
+-	next += temp;
+-#endif
+-
+-done:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-
+-	return buf->alloc_size - size;
+-}
+-
+-static struct debug_buffer
+-*alloc_buffer(struct usb_bus *bus, ssize_t (*fill_func)(struct debug_buffer *))
+-{
+-	struct debug_buffer *buf;
+-
+-	buf = kzalloc(sizeof(struct debug_buffer), GFP_KERNEL);
+-
+-	if (buf) {
+-		buf->bus = bus;
+-		buf->fill_func = fill_func;
+-		mutex_init(&buf->mutex);
+-		buf->alloc_size = PAGE_SIZE;
+-	}
+-
+-	return buf;
+-}
+-
+-static int fill_buffer(struct debug_buffer *buf)
+-{
+-	int ret = 0;
+-
+-	if (!buf->output_buf)
+-		buf->output_buf = vmalloc(buf->alloc_size);
+-
+-	if (!buf->output_buf) {
+-		ret = -ENOMEM;
+-		goto out;
+-	}
+-
+-	ret = buf->fill_func(buf);
+-
+-	if (ret >= 0) {
+-		buf->count = ret;
+-		ret = 0;
+-	}
+-
+-out:
+-	return ret;
+-}
+-
+-static ssize_t debug_output(struct file *file, char __user *user_buf,
+-		size_t len, loff_t *offset)
+-{
+-	struct debug_buffer *buf = file->private_data;
+-	int ret = 0;
+-
+-	mutex_lock(&buf->mutex);
+-	if (buf->count == 0) {
+-		ret = fill_buffer(buf);
+-		if (ret != 0) {
+-			mutex_unlock(&buf->mutex);
+-			goto out;
+-		}
+-	}
+-	mutex_unlock(&buf->mutex);
+-
+-	ret = simple_read_from_buffer(user_buf, len, offset,
+-			buf->output_buf, buf->count);
+-
+-out:
+-	return ret;
+-
+-}
+-
+-static int debug_close(struct inode *inode, struct file *file)
+-{
+-	struct debug_buffer *buf = file->private_data;
+-
+-	if (buf) {
+-		vfree(buf->output_buf);
+-		kfree(buf);
+-	}
+-
+-	return 0;
+-}
+-static int debug_async_open(struct inode *inode, struct file *file)
+-{
+-	file->private_data = alloc_buffer(inode->i_private, fill_async_buffer);
+-
+-	return file->private_data ? 0 : -ENOMEM;
+-}
+-
+-static int debug_periodic_open(struct inode *inode, struct file *file)
+-{
+-	struct debug_buffer *buf;
+-
+-	buf = alloc_buffer(inode->i_private, fill_periodic_buffer);
+-	if (!buf)
+-		return -ENOMEM;
+-
+-	buf->alloc_size = (sizeof(void *) == 4 ? 6 : 8)*PAGE_SIZE;
+-	file->private_data = buf;
+-	return 0;
+-}
+-
+-static int debug_registers_open(struct inode *inode, struct file *file)
+-{
+-	file->private_data = alloc_buffer(inode->i_private,
+-			fill_registers_buffer);
+-
+-	return file->private_data ? 0 : -ENOMEM;
+-}
+-
+-static inline void create_debug_files(struct fotg210_hcd *fotg210)
+-{
+-	struct usb_bus *bus = &fotg210_to_hcd(fotg210)->self;
+-	struct dentry *root;
+-
+-	root = debugfs_create_dir(bus->bus_name, fotg210_debug_root);
+-
+-	debugfs_create_file("async", S_IRUGO, root, bus, &debug_async_fops);
+-	debugfs_create_file("periodic", S_IRUGO, root, bus,
+-			    &debug_periodic_fops);
+-	debugfs_create_file("registers", S_IRUGO, root, bus,
+-			    &debug_registers_fops);
+-}
+-
+-static inline void remove_debug_files(struct fotg210_hcd *fotg210)
+-{
+-	struct usb_bus *bus = &fotg210_to_hcd(fotg210)->self;
+-
+-	debugfs_lookup_and_remove(bus->bus_name, fotg210_debug_root);
+-}
+-
+-/* handshake - spin reading hc until handshake completes or fails
+- * @ptr: address of hc register to be read
+- * @mask: bits to look at in result of read
+- * @done: value of those bits when handshake succeeds
+- * @usec: timeout in microseconds
+- *
+- * Returns negative errno, or zero on success
+- *
+- * Success happens when the "mask" bits have the specified value (hardware
+- * handshake done).  There are two failure modes:  "usec" have passed (major
+- * hardware flakeout), or the register reads as all-ones (hardware removed).
+- *
+- * That last failure should_only happen in cases like physical cardbus eject
+- * before driver shutdown. But it also seems to be caused by bugs in cardbus
+- * bridge shutdown:  shutting down the bridge before the devices using it.
+- */
+-static int handshake(struct fotg210_hcd *fotg210, void __iomem *ptr,
+-		u32 mask, u32 done, int usec)
+-{
+-	u32 result;
+-	int ret;
+-
+-	ret = readl_poll_timeout_atomic(ptr, result,
+-					((result & mask) == done ||
+-					 result == U32_MAX), 1, usec);
+-	if (result == U32_MAX)		/* card removed */
+-		return -ENODEV;
+-
+-	return ret;
+-}
+-
+-/* 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 fotg210_halt(struct fotg210_hcd *fotg210)
+-{
+-	u32 temp;
+-
+-	spin_lock_irq(&fotg210->lock);
+-
+-	/* disable any irqs left enabled by previous code */
+-	fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
+-
+-	/*
+-	 * This routine gets called during probe before fotg210->command
+-	 * has been initialized, so we can't rely on its value.
+-	 */
+-	fotg210->command &= ~CMD_RUN;
+-	temp = fotg210_readl(fotg210, &fotg210->regs->command);
+-	temp &= ~(CMD_RUN | CMD_IAAD);
+-	fotg210_writel(fotg210, temp, &fotg210->regs->command);
+-
+-	spin_unlock_irq(&fotg210->lock);
+-	synchronize_irq(fotg210_to_hcd(fotg210)->irq);
+-
+-	return handshake(fotg210, &fotg210->regs->status,
+-			STS_HALT, STS_HALT, 16 * 125);
+-}
+-
+-/* Reset a non-running (STS_HALT == 1) controller.
+- * Must be called with interrupts enabled and the lock not held.
+- */
+-static int fotg210_reset(struct fotg210_hcd *fotg210)
+-{
+-	int retval;
+-	u32 command = fotg210_readl(fotg210, &fotg210->regs->command);
+-
+-	/* If the EHCI debug controller is active, special care must be
+-	 * taken before and after a host controller reset
+-	 */
+-	if (fotg210->debug && !dbgp_reset_prep(fotg210_to_hcd(fotg210)))
+-		fotg210->debug = NULL;
+-
+-	command |= CMD_RESET;
+-	dbg_cmd(fotg210, "reset", command);
+-	fotg210_writel(fotg210, command, &fotg210->regs->command);
+-	fotg210->rh_state = FOTG210_RH_HALTED;
+-	fotg210->next_statechange = jiffies;
+-	retval = handshake(fotg210, &fotg210->regs->command,
+-			CMD_RESET, 0, 250 * 1000);
+-
+-	if (retval)
+-		return retval;
+-
+-	if (fotg210->debug)
+-		dbgp_external_startup(fotg210_to_hcd(fotg210));
+-
+-	fotg210->port_c_suspend = fotg210->suspended_ports =
+-			fotg210->resuming_ports = 0;
+-	return retval;
+-}
+-
+-/* Idle the controller (turn off the schedules).
+- * Must be called with interrupts enabled and the lock not held.
+- */
+-static void fotg210_quiesce(struct fotg210_hcd *fotg210)
+-{
+-	u32 temp;
+-
+-	if (fotg210->rh_state != FOTG210_RH_RUNNING)
+-		return;
+-
+-	/* wait for any schedule enables/disables to take effect */
+-	temp = (fotg210->command << 10) & (STS_ASS | STS_PSS);
+-	handshake(fotg210, &fotg210->regs->status, STS_ASS | STS_PSS, temp,
+-			16 * 125);
+-
+-	/* then disable anything that's still active */
+-	spin_lock_irq(&fotg210->lock);
+-	fotg210->command &= ~(CMD_ASE | CMD_PSE);
+-	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
+-	spin_unlock_irq(&fotg210->lock);
+-
+-	/* hardware can take 16 microframes to turn off ... */
+-	handshake(fotg210, &fotg210->regs->status, STS_ASS | STS_PSS, 0,
+-			16 * 125);
+-}
+-
+-static void end_unlink_async(struct fotg210_hcd *fotg210);
+-static void unlink_empty_async(struct fotg210_hcd *fotg210);
+-static void fotg210_work(struct fotg210_hcd *fotg210);
+-static void start_unlink_intr(struct fotg210_hcd *fotg210,
+-			      struct fotg210_qh *qh);
+-static void end_unlink_intr(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
+-
+-/* Set a bit in the USBCMD register */
+-static void fotg210_set_command_bit(struct fotg210_hcd *fotg210, u32 bit)
+-{
+-	fotg210->command |= bit;
+-	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
+-
+-	/* unblock posted write */
+-	fotg210_readl(fotg210, &fotg210->regs->command);
+-}
+-
+-/* Clear a bit in the USBCMD register */
+-static void fotg210_clear_command_bit(struct fotg210_hcd *fotg210, u32 bit)
+-{
+-	fotg210->command &= ~bit;
+-	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
+-
+-	/* unblock posted write */
+-	fotg210_readl(fotg210, &fotg210->regs->command);
+-}
+-
+-/* EHCI timer support...  Now using hrtimers.
+- *
+- * Lots of different events are triggered from fotg210->hrtimer.  Whenever
+- * the timer routine runs, it checks each possible event; events that are
+- * currently enabled and whose expiration time has passed get handled.
+- * The set of enabled events is stored as a collection of bitflags in
+- * fotg210->enabled_hrtimer_events, and they are numbered in order of
+- * increasing delay values (ranging between 1 ms and 100 ms).
+- *
+- * Rather than implementing a sorted list or tree of all pending events,
+- * we keep track only of the lowest-numbered pending event, in
+- * fotg210->next_hrtimer_event.  Whenever fotg210->hrtimer gets restarted, its
+- * expiration time is set to the timeout value for this event.
+- *
+- * As a result, events might not get handled right away; the actual delay
+- * could be anywhere up to twice the requested delay.  This doesn't
+- * matter, because none of the events are especially time-critical.  The
+- * ones that matter most all have a delay of 1 ms, so they will be
+- * handled after 2 ms at most, which is okay.  In addition to this, we
+- * allow for an expiration range of 1 ms.
+- */
+-
+-/* Delay lengths for the hrtimer event types.
+- * Keep this list sorted by delay length, in the same order as
+- * the event types indexed by enum fotg210_hrtimer_event in fotg210.h.
+- */
+-static unsigned event_delays_ns[] = {
+-	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_ASS */
+-	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_PSS */
+-	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_DEAD */
+-	1125 * NSEC_PER_USEC,	/* FOTG210_HRTIMER_UNLINK_INTR */
+-	2 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_FREE_ITDS */
+-	6 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_ASYNC_UNLINKS */
+-	10 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_IAA_WATCHDOG */
+-	10 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_DISABLE_PERIODIC */
+-	15 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_DISABLE_ASYNC */
+-	100 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_IO_WATCHDOG */
+-};
+-
+-/* Enable a pending hrtimer event */
+-static void fotg210_enable_event(struct fotg210_hcd *fotg210, unsigned event,
+-		bool resched)
+-{
+-	ktime_t *timeout = &fotg210->hr_timeouts[event];
+-
+-	if (resched)
+-		*timeout = ktime_add(ktime_get(), event_delays_ns[event]);
+-	fotg210->enabled_hrtimer_events |= (1 << event);
+-
+-	/* Track only the lowest-numbered pending event */
+-	if (event < fotg210->next_hrtimer_event) {
+-		fotg210->next_hrtimer_event = event;
+-		hrtimer_start_range_ns(&fotg210->hrtimer, *timeout,
+-				NSEC_PER_MSEC, HRTIMER_MODE_ABS);
+-	}
+-}
+-
+-
+-/* Poll the STS_ASS status bit; see when it agrees with CMD_ASE */
+-static void fotg210_poll_ASS(struct fotg210_hcd *fotg210)
+-{
+-	unsigned actual, want;
+-
+-	/* Don't enable anything if the controller isn't running (e.g., died) */
+-	if (fotg210->rh_state != FOTG210_RH_RUNNING)
+-		return;
+-
+-	want = (fotg210->command & CMD_ASE) ? STS_ASS : 0;
+-	actual = fotg210_readl(fotg210, &fotg210->regs->status) & STS_ASS;
+-
+-	if (want != actual) {
+-
+-		/* Poll again later, but give up after about 20 ms */
+-		if (fotg210->ASS_poll_count++ < 20) {
+-			fotg210_enable_event(fotg210, FOTG210_HRTIMER_POLL_ASS,
+-					true);
+-			return;
+-		}
+-		fotg210_dbg(fotg210, "Waited too long for the async schedule status (%x/%x), giving up\n",
+-				want, actual);
+-	}
+-	fotg210->ASS_poll_count = 0;
+-
+-	/* The status is up-to-date; restart or stop the schedule as needed */
+-	if (want == 0) {	/* Stopped */
+-		if (fotg210->async_count > 0)
+-			fotg210_set_command_bit(fotg210, CMD_ASE);
+-
+-	} else {		/* Running */
+-		if (fotg210->async_count == 0) {
+-
+-			/* Turn off the schedule after a while */
+-			fotg210_enable_event(fotg210,
+-					FOTG210_HRTIMER_DISABLE_ASYNC,
+-					true);
+-		}
+-	}
+-}
+-
+-/* Turn off the async schedule after a brief delay */
+-static void fotg210_disable_ASE(struct fotg210_hcd *fotg210)
+-{
+-	fotg210_clear_command_bit(fotg210, CMD_ASE);
+-}
+-
+-
+-/* Poll the STS_PSS status bit; see when it agrees with CMD_PSE */
+-static void fotg210_poll_PSS(struct fotg210_hcd *fotg210)
+-{
+-	unsigned actual, want;
+-
+-	/* Don't do anything if the controller isn't running (e.g., died) */
+-	if (fotg210->rh_state != FOTG210_RH_RUNNING)
+-		return;
+-
+-	want = (fotg210->command & CMD_PSE) ? STS_PSS : 0;
+-	actual = fotg210_readl(fotg210, &fotg210->regs->status) & STS_PSS;
+-
+-	if (want != actual) {
+-
+-		/* Poll again later, but give up after about 20 ms */
+-		if (fotg210->PSS_poll_count++ < 20) {
+-			fotg210_enable_event(fotg210, FOTG210_HRTIMER_POLL_PSS,
+-					true);
+-			return;
+-		}
+-		fotg210_dbg(fotg210, "Waited too long for the periodic schedule status (%x/%x), giving up\n",
+-				want, actual);
+-	}
+-	fotg210->PSS_poll_count = 0;
+-
+-	/* The status is up-to-date; restart or stop the schedule as needed */
+-	if (want == 0) {	/* Stopped */
+-		if (fotg210->periodic_count > 0)
+-			fotg210_set_command_bit(fotg210, CMD_PSE);
+-
+-	} else {		/* Running */
+-		if (fotg210->periodic_count == 0) {
+-
+-			/* Turn off the schedule after a while */
+-			fotg210_enable_event(fotg210,
+-					FOTG210_HRTIMER_DISABLE_PERIODIC,
+-					true);
+-		}
+-	}
+-}
+-
+-/* Turn off the periodic schedule after a brief delay */
+-static void fotg210_disable_PSE(struct fotg210_hcd *fotg210)
+-{
+-	fotg210_clear_command_bit(fotg210, CMD_PSE);
+-}
+-
+-
+-/* Poll the STS_HALT status bit; see when a dead controller stops */
+-static void fotg210_handle_controller_death(struct fotg210_hcd *fotg210)
+-{
+-	if (!(fotg210_readl(fotg210, &fotg210->regs->status) & STS_HALT)) {
+-
+-		/* Give up after a few milliseconds */
+-		if (fotg210->died_poll_count++ < 5) {
+-			/* Try again later */
+-			fotg210_enable_event(fotg210,
+-					FOTG210_HRTIMER_POLL_DEAD, true);
+-			return;
+-		}
+-		fotg210_warn(fotg210, "Waited too long for the controller to stop, giving up\n");
+-	}
+-
+-	/* Clean up the mess */
+-	fotg210->rh_state = FOTG210_RH_HALTED;
+-	fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
+-	fotg210_work(fotg210);
+-	end_unlink_async(fotg210);
+-
+-	/* Not in process context, so don't try to reset the controller */
+-}
+-
+-
+-/* Handle unlinked interrupt QHs once they are gone from the hardware */
+-static void fotg210_handle_intr_unlinks(struct fotg210_hcd *fotg210)
+-{
+-	bool stopped = (fotg210->rh_state < FOTG210_RH_RUNNING);
+-
+-	/*
+-	 * Process all the QHs on the intr_unlink list that were added
+-	 * before the current unlink cycle began.  The list is in
+-	 * temporal order, so stop when we reach the first entry in the
+-	 * current cycle.  But if the root hub isn't running then
+-	 * process all the QHs on the list.
+-	 */
+-	fotg210->intr_unlinking = true;
+-	while (fotg210->intr_unlink) {
+-		struct fotg210_qh *qh = fotg210->intr_unlink;
+-
+-		if (!stopped && qh->unlink_cycle == fotg210->intr_unlink_cycle)
+-			break;
+-		fotg210->intr_unlink = qh->unlink_next;
+-		qh->unlink_next = NULL;
+-		end_unlink_intr(fotg210, qh);
+-	}
+-
+-	/* Handle remaining entries later */
+-	if (fotg210->intr_unlink) {
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_UNLINK_INTR,
+-				true);
+-		++fotg210->intr_unlink_cycle;
+-	}
+-	fotg210->intr_unlinking = false;
+-}
+-
+-
+-/* Start another free-iTDs/siTDs cycle */
+-static void start_free_itds(struct fotg210_hcd *fotg210)
+-{
+-	if (!(fotg210->enabled_hrtimer_events &
+-			BIT(FOTG210_HRTIMER_FREE_ITDS))) {
+-		fotg210->last_itd_to_free = list_entry(
+-				fotg210->cached_itd_list.prev,
+-				struct fotg210_itd, itd_list);
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_FREE_ITDS, true);
+-	}
+-}
+-
+-/* Wait for controller to stop using old iTDs and siTDs */
+-static void end_free_itds(struct fotg210_hcd *fotg210)
+-{
+-	struct fotg210_itd *itd, *n;
+-
+-	if (fotg210->rh_state < FOTG210_RH_RUNNING)
+-		fotg210->last_itd_to_free = NULL;
+-
+-	list_for_each_entry_safe(itd, n, &fotg210->cached_itd_list, itd_list) {
+-		list_del(&itd->itd_list);
+-		dma_pool_free(fotg210->itd_pool, itd, itd->itd_dma);
+-		if (itd == fotg210->last_itd_to_free)
+-			break;
+-	}
+-
+-	if (!list_empty(&fotg210->cached_itd_list))
+-		start_free_itds(fotg210);
+-}
+-
+-
+-/* Handle lost (or very late) IAA interrupts */
+-static void fotg210_iaa_watchdog(struct fotg210_hcd *fotg210)
+-{
+-	if (fotg210->rh_state != FOTG210_RH_RUNNING)
+-		return;
+-
+-	/*
+-	 * Lost IAA irqs wedge things badly; seen first with a vt8235.
+-	 * So we need this watchdog, but must protect it against both
+-	 * (a) SMP races against real IAA firing and retriggering, and
+-	 * (b) clean HC shutdown, when IAA watchdog was pending.
+-	 */
+-	if (fotg210->async_iaa) {
+-		u32 cmd, status;
+-
+-		/* If we get here, IAA is *REALLY* late.  It's barely
+-		 * conceivable that the system is so busy that CMD_IAAD
+-		 * is still legitimately set, so let's be sure it's
+-		 * clear before we read STS_IAA.  (The HC should clear
+-		 * CMD_IAAD when it sets STS_IAA.)
+-		 */
+-		cmd = fotg210_readl(fotg210, &fotg210->regs->command);
+-
+-		/*
+-		 * If IAA is set here it either legitimately triggered
+-		 * after the watchdog timer expired (_way_ late, so we'll
+-		 * still count it as lost) ... or a silicon erratum:
+-		 * - VIA seems to set IAA without triggering the IRQ;
+-		 * - IAAD potentially cleared without setting IAA.
+-		 */
+-		status = fotg210_readl(fotg210, &fotg210->regs->status);
+-		if ((status & STS_IAA) || !(cmd & CMD_IAAD)) {
+-			INCR(fotg210->stats.lost_iaa);
+-			fotg210_writel(fotg210, STS_IAA,
+-					&fotg210->regs->status);
+-		}
+-
+-		fotg210_dbg(fotg210, "IAA watchdog: status %x cmd %x\n",
+-				status, cmd);
+-		end_unlink_async(fotg210);
+-	}
+-}
+-
+-
+-/* Enable the I/O watchdog, if appropriate */
+-static void turn_on_io_watchdog(struct fotg210_hcd *fotg210)
+-{
+-	/* Not needed if the controller isn't running or it's already enabled */
+-	if (fotg210->rh_state != FOTG210_RH_RUNNING ||
+-			(fotg210->enabled_hrtimer_events &
+-			BIT(FOTG210_HRTIMER_IO_WATCHDOG)))
+-		return;
+-
+-	/*
+-	 * Isochronous transfers always need the watchdog.
+-	 * For other sorts we use it only if the flag is set.
+-	 */
+-	if (fotg210->isoc_count > 0 || (fotg210->need_io_watchdog &&
+-			fotg210->async_count + fotg210->intr_count > 0))
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_IO_WATCHDOG,
+-				true);
+-}
+-
+-
+-/* Handler functions for the hrtimer event types.
+- * Keep this array in the same order as the event types indexed by
+- * enum fotg210_hrtimer_event in fotg210.h.
+- */
+-static void (*event_handlers[])(struct fotg210_hcd *) = {
+-	fotg210_poll_ASS,			/* FOTG210_HRTIMER_POLL_ASS */
+-	fotg210_poll_PSS,			/* FOTG210_HRTIMER_POLL_PSS */
+-	fotg210_handle_controller_death,	/* FOTG210_HRTIMER_POLL_DEAD */
+-	fotg210_handle_intr_unlinks,	/* FOTG210_HRTIMER_UNLINK_INTR */
+-	end_free_itds,			/* FOTG210_HRTIMER_FREE_ITDS */
+-	unlink_empty_async,		/* FOTG210_HRTIMER_ASYNC_UNLINKS */
+-	fotg210_iaa_watchdog,		/* FOTG210_HRTIMER_IAA_WATCHDOG */
+-	fotg210_disable_PSE,		/* FOTG210_HRTIMER_DISABLE_PERIODIC */
+-	fotg210_disable_ASE,		/* FOTG210_HRTIMER_DISABLE_ASYNC */
+-	fotg210_work,			/* FOTG210_HRTIMER_IO_WATCHDOG */
+-};
+-
+-static enum hrtimer_restart fotg210_hrtimer_func(struct hrtimer *t)
+-{
+-	struct fotg210_hcd *fotg210 =
+-			container_of(t, struct fotg210_hcd, hrtimer);
+-	ktime_t now;
+-	unsigned long events;
+-	unsigned long flags;
+-	unsigned e;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	events = fotg210->enabled_hrtimer_events;
+-	fotg210->enabled_hrtimer_events = 0;
+-	fotg210->next_hrtimer_event = FOTG210_HRTIMER_NO_EVENT;
+-
+-	/*
+-	 * Check each pending event.  If its time has expired, handle
+-	 * the event; otherwise re-enable it.
+-	 */
+-	now = ktime_get();
+-	for_each_set_bit(e, &events, FOTG210_HRTIMER_NUM_EVENTS) {
+-		if (ktime_compare(now, fotg210->hr_timeouts[e]) >= 0)
+-			event_handlers[e](fotg210);
+-		else
+-			fotg210_enable_event(fotg210, e, false);
+-	}
+-
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return HRTIMER_NORESTART;
+-}
+-
+-#define fotg210_bus_suspend NULL
+-#define fotg210_bus_resume NULL
+-
+-static int check_reset_complete(struct fotg210_hcd *fotg210, int index,
+-		u32 __iomem *status_reg, int port_status)
+-{
+-	if (!(port_status & PORT_CONNECT))
+-		return port_status;
+-
+-	/* if reset finished and it's still not enabled -- handoff */
+-	if (!(port_status & PORT_PE))
+-		/* with integrated TT, there's nobody to hand it to! */
+-		fotg210_dbg(fotg210, "Failed to enable port %d on root hub TT\n",
+-				index + 1);
+-	else
+-		fotg210_dbg(fotg210, "port %d reset complete, port enabled\n",
+-				index + 1);
+-
+-	return port_status;
+-}
+-
+-
+-/* build "status change" packet (one or two bytes) from HC registers */
+-
+-static int fotg210_hub_status_data(struct usb_hcd *hcd, char *buf)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	u32 temp, status;
+-	u32 mask;
+-	int retval = 1;
+-	unsigned long flags;
+-
+-	/* init status to no-changes */
+-	buf[0] = 0;
+-
+-	/* Inform the core about resumes-in-progress by returning
+-	 * a non-zero value even if there are no status changes.
+-	 */
+-	status = fotg210->resuming_ports;
+-
+-	mask = PORT_CSC | PORT_PEC;
+-	/* PORT_RESUME from hardware ~= PORT_STAT_C_SUSPEND */
+-
+-	/* no hub change reports (bit 0) for now (power, ...) */
+-
+-	/* port N changes (bit N)? */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	temp = fotg210_readl(fotg210, &fotg210->regs->port_status);
+-
+-	/*
+-	 * Return status information even for ports with OWNER set.
+-	 * Otherwise hub_wq wouldn't see the disconnect event when a
+-	 * high-speed device is switched over to the companion
+-	 * controller by the user.
+-	 */
+-
+-	if ((temp & mask) != 0 || test_bit(0, &fotg210->port_c_suspend) ||
+-			(fotg210->reset_done[0] &&
+-			time_after_eq(jiffies, fotg210->reset_done[0]))) {
+-		buf[0] |= 1 << 1;
+-		status = STS_PCD;
+-	}
+-	/* FIXME autosuspend idle root hubs */
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return status ? retval : 0;
+-}
+-
+-static void fotg210_hub_descriptor(struct fotg210_hcd *fotg210,
+-		struct usb_hub_descriptor *desc)
+-{
+-	int ports = HCS_N_PORTS(fotg210->hcs_params);
+-	u16 temp;
+-
+-	desc->bDescriptorType = USB_DT_HUB;
+-	desc->bPwrOn2PwrGood = 10;	/* fotg210 1.0, 2.3.9 says 20ms max */
+-	desc->bHubContrCurrent = 0;
+-
+-	desc->bNbrPorts = ports;
+-	temp = 1 + (ports / 8);
+-	desc->bDescLength = 7 + 2 * temp;
+-
+-	/* two bitmaps:  ports removable, and usb 1.0 legacy PortPwrCtrlMask */
+-	memset(&desc->u.hs.DeviceRemovable[0], 0, temp);
+-	memset(&desc->u.hs.DeviceRemovable[temp], 0xff, temp);
+-
+-	temp = HUB_CHAR_INDV_PORT_OCPM;	/* per-port overcurrent reporting */
+-	temp |= HUB_CHAR_NO_LPSM;	/* no power switching */
+-	desc->wHubCharacteristics = cpu_to_le16(temp);
+-}
+-
+-static int fotg210_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
+-		u16 wIndex, char *buf, u16 wLength)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	int ports = HCS_N_PORTS(fotg210->hcs_params);
+-	u32 __iomem *status_reg = &fotg210->regs->port_status;
+-	u32 temp, temp1, status;
+-	unsigned long flags;
+-	int retval = 0;
+-	unsigned selector;
+-
+-	/*
+-	 * FIXME:  support SetPortFeatures USB_PORT_FEAT_INDICATOR.
+-	 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
+-	 * (track current state ourselves) ... blink for diagnostics,
+-	 * power, "this is the one", etc.  EHCI spec supports this.
+-	 */
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	switch (typeReq) {
+-	case ClearHubFeature:
+-		switch (wValue) {
+-		case C_HUB_LOCAL_POWER:
+-		case C_HUB_OVER_CURRENT:
+-			/* no hub-wide feature/status flags */
+-			break;
+-		default:
+-			goto error;
+-		}
+-		break;
+-	case ClearPortFeature:
+-		if (!wIndex || wIndex > ports)
+-			goto error;
+-		wIndex--;
+-		temp = fotg210_readl(fotg210, status_reg);
+-		temp &= ~PORT_RWC_BITS;
+-
+-		/*
+-		 * Even if OWNER is set, so the port is owned by the
+-		 * companion controller, hub_wq needs to be able to clear
+-		 * the port-change status bits (especially
+-		 * USB_PORT_STAT_C_CONNECTION).
+-		 */
+-
+-		switch (wValue) {
+-		case USB_PORT_FEAT_ENABLE:
+-			fotg210_writel(fotg210, temp & ~PORT_PE, status_reg);
+-			break;
+-		case USB_PORT_FEAT_C_ENABLE:
+-			fotg210_writel(fotg210, temp | PORT_PEC, status_reg);
+-			break;
+-		case USB_PORT_FEAT_SUSPEND:
+-			if (temp & PORT_RESET)
+-				goto error;
+-			if (!(temp & PORT_SUSPEND))
+-				break;
+-			if ((temp & PORT_PE) == 0)
+-				goto error;
+-
+-			/* resume signaling for 20 msec */
+-			fotg210_writel(fotg210, temp | PORT_RESUME, status_reg);
+-			fotg210->reset_done[wIndex] = jiffies
+-					+ msecs_to_jiffies(USB_RESUME_TIMEOUT);
+-			break;
+-		case USB_PORT_FEAT_C_SUSPEND:
+-			clear_bit(wIndex, &fotg210->port_c_suspend);
+-			break;
+-		case USB_PORT_FEAT_C_CONNECTION:
+-			fotg210_writel(fotg210, temp | PORT_CSC, status_reg);
+-			break;
+-		case USB_PORT_FEAT_C_OVER_CURRENT:
+-			fotg210_writel(fotg210, temp | OTGISR_OVC,
+-					&fotg210->regs->otgisr);
+-			break;
+-		case USB_PORT_FEAT_C_RESET:
+-			/* GetPortStatus clears reset */
+-			break;
+-		default:
+-			goto error;
+-		}
+-		fotg210_readl(fotg210, &fotg210->regs->command);
+-		break;
+-	case GetHubDescriptor:
+-		fotg210_hub_descriptor(fotg210, (struct usb_hub_descriptor *)
+-				buf);
+-		break;
+-	case GetHubStatus:
+-		/* no hub-wide feature/status flags */
+-		memset(buf, 0, 4);
+-		/*cpu_to_le32s ((u32 *) buf); */
+-		break;
+-	case GetPortStatus:
+-		if (!wIndex || wIndex > ports)
+-			goto error;
+-		wIndex--;
+-		status = 0;
+-		temp = fotg210_readl(fotg210, status_reg);
+-
+-		/* wPortChange bits */
+-		if (temp & PORT_CSC)
+-			status |= USB_PORT_STAT_C_CONNECTION << 16;
+-		if (temp & PORT_PEC)
+-			status |= USB_PORT_STAT_C_ENABLE << 16;
+-
+-		temp1 = fotg210_readl(fotg210, &fotg210->regs->otgisr);
+-		if (temp1 & OTGISR_OVC)
+-			status |= USB_PORT_STAT_C_OVERCURRENT << 16;
+-
+-		/* whoever resumes must GetPortStatus to complete it!! */
+-		if (temp & PORT_RESUME) {
+-
+-			/* Remote Wakeup received? */
+-			if (!fotg210->reset_done[wIndex]) {
+-				/* resume signaling for 20 msec */
+-				fotg210->reset_done[wIndex] = jiffies
+-						+ msecs_to_jiffies(20);
+-				/* check the port again */
+-				mod_timer(&fotg210_to_hcd(fotg210)->rh_timer,
+-						fotg210->reset_done[wIndex]);
+-			}
+-
+-			/* resume completed? */
+-			else if (time_after_eq(jiffies,
+-					fotg210->reset_done[wIndex])) {
+-				clear_bit(wIndex, &fotg210->suspended_ports);
+-				set_bit(wIndex, &fotg210->port_c_suspend);
+-				fotg210->reset_done[wIndex] = 0;
+-
+-				/* stop resume signaling */
+-				temp = fotg210_readl(fotg210, status_reg);
+-				fotg210_writel(fotg210, temp &
+-						~(PORT_RWC_BITS | PORT_RESUME),
+-						status_reg);
+-				clear_bit(wIndex, &fotg210->resuming_ports);
+-				retval = handshake(fotg210, status_reg,
+-						PORT_RESUME, 0, 2000);/* 2ms */
+-				if (retval != 0) {
+-					fotg210_err(fotg210,
+-							"port %d resume error %d\n",
+-							wIndex + 1, retval);
+-					goto error;
+-				}
+-				temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
+-			}
+-		}
+-
+-		/* whoever resets must GetPortStatus to complete it!! */
+-		if ((temp & PORT_RESET) && time_after_eq(jiffies,
+-				fotg210->reset_done[wIndex])) {
+-			status |= USB_PORT_STAT_C_RESET << 16;
+-			fotg210->reset_done[wIndex] = 0;
+-			clear_bit(wIndex, &fotg210->resuming_ports);
+-
+-			/* force reset to complete */
+-			fotg210_writel(fotg210,
+-					temp & ~(PORT_RWC_BITS | PORT_RESET),
+-					status_reg);
+-			/* REVISIT:  some hardware needs 550+ usec to clear
+-			 * this bit; seems too long to spin routinely...
+-			 */
+-			retval = handshake(fotg210, status_reg,
+-					PORT_RESET, 0, 1000);
+-			if (retval != 0) {
+-				fotg210_err(fotg210, "port %d reset error %d\n",
+-						wIndex + 1, retval);
+-				goto error;
+-			}
+-
+-			/* see what we found out */
+-			temp = check_reset_complete(fotg210, wIndex, status_reg,
+-					fotg210_readl(fotg210, status_reg));
+-
+-			/* restart schedule */
+-			fotg210->command |= CMD_RUN;
+-			fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
+-		}
+-
+-		if (!(temp & (PORT_RESUME|PORT_RESET))) {
+-			fotg210->reset_done[wIndex] = 0;
+-			clear_bit(wIndex, &fotg210->resuming_ports);
+-		}
+-
+-		/* transfer dedicated ports to the companion hc */
+-		if ((temp & PORT_CONNECT) &&
+-				test_bit(wIndex, &fotg210->companion_ports)) {
+-			temp &= ~PORT_RWC_BITS;
+-			fotg210_writel(fotg210, temp, status_reg);
+-			fotg210_dbg(fotg210, "port %d --> companion\n",
+-					wIndex + 1);
+-			temp = fotg210_readl(fotg210, status_reg);
+-		}
+-
+-		/*
+-		 * Even if OWNER is set, there's no harm letting hub_wq
+-		 * see the wPortStatus values (they should all be 0 except
+-		 * for PORT_POWER anyway).
+-		 */
+-
+-		if (temp & PORT_CONNECT) {
+-			status |= USB_PORT_STAT_CONNECTION;
+-			status |= fotg210_port_speed(fotg210, temp);
+-		}
+-		if (temp & PORT_PE)
+-			status |= USB_PORT_STAT_ENABLE;
+-
+-		/* maybe the port was unsuspended without our knowledge */
+-		if (temp & (PORT_SUSPEND|PORT_RESUME)) {
+-			status |= USB_PORT_STAT_SUSPEND;
+-		} else if (test_bit(wIndex, &fotg210->suspended_ports)) {
+-			clear_bit(wIndex, &fotg210->suspended_ports);
+-			clear_bit(wIndex, &fotg210->resuming_ports);
+-			fotg210->reset_done[wIndex] = 0;
+-			if (temp & PORT_PE)
+-				set_bit(wIndex, &fotg210->port_c_suspend);
+-		}
+-
+-		temp1 = fotg210_readl(fotg210, &fotg210->regs->otgisr);
+-		if (temp1 & OTGISR_OVC)
+-			status |= USB_PORT_STAT_OVERCURRENT;
+-		if (temp & PORT_RESET)
+-			status |= USB_PORT_STAT_RESET;
+-		if (test_bit(wIndex, &fotg210->port_c_suspend))
+-			status |= USB_PORT_STAT_C_SUSPEND << 16;
+-
+-		if (status & ~0xffff)	/* only if wPortChange is interesting */
+-			dbg_port(fotg210, "GetStatus", wIndex + 1, temp);
+-		put_unaligned_le32(status, buf);
+-		break;
+-	case SetHubFeature:
+-		switch (wValue) {
+-		case C_HUB_LOCAL_POWER:
+-		case C_HUB_OVER_CURRENT:
+-			/* no hub-wide feature/status flags */
+-			break;
+-		default:
+-			goto error;
+-		}
+-		break;
+-	case SetPortFeature:
+-		selector = wIndex >> 8;
+-		wIndex &= 0xff;
+-
+-		if (!wIndex || wIndex > ports)
+-			goto error;
+-		wIndex--;
+-		temp = fotg210_readl(fotg210, status_reg);
+-		temp &= ~PORT_RWC_BITS;
+-		switch (wValue) {
+-		case USB_PORT_FEAT_SUSPEND:
+-			if ((temp & PORT_PE) == 0
+-					|| (temp & PORT_RESET) != 0)
+-				goto error;
+-
+-			/* After above check the port must be connected.
+-			 * Set appropriate bit thus could put phy into low power
+-			 * mode if we have hostpc feature
+-			 */
+-			fotg210_writel(fotg210, temp | PORT_SUSPEND,
+-					status_reg);
+-			set_bit(wIndex, &fotg210->suspended_ports);
+-			break;
+-		case USB_PORT_FEAT_RESET:
+-			if (temp & PORT_RESUME)
+-				goto error;
+-			/* line status bits may report this as low speed,
+-			 * which can be fine if this root hub has a
+-			 * transaction translator built in.
+-			 */
+-			fotg210_dbg(fotg210, "port %d reset\n", wIndex + 1);
+-			temp |= PORT_RESET;
+-			temp &= ~PORT_PE;
+-
+-			/*
+-			 * caller must wait, then call GetPortStatus
+-			 * usb 2.0 spec says 50 ms resets on root
+-			 */
+-			fotg210->reset_done[wIndex] = jiffies
+-					+ msecs_to_jiffies(50);
+-			fotg210_writel(fotg210, temp, status_reg);
+-			break;
+-
+-		/* For downstream facing ports (these):  one hub port is put
+-		 * into test mode according to USB2 11.24.2.13, then the hub
+-		 * must be reset (which for root hub now means rmmod+modprobe,
+-		 * or else system reboot).  See EHCI 2.3.9 and 4.14 for info
+-		 * about the EHCI-specific stuff.
+-		 */
+-		case USB_PORT_FEAT_TEST:
+-			if (!selector || selector > 5)
+-				goto error;
+-			spin_unlock_irqrestore(&fotg210->lock, flags);
+-			fotg210_quiesce(fotg210);
+-			spin_lock_irqsave(&fotg210->lock, flags);
+-
+-			/* Put all enabled ports into suspend */
+-			temp = fotg210_readl(fotg210, status_reg) &
+-				~PORT_RWC_BITS;
+-			if (temp & PORT_PE)
+-				fotg210_writel(fotg210, temp | PORT_SUSPEND,
+-						status_reg);
+-
+-			spin_unlock_irqrestore(&fotg210->lock, flags);
+-			fotg210_halt(fotg210);
+-			spin_lock_irqsave(&fotg210->lock, flags);
+-
+-			temp = fotg210_readl(fotg210, status_reg);
+-			temp |= selector << 16;
+-			fotg210_writel(fotg210, temp, status_reg);
+-			break;
+-
+-		default:
+-			goto error;
+-		}
+-		fotg210_readl(fotg210, &fotg210->regs->command);
+-		break;
+-
+-	default:
+-error:
+-		/* "stall" on error */
+-		retval = -EPIPE;
+-	}
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return retval;
+-}
+-
+-static void __maybe_unused fotg210_relinquish_port(struct usb_hcd *hcd,
+-		int portnum)
+-{
+-	return;
+-}
+-
+-static int __maybe_unused fotg210_port_handed_over(struct usb_hcd *hcd,
+-		int portnum)
+-{
+-	return 0;
+-}
+-
+-/* There's basically three types of memory:
+- *	- data used only by the HCD ... kmalloc is fine
+- *	- async and periodic schedules, shared by HC and HCD ... these
+- *	  need to use dma_pool or dma_alloc_coherent
+- *	- driver buffers, read/written by HC ... single shot DMA mapped
+- *
+- * There's also "register" data (e.g. PCI or SOC), which is memory mapped.
+- * No memory seen by this driver is pageable.
+- */
+-
+-/* Allocate the key transfer structures from the previously allocated pool */
+-static inline void fotg210_qtd_init(struct fotg210_hcd *fotg210,
+-		struct fotg210_qtd *qtd, dma_addr_t dma)
+-{
+-	memset(qtd, 0, sizeof(*qtd));
+-	qtd->qtd_dma = dma;
+-	qtd->hw_token = cpu_to_hc32(fotg210, QTD_STS_HALT);
+-	qtd->hw_next = FOTG210_LIST_END(fotg210);
+-	qtd->hw_alt_next = FOTG210_LIST_END(fotg210);
+-	INIT_LIST_HEAD(&qtd->qtd_list);
+-}
+-
+-static struct fotg210_qtd *fotg210_qtd_alloc(struct fotg210_hcd *fotg210,
+-		gfp_t flags)
+-{
+-	struct fotg210_qtd *qtd;
+-	dma_addr_t dma;
+-
+-	qtd = dma_pool_alloc(fotg210->qtd_pool, flags, &dma);
+-	if (qtd != NULL)
+-		fotg210_qtd_init(fotg210, qtd, dma);
+-
+-	return qtd;
+-}
+-
+-static inline void fotg210_qtd_free(struct fotg210_hcd *fotg210,
+-		struct fotg210_qtd *qtd)
+-{
+-	dma_pool_free(fotg210->qtd_pool, qtd, qtd->qtd_dma);
+-}
+-
+-
+-static void qh_destroy(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	/* clean qtds first, and know this is not linked */
+-	if (!list_empty(&qh->qtd_list) || qh->qh_next.ptr) {
+-		fotg210_dbg(fotg210, "unused qh not empty!\n");
+-		BUG();
+-	}
+-	if (qh->dummy)
+-		fotg210_qtd_free(fotg210, qh->dummy);
+-	dma_pool_free(fotg210->qh_pool, qh->hw, qh->qh_dma);
+-	kfree(qh);
+-}
+-
+-static struct fotg210_qh *fotg210_qh_alloc(struct fotg210_hcd *fotg210,
+-		gfp_t flags)
+-{
+-	struct fotg210_qh *qh;
+-	dma_addr_t dma;
+-
+-	qh = kzalloc(sizeof(*qh), GFP_ATOMIC);
+-	if (!qh)
+-		goto done;
+-	qh->hw = (struct fotg210_qh_hw *)
+-		dma_pool_zalloc(fotg210->qh_pool, flags, &dma);
+-	if (!qh->hw)
+-		goto fail;
+-	qh->qh_dma = dma;
+-	INIT_LIST_HEAD(&qh->qtd_list);
+-
+-	/* dummy td enables safe urb queuing */
+-	qh->dummy = fotg210_qtd_alloc(fotg210, flags);
+-	if (qh->dummy == NULL) {
+-		fotg210_dbg(fotg210, "no dummy td\n");
+-		goto fail1;
+-	}
+-done:
+-	return qh;
+-fail1:
+-	dma_pool_free(fotg210->qh_pool, qh->hw, qh->qh_dma);
+-fail:
+-	kfree(qh);
+-	return NULL;
+-}
+-
+-/* The queue heads and transfer descriptors are managed from pools tied
+- * to each of the "per device" structures.
+- * This is the initialisation and cleanup code.
+- */
+-
+-static void fotg210_mem_cleanup(struct fotg210_hcd *fotg210)
+-{
+-	if (fotg210->async)
+-		qh_destroy(fotg210, fotg210->async);
+-	fotg210->async = NULL;
+-
+-	if (fotg210->dummy)
+-		qh_destroy(fotg210, fotg210->dummy);
+-	fotg210->dummy = NULL;
+-
+-	/* DMA consistent memory and pools */
+-	dma_pool_destroy(fotg210->qtd_pool);
+-	fotg210->qtd_pool = NULL;
+-
+-	dma_pool_destroy(fotg210->qh_pool);
+-	fotg210->qh_pool = NULL;
+-
+-	dma_pool_destroy(fotg210->itd_pool);
+-	fotg210->itd_pool = NULL;
+-
+-	if (fotg210->periodic)
+-		dma_free_coherent(fotg210_to_hcd(fotg210)->self.controller,
+-				fotg210->periodic_size * sizeof(u32),
+-				fotg210->periodic, fotg210->periodic_dma);
+-	fotg210->periodic = NULL;
+-
+-	/* shadow periodic table */
+-	kfree(fotg210->pshadow);
+-	fotg210->pshadow = NULL;
+-}
+-
+-/* remember to add cleanup code (above) if you add anything here */
+-static int fotg210_mem_init(struct fotg210_hcd *fotg210, gfp_t flags)
+-{
+-	int i;
+-
+-	/* QTDs for control/bulk/intr transfers */
+-	fotg210->qtd_pool = dma_pool_create("fotg210_qtd",
+-			fotg210_to_hcd(fotg210)->self.controller,
+-			sizeof(struct fotg210_qtd),
+-			32 /* byte alignment (for hw parts) */,
+-			4096 /* can't cross 4K */);
+-	if (!fotg210->qtd_pool)
+-		goto fail;
+-
+-	/* QHs for control/bulk/intr transfers */
+-	fotg210->qh_pool = dma_pool_create("fotg210_qh",
+-			fotg210_to_hcd(fotg210)->self.controller,
+-			sizeof(struct fotg210_qh_hw),
+-			32 /* byte alignment (for hw parts) */,
+-			4096 /* can't cross 4K */);
+-	if (!fotg210->qh_pool)
+-		goto fail;
+-
+-	fotg210->async = fotg210_qh_alloc(fotg210, flags);
+-	if (!fotg210->async)
+-		goto fail;
+-
+-	/* ITD for high speed ISO transfers */
+-	fotg210->itd_pool = dma_pool_create("fotg210_itd",
+-			fotg210_to_hcd(fotg210)->self.controller,
+-			sizeof(struct fotg210_itd),
+-			64 /* byte alignment (for hw parts) */,
+-			4096 /* can't cross 4K */);
+-	if (!fotg210->itd_pool)
+-		goto fail;
+-
+-	/* Hardware periodic table */
+-	fotg210->periodic =
+-		dma_alloc_coherent(fotg210_to_hcd(fotg210)->self.controller,
+-				fotg210->periodic_size * sizeof(__le32),
+-				&fotg210->periodic_dma, 0);
+-	if (fotg210->periodic == NULL)
+-		goto fail;
+-
+-	for (i = 0; i < fotg210->periodic_size; i++)
+-		fotg210->periodic[i] = FOTG210_LIST_END(fotg210);
+-
+-	/* software shadow of hardware table */
+-	fotg210->pshadow = kcalloc(fotg210->periodic_size, sizeof(void *),
+-			flags);
+-	if (fotg210->pshadow != NULL)
+-		return 0;
+-
+-fail:
+-	fotg210_dbg(fotg210, "couldn't init memory\n");
+-	fotg210_mem_cleanup(fotg210);
+-	return -ENOMEM;
+-}
+-/* EHCI hardware queue manipulation ... the core.  QH/QTD manipulation.
+- *
+- * Control, bulk, and interrupt traffic all use "qh" lists.  They list "qtd"
+- * entries describing USB transactions, max 16-20kB/entry (with 4kB-aligned
+- * buffers needed for the larger number).  We use one QH per endpoint, queue
+- * multiple urbs (all three types) per endpoint.  URBs may need several qtds.
+- *
+- * ISO traffic uses "ISO TD" (itd) records, and (along with
+- * interrupts) needs careful scheduling.  Performance improvements can be
+- * an ongoing challenge.  That's in "ehci-sched.c".
+- *
+- * USB 1.1 devices are handled (a) by "companion" OHCI or UHCI root hubs,
+- * or otherwise through transaction translators (TTs) in USB 2.0 hubs using
+- * (b) special fields in qh entries or (c) split iso entries.  TTs will
+- * buffer low/full speed data so the host collects it at high speed.
+- */
+-
+-/* fill a qtd, returning how much of the buffer we were able to queue up */
+-static int qtd_fill(struct fotg210_hcd *fotg210, struct fotg210_qtd *qtd,
+-		dma_addr_t buf, size_t len, int token, int maxpacket)
+-{
+-	int i, count;
+-	u64 addr = buf;
+-
+-	/* one buffer entry per 4K ... first might be short or unaligned */
+-	qtd->hw_buf[0] = cpu_to_hc32(fotg210, (u32)addr);
+-	qtd->hw_buf_hi[0] = cpu_to_hc32(fotg210, (u32)(addr >> 32));
+-	count = 0x1000 - (buf & 0x0fff);	/* rest of that page */
+-	if (likely(len < count))		/* ... iff needed */
+-		count = len;
+-	else {
+-		buf +=  0x1000;
+-		buf &= ~0x0fff;
+-
+-		/* per-qtd limit: from 16K to 20K (best alignment) */
+-		for (i = 1; count < len && i < 5; i++) {
+-			addr = buf;
+-			qtd->hw_buf[i] = cpu_to_hc32(fotg210, (u32)addr);
+-			qtd->hw_buf_hi[i] = cpu_to_hc32(fotg210,
+-					(u32)(addr >> 32));
+-			buf += 0x1000;
+-			if ((count + 0x1000) < len)
+-				count += 0x1000;
+-			else
+-				count = len;
+-		}
+-
+-		/* short packets may only terminate transfers */
+-		if (count != len)
+-			count -= (count % maxpacket);
+-	}
+-	qtd->hw_token = cpu_to_hc32(fotg210, (count << 16) | token);
+-	qtd->length = count;
+-
+-	return count;
+-}
+-
+-static inline void qh_update(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh, struct fotg210_qtd *qtd)
+-{
+-	struct fotg210_qh_hw *hw = qh->hw;
+-
+-	/* writes to an active overlay are unsafe */
+-	BUG_ON(qh->qh_state != QH_STATE_IDLE);
+-
+-	hw->hw_qtd_next = QTD_NEXT(fotg210, qtd->qtd_dma);
+-	hw->hw_alt_next = FOTG210_LIST_END(fotg210);
+-
+-	/* Except for control endpoints, we make hardware maintain data
+-	 * toggle (like OHCI) ... here (re)initialize the toggle in the QH,
+-	 * and set the pseudo-toggle in udev. Only usb_clear_halt() will
+-	 * ever clear it.
+-	 */
+-	if (!(hw->hw_info1 & cpu_to_hc32(fotg210, QH_TOGGLE_CTL))) {
+-		unsigned is_out, epnum;
+-
+-		is_out = qh->is_out;
+-		epnum = (hc32_to_cpup(fotg210, &hw->hw_info1) >> 8) & 0x0f;
+-		if (unlikely(!usb_gettoggle(qh->dev, epnum, is_out))) {
+-			hw->hw_token &= ~cpu_to_hc32(fotg210, QTD_TOGGLE);
+-			usb_settoggle(qh->dev, epnum, is_out, 1);
+-		}
+-	}
+-
+-	hw->hw_token &= cpu_to_hc32(fotg210, QTD_TOGGLE | QTD_STS_PING);
+-}
+-
+-/* if it weren't for a common silicon quirk (writing the dummy into the qh
+- * overlay, so qh->hw_token wrongly becomes inactive/halted), only fault
+- * recovery (including urb dequeue) would need software changes to a QH...
+- */
+-static void qh_refresh(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	struct fotg210_qtd *qtd;
+-
+-	if (list_empty(&qh->qtd_list))
+-		qtd = qh->dummy;
+-	else {
+-		qtd = list_entry(qh->qtd_list.next,
+-				struct fotg210_qtd, qtd_list);
+-		/*
+-		 * first qtd may already be partially processed.
+-		 * If we come here during unlink, the QH overlay region
+-		 * might have reference to the just unlinked qtd. The
+-		 * qtd is updated in qh_completions(). Update the QH
+-		 * overlay here.
+-		 */
+-		if (cpu_to_hc32(fotg210, qtd->qtd_dma) == qh->hw->hw_current) {
+-			qh->hw->hw_qtd_next = qtd->hw_next;
+-			qtd = NULL;
+-		}
+-	}
+-
+-	if (qtd)
+-		qh_update(fotg210, qh, qtd);
+-}
+-
+-static void qh_link_async(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
+-
+-static void fotg210_clear_tt_buffer_complete(struct usb_hcd *hcd,
+-		struct usb_host_endpoint *ep)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	struct fotg210_qh *qh = ep->hcpriv;
+-	unsigned long flags;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	qh->clearing_tt = 0;
+-	if (qh->qh_state == QH_STATE_IDLE && !list_empty(&qh->qtd_list)
+-			&& fotg210->rh_state == FOTG210_RH_RUNNING)
+-		qh_link_async(fotg210, qh);
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-}
+-
+-static void fotg210_clear_tt_buffer(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh, struct urb *urb, u32 token)
+-{
+-
+-	/* If an async split transaction gets an error or is unlinked,
+-	 * the TT buffer may be left in an indeterminate state.  We
+-	 * have to clear the TT buffer.
+-	 *
+-	 * Note: this routine is never called for Isochronous transfers.
+-	 */
+-	if (urb->dev->tt && !usb_pipeint(urb->pipe) && !qh->clearing_tt) {
+-		struct usb_device *tt = urb->dev->tt->hub;
+-
+-		dev_dbg(&tt->dev,
+-				"clear tt buffer port %d, a%d ep%d t%08x\n",
+-				urb->dev->ttport, urb->dev->devnum,
+-				usb_pipeendpoint(urb->pipe), token);
+-
+-		if (urb->dev->tt->hub !=
+-				fotg210_to_hcd(fotg210)->self.root_hub) {
+-			if (usb_hub_clear_tt_buffer(urb) == 0)
+-				qh->clearing_tt = 1;
+-		}
+-	}
+-}
+-
+-static int qtd_copy_status(struct fotg210_hcd *fotg210, struct urb *urb,
+-		size_t length, u32 token)
+-{
+-	int status = -EINPROGRESS;
+-
+-	/* count IN/OUT bytes, not SETUP (even short packets) */
+-	if (likely(QTD_PID(token) != 2))
+-		urb->actual_length += length - QTD_LENGTH(token);
+-
+-	/* don't modify error codes */
+-	if (unlikely(urb->unlinked))
+-		return status;
+-
+-	/* force cleanup after short read; not always an error */
+-	if (unlikely(IS_SHORT_READ(token)))
+-		status = -EREMOTEIO;
+-
+-	/* serious "can't proceed" faults reported by the hardware */
+-	if (token & QTD_STS_HALT) {
+-		if (token & QTD_STS_BABBLE) {
+-			/* FIXME "must" disable babbling device's port too */
+-			status = -EOVERFLOW;
+-		/* CERR nonzero + halt --> stall */
+-		} else if (QTD_CERR(token)) {
+-			status = -EPIPE;
+-
+-		/* In theory, more than one of the following bits can be set
+-		 * since they are sticky and the transaction is retried.
+-		 * Which to test first is rather arbitrary.
+-		 */
+-		} else if (token & QTD_STS_MMF) {
+-			/* fs/ls interrupt xfer missed the complete-split */
+-			status = -EPROTO;
+-		} else if (token & QTD_STS_DBE) {
+-			status = (QTD_PID(token) == 1) /* IN ? */
+-				? -ENOSR  /* hc couldn't read data */
+-				: -ECOMM; /* hc couldn't write data */
+-		} else if (token & QTD_STS_XACT) {
+-			/* timeout, bad CRC, wrong PID, etc */
+-			fotg210_dbg(fotg210, "devpath %s ep%d%s 3strikes\n",
+-					urb->dev->devpath,
+-					usb_pipeendpoint(urb->pipe),
+-					usb_pipein(urb->pipe) ? "in" : "out");
+-			status = -EPROTO;
+-		} else {	/* unknown */
+-			status = -EPROTO;
+-		}
+-
+-		fotg210_dbg(fotg210,
+-				"dev%d ep%d%s qtd token %08x --> status %d\n",
+-				usb_pipedevice(urb->pipe),
+-				usb_pipeendpoint(urb->pipe),
+-				usb_pipein(urb->pipe) ? "in" : "out",
+-				token, status);
+-	}
+-
+-	return status;
+-}
+-
+-static void fotg210_urb_done(struct fotg210_hcd *fotg210, struct urb *urb,
+-		int status)
+-__releases(fotg210->lock)
+-__acquires(fotg210->lock)
+-{
+-	if (likely(urb->hcpriv != NULL)) {
+-		struct fotg210_qh *qh = (struct fotg210_qh *) urb->hcpriv;
+-
+-		/* S-mask in a QH means it's an interrupt urb */
+-		if ((qh->hw->hw_info2 & cpu_to_hc32(fotg210, QH_SMASK)) != 0) {
+-
+-			/* ... update hc-wide periodic stats (for usbfs) */
+-			fotg210_to_hcd(fotg210)->self.bandwidth_int_reqs--;
+-		}
+-	}
+-
+-	if (unlikely(urb->unlinked)) {
+-		INCR(fotg210->stats.unlink);
+-	} else {
+-		/* report non-error and short read status as zero */
+-		if (status == -EINPROGRESS || status == -EREMOTEIO)
+-			status = 0;
+-		INCR(fotg210->stats.complete);
+-	}
+-
+-#ifdef FOTG210_URB_TRACE
+-	fotg210_dbg(fotg210,
+-			"%s %s urb %p ep%d%s status %d len %d/%d\n",
+-			__func__, urb->dev->devpath, urb,
+-			usb_pipeendpoint(urb->pipe),
+-			usb_pipein(urb->pipe) ? "in" : "out",
+-			status,
+-			urb->actual_length, urb->transfer_buffer_length);
+-#endif
+-
+-	/* complete() can reenter this HCD */
+-	usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
+-	spin_unlock(&fotg210->lock);
+-	usb_hcd_giveback_urb(fotg210_to_hcd(fotg210), urb, status);
+-	spin_lock(&fotg210->lock);
+-}
+-
+-static int qh_schedule(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
+-
+-/* Process and free completed qtds for a qh, returning URBs to drivers.
+- * Chases up to qh->hw_current.  Returns number of completions called,
+- * indicating how much "real" work we did.
+- */
+-static unsigned qh_completions(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh)
+-{
+-	struct fotg210_qtd *last, *end = qh->dummy;
+-	struct fotg210_qtd *qtd, *tmp;
+-	int last_status;
+-	int stopped;
+-	unsigned count = 0;
+-	u8 state;
+-	struct fotg210_qh_hw *hw = qh->hw;
+-
+-	if (unlikely(list_empty(&qh->qtd_list)))
+-		return count;
+-
+-	/* completions (or tasks on other cpus) must never clobber HALT
+-	 * till we've gone through and cleaned everything up, even when
+-	 * they add urbs to this qh's queue or mark them for unlinking.
+-	 *
+-	 * NOTE:  unlinking expects to be done in queue order.
+-	 *
+-	 * It's a bug for qh->qh_state to be anything other than
+-	 * QH_STATE_IDLE, unless our caller is scan_async() or
+-	 * scan_intr().
+-	 */
+-	state = qh->qh_state;
+-	qh->qh_state = QH_STATE_COMPLETING;
+-	stopped = (state == QH_STATE_IDLE);
+-
+-rescan:
+-	last = NULL;
+-	last_status = -EINPROGRESS;
+-	qh->needs_rescan = 0;
+-
+-	/* remove de-activated QTDs from front of queue.
+-	 * after faults (including short reads), cleanup this urb
+-	 * then let the queue advance.
+-	 * if queue is stopped, handles unlinks.
+-	 */
+-	list_for_each_entry_safe(qtd, tmp, &qh->qtd_list, qtd_list) {
+-		struct urb *urb;
+-		u32 token = 0;
+-
+-		urb = qtd->urb;
+-
+-		/* clean up any state from previous QTD ...*/
+-		if (last) {
+-			if (likely(last->urb != urb)) {
+-				fotg210_urb_done(fotg210, last->urb,
+-						last_status);
+-				count++;
+-				last_status = -EINPROGRESS;
+-			}
+-			fotg210_qtd_free(fotg210, last);
+-			last = NULL;
+-		}
+-
+-		/* ignore urbs submitted during completions we reported */
+-		if (qtd == end)
+-			break;
+-
+-		/* hardware copies qtd out of qh overlay */
+-		rmb();
+-		token = hc32_to_cpu(fotg210, qtd->hw_token);
+-
+-		/* always clean up qtds the hc de-activated */
+-retry_xacterr:
+-		if ((token & QTD_STS_ACTIVE) == 0) {
+-
+-			/* Report Data Buffer Error: non-fatal but useful */
+-			if (token & QTD_STS_DBE)
+-				fotg210_dbg(fotg210,
+-					"detected DataBufferErr for urb %p ep%d%s len %d, qtd %p [qh %p]\n",
+-					urb, usb_endpoint_num(&urb->ep->desc),
+-					usb_endpoint_dir_in(&urb->ep->desc)
+-						? "in" : "out",
+-					urb->transfer_buffer_length, qtd, qh);
+-
+-			/* on STALL, error, and short reads this urb must
+-			 * complete and all its qtds must be recycled.
+-			 */
+-			if ((token & QTD_STS_HALT) != 0) {
+-
+-				/* retry transaction errors until we
+-				 * reach the software xacterr limit
+-				 */
+-				if ((token & QTD_STS_XACT) &&
+-						QTD_CERR(token) == 0 &&
+-						++qh->xacterrs < QH_XACTERR_MAX &&
+-						!urb->unlinked) {
+-					fotg210_dbg(fotg210,
+-						"detected XactErr len %zu/%zu retry %d\n",
+-						qtd->length - QTD_LENGTH(token),
+-						qtd->length,
+-						qh->xacterrs);
+-
+-					/* reset the token in the qtd and the
+-					 * qh overlay (which still contains
+-					 * the qtd) so that we pick up from
+-					 * where we left off
+-					 */
+-					token &= ~QTD_STS_HALT;
+-					token |= QTD_STS_ACTIVE |
+-						 (FOTG210_TUNE_CERR << 10);
+-					qtd->hw_token = cpu_to_hc32(fotg210,
+-							token);
+-					wmb();
+-					hw->hw_token = cpu_to_hc32(fotg210,
+-							token);
+-					goto retry_xacterr;
+-				}
+-				stopped = 1;
+-
+-			/* magic dummy for some short reads; qh won't advance.
+-			 * that silicon quirk can kick in with this dummy too.
+-			 *
+-			 * other short reads won't stop the queue, including
+-			 * control transfers (status stage handles that) or
+-			 * most other single-qtd reads ... the queue stops if
+-			 * URB_SHORT_NOT_OK was set so the driver submitting
+-			 * the urbs could clean it up.
+-			 */
+-			} else if (IS_SHORT_READ(token) &&
+-					!(qtd->hw_alt_next &
+-					FOTG210_LIST_END(fotg210))) {
+-				stopped = 1;
+-			}
+-
+-		/* stop scanning when we reach qtds the hc is using */
+-		} else if (likely(!stopped
+-				&& fotg210->rh_state >= FOTG210_RH_RUNNING)) {
+-			break;
+-
+-		/* scan the whole queue for unlinks whenever it stops */
+-		} else {
+-			stopped = 1;
+-
+-			/* cancel everything if we halt, suspend, etc */
+-			if (fotg210->rh_state < FOTG210_RH_RUNNING)
+-				last_status = -ESHUTDOWN;
+-
+-			/* this qtd is active; skip it unless a previous qtd
+-			 * for its urb faulted, or its urb was canceled.
+-			 */
+-			else if (last_status == -EINPROGRESS && !urb->unlinked)
+-				continue;
+-
+-			/* qh unlinked; token in overlay may be most current */
+-			if (state == QH_STATE_IDLE &&
+-					cpu_to_hc32(fotg210, qtd->qtd_dma)
+-					== hw->hw_current) {
+-				token = hc32_to_cpu(fotg210, hw->hw_token);
+-
+-				/* An unlink may leave an incomplete
+-				 * async transaction in the TT buffer.
+-				 * We have to clear it.
+-				 */
+-				fotg210_clear_tt_buffer(fotg210, qh, urb,
+-						token);
+-			}
+-		}
+-
+-		/* unless we already know the urb's status, collect qtd status
+-		 * and update count of bytes transferred.  in common short read
+-		 * cases with only one data qtd (including control transfers),
+-		 * queue processing won't halt.  but with two or more qtds (for
+-		 * example, with a 32 KB transfer), when the first qtd gets a
+-		 * short read the second must be removed by hand.
+-		 */
+-		if (last_status == -EINPROGRESS) {
+-			last_status = qtd_copy_status(fotg210, urb,
+-					qtd->length, token);
+-			if (last_status == -EREMOTEIO &&
+-					(qtd->hw_alt_next &
+-					FOTG210_LIST_END(fotg210)))
+-				last_status = -EINPROGRESS;
+-
+-			/* As part of low/full-speed endpoint-halt processing
+-			 * we must clear the TT buffer (11.17.5).
+-			 */
+-			if (unlikely(last_status != -EINPROGRESS &&
+-					last_status != -EREMOTEIO)) {
+-				/* The TT's in some hubs malfunction when they
+-				 * receive this request following a STALL (they
+-				 * stop sending isochronous packets).  Since a
+-				 * STALL can't leave the TT buffer in a busy
+-				 * state (if you believe Figures 11-48 - 11-51
+-				 * in the USB 2.0 spec), we won't clear the TT
+-				 * buffer in this case.  Strictly speaking this
+-				 * is a violation of the spec.
+-				 */
+-				if (last_status != -EPIPE)
+-					fotg210_clear_tt_buffer(fotg210, qh,
+-							urb, token);
+-			}
+-		}
+-
+-		/* if we're removing something not at the queue head,
+-		 * patch the hardware queue pointer.
+-		 */
+-		if (stopped && qtd->qtd_list.prev != &qh->qtd_list) {
+-			last = list_entry(qtd->qtd_list.prev,
+-					struct fotg210_qtd, qtd_list);
+-			last->hw_next = qtd->hw_next;
+-		}
+-
+-		/* remove qtd; it's recycled after possible urb completion */
+-		list_del(&qtd->qtd_list);
+-		last = qtd;
+-
+-		/* reinit the xacterr counter for the next qtd */
+-		qh->xacterrs = 0;
+-	}
+-
+-	/* last urb's completion might still need calling */
+-	if (likely(last != NULL)) {
+-		fotg210_urb_done(fotg210, last->urb, last_status);
+-		count++;
+-		fotg210_qtd_free(fotg210, last);
+-	}
+-
+-	/* Do we need to rescan for URBs dequeued during a giveback? */
+-	if (unlikely(qh->needs_rescan)) {
+-		/* If the QH is already unlinked, do the rescan now. */
+-		if (state == QH_STATE_IDLE)
+-			goto rescan;
+-
+-		/* Otherwise we have to wait until the QH is fully unlinked.
+-		 * Our caller will start an unlink if qh->needs_rescan is
+-		 * set.  But if an unlink has already started, nothing needs
+-		 * to be done.
+-		 */
+-		if (state != QH_STATE_LINKED)
+-			qh->needs_rescan = 0;
+-	}
+-
+-	/* restore original state; caller must unlink or relink */
+-	qh->qh_state = state;
+-
+-	/* be sure the hardware's done with the qh before refreshing
+-	 * it after fault cleanup, or recovering from silicon wrongly
+-	 * overlaying the dummy qtd (which reduces DMA chatter).
+-	 */
+-	if (stopped != 0 || hw->hw_qtd_next == FOTG210_LIST_END(fotg210)) {
+-		switch (state) {
+-		case QH_STATE_IDLE:
+-			qh_refresh(fotg210, qh);
+-			break;
+-		case QH_STATE_LINKED:
+-			/* We won't refresh a QH that's linked (after the HC
+-			 * stopped the queue).  That avoids a race:
+-			 *  - HC reads first part of QH;
+-			 *  - CPU updates that first part and the token;
+-			 *  - HC reads rest of that QH, including token
+-			 * Result:  HC gets an inconsistent image, and then
+-			 * DMAs to/from the wrong memory (corrupting it).
+-			 *
+-			 * That should be rare for interrupt transfers,
+-			 * except maybe high bandwidth ...
+-			 */
+-
+-			/* Tell the caller to start an unlink */
+-			qh->needs_rescan = 1;
+-			break;
+-		/* otherwise, unlink already started */
+-		}
+-	}
+-
+-	return count;
+-}
+-
+-/* reverse of qh_urb_transaction:  free a list of TDs.
+- * used for cleanup after errors, before HC sees an URB's TDs.
+- */
+-static void qtd_list_free(struct fotg210_hcd *fotg210, struct urb *urb,
+-		struct list_head *head)
+-{
+-	struct fotg210_qtd *qtd, *temp;
+-
+-	list_for_each_entry_safe(qtd, temp, head, qtd_list) {
+-		list_del(&qtd->qtd_list);
+-		fotg210_qtd_free(fotg210, qtd);
+-	}
+-}
+-
+-/* create a list of filled qtds for this URB; won't link into qh.
+- */
+-static struct list_head *qh_urb_transaction(struct fotg210_hcd *fotg210,
+-		struct urb *urb, struct list_head *head, gfp_t flags)
+-{
+-	struct fotg210_qtd *qtd, *qtd_prev;
+-	dma_addr_t buf;
+-	int len, this_sg_len, maxpacket;
+-	int is_input;
+-	u32 token;
+-	int i;
+-	struct scatterlist *sg;
+-
+-	/*
+-	 * URBs map to sequences of QTDs:  one logical transaction
+-	 */
+-	qtd = fotg210_qtd_alloc(fotg210, flags);
+-	if (unlikely(!qtd))
+-		return NULL;
+-	list_add_tail(&qtd->qtd_list, head);
+-	qtd->urb = urb;
+-
+-	token = QTD_STS_ACTIVE;
+-	token |= (FOTG210_TUNE_CERR << 10);
+-	/* for split transactions, SplitXState initialized to zero */
+-
+-	len = urb->transfer_buffer_length;
+-	is_input = usb_pipein(urb->pipe);
+-	if (usb_pipecontrol(urb->pipe)) {
+-		/* SETUP pid */
+-		qtd_fill(fotg210, qtd, urb->setup_dma,
+-				sizeof(struct usb_ctrlrequest),
+-				token | (2 /* "setup" */ << 8), 8);
+-
+-		/* ... and always at least one more pid */
+-		token ^= QTD_TOGGLE;
+-		qtd_prev = qtd;
+-		qtd = fotg210_qtd_alloc(fotg210, flags);
+-		if (unlikely(!qtd))
+-			goto cleanup;
+-		qtd->urb = urb;
+-		qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
+-		list_add_tail(&qtd->qtd_list, head);
+-
+-		/* for zero length DATA stages, STATUS is always IN */
+-		if (len == 0)
+-			token |= (1 /* "in" */ << 8);
+-	}
+-
+-	/*
+-	 * data transfer stage:  buffer setup
+-	 */
+-	i = urb->num_mapped_sgs;
+-	if (len > 0 && i > 0) {
+-		sg = urb->sg;
+-		buf = sg_dma_address(sg);
+-
+-		/* urb->transfer_buffer_length may be smaller than the
+-		 * size of the scatterlist (or vice versa)
+-		 */
+-		this_sg_len = min_t(int, sg_dma_len(sg), len);
+-	} else {
+-		sg = NULL;
+-		buf = urb->transfer_dma;
+-		this_sg_len = len;
+-	}
+-
+-	if (is_input)
+-		token |= (1 /* "in" */ << 8);
+-	/* else it's already initted to "out" pid (0 << 8) */
+-
+-	maxpacket = usb_maxpacket(urb->dev, urb->pipe);
+-
+-	/*
+-	 * buffer gets wrapped in one or more qtds;
+-	 * last one may be "short" (including zero len)
+-	 * and may serve as a control status ack
+-	 */
+-	for (;;) {
+-		int this_qtd_len;
+-
+-		this_qtd_len = qtd_fill(fotg210, qtd, buf, this_sg_len, token,
+-				maxpacket);
+-		this_sg_len -= this_qtd_len;
+-		len -= this_qtd_len;
+-		buf += this_qtd_len;
+-
+-		/*
+-		 * short reads advance to a "magic" dummy instead of the next
+-		 * qtd ... that forces the queue to stop, for manual cleanup.
+-		 * (this will usually be overridden later.)
+-		 */
+-		if (is_input)
+-			qtd->hw_alt_next = fotg210->async->hw->hw_alt_next;
+-
+-		/* qh makes control packets use qtd toggle; maybe switch it */
+-		if ((maxpacket & (this_qtd_len + (maxpacket - 1))) == 0)
+-			token ^= QTD_TOGGLE;
+-
+-		if (likely(this_sg_len <= 0)) {
+-			if (--i <= 0 || len <= 0)
+-				break;
+-			sg = sg_next(sg);
+-			buf = sg_dma_address(sg);
+-			this_sg_len = min_t(int, sg_dma_len(sg), len);
+-		}
+-
+-		qtd_prev = qtd;
+-		qtd = fotg210_qtd_alloc(fotg210, flags);
+-		if (unlikely(!qtd))
+-			goto cleanup;
+-		qtd->urb = urb;
+-		qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
+-		list_add_tail(&qtd->qtd_list, head);
+-	}
+-
+-	/*
+-	 * unless the caller requires manual cleanup after short reads,
+-	 * have the alt_next mechanism keep the queue running after the
+-	 * last data qtd (the only one, for control and most other cases).
+-	 */
+-	if (likely((urb->transfer_flags & URB_SHORT_NOT_OK) == 0 ||
+-			usb_pipecontrol(urb->pipe)))
+-		qtd->hw_alt_next = FOTG210_LIST_END(fotg210);
+-
+-	/*
+-	 * control requests may need a terminating data "status" ack;
+-	 * other OUT ones may need a terminating short packet
+-	 * (zero length).
+-	 */
+-	if (likely(urb->transfer_buffer_length != 0)) {
+-		int one_more = 0;
+-
+-		if (usb_pipecontrol(urb->pipe)) {
+-			one_more = 1;
+-			token ^= 0x0100;	/* "in" <--> "out"  */
+-			token |= QTD_TOGGLE;	/* force DATA1 */
+-		} else if (usb_pipeout(urb->pipe)
+-				&& (urb->transfer_flags & URB_ZERO_PACKET)
+-				&& !(urb->transfer_buffer_length % maxpacket)) {
+-			one_more = 1;
+-		}
+-		if (one_more) {
+-			qtd_prev = qtd;
+-			qtd = fotg210_qtd_alloc(fotg210, flags);
+-			if (unlikely(!qtd))
+-				goto cleanup;
+-			qtd->urb = urb;
+-			qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
+-			list_add_tail(&qtd->qtd_list, head);
+-
+-			/* never any data in such packets */
+-			qtd_fill(fotg210, qtd, 0, 0, token, 0);
+-		}
+-	}
+-
+-	/* by default, enable interrupt on urb completion */
+-	if (likely(!(urb->transfer_flags & URB_NO_INTERRUPT)))
+-		qtd->hw_token |= cpu_to_hc32(fotg210, QTD_IOC);
+-	return head;
+-
+-cleanup:
+-	qtd_list_free(fotg210, urb, head);
+-	return NULL;
+-}
+-
+-/* Would be best to create all qh's from config descriptors,
+- * when each interface/altsetting is established.  Unlink
+- * any previous qh and cancel its urbs first; endpoints are
+- * implicitly reset then (data toggle too).
+- * That'd mean updating how usbcore talks to HCDs. (2.7?)
+- */
+-
+-
+-/* Each QH holds a qtd list; a QH is used for everything except iso.
+- *
+- * For interrupt urbs, the scheduler must set the microframe scheduling
+- * mask(s) each time the QH gets scheduled.  For highspeed, that's
+- * just one microframe in the s-mask.  For split interrupt transactions
+- * there are additional complications: c-mask, maybe FSTNs.
+- */
+-static struct fotg210_qh *qh_make(struct fotg210_hcd *fotg210, struct urb *urb,
+-		gfp_t flags)
+-{
+-	struct fotg210_qh *qh = fotg210_qh_alloc(fotg210, flags);
+-	struct usb_host_endpoint *ep;
+-	u32 info1 = 0, info2 = 0;
+-	int is_input, type;
+-	int maxp = 0;
+-	int mult;
+-	struct usb_tt *tt = urb->dev->tt;
+-	struct fotg210_qh_hw *hw;
+-
+-	if (!qh)
+-		return qh;
+-
+-	/*
+-	 * init endpoint/device data for this QH
+-	 */
+-	info1 |= usb_pipeendpoint(urb->pipe) << 8;
+-	info1 |= usb_pipedevice(urb->pipe) << 0;
+-
+-	is_input = usb_pipein(urb->pipe);
+-	type = usb_pipetype(urb->pipe);
+-	ep = usb_pipe_endpoint(urb->dev, urb->pipe);
+-	maxp = usb_endpoint_maxp(&ep->desc);
+-	mult = usb_endpoint_maxp_mult(&ep->desc);
+-
+-	/* 1024 byte maxpacket is a hardware ceiling.  High bandwidth
+-	 * acts like up to 3KB, but is built from smaller packets.
+-	 */
+-	if (maxp > 1024) {
+-		fotg210_dbg(fotg210, "bogus qh maxpacket %d\n", maxp);
+-		goto done;
+-	}
+-
+-	/* Compute interrupt scheduling parameters just once, and save.
+-	 * - allowing for high bandwidth, how many nsec/uframe are used?
+-	 * - split transactions need a second CSPLIT uframe; same question
+-	 * - splits also need a schedule gap (for full/low speed I/O)
+-	 * - qh has a polling interval
+-	 *
+-	 * For control/bulk requests, the HC or TT handles these.
+-	 */
+-	if (type == PIPE_INTERRUPT) {
+-		qh->usecs = NS_TO_US(usb_calc_bus_time(USB_SPEED_HIGH,
+-				is_input, 0, mult * maxp));
+-		qh->start = NO_FRAME;
+-
+-		if (urb->dev->speed == USB_SPEED_HIGH) {
+-			qh->c_usecs = 0;
+-			qh->gap_uf = 0;
+-
+-			qh->period = urb->interval >> 3;
+-			if (qh->period == 0 && urb->interval != 1) {
+-				/* NOTE interval 2 or 4 uframes could work.
+-				 * But interval 1 scheduling is simpler, and
+-				 * includes high bandwidth.
+-				 */
+-				urb->interval = 1;
+-			} else if (qh->period > fotg210->periodic_size) {
+-				qh->period = fotg210->periodic_size;
+-				urb->interval = qh->period << 3;
+-			}
+-		} else {
+-			int think_time;
+-
+-			/* gap is f(FS/LS transfer times) */
+-			qh->gap_uf = 1 + usb_calc_bus_time(urb->dev->speed,
+-					is_input, 0, maxp) / (125 * 1000);
+-
+-			/* FIXME this just approximates SPLIT/CSPLIT times */
+-			if (is_input) {		/* SPLIT, gap, CSPLIT+DATA */
+-				qh->c_usecs = qh->usecs + HS_USECS(0);
+-				qh->usecs = HS_USECS(1);
+-			} else {		/* SPLIT+DATA, gap, CSPLIT */
+-				qh->usecs += HS_USECS(1);
+-				qh->c_usecs = HS_USECS(0);
+-			}
+-
+-			think_time = tt ? tt->think_time : 0;
+-			qh->tt_usecs = NS_TO_US(think_time +
+-					usb_calc_bus_time(urb->dev->speed,
+-					is_input, 0, maxp));
+-			qh->period = urb->interval;
+-			if (qh->period > fotg210->periodic_size) {
+-				qh->period = fotg210->periodic_size;
+-				urb->interval = qh->period;
+-			}
+-		}
+-	}
+-
+-	/* support for tt scheduling, and access to toggles */
+-	qh->dev = urb->dev;
+-
+-	/* using TT? */
+-	switch (urb->dev->speed) {
+-	case USB_SPEED_LOW:
+-		info1 |= QH_LOW_SPEED;
+-		fallthrough;
+-
+-	case USB_SPEED_FULL:
+-		/* EPS 0 means "full" */
+-		if (type != PIPE_INTERRUPT)
+-			info1 |= (FOTG210_TUNE_RL_TT << 28);
+-		if (type == PIPE_CONTROL) {
+-			info1 |= QH_CONTROL_EP;		/* for TT */
+-			info1 |= QH_TOGGLE_CTL;		/* toggle from qtd */
+-		}
+-		info1 |= maxp << 16;
+-
+-		info2 |= (FOTG210_TUNE_MULT_TT << 30);
+-
+-		/* Some Freescale processors have an erratum in which the
+-		 * port number in the queue head was 0..N-1 instead of 1..N.
+-		 */
+-		if (fotg210_has_fsl_portno_bug(fotg210))
+-			info2 |= (urb->dev->ttport-1) << 23;
+-		else
+-			info2 |= urb->dev->ttport << 23;
+-
+-		/* set the address of the TT; for TDI's integrated
+-		 * root hub tt, leave it zeroed.
+-		 */
+-		if (tt && tt->hub != fotg210_to_hcd(fotg210)->self.root_hub)
+-			info2 |= tt->hub->devnum << 16;
+-
+-		/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets c-mask } */
+-
+-		break;
+-
+-	case USB_SPEED_HIGH:		/* no TT involved */
+-		info1 |= QH_HIGH_SPEED;
+-		if (type == PIPE_CONTROL) {
+-			info1 |= (FOTG210_TUNE_RL_HS << 28);
+-			info1 |= 64 << 16;	/* usb2 fixed maxpacket */
+-			info1 |= QH_TOGGLE_CTL;	/* toggle from qtd */
+-			info2 |= (FOTG210_TUNE_MULT_HS << 30);
+-		} else if (type == PIPE_BULK) {
+-			info1 |= (FOTG210_TUNE_RL_HS << 28);
+-			/* The USB spec says that high speed bulk endpoints
+-			 * always use 512 byte maxpacket.  But some device
+-			 * vendors decided to ignore that, and MSFT is happy
+-			 * to help them do so.  So now people expect to use
+-			 * such nonconformant devices with Linux too; sigh.
+-			 */
+-			info1 |= maxp << 16;
+-			info2 |= (FOTG210_TUNE_MULT_HS << 30);
+-		} else {		/* PIPE_INTERRUPT */
+-			info1 |= maxp << 16;
+-			info2 |= mult << 30;
+-		}
+-		break;
+-	default:
+-		fotg210_dbg(fotg210, "bogus dev %p speed %d\n", urb->dev,
+-				urb->dev->speed);
+-done:
+-		qh_destroy(fotg210, qh);
+-		return NULL;
+-	}
+-
+-	/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets s-mask } */
+-
+-	/* init as live, toggle clear, advance to dummy */
+-	qh->qh_state = QH_STATE_IDLE;
+-	hw = qh->hw;
+-	hw->hw_info1 = cpu_to_hc32(fotg210, info1);
+-	hw->hw_info2 = cpu_to_hc32(fotg210, info2);
+-	qh->is_out = !is_input;
+-	usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), !is_input, 1);
+-	qh_refresh(fotg210, qh);
+-	return qh;
+-}
+-
+-static void enable_async(struct fotg210_hcd *fotg210)
+-{
+-	if (fotg210->async_count++)
+-		return;
+-
+-	/* Stop waiting to turn off the async schedule */
+-	fotg210->enabled_hrtimer_events &= ~BIT(FOTG210_HRTIMER_DISABLE_ASYNC);
+-
+-	/* Don't start the schedule until ASS is 0 */
+-	fotg210_poll_ASS(fotg210);
+-	turn_on_io_watchdog(fotg210);
+-}
+-
+-static void disable_async(struct fotg210_hcd *fotg210)
+-{
+-	if (--fotg210->async_count)
+-		return;
+-
+-	/* The async schedule and async_unlink list are supposed to be empty */
+-	WARN_ON(fotg210->async->qh_next.qh || fotg210->async_unlink);
+-
+-	/* Don't turn off the schedule until ASS is 1 */
+-	fotg210_poll_ASS(fotg210);
+-}
+-
+-/* move qh (and its qtds) onto async queue; maybe enable queue.  */
+-
+-static void qh_link_async(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	__hc32 dma = QH_NEXT(fotg210, qh->qh_dma);
+-	struct fotg210_qh *head;
+-
+-	/* Don't link a QH if there's a Clear-TT-Buffer pending */
+-	if (unlikely(qh->clearing_tt))
+-		return;
+-
+-	WARN_ON(qh->qh_state != QH_STATE_IDLE);
+-
+-	/* clear halt and/or toggle; and maybe recover from silicon quirk */
+-	qh_refresh(fotg210, qh);
+-
+-	/* splice right after start */
+-	head = fotg210->async;
+-	qh->qh_next = head->qh_next;
+-	qh->hw->hw_next = head->hw->hw_next;
+-	wmb();
+-
+-	head->qh_next.qh = qh;
+-	head->hw->hw_next = dma;
+-
+-	qh->xacterrs = 0;
+-	qh->qh_state = QH_STATE_LINKED;
+-	/* qtd completions reported later by interrupt */
+-
+-	enable_async(fotg210);
+-}
+-
+-/* For control/bulk/interrupt, return QH with these TDs appended.
+- * Allocates and initializes the QH if necessary.
+- * Returns null if it can't allocate a QH it needs to.
+- * If the QH has TDs (urbs) already, that's great.
+- */
+-static struct fotg210_qh *qh_append_tds(struct fotg210_hcd *fotg210,
+-		struct urb *urb, struct list_head *qtd_list,
+-		int epnum, void **ptr)
+-{
+-	struct fotg210_qh *qh = NULL;
+-	__hc32 qh_addr_mask = cpu_to_hc32(fotg210, 0x7f);
+-
+-	qh = (struct fotg210_qh *) *ptr;
+-	if (unlikely(qh == NULL)) {
+-		/* can't sleep here, we have fotg210->lock... */
+-		qh = qh_make(fotg210, urb, GFP_ATOMIC);
+-		*ptr = qh;
+-	}
+-	if (likely(qh != NULL)) {
+-		struct fotg210_qtd *qtd;
+-
+-		if (unlikely(list_empty(qtd_list)))
+-			qtd = NULL;
+-		else
+-			qtd = list_entry(qtd_list->next, struct fotg210_qtd,
+-					qtd_list);
+-
+-		/* control qh may need patching ... */
+-		if (unlikely(epnum == 0)) {
+-			/* usb_reset_device() briefly reverts to address 0 */
+-			if (usb_pipedevice(urb->pipe) == 0)
+-				qh->hw->hw_info1 &= ~qh_addr_mask;
+-		}
+-
+-		/* just one way to queue requests: swap with the dummy qtd.
+-		 * only hc or qh_refresh() ever modify the overlay.
+-		 */
+-		if (likely(qtd != NULL)) {
+-			struct fotg210_qtd *dummy;
+-			dma_addr_t dma;
+-			__hc32 token;
+-
+-			/* to avoid racing the HC, use the dummy td instead of
+-			 * the first td of our list (becomes new dummy).  both
+-			 * tds stay deactivated until we're done, when the
+-			 * HC is allowed to fetch the old dummy (4.10.2).
+-			 */
+-			token = qtd->hw_token;
+-			qtd->hw_token = HALT_BIT(fotg210);
+-
+-			dummy = qh->dummy;
+-
+-			dma = dummy->qtd_dma;
+-			*dummy = *qtd;
+-			dummy->qtd_dma = dma;
+-
+-			list_del(&qtd->qtd_list);
+-			list_add(&dummy->qtd_list, qtd_list);
+-			list_splice_tail(qtd_list, &qh->qtd_list);
+-
+-			fotg210_qtd_init(fotg210, qtd, qtd->qtd_dma);
+-			qh->dummy = qtd;
+-
+-			/* hc must see the new dummy at list end */
+-			dma = qtd->qtd_dma;
+-			qtd = list_entry(qh->qtd_list.prev,
+-					struct fotg210_qtd, qtd_list);
+-			qtd->hw_next = QTD_NEXT(fotg210, dma);
+-
+-			/* let the hc process these next qtds */
+-			wmb();
+-			dummy->hw_token = token;
+-
+-			urb->hcpriv = qh;
+-		}
+-	}
+-	return qh;
+-}
+-
+-static int submit_async(struct fotg210_hcd *fotg210, struct urb *urb,
+-		struct list_head *qtd_list, gfp_t mem_flags)
+-{
+-	int epnum;
+-	unsigned long flags;
+-	struct fotg210_qh *qh = NULL;
+-	int rc;
+-
+-	epnum = urb->ep->desc.bEndpointAddress;
+-
+-#ifdef FOTG210_URB_TRACE
+-	{
+-		struct fotg210_qtd *qtd;
+-
+-		qtd = list_entry(qtd_list->next, struct fotg210_qtd, qtd_list);
+-		fotg210_dbg(fotg210,
+-				"%s %s urb %p ep%d%s len %d, qtd %p [qh %p]\n",
+-				__func__, urb->dev->devpath, urb,
+-				epnum & 0x0f, (epnum & USB_DIR_IN)
+-					? "in" : "out",
+-				urb->transfer_buffer_length,
+-				qtd, urb->ep->hcpriv);
+-	}
+-#endif
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
+-		rc = -ESHUTDOWN;
+-		goto done;
+-	}
+-	rc = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
+-	if (unlikely(rc))
+-		goto done;
+-
+-	qh = qh_append_tds(fotg210, urb, qtd_list, epnum, &urb->ep->hcpriv);
+-	if (unlikely(qh == NULL)) {
+-		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
+-		rc = -ENOMEM;
+-		goto done;
+-	}
+-
+-	/* Control/bulk operations through TTs don't need scheduling,
+-	 * the HC and TT handle it when the TT has a buffer ready.
+-	 */
+-	if (likely(qh->qh_state == QH_STATE_IDLE))
+-		qh_link_async(fotg210, qh);
+-done:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	if (unlikely(qh == NULL))
+-		qtd_list_free(fotg210, urb, qtd_list);
+-	return rc;
+-}
+-
+-static void single_unlink_async(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh)
+-{
+-	struct fotg210_qh *prev;
+-
+-	/* Add to the end of the list of QHs waiting for the next IAAD */
+-	qh->qh_state = QH_STATE_UNLINK;
+-	if (fotg210->async_unlink)
+-		fotg210->async_unlink_last->unlink_next = qh;
+-	else
+-		fotg210->async_unlink = qh;
+-	fotg210->async_unlink_last = qh;
+-
+-	/* Unlink it from the schedule */
+-	prev = fotg210->async;
+-	while (prev->qh_next.qh != qh)
+-		prev = prev->qh_next.qh;
+-
+-	prev->hw->hw_next = qh->hw->hw_next;
+-	prev->qh_next = qh->qh_next;
+-	if (fotg210->qh_scan_next == qh)
+-		fotg210->qh_scan_next = qh->qh_next.qh;
+-}
+-
+-static void start_iaa_cycle(struct fotg210_hcd *fotg210, bool nested)
+-{
+-	/*
+-	 * Do nothing if an IAA cycle is already running or
+-	 * if one will be started shortly.
+-	 */
+-	if (fotg210->async_iaa || fotg210->async_unlinking)
+-		return;
+-
+-	/* Do all the waiting QHs at once */
+-	fotg210->async_iaa = fotg210->async_unlink;
+-	fotg210->async_unlink = NULL;
+-
+-	/* If the controller isn't running, we don't have to wait for it */
+-	if (unlikely(fotg210->rh_state < FOTG210_RH_RUNNING)) {
+-		if (!nested)		/* Avoid recursion */
+-			end_unlink_async(fotg210);
+-
+-	/* Otherwise start a new IAA cycle */
+-	} else if (likely(fotg210->rh_state == FOTG210_RH_RUNNING)) {
+-		/* Make sure the unlinks are all visible to the hardware */
+-		wmb();
+-
+-		fotg210_writel(fotg210, fotg210->command | CMD_IAAD,
+-				&fotg210->regs->command);
+-		fotg210_readl(fotg210, &fotg210->regs->command);
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_IAA_WATCHDOG,
+-				true);
+-	}
+-}
+-
+-/* the async qh for the qtds being unlinked are now gone from the HC */
+-
+-static void end_unlink_async(struct fotg210_hcd *fotg210)
+-{
+-	struct fotg210_qh *qh;
+-
+-	/* Process the idle QHs */
+-restart:
+-	fotg210->async_unlinking = true;
+-	while (fotg210->async_iaa) {
+-		qh = fotg210->async_iaa;
+-		fotg210->async_iaa = qh->unlink_next;
+-		qh->unlink_next = NULL;
+-
+-		qh->qh_state = QH_STATE_IDLE;
+-		qh->qh_next.qh = NULL;
+-
+-		qh_completions(fotg210, qh);
+-		if (!list_empty(&qh->qtd_list) &&
+-				fotg210->rh_state == FOTG210_RH_RUNNING)
+-			qh_link_async(fotg210, qh);
+-		disable_async(fotg210);
+-	}
+-	fotg210->async_unlinking = false;
+-
+-	/* Start a new IAA cycle if any QHs are waiting for it */
+-	if (fotg210->async_unlink) {
+-		start_iaa_cycle(fotg210, true);
+-		if (unlikely(fotg210->rh_state < FOTG210_RH_RUNNING))
+-			goto restart;
+-	}
+-}
+-
+-static void unlink_empty_async(struct fotg210_hcd *fotg210)
+-{
+-	struct fotg210_qh *qh, *next;
+-	bool stopped = (fotg210->rh_state < FOTG210_RH_RUNNING);
+-	bool check_unlinks_later = false;
+-
+-	/* Unlink all the async QHs that have been empty for a timer cycle */
+-	next = fotg210->async->qh_next.qh;
+-	while (next) {
+-		qh = next;
+-		next = qh->qh_next.qh;
+-
+-		if (list_empty(&qh->qtd_list) &&
+-				qh->qh_state == QH_STATE_LINKED) {
+-			if (!stopped && qh->unlink_cycle ==
+-					fotg210->async_unlink_cycle)
+-				check_unlinks_later = true;
+-			else
+-				single_unlink_async(fotg210, qh);
+-		}
+-	}
+-
+-	/* Start a new IAA cycle if any QHs are waiting for it */
+-	if (fotg210->async_unlink)
+-		start_iaa_cycle(fotg210, false);
+-
+-	/* QHs that haven't been empty for long enough will be handled later */
+-	if (check_unlinks_later) {
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_ASYNC_UNLINKS,
+-				true);
+-		++fotg210->async_unlink_cycle;
+-	}
+-}
+-
+-/* makes sure the async qh will become idle */
+-/* caller must own fotg210->lock */
+-
+-static void start_unlink_async(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh)
+-{
+-	/*
+-	 * If the QH isn't linked then there's nothing we can do
+-	 * unless we were called during a giveback, in which case
+-	 * qh_completions() has to deal with it.
+-	 */
+-	if (qh->qh_state != QH_STATE_LINKED) {
+-		if (qh->qh_state == QH_STATE_COMPLETING)
+-			qh->needs_rescan = 1;
+-		return;
+-	}
+-
+-	single_unlink_async(fotg210, qh);
+-	start_iaa_cycle(fotg210, false);
+-}
+-
+-static void scan_async(struct fotg210_hcd *fotg210)
+-{
+-	struct fotg210_qh *qh;
+-	bool check_unlinks_later = false;
+-
+-	fotg210->qh_scan_next = fotg210->async->qh_next.qh;
+-	while (fotg210->qh_scan_next) {
+-		qh = fotg210->qh_scan_next;
+-		fotg210->qh_scan_next = qh->qh_next.qh;
+-rescan:
+-		/* clean any finished work for this qh */
+-		if (!list_empty(&qh->qtd_list)) {
+-			int temp;
+-
+-			/*
+-			 * Unlinks could happen here; completion reporting
+-			 * drops the lock.  That's why fotg210->qh_scan_next
+-			 * always holds the next qh to scan; if the next qh
+-			 * gets unlinked then fotg210->qh_scan_next is adjusted
+-			 * in single_unlink_async().
+-			 */
+-			temp = qh_completions(fotg210, qh);
+-			if (qh->needs_rescan) {
+-				start_unlink_async(fotg210, qh);
+-			} else if (list_empty(&qh->qtd_list)
+-					&& qh->qh_state == QH_STATE_LINKED) {
+-				qh->unlink_cycle = fotg210->async_unlink_cycle;
+-				check_unlinks_later = true;
+-			} else if (temp != 0)
+-				goto rescan;
+-		}
+-	}
+-
+-	/*
+-	 * Unlink empty entries, reducing DMA usage as well
+-	 * as HCD schedule-scanning costs.  Delay for any qh
+-	 * we just scanned, there's a not-unusual case that it
+-	 * doesn't stay idle for long.
+-	 */
+-	if (check_unlinks_later && fotg210->rh_state == FOTG210_RH_RUNNING &&
+-			!(fotg210->enabled_hrtimer_events &
+-			BIT(FOTG210_HRTIMER_ASYNC_UNLINKS))) {
+-		fotg210_enable_event(fotg210,
+-				FOTG210_HRTIMER_ASYNC_UNLINKS, true);
+-		++fotg210->async_unlink_cycle;
+-	}
+-}
+-/* EHCI scheduled transaction support:  interrupt, iso, split iso
+- * These are called "periodic" transactions in the EHCI spec.
+- *
+- * Note that for interrupt transfers, the QH/QTD manipulation is shared
+- * with the "asynchronous" transaction support (control/bulk transfers).
+- * The only real difference is in how interrupt transfers are scheduled.
+- *
+- * For ISO, we make an "iso_stream" head to serve the same role as a QH.
+- * It keeps track of every ITD (or SITD) that's linked, and holds enough
+- * pre-calculated schedule data to make appending to the queue be quick.
+- */
+-static int fotg210_get_frame(struct usb_hcd *hcd);
+-
+-/* periodic_next_shadow - return "next" pointer on shadow list
+- * @periodic: host pointer to qh/itd
+- * @tag: hardware tag for type of this record
+- */
+-static union fotg210_shadow *periodic_next_shadow(struct fotg210_hcd *fotg210,
+-		union fotg210_shadow *periodic, __hc32 tag)
+-{
+-	switch (hc32_to_cpu(fotg210, tag)) {
+-	case Q_TYPE_QH:
+-		return &periodic->qh->qh_next;
+-	case Q_TYPE_FSTN:
+-		return &periodic->fstn->fstn_next;
+-	default:
+-		return &periodic->itd->itd_next;
+-	}
+-}
+-
+-static __hc32 *shadow_next_periodic(struct fotg210_hcd *fotg210,
+-		union fotg210_shadow *periodic, __hc32 tag)
+-{
+-	switch (hc32_to_cpu(fotg210, tag)) {
+-	/* our fotg210_shadow.qh is actually software part */
+-	case Q_TYPE_QH:
+-		return &periodic->qh->hw->hw_next;
+-	/* others are hw parts */
+-	default:
+-		return periodic->hw_next;
+-	}
+-}
+-
+-/* caller must hold fotg210->lock */
+-static void periodic_unlink(struct fotg210_hcd *fotg210, unsigned frame,
+-		void *ptr)
+-{
+-	union fotg210_shadow *prev_p = &fotg210->pshadow[frame];
+-	__hc32 *hw_p = &fotg210->periodic[frame];
+-	union fotg210_shadow here = *prev_p;
+-
+-	/* find predecessor of "ptr"; hw and shadow lists are in sync */
+-	while (here.ptr && here.ptr != ptr) {
+-		prev_p = periodic_next_shadow(fotg210, prev_p,
+-				Q_NEXT_TYPE(fotg210, *hw_p));
+-		hw_p = shadow_next_periodic(fotg210, &here,
+-				Q_NEXT_TYPE(fotg210, *hw_p));
+-		here = *prev_p;
+-	}
+-	/* an interrupt entry (at list end) could have been shared */
+-	if (!here.ptr)
+-		return;
+-
+-	/* update shadow and hardware lists ... the old "next" pointers
+-	 * from ptr may still be in use, the caller updates them.
+-	 */
+-	*prev_p = *periodic_next_shadow(fotg210, &here,
+-			Q_NEXT_TYPE(fotg210, *hw_p));
+-
+-	*hw_p = *shadow_next_periodic(fotg210, &here,
+-			Q_NEXT_TYPE(fotg210, *hw_p));
+-}
+-
+-/* how many of the uframe's 125 usecs are allocated? */
+-static unsigned short periodic_usecs(struct fotg210_hcd *fotg210,
+-		unsigned frame, unsigned uframe)
+-{
+-	__hc32 *hw_p = &fotg210->periodic[frame];
+-	union fotg210_shadow *q = &fotg210->pshadow[frame];
+-	unsigned usecs = 0;
+-	struct fotg210_qh_hw *hw;
+-
+-	while (q->ptr) {
+-		switch (hc32_to_cpu(fotg210, Q_NEXT_TYPE(fotg210, *hw_p))) {
+-		case Q_TYPE_QH:
+-			hw = q->qh->hw;
+-			/* is it in the S-mask? */
+-			if (hw->hw_info2 & cpu_to_hc32(fotg210, 1 << uframe))
+-				usecs += q->qh->usecs;
+-			/* ... or C-mask? */
+-			if (hw->hw_info2 & cpu_to_hc32(fotg210,
+-					1 << (8 + uframe)))
+-				usecs += q->qh->c_usecs;
+-			hw_p = &hw->hw_next;
+-			q = &q->qh->qh_next;
+-			break;
+-		/* case Q_TYPE_FSTN: */
+-		default:
+-			/* for "save place" FSTNs, count the relevant INTR
+-			 * bandwidth from the previous frame
+-			 */
+-			if (q->fstn->hw_prev != FOTG210_LIST_END(fotg210))
+-				fotg210_dbg(fotg210, "ignoring FSTN cost ...\n");
+-
+-			hw_p = &q->fstn->hw_next;
+-			q = &q->fstn->fstn_next;
+-			break;
+-		case Q_TYPE_ITD:
+-			if (q->itd->hw_transaction[uframe])
+-				usecs += q->itd->stream->usecs;
+-			hw_p = &q->itd->hw_next;
+-			q = &q->itd->itd_next;
+-			break;
+-		}
+-	}
+-	if (usecs > fotg210->uframe_periodic_max)
+-		fotg210_err(fotg210, "uframe %d sched overrun: %d usecs\n",
+-				frame * 8 + uframe, usecs);
+-	return usecs;
+-}
+-
+-static int same_tt(struct usb_device *dev1, struct usb_device *dev2)
+-{
+-	if (!dev1->tt || !dev2->tt)
+-		return 0;
+-	if (dev1->tt != dev2->tt)
+-		return 0;
+-	if (dev1->tt->multi)
+-		return dev1->ttport == dev2->ttport;
+-	else
+-		return 1;
+-}
+-
+-/* return true iff the device's transaction translator is available
+- * for a periodic transfer starting at the specified frame, using
+- * all the uframes in the mask.
+- */
+-static int tt_no_collision(struct fotg210_hcd *fotg210, unsigned period,
+-		struct usb_device *dev, unsigned frame, u32 uf_mask)
+-{
+-	if (period == 0)	/* error */
+-		return 0;
+-
+-	/* note bandwidth wastage:  split never follows csplit
+-	 * (different dev or endpoint) until the next uframe.
+-	 * calling convention doesn't make that distinction.
+-	 */
+-	for (; frame < fotg210->periodic_size; frame += period) {
+-		union fotg210_shadow here;
+-		__hc32 type;
+-		struct fotg210_qh_hw *hw;
+-
+-		here = fotg210->pshadow[frame];
+-		type = Q_NEXT_TYPE(fotg210, fotg210->periodic[frame]);
+-		while (here.ptr) {
+-			switch (hc32_to_cpu(fotg210, type)) {
+-			case Q_TYPE_ITD:
+-				type = Q_NEXT_TYPE(fotg210, here.itd->hw_next);
+-				here = here.itd->itd_next;
+-				continue;
+-			case Q_TYPE_QH:
+-				hw = here.qh->hw;
+-				if (same_tt(dev, here.qh->dev)) {
+-					u32 mask;
+-
+-					mask = hc32_to_cpu(fotg210,
+-							hw->hw_info2);
+-					/* "knows" no gap is needed */
+-					mask |= mask >> 8;
+-					if (mask & uf_mask)
+-						break;
+-				}
+-				type = Q_NEXT_TYPE(fotg210, hw->hw_next);
+-				here = here.qh->qh_next;
+-				continue;
+-			/* case Q_TYPE_FSTN: */
+-			default:
+-				fotg210_dbg(fotg210,
+-						"periodic frame %d bogus type %d\n",
+-						frame, type);
+-			}
+-
+-			/* collision or error */
+-			return 0;
+-		}
+-	}
+-
+-	/* no collision */
+-	return 1;
+-}
+-
+-static void enable_periodic(struct fotg210_hcd *fotg210)
+-{
+-	if (fotg210->periodic_count++)
+-		return;
+-
+-	/* Stop waiting to turn off the periodic schedule */
+-	fotg210->enabled_hrtimer_events &=
+-		~BIT(FOTG210_HRTIMER_DISABLE_PERIODIC);
+-
+-	/* Don't start the schedule until PSS is 0 */
+-	fotg210_poll_PSS(fotg210);
+-	turn_on_io_watchdog(fotg210);
+-}
+-
+-static void disable_periodic(struct fotg210_hcd *fotg210)
+-{
+-	if (--fotg210->periodic_count)
+-		return;
+-
+-	/* Don't turn off the schedule until PSS is 1 */
+-	fotg210_poll_PSS(fotg210);
+-}
+-
+-/* periodic schedule slots have iso tds (normal or split) first, then a
+- * sparse tree for active interrupt transfers.
+- *
+- * this just links in a qh; caller guarantees uframe masks are set right.
+- * no FSTN support (yet; fotg210 0.96+)
+- */
+-static void qh_link_periodic(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	unsigned i;
+-	unsigned period = qh->period;
+-
+-	dev_dbg(&qh->dev->dev,
+-			"link qh%d-%04x/%p start %d [%d/%d us]\n", period,
+-			hc32_to_cpup(fotg210, &qh->hw->hw_info2) &
+-			(QH_CMASK | QH_SMASK), qh, qh->start, qh->usecs,
+-			qh->c_usecs);
+-
+-	/* high bandwidth, or otherwise every microframe */
+-	if (period == 0)
+-		period = 1;
+-
+-	for (i = qh->start; i < fotg210->periodic_size; i += period) {
+-		union fotg210_shadow *prev = &fotg210->pshadow[i];
+-		__hc32 *hw_p = &fotg210->periodic[i];
+-		union fotg210_shadow here = *prev;
+-		__hc32 type = 0;
+-
+-		/* skip the iso nodes at list head */
+-		while (here.ptr) {
+-			type = Q_NEXT_TYPE(fotg210, *hw_p);
+-			if (type == cpu_to_hc32(fotg210, Q_TYPE_QH))
+-				break;
+-			prev = periodic_next_shadow(fotg210, prev, type);
+-			hw_p = shadow_next_periodic(fotg210, &here, type);
+-			here = *prev;
+-		}
+-
+-		/* sorting each branch by period (slow-->fast)
+-		 * enables sharing interior tree nodes
+-		 */
+-		while (here.ptr && qh != here.qh) {
+-			if (qh->period > here.qh->period)
+-				break;
+-			prev = &here.qh->qh_next;
+-			hw_p = &here.qh->hw->hw_next;
+-			here = *prev;
+-		}
+-		/* link in this qh, unless some earlier pass did that */
+-		if (qh != here.qh) {
+-			qh->qh_next = here;
+-			if (here.qh)
+-				qh->hw->hw_next = *hw_p;
+-			wmb();
+-			prev->qh = qh;
+-			*hw_p = QH_NEXT(fotg210, qh->qh_dma);
+-		}
+-	}
+-	qh->qh_state = QH_STATE_LINKED;
+-	qh->xacterrs = 0;
+-
+-	/* update per-qh bandwidth for usbfs */
+-	fotg210_to_hcd(fotg210)->self.bandwidth_allocated += qh->period
+-		? ((qh->usecs + qh->c_usecs) / qh->period)
+-		: (qh->usecs * 8);
+-
+-	list_add(&qh->intr_node, &fotg210->intr_qh_list);
+-
+-	/* maybe enable periodic schedule processing */
+-	++fotg210->intr_count;
+-	enable_periodic(fotg210);
+-}
+-
+-static void qh_unlink_periodic(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh)
+-{
+-	unsigned i;
+-	unsigned period;
+-
+-	/*
+-	 * If qh is for a low/full-speed device, simply unlinking it
+-	 * could interfere with an ongoing split transaction.  To unlink
+-	 * it safely would require setting the QH_INACTIVATE bit and
+-	 * waiting at least one frame, as described in EHCI 4.12.2.5.
+-	 *
+-	 * We won't bother with any of this.  Instead, we assume that the
+-	 * only reason for unlinking an interrupt QH while the current URB
+-	 * is still active is to dequeue all the URBs (flush the whole
+-	 * endpoint queue).
+-	 *
+-	 * If rebalancing the periodic schedule is ever implemented, this
+-	 * approach will no longer be valid.
+-	 */
+-
+-	/* high bandwidth, or otherwise part of every microframe */
+-	period = qh->period;
+-	if (!period)
+-		period = 1;
+-
+-	for (i = qh->start; i < fotg210->periodic_size; i += period)
+-		periodic_unlink(fotg210, i, qh);
+-
+-	/* update per-qh bandwidth for usbfs */
+-	fotg210_to_hcd(fotg210)->self.bandwidth_allocated -= qh->period
+-		? ((qh->usecs + qh->c_usecs) / qh->period)
+-		: (qh->usecs * 8);
+-
+-	dev_dbg(&qh->dev->dev,
+-			"unlink qh%d-%04x/%p start %d [%d/%d us]\n",
+-			qh->period, hc32_to_cpup(fotg210, &qh->hw->hw_info2) &
+-			(QH_CMASK | QH_SMASK), qh, qh->start, qh->usecs,
+-			qh->c_usecs);
+-
+-	/* qh->qh_next still "live" to HC */
+-	qh->qh_state = QH_STATE_UNLINK;
+-	qh->qh_next.ptr = NULL;
+-
+-	if (fotg210->qh_scan_next == qh)
+-		fotg210->qh_scan_next = list_entry(qh->intr_node.next,
+-				struct fotg210_qh, intr_node);
+-	list_del(&qh->intr_node);
+-}
+-
+-static void start_unlink_intr(struct fotg210_hcd *fotg210,
+-		struct fotg210_qh *qh)
+-{
+-	/* If the QH isn't linked then there's nothing we can do
+-	 * unless we were called during a giveback, in which case
+-	 * qh_completions() has to deal with it.
+-	 */
+-	if (qh->qh_state != QH_STATE_LINKED) {
+-		if (qh->qh_state == QH_STATE_COMPLETING)
+-			qh->needs_rescan = 1;
+-		return;
+-	}
+-
+-	qh_unlink_periodic(fotg210, qh);
+-
+-	/* Make sure the unlinks are visible before starting the timer */
+-	wmb();
+-
+-	/*
+-	 * The EHCI spec doesn't say how long it takes the controller to
+-	 * stop accessing an unlinked interrupt QH.  The timer delay is
+-	 * 9 uframes; presumably that will be long enough.
+-	 */
+-	qh->unlink_cycle = fotg210->intr_unlink_cycle;
+-
+-	/* New entries go at the end of the intr_unlink list */
+-	if (fotg210->intr_unlink)
+-		fotg210->intr_unlink_last->unlink_next = qh;
+-	else
+-		fotg210->intr_unlink = qh;
+-	fotg210->intr_unlink_last = qh;
+-
+-	if (fotg210->intr_unlinking)
+-		;	/* Avoid recursive calls */
+-	else if (fotg210->rh_state < FOTG210_RH_RUNNING)
+-		fotg210_handle_intr_unlinks(fotg210);
+-	else if (fotg210->intr_unlink == qh) {
+-		fotg210_enable_event(fotg210, FOTG210_HRTIMER_UNLINK_INTR,
+-				true);
+-		++fotg210->intr_unlink_cycle;
+-	}
+-}
+-
+-static void end_unlink_intr(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	struct fotg210_qh_hw *hw = qh->hw;
+-	int rc;
+-
+-	qh->qh_state = QH_STATE_IDLE;
+-	hw->hw_next = FOTG210_LIST_END(fotg210);
+-
+-	qh_completions(fotg210, qh);
+-
+-	/* reschedule QH iff another request is queued */
+-	if (!list_empty(&qh->qtd_list) &&
+-			fotg210->rh_state == FOTG210_RH_RUNNING) {
+-		rc = qh_schedule(fotg210, qh);
+-
+-		/* An error here likely indicates handshake failure
+-		 * or no space left in the schedule.  Neither fault
+-		 * should happen often ...
+-		 *
+-		 * FIXME kill the now-dysfunctional queued urbs
+-		 */
+-		if (rc != 0)
+-			fotg210_err(fotg210, "can't reschedule qh %p, err %d\n",
+-					qh, rc);
+-	}
+-
+-	/* maybe turn off periodic schedule */
+-	--fotg210->intr_count;
+-	disable_periodic(fotg210);
+-}
+-
+-static int check_period(struct fotg210_hcd *fotg210, unsigned frame,
+-		unsigned uframe, unsigned period, unsigned usecs)
+-{
+-	int claimed;
+-
+-	/* complete split running into next frame?
+-	 * given FSTN support, we could sometimes check...
+-	 */
+-	if (uframe >= 8)
+-		return 0;
+-
+-	/* convert "usecs we need" to "max already claimed" */
+-	usecs = fotg210->uframe_periodic_max - usecs;
+-
+-	/* we "know" 2 and 4 uframe intervals were rejected; so
+-	 * for period 0, check _every_ microframe in the schedule.
+-	 */
+-	if (unlikely(period == 0)) {
+-		do {
+-			for (uframe = 0; uframe < 7; uframe++) {
+-				claimed = periodic_usecs(fotg210, frame,
+-						uframe);
+-				if (claimed > usecs)
+-					return 0;
+-			}
+-		} while ((frame += 1) < fotg210->periodic_size);
+-
+-	/* just check the specified uframe, at that period */
+-	} else {
+-		do {
+-			claimed = periodic_usecs(fotg210, frame, uframe);
+-			if (claimed > usecs)
+-				return 0;
+-		} while ((frame += period) < fotg210->periodic_size);
+-	}
+-
+-	/* success! */
+-	return 1;
+-}
+-
+-static int check_intr_schedule(struct fotg210_hcd *fotg210, unsigned frame,
+-		unsigned uframe, const struct fotg210_qh *qh, __hc32 *c_maskp)
+-{
+-	int retval = -ENOSPC;
+-	u8 mask = 0;
+-
+-	if (qh->c_usecs && uframe >= 6)		/* FSTN territory? */
+-		goto done;
+-
+-	if (!check_period(fotg210, frame, uframe, qh->period, qh->usecs))
+-		goto done;
+-	if (!qh->c_usecs) {
+-		retval = 0;
+-		*c_maskp = 0;
+-		goto done;
+-	}
+-
+-	/* Make sure this tt's buffer is also available for CSPLITs.
+-	 * We pessimize a bit; probably the typical full speed case
+-	 * doesn't need the second CSPLIT.
+-	 *
+-	 * NOTE:  both SPLIT and CSPLIT could be checked in just
+-	 * one smart pass...
+-	 */
+-	mask = 0x03 << (uframe + qh->gap_uf);
+-	*c_maskp = cpu_to_hc32(fotg210, mask << 8);
+-
+-	mask |= 1 << uframe;
+-	if (tt_no_collision(fotg210, qh->period, qh->dev, frame, mask)) {
+-		if (!check_period(fotg210, frame, uframe + qh->gap_uf + 1,
+-				qh->period, qh->c_usecs))
+-			goto done;
+-		if (!check_period(fotg210, frame, uframe + qh->gap_uf,
+-				qh->period, qh->c_usecs))
+-			goto done;
+-		retval = 0;
+-	}
+-done:
+-	return retval;
+-}
+-
+-/* "first fit" scheduling policy used the first time through,
+- * or when the previous schedule slot can't be re-used.
+- */
+-static int qh_schedule(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
+-{
+-	int status;
+-	unsigned uframe;
+-	__hc32 c_mask;
+-	unsigned frame;	/* 0..(qh->period - 1), or NO_FRAME */
+-	struct fotg210_qh_hw *hw = qh->hw;
+-
+-	qh_refresh(fotg210, qh);
+-	hw->hw_next = FOTG210_LIST_END(fotg210);
+-	frame = qh->start;
+-
+-	/* reuse the previous schedule slots, if we can */
+-	if (frame < qh->period) {
+-		uframe = ffs(hc32_to_cpup(fotg210, &hw->hw_info2) & QH_SMASK);
+-		status = check_intr_schedule(fotg210, frame, --uframe,
+-				qh, &c_mask);
+-	} else {
+-		uframe = 0;
+-		c_mask = 0;
+-		status = -ENOSPC;
+-	}
+-
+-	/* else scan the schedule to find a group of slots such that all
+-	 * uframes have enough periodic bandwidth available.
+-	 */
+-	if (status) {
+-		/* "normal" case, uframing flexible except with splits */
+-		if (qh->period) {
+-			int i;
+-
+-			for (i = qh->period; status && i > 0; --i) {
+-				frame = ++fotg210->random_frame % qh->period;
+-				for (uframe = 0; uframe < 8; uframe++) {
+-					status = check_intr_schedule(fotg210,
+-							frame, uframe, qh,
+-							&c_mask);
+-					if (status == 0)
+-						break;
+-				}
+-			}
+-
+-		/* qh->period == 0 means every uframe */
+-		} else {
+-			frame = 0;
+-			status = check_intr_schedule(fotg210, 0, 0, qh,
+-					&c_mask);
+-		}
+-		if (status)
+-			goto done;
+-		qh->start = frame;
+-
+-		/* reset S-frame and (maybe) C-frame masks */
+-		hw->hw_info2 &= cpu_to_hc32(fotg210, ~(QH_CMASK | QH_SMASK));
+-		hw->hw_info2 |= qh->period
+-			? cpu_to_hc32(fotg210, 1 << uframe)
+-			: cpu_to_hc32(fotg210, QH_SMASK);
+-		hw->hw_info2 |= c_mask;
+-	} else
+-		fotg210_dbg(fotg210, "reused qh %p schedule\n", qh);
+-
+-	/* stuff into the periodic schedule */
+-	qh_link_periodic(fotg210, qh);
+-done:
+-	return status;
+-}
+-
+-static int intr_submit(struct fotg210_hcd *fotg210, struct urb *urb,
+-		struct list_head *qtd_list, gfp_t mem_flags)
+-{
+-	unsigned epnum;
+-	unsigned long flags;
+-	struct fotg210_qh *qh;
+-	int status;
+-	struct list_head empty;
+-
+-	/* get endpoint and transfer/schedule data */
+-	epnum = urb->ep->desc.bEndpointAddress;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
+-		status = -ESHUTDOWN;
+-		goto done_not_linked;
+-	}
+-	status = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
+-	if (unlikely(status))
+-		goto done_not_linked;
+-
+-	/* get qh and force any scheduling errors */
+-	INIT_LIST_HEAD(&empty);
+-	qh = qh_append_tds(fotg210, urb, &empty, epnum, &urb->ep->hcpriv);
+-	if (qh == NULL) {
+-		status = -ENOMEM;
+-		goto done;
+-	}
+-	if (qh->qh_state == QH_STATE_IDLE) {
+-		status = qh_schedule(fotg210, qh);
+-		if (status)
+-			goto done;
+-	}
+-
+-	/* then queue the urb's tds to the qh */
+-	qh = qh_append_tds(fotg210, urb, qtd_list, epnum, &urb->ep->hcpriv);
+-	BUG_ON(qh == NULL);
+-
+-	/* ... update usbfs periodic stats */
+-	fotg210_to_hcd(fotg210)->self.bandwidth_int_reqs++;
+-
+-done:
+-	if (unlikely(status))
+-		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
+-done_not_linked:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	if (status)
+-		qtd_list_free(fotg210, urb, qtd_list);
+-
+-	return status;
+-}
+-
+-static void scan_intr(struct fotg210_hcd *fotg210)
+-{
+-	struct fotg210_qh *qh;
+-
+-	list_for_each_entry_safe(qh, fotg210->qh_scan_next,
+-			&fotg210->intr_qh_list, intr_node) {
+-rescan:
+-		/* clean any finished work for this qh */
+-		if (!list_empty(&qh->qtd_list)) {
+-			int temp;
+-
+-			/*
+-			 * Unlinks could happen here; completion reporting
+-			 * drops the lock.  That's why fotg210->qh_scan_next
+-			 * always holds the next qh to scan; if the next qh
+-			 * gets unlinked then fotg210->qh_scan_next is adjusted
+-			 * in qh_unlink_periodic().
+-			 */
+-			temp = qh_completions(fotg210, qh);
+-			if (unlikely(qh->needs_rescan ||
+-					(list_empty(&qh->qtd_list) &&
+-					qh->qh_state == QH_STATE_LINKED)))
+-				start_unlink_intr(fotg210, qh);
+-			else if (temp != 0)
+-				goto rescan;
+-		}
+-	}
+-}
+-
+-/* fotg210_iso_stream ops work with both ITD and SITD */
+-
+-static struct fotg210_iso_stream *iso_stream_alloc(gfp_t mem_flags)
+-{
+-	struct fotg210_iso_stream *stream;
+-
+-	stream = kzalloc(sizeof(*stream), mem_flags);
+-	if (likely(stream != NULL)) {
+-		INIT_LIST_HEAD(&stream->td_list);
+-		INIT_LIST_HEAD(&stream->free_list);
+-		stream->next_uframe = -1;
+-	}
+-	return stream;
+-}
+-
+-static void iso_stream_init(struct fotg210_hcd *fotg210,
+-		struct fotg210_iso_stream *stream, struct usb_device *dev,
+-		int pipe, unsigned interval)
+-{
+-	u32 buf1;
+-	unsigned epnum, maxp;
+-	int is_input;
+-	long bandwidth;
+-	unsigned multi;
+-	struct usb_host_endpoint *ep;
+-
+-	/*
+-	 * this might be a "high bandwidth" highspeed endpoint,
+-	 * as encoded in the ep descriptor's wMaxPacket field
+-	 */
+-	epnum = usb_pipeendpoint(pipe);
+-	is_input = usb_pipein(pipe) ? USB_DIR_IN : 0;
+-	ep = usb_pipe_endpoint(dev, pipe);
+-	maxp = usb_endpoint_maxp(&ep->desc);
+-	if (is_input)
+-		buf1 = (1 << 11);
+-	else
+-		buf1 = 0;
+-
+-	multi = usb_endpoint_maxp_mult(&ep->desc);
+-	buf1 |= maxp;
+-	maxp *= multi;
+-
+-	stream->buf0 = cpu_to_hc32(fotg210, (epnum << 8) | dev->devnum);
+-	stream->buf1 = cpu_to_hc32(fotg210, buf1);
+-	stream->buf2 = cpu_to_hc32(fotg210, multi);
+-
+-	/* usbfs wants to report the average usecs per frame tied up
+-	 * when transfers on this endpoint are scheduled ...
+-	 */
+-	if (dev->speed == USB_SPEED_FULL) {
+-		interval <<= 3;
+-		stream->usecs = NS_TO_US(usb_calc_bus_time(dev->speed,
+-				is_input, 1, maxp));
+-		stream->usecs /= 8;
+-	} else {
+-		stream->highspeed = 1;
+-		stream->usecs = HS_USECS_ISO(maxp);
+-	}
+-	bandwidth = stream->usecs * 8;
+-	bandwidth /= interval;
+-
+-	stream->bandwidth = bandwidth;
+-	stream->udev = dev;
+-	stream->bEndpointAddress = is_input | epnum;
+-	stream->interval = interval;
+-	stream->maxp = maxp;
+-}
+-
+-static struct fotg210_iso_stream *iso_stream_find(struct fotg210_hcd *fotg210,
+-		struct urb *urb)
+-{
+-	unsigned epnum;
+-	struct fotg210_iso_stream *stream;
+-	struct usb_host_endpoint *ep;
+-	unsigned long flags;
+-
+-	epnum = usb_pipeendpoint(urb->pipe);
+-	if (usb_pipein(urb->pipe))
+-		ep = urb->dev->ep_in[epnum];
+-	else
+-		ep = urb->dev->ep_out[epnum];
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	stream = ep->hcpriv;
+-
+-	if (unlikely(stream == NULL)) {
+-		stream = iso_stream_alloc(GFP_ATOMIC);
+-		if (likely(stream != NULL)) {
+-			ep->hcpriv = stream;
+-			stream->ep = ep;
+-			iso_stream_init(fotg210, stream, urb->dev, urb->pipe,
+-					urb->interval);
+-		}
+-
+-	/* if dev->ep[epnum] is a QH, hw is set */
+-	} else if (unlikely(stream->hw != NULL)) {
+-		fotg210_dbg(fotg210, "dev %s ep%d%s, not iso??\n",
+-				urb->dev->devpath, epnum,
+-				usb_pipein(urb->pipe) ? "in" : "out");
+-		stream = NULL;
+-	}
+-
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return stream;
+-}
+-
+-/* fotg210_iso_sched ops can be ITD-only or SITD-only */
+-
+-static struct fotg210_iso_sched *iso_sched_alloc(unsigned packets,
+-		gfp_t mem_flags)
+-{
+-	struct fotg210_iso_sched *iso_sched;
+-
+-	iso_sched = kzalloc(struct_size(iso_sched, packet, packets), mem_flags);
+-	if (likely(iso_sched != NULL))
+-		INIT_LIST_HEAD(&iso_sched->td_list);
+-
+-	return iso_sched;
+-}
+-
+-static inline void itd_sched_init(struct fotg210_hcd *fotg210,
+-		struct fotg210_iso_sched *iso_sched,
+-		struct fotg210_iso_stream *stream, struct urb *urb)
+-{
+-	unsigned i;
+-	dma_addr_t dma = urb->transfer_dma;
+-
+-	/* how many uframes are needed for these transfers */
+-	iso_sched->span = urb->number_of_packets * stream->interval;
+-
+-	/* figure out per-uframe itd fields that we'll need later
+-	 * when we fit new itds into the schedule.
+-	 */
+-	for (i = 0; i < urb->number_of_packets; i++) {
+-		struct fotg210_iso_packet *uframe = &iso_sched->packet[i];
+-		unsigned length;
+-		dma_addr_t buf;
+-		u32 trans;
+-
+-		length = urb->iso_frame_desc[i].length;
+-		buf = dma + urb->iso_frame_desc[i].offset;
+-
+-		trans = FOTG210_ISOC_ACTIVE;
+-		trans |= buf & 0x0fff;
+-		if (unlikely(((i + 1) == urb->number_of_packets))
+-				&& !(urb->transfer_flags & URB_NO_INTERRUPT))
+-			trans |= FOTG210_ITD_IOC;
+-		trans |= length << 16;
+-		uframe->transaction = cpu_to_hc32(fotg210, trans);
+-
+-		/* might need to cross a buffer page within a uframe */
+-		uframe->bufp = (buf & ~(u64)0x0fff);
+-		buf += length;
+-		if (unlikely((uframe->bufp != (buf & ~(u64)0x0fff))))
+-			uframe->cross = 1;
+-	}
+-}
+-
+-static void iso_sched_free(struct fotg210_iso_stream *stream,
+-		struct fotg210_iso_sched *iso_sched)
+-{
+-	if (!iso_sched)
+-		return;
+-	/* caller must hold fotg210->lock!*/
+-	list_splice(&iso_sched->td_list, &stream->free_list);
+-	kfree(iso_sched);
+-}
+-
+-static int itd_urb_transaction(struct fotg210_iso_stream *stream,
+-		struct fotg210_hcd *fotg210, struct urb *urb, gfp_t mem_flags)
+-{
+-	struct fotg210_itd *itd;
+-	dma_addr_t itd_dma;
+-	int i;
+-	unsigned num_itds;
+-	struct fotg210_iso_sched *sched;
+-	unsigned long flags;
+-
+-	sched = iso_sched_alloc(urb->number_of_packets, mem_flags);
+-	if (unlikely(sched == NULL))
+-		return -ENOMEM;
+-
+-	itd_sched_init(fotg210, sched, stream, urb);
+-
+-	if (urb->interval < 8)
+-		num_itds = 1 + (sched->span + 7) / 8;
+-	else
+-		num_itds = urb->number_of_packets;
+-
+-	/* allocate/init ITDs */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	for (i = 0; i < num_itds; i++) {
+-
+-		/*
+-		 * Use iTDs from the free list, but not iTDs that may
+-		 * still be in use by the hardware.
+-		 */
+-		if (likely(!list_empty(&stream->free_list))) {
+-			itd = list_first_entry(&stream->free_list,
+-					struct fotg210_itd, itd_list);
+-			if (itd->frame == fotg210->now_frame)
+-				goto alloc_itd;
+-			list_del(&itd->itd_list);
+-			itd_dma = itd->itd_dma;
+-		} else {
+-alloc_itd:
+-			spin_unlock_irqrestore(&fotg210->lock, flags);
+-			itd = dma_pool_alloc(fotg210->itd_pool, mem_flags,
+-					&itd_dma);
+-			spin_lock_irqsave(&fotg210->lock, flags);
+-			if (!itd) {
+-				iso_sched_free(stream, sched);
+-				spin_unlock_irqrestore(&fotg210->lock, flags);
+-				return -ENOMEM;
+-			}
+-		}
+-
+-		memset(itd, 0, sizeof(*itd));
+-		itd->itd_dma = itd_dma;
+-		list_add(&itd->itd_list, &sched->td_list);
+-	}
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-
+-	/* temporarily store schedule info in hcpriv */
+-	urb->hcpriv = sched;
+-	urb->error_count = 0;
+-	return 0;
+-}
+-
+-static inline int itd_slot_ok(struct fotg210_hcd *fotg210, u32 mod, u32 uframe,
+-		u8 usecs, u32 period)
+-{
+-	uframe %= period;
+-	do {
+-		/* can't commit more than uframe_periodic_max usec */
+-		if (periodic_usecs(fotg210, uframe >> 3, uframe & 0x7)
+-				> (fotg210->uframe_periodic_max - usecs))
+-			return 0;
+-
+-		/* we know urb->interval is 2^N uframes */
+-		uframe += period;
+-	} while (uframe < mod);
+-	return 1;
+-}
+-
+-/* This scheduler plans almost as far into the future as it has actual
+- * periodic schedule slots.  (Affected by TUNE_FLS, which defaults to
+- * "as small as possible" to be cache-friendlier.)  That limits the size
+- * transfers you can stream reliably; avoid more than 64 msec per urb.
+- * Also avoid queue depths of less than fotg210's worst irq latency (affected
+- * by the per-urb URB_NO_INTERRUPT hint, the log2_irq_thresh module parameter,
+- * and other factors); or more than about 230 msec total (for portability,
+- * given FOTG210_TUNE_FLS and the slop).  Or, write a smarter scheduler!
+- */
+-
+-#define SCHEDULE_SLOP 80 /* microframes */
+-
+-static int iso_stream_schedule(struct fotg210_hcd *fotg210, struct urb *urb,
+-		struct fotg210_iso_stream *stream)
+-{
+-	u32 now, next, start, period, span;
+-	int status;
+-	unsigned mod = fotg210->periodic_size << 3;
+-	struct fotg210_iso_sched *sched = urb->hcpriv;
+-
+-	period = urb->interval;
+-	span = sched->span;
+-
+-	if (span > mod - SCHEDULE_SLOP) {
+-		fotg210_dbg(fotg210, "iso request %p too long\n", urb);
+-		status = -EFBIG;
+-		goto fail;
+-	}
+-
+-	now = fotg210_read_frame_index(fotg210) & (mod - 1);
+-
+-	/* Typical case: reuse current schedule, stream is still active.
+-	 * Hopefully there are no gaps from the host falling behind
+-	 * (irq delays etc), but if there are we'll take the next
+-	 * slot in the schedule, implicitly assuming URB_ISO_ASAP.
+-	 */
+-	if (likely(!list_empty(&stream->td_list))) {
+-		u32 excess;
+-
+-		/* For high speed devices, allow scheduling within the
+-		 * isochronous scheduling threshold.  For full speed devices
+-		 * and Intel PCI-based controllers, don't (work around for
+-		 * Intel ICH9 bug).
+-		 */
+-		if (!stream->highspeed && fotg210->fs_i_thresh)
+-			next = now + fotg210->i_thresh;
+-		else
+-			next = now;
+-
+-		/* Fell behind (by up to twice the slop amount)?
+-		 * We decide based on the time of the last currently-scheduled
+-		 * slot, not the time of the next available slot.
+-		 */
+-		excess = (stream->next_uframe - period - next) & (mod - 1);
+-		if (excess >= mod - 2 * SCHEDULE_SLOP)
+-			start = next + excess - mod + period *
+-					DIV_ROUND_UP(mod - excess, period);
+-		else
+-			start = next + excess + period;
+-		if (start - now >= mod) {
+-			fotg210_dbg(fotg210, "request %p would overflow (%d+%d >= %d)\n",
+-					urb, start - now - period, period,
+-					mod);
+-			status = -EFBIG;
+-			goto fail;
+-		}
+-	}
+-
+-	/* need to schedule; when's the next (u)frame we could start?
+-	 * this is bigger than fotg210->i_thresh allows; scheduling itself
+-	 * isn't free, the slop should handle reasonably slow cpus.  it
+-	 * can also help high bandwidth if the dma and irq loads don't
+-	 * jump until after the queue is primed.
+-	 */
+-	else {
+-		int done = 0;
+-
+-		start = SCHEDULE_SLOP + (now & ~0x07);
+-
+-		/* NOTE:  assumes URB_ISO_ASAP, to limit complexity/bugs */
+-
+-		/* find a uframe slot with enough bandwidth.
+-		 * Early uframes are more precious because full-speed
+-		 * iso IN transfers can't use late uframes,
+-		 * and therefore they should be allocated last.
+-		 */
+-		next = start;
+-		start += period;
+-		do {
+-			start--;
+-			/* check schedule: enough space? */
+-			if (itd_slot_ok(fotg210, mod, start,
+-					stream->usecs, period))
+-				done = 1;
+-		} while (start > next && !done);
+-
+-		/* no room in the schedule */
+-		if (!done) {
+-			fotg210_dbg(fotg210, "iso resched full %p (now %d max %d)\n",
+-					urb, now, now + mod);
+-			status = -ENOSPC;
+-			goto fail;
+-		}
+-	}
+-
+-	/* Tried to schedule too far into the future? */
+-	if (unlikely(start - now + span - period >=
+-			mod - 2 * SCHEDULE_SLOP)) {
+-		fotg210_dbg(fotg210, "request %p would overflow (%d+%d >= %d)\n",
+-				urb, start - now, span - period,
+-				mod - 2 * SCHEDULE_SLOP);
+-		status = -EFBIG;
+-		goto fail;
+-	}
+-
+-	stream->next_uframe = start & (mod - 1);
+-
+-	/* report high speed start in uframes; full speed, in frames */
+-	urb->start_frame = stream->next_uframe;
+-	if (!stream->highspeed)
+-		urb->start_frame >>= 3;
+-
+-	/* Make sure scan_isoc() sees these */
+-	if (fotg210->isoc_count == 0)
+-		fotg210->next_frame = now >> 3;
+-	return 0;
+-
+-fail:
+-	iso_sched_free(stream, sched);
+-	urb->hcpriv = NULL;
+-	return status;
+-}
+-
+-static inline void itd_init(struct fotg210_hcd *fotg210,
+-		struct fotg210_iso_stream *stream, struct fotg210_itd *itd)
+-{
+-	int i;
+-
+-	/* it's been recently zeroed */
+-	itd->hw_next = FOTG210_LIST_END(fotg210);
+-	itd->hw_bufp[0] = stream->buf0;
+-	itd->hw_bufp[1] = stream->buf1;
+-	itd->hw_bufp[2] = stream->buf2;
+-
+-	for (i = 0; i < 8; i++)
+-		itd->index[i] = -1;
+-
+-	/* All other fields are filled when scheduling */
+-}
+-
+-static inline void itd_patch(struct fotg210_hcd *fotg210,
+-		struct fotg210_itd *itd, struct fotg210_iso_sched *iso_sched,
+-		unsigned index, u16 uframe)
+-{
+-	struct fotg210_iso_packet *uf = &iso_sched->packet[index];
+-	unsigned pg = itd->pg;
+-
+-	uframe &= 0x07;
+-	itd->index[uframe] = index;
+-
+-	itd->hw_transaction[uframe] = uf->transaction;
+-	itd->hw_transaction[uframe] |= cpu_to_hc32(fotg210, pg << 12);
+-	itd->hw_bufp[pg] |= cpu_to_hc32(fotg210, uf->bufp & ~(u32)0);
+-	itd->hw_bufp_hi[pg] |= cpu_to_hc32(fotg210, (u32)(uf->bufp >> 32));
+-
+-	/* iso_frame_desc[].offset must be strictly increasing */
+-	if (unlikely(uf->cross)) {
+-		u64 bufp = uf->bufp + 4096;
+-
+-		itd->pg = ++pg;
+-		itd->hw_bufp[pg] |= cpu_to_hc32(fotg210, bufp & ~(u32)0);
+-		itd->hw_bufp_hi[pg] |= cpu_to_hc32(fotg210, (u32)(bufp >> 32));
+-	}
+-}
+-
+-static inline void itd_link(struct fotg210_hcd *fotg210, unsigned frame,
+-		struct fotg210_itd *itd)
+-{
+-	union fotg210_shadow *prev = &fotg210->pshadow[frame];
+-	__hc32 *hw_p = &fotg210->periodic[frame];
+-	union fotg210_shadow here = *prev;
+-	__hc32 type = 0;
+-
+-	/* skip any iso nodes which might belong to previous microframes */
+-	while (here.ptr) {
+-		type = Q_NEXT_TYPE(fotg210, *hw_p);
+-		if (type == cpu_to_hc32(fotg210, Q_TYPE_QH))
+-			break;
+-		prev = periodic_next_shadow(fotg210, prev, type);
+-		hw_p = shadow_next_periodic(fotg210, &here, type);
+-		here = *prev;
+-	}
+-
+-	itd->itd_next = here;
+-	itd->hw_next = *hw_p;
+-	prev->itd = itd;
+-	itd->frame = frame;
+-	wmb();
+-	*hw_p = cpu_to_hc32(fotg210, itd->itd_dma | Q_TYPE_ITD);
+-}
+-
+-/* fit urb's itds into the selected schedule slot; activate as needed */
+-static void itd_link_urb(struct fotg210_hcd *fotg210, struct urb *urb,
+-		unsigned mod, struct fotg210_iso_stream *stream)
+-{
+-	int packet;
+-	unsigned next_uframe, uframe, frame;
+-	struct fotg210_iso_sched *iso_sched = urb->hcpriv;
+-	struct fotg210_itd *itd;
+-
+-	next_uframe = stream->next_uframe & (mod - 1);
+-
+-	if (unlikely(list_empty(&stream->td_list))) {
+-		fotg210_to_hcd(fotg210)->self.bandwidth_allocated
+-				+= stream->bandwidth;
+-		fotg210_dbg(fotg210,
+-			"schedule devp %s ep%d%s-iso period %d start %d.%d\n",
+-			urb->dev->devpath, stream->bEndpointAddress & 0x0f,
+-			(stream->bEndpointAddress & USB_DIR_IN) ? "in" : "out",
+-			urb->interval,
+-			next_uframe >> 3, next_uframe & 0x7);
+-	}
+-
+-	/* fill iTDs uframe by uframe */
+-	for (packet = 0, itd = NULL; packet < urb->number_of_packets;) {
+-		if (itd == NULL) {
+-			/* ASSERT:  we have all necessary itds */
+-
+-			/* ASSERT:  no itds for this endpoint in this uframe */
+-
+-			itd = list_entry(iso_sched->td_list.next,
+-					struct fotg210_itd, itd_list);
+-			list_move_tail(&itd->itd_list, &stream->td_list);
+-			itd->stream = stream;
+-			itd->urb = urb;
+-			itd_init(fotg210, stream, itd);
+-		}
+-
+-		uframe = next_uframe & 0x07;
+-		frame = next_uframe >> 3;
+-
+-		itd_patch(fotg210, itd, iso_sched, packet, uframe);
+-
+-		next_uframe += stream->interval;
+-		next_uframe &= mod - 1;
+-		packet++;
+-
+-		/* link completed itds into the schedule */
+-		if (((next_uframe >> 3) != frame)
+-				|| packet == urb->number_of_packets) {
+-			itd_link(fotg210, frame & (fotg210->periodic_size - 1),
+-					itd);
+-			itd = NULL;
+-		}
+-	}
+-	stream->next_uframe = next_uframe;
+-
+-	/* don't need that schedule data any more */
+-	iso_sched_free(stream, iso_sched);
+-	urb->hcpriv = NULL;
+-
+-	++fotg210->isoc_count;
+-	enable_periodic(fotg210);
+-}
+-
+-#define ISO_ERRS (FOTG210_ISOC_BUF_ERR | FOTG210_ISOC_BABBLE |\
+-		FOTG210_ISOC_XACTERR)
+-
+-/* Process and recycle a completed ITD.  Return true iff its urb completed,
+- * and hence its completion callback probably added things to the hardware
+- * schedule.
+- *
+- * Note that we carefully avoid recycling this descriptor until after any
+- * completion callback runs, so that it won't be reused quickly.  That is,
+- * assuming (a) no more than two urbs per frame on this endpoint, and also
+- * (b) only this endpoint's completions submit URBs.  It seems some silicon
+- * corrupts things if you reuse completed descriptors very quickly...
+- */
+-static bool itd_complete(struct fotg210_hcd *fotg210, struct fotg210_itd *itd)
+-{
+-	struct urb *urb = itd->urb;
+-	struct usb_iso_packet_descriptor *desc;
+-	u32 t;
+-	unsigned uframe;
+-	int urb_index = -1;
+-	struct fotg210_iso_stream *stream = itd->stream;
+-	struct usb_device *dev;
+-	bool retval = false;
+-
+-	/* for each uframe with a packet */
+-	for (uframe = 0; uframe < 8; uframe++) {
+-		if (likely(itd->index[uframe] == -1))
+-			continue;
+-		urb_index = itd->index[uframe];
+-		desc = &urb->iso_frame_desc[urb_index];
+-
+-		t = hc32_to_cpup(fotg210, &itd->hw_transaction[uframe]);
+-		itd->hw_transaction[uframe] = 0;
+-
+-		/* report transfer status */
+-		if (unlikely(t & ISO_ERRS)) {
+-			urb->error_count++;
+-			if (t & FOTG210_ISOC_BUF_ERR)
+-				desc->status = usb_pipein(urb->pipe)
+-					? -ENOSR  /* hc couldn't read */
+-					: -ECOMM; /* hc couldn't write */
+-			else if (t & FOTG210_ISOC_BABBLE)
+-				desc->status = -EOVERFLOW;
+-			else /* (t & FOTG210_ISOC_XACTERR) */
+-				desc->status = -EPROTO;
+-
+-			/* HC need not update length with this error */
+-			if (!(t & FOTG210_ISOC_BABBLE)) {
+-				desc->actual_length = FOTG210_ITD_LENGTH(t);
+-				urb->actual_length += desc->actual_length;
+-			}
+-		} else if (likely((t & FOTG210_ISOC_ACTIVE) == 0)) {
+-			desc->status = 0;
+-			desc->actual_length = FOTG210_ITD_LENGTH(t);
+-			urb->actual_length += desc->actual_length;
+-		} else {
+-			/* URB was too late */
+-			desc->status = -EXDEV;
+-		}
+-	}
+-
+-	/* handle completion now? */
+-	if (likely((urb_index + 1) != urb->number_of_packets))
+-		goto done;
+-
+-	/* ASSERT: it's really the last itd for this urb
+-	 * list_for_each_entry (itd, &stream->td_list, itd_list)
+-	 *	BUG_ON (itd->urb == urb);
+-	 */
+-
+-	/* give urb back to the driver; completion often (re)submits */
+-	dev = urb->dev;
+-	fotg210_urb_done(fotg210, urb, 0);
+-	retval = true;
+-	urb = NULL;
+-
+-	--fotg210->isoc_count;
+-	disable_periodic(fotg210);
+-
+-	if (unlikely(list_is_singular(&stream->td_list))) {
+-		fotg210_to_hcd(fotg210)->self.bandwidth_allocated
+-				-= stream->bandwidth;
+-		fotg210_dbg(fotg210,
+-			"deschedule devp %s ep%d%s-iso\n",
+-			dev->devpath, stream->bEndpointAddress & 0x0f,
+-			(stream->bEndpointAddress & USB_DIR_IN) ? "in" : "out");
+-	}
+-
+-done:
+-	itd->urb = NULL;
+-
+-	/* Add to the end of the free list for later reuse */
+-	list_move_tail(&itd->itd_list, &stream->free_list);
+-
+-	/* Recycle the iTDs when the pipeline is empty (ep no longer in use) */
+-	if (list_empty(&stream->td_list)) {
+-		list_splice_tail_init(&stream->free_list,
+-				&fotg210->cached_itd_list);
+-		start_free_itds(fotg210);
+-	}
+-
+-	return retval;
+-}
+-
+-static int itd_submit(struct fotg210_hcd *fotg210, struct urb *urb,
+-		gfp_t mem_flags)
+-{
+-	int status = -EINVAL;
+-	unsigned long flags;
+-	struct fotg210_iso_stream *stream;
+-
+-	/* Get iso_stream head */
+-	stream = iso_stream_find(fotg210, urb);
+-	if (unlikely(stream == NULL)) {
+-		fotg210_dbg(fotg210, "can't get iso stream\n");
+-		return -ENOMEM;
+-	}
+-	if (unlikely(urb->interval != stream->interval &&
+-			fotg210_port_speed(fotg210, 0) ==
+-			USB_PORT_STAT_HIGH_SPEED)) {
+-		fotg210_dbg(fotg210, "can't change iso interval %d --> %d\n",
+-				stream->interval, urb->interval);
+-		goto done;
+-	}
+-
+-#ifdef FOTG210_URB_TRACE
+-	fotg210_dbg(fotg210,
+-			"%s %s urb %p ep%d%s len %d, %d pkts %d uframes[%p]\n",
+-			__func__, urb->dev->devpath, urb,
+-			usb_pipeendpoint(urb->pipe),
+-			usb_pipein(urb->pipe) ? "in" : "out",
+-			urb->transfer_buffer_length,
+-			urb->number_of_packets, urb->interval,
+-			stream);
+-#endif
+-
+-	/* allocate ITDs w/o locking anything */
+-	status = itd_urb_transaction(stream, fotg210, urb, mem_flags);
+-	if (unlikely(status < 0)) {
+-		fotg210_dbg(fotg210, "can't init itds\n");
+-		goto done;
+-	}
+-
+-	/* schedule ... need to lock */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
+-		status = -ESHUTDOWN;
+-		goto done_not_linked;
+-	}
+-	status = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
+-	if (unlikely(status))
+-		goto done_not_linked;
+-	status = iso_stream_schedule(fotg210, urb, stream);
+-	if (likely(status == 0))
+-		itd_link_urb(fotg210, urb, fotg210->periodic_size << 3, stream);
+-	else
+-		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
+-done_not_linked:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-done:
+-	return status;
+-}
+-
+-static inline int scan_frame_queue(struct fotg210_hcd *fotg210, unsigned frame,
+-		unsigned now_frame, bool live)
+-{
+-	unsigned uf;
+-	bool modified;
+-	union fotg210_shadow q, *q_p;
+-	__hc32 type, *hw_p;
+-
+-	/* scan each element in frame's queue for completions */
+-	q_p = &fotg210->pshadow[frame];
+-	hw_p = &fotg210->periodic[frame];
+-	q.ptr = q_p->ptr;
+-	type = Q_NEXT_TYPE(fotg210, *hw_p);
+-	modified = false;
+-
+-	while (q.ptr) {
+-		switch (hc32_to_cpu(fotg210, type)) {
+-		case Q_TYPE_ITD:
+-			/* If this ITD is still active, leave it for
+-			 * later processing ... check the next entry.
+-			 * No need to check for activity unless the
+-			 * frame is current.
+-			 */
+-			if (frame == now_frame && live) {
+-				rmb();
+-				for (uf = 0; uf < 8; uf++) {
+-					if (q.itd->hw_transaction[uf] &
+-							ITD_ACTIVE(fotg210))
+-						break;
+-				}
+-				if (uf < 8) {
+-					q_p = &q.itd->itd_next;
+-					hw_p = &q.itd->hw_next;
+-					type = Q_NEXT_TYPE(fotg210,
+-							q.itd->hw_next);
+-					q = *q_p;
+-					break;
+-				}
+-			}
+-
+-			/* Take finished ITDs out of the schedule
+-			 * and process them:  recycle, maybe report
+-			 * URB completion.  HC won't cache the
+-			 * pointer for much longer, if at all.
+-			 */
+-			*q_p = q.itd->itd_next;
+-			*hw_p = q.itd->hw_next;
+-			type = Q_NEXT_TYPE(fotg210, q.itd->hw_next);
+-			wmb();
+-			modified = itd_complete(fotg210, q.itd);
+-			q = *q_p;
+-			break;
+-		default:
+-			fotg210_dbg(fotg210, "corrupt type %d frame %d shadow %p\n",
+-					type, frame, q.ptr);
+-			fallthrough;
+-		case Q_TYPE_QH:
+-		case Q_TYPE_FSTN:
+-			/* End of the iTDs and siTDs */
+-			q.ptr = NULL;
+-			break;
+-		}
+-
+-		/* assume completion callbacks modify the queue */
+-		if (unlikely(modified && fotg210->isoc_count > 0))
+-			return -EINVAL;
+-	}
+-	return 0;
+-}
+-
+-static void scan_isoc(struct fotg210_hcd *fotg210)
+-{
+-	unsigned uf, now_frame, frame, ret;
+-	unsigned fmask = fotg210->periodic_size - 1;
+-	bool live;
+-
+-	/*
+-	 * When running, scan from last scan point up to "now"
+-	 * else clean up by scanning everything that's left.
+-	 * Touches as few pages as possible:  cache-friendly.
+-	 */
+-	if (fotg210->rh_state >= FOTG210_RH_RUNNING) {
+-		uf = fotg210_read_frame_index(fotg210);
+-		now_frame = (uf >> 3) & fmask;
+-		live = true;
+-	} else  {
+-		now_frame = (fotg210->next_frame - 1) & fmask;
+-		live = false;
+-	}
+-	fotg210->now_frame = now_frame;
+-
+-	frame = fotg210->next_frame;
+-	for (;;) {
+-		ret = 1;
+-		while (ret != 0)
+-			ret = scan_frame_queue(fotg210, frame,
+-					now_frame, live);
+-
+-		/* Stop when we have reached the current frame */
+-		if (frame == now_frame)
+-			break;
+-		frame = (frame + 1) & fmask;
+-	}
+-	fotg210->next_frame = now_frame;
+-}
+-
+-/* Display / Set uframe_periodic_max
+- */
+-static ssize_t uframe_periodic_max_show(struct device *dev,
+-		struct device_attribute *attr, char *buf)
+-{
+-	struct fotg210_hcd *fotg210;
+-	int n;
+-
+-	fotg210 = hcd_to_fotg210(bus_to_hcd(dev_get_drvdata(dev)));
+-	n = scnprintf(buf, PAGE_SIZE, "%d\n", fotg210->uframe_periodic_max);
+-	return n;
+-}
+-
+-
+-static ssize_t uframe_periodic_max_store(struct device *dev,
+-		struct device_attribute *attr, const char *buf, size_t count)
+-{
+-	struct fotg210_hcd *fotg210;
+-	unsigned uframe_periodic_max;
+-	unsigned frame, uframe;
+-	unsigned short allocated_max;
+-	unsigned long flags;
+-	ssize_t ret;
+-
+-	fotg210 = hcd_to_fotg210(bus_to_hcd(dev_get_drvdata(dev)));
+-	if (kstrtouint(buf, 0, &uframe_periodic_max) < 0)
+-		return -EINVAL;
+-
+-	if (uframe_periodic_max < 100 || uframe_periodic_max >= 125) {
+-		fotg210_info(fotg210, "rejecting invalid request for uframe_periodic_max=%u\n",
+-				uframe_periodic_max);
+-		return -EINVAL;
+-	}
+-
+-	ret = -EINVAL;
+-
+-	/*
+-	 * lock, so that our checking does not race with possible periodic
+-	 * bandwidth allocation through submitting new urbs.
+-	 */
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	/*
+-	 * for request to decrease max periodic bandwidth, we have to check
+-	 * every microframe in the schedule to see whether the decrease is
+-	 * possible.
+-	 */
+-	if (uframe_periodic_max < fotg210->uframe_periodic_max) {
+-		allocated_max = 0;
+-
+-		for (frame = 0; frame < fotg210->periodic_size; ++frame)
+-			for (uframe = 0; uframe < 7; ++uframe)
+-				allocated_max = max(allocated_max,
+-						periodic_usecs(fotg210, frame,
+-						uframe));
+-
+-		if (allocated_max > uframe_periodic_max) {
+-			fotg210_info(fotg210,
+-					"cannot decrease uframe_periodic_max because periodic bandwidth is already allocated (%u > %u)\n",
+-					allocated_max, uframe_periodic_max);
+-			goto out_unlock;
+-		}
+-	}
+-
+-	/* increasing is always ok */
+-
+-	fotg210_info(fotg210,
+-			"setting max periodic bandwidth to %u%% (== %u usec/uframe)\n",
+-			100 * uframe_periodic_max/125, uframe_periodic_max);
+-
+-	if (uframe_periodic_max != 100)
+-		fotg210_warn(fotg210, "max periodic bandwidth set is non-standard\n");
+-
+-	fotg210->uframe_periodic_max = uframe_periodic_max;
+-	ret = count;
+-
+-out_unlock:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return ret;
+-}
+-
+-static DEVICE_ATTR_RW(uframe_periodic_max);
+-
+-static inline int create_sysfs_files(struct fotg210_hcd *fotg210)
+-{
+-	struct device *controller = fotg210_to_hcd(fotg210)->self.controller;
+-
+-	return device_create_file(controller, &dev_attr_uframe_periodic_max);
+-}
+-
+-static inline void remove_sysfs_files(struct fotg210_hcd *fotg210)
+-{
+-	struct device *controller = fotg210_to_hcd(fotg210)->self.controller;
+-
+-	device_remove_file(controller, &dev_attr_uframe_periodic_max);
+-}
+-/* On some systems, leaving remote wakeup enabled prevents system shutdown.
+- * The firmware seems to think that powering off is a wakeup event!
+- * This routine turns off remote wakeup and everything else, on all ports.
+- */
+-static void fotg210_turn_off_all_ports(struct fotg210_hcd *fotg210)
+-{
+-	u32 __iomem *status_reg = &fotg210->regs->port_status;
+-
+-	fotg210_writel(fotg210, PORT_RWC_BITS, status_reg);
+-}
+-
+-/* Halt HC, turn off all ports, and let the BIOS use the companion controllers.
+- * Must be called with interrupts enabled and the lock not held.
+- */
+-static void fotg210_silence_controller(struct fotg210_hcd *fotg210)
+-{
+-	fotg210_halt(fotg210);
+-
+-	spin_lock_irq(&fotg210->lock);
+-	fotg210->rh_state = FOTG210_RH_HALTED;
+-	fotg210_turn_off_all_ports(fotg210);
+-	spin_unlock_irq(&fotg210->lock);
+-}
+-
+-/* fotg210_shutdown kick in for silicon on any bus (not just pci, etc).
+- * This forcibly disables dma and IRQs, helping kexec and other cases
+- * where the next system software may expect clean state.
+- */
+-static void fotg210_shutdown(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-
+-	spin_lock_irq(&fotg210->lock);
+-	fotg210->shutdown = true;
+-	fotg210->rh_state = FOTG210_RH_STOPPING;
+-	fotg210->enabled_hrtimer_events = 0;
+-	spin_unlock_irq(&fotg210->lock);
+-
+-	fotg210_silence_controller(fotg210);
+-
+-	hrtimer_cancel(&fotg210->hrtimer);
+-}
+-
+-/* fotg210_work is called from some interrupts, timers, and so on.
+- * it calls driver completion functions, after dropping fotg210->lock.
+- */
+-static void fotg210_work(struct fotg210_hcd *fotg210)
+-{
+-	/* another CPU may drop fotg210->lock during a schedule scan while
+-	 * it reports urb completions.  this flag guards against bogus
+-	 * attempts at re-entrant schedule scanning.
+-	 */
+-	if (fotg210->scanning) {
+-		fotg210->need_rescan = true;
+-		return;
+-	}
+-	fotg210->scanning = true;
+-
+-rescan:
+-	fotg210->need_rescan = false;
+-	if (fotg210->async_count)
+-		scan_async(fotg210);
+-	if (fotg210->intr_count > 0)
+-		scan_intr(fotg210);
+-	if (fotg210->isoc_count > 0)
+-		scan_isoc(fotg210);
+-	if (fotg210->need_rescan)
+-		goto rescan;
+-	fotg210->scanning = false;
+-
+-	/* the IO watchdog guards against hardware or driver bugs that
+-	 * misplace IRQs, and should let us run completely without IRQs.
+-	 * such lossage has been observed on both VT6202 and VT8235.
+-	 */
+-	turn_on_io_watchdog(fotg210);
+-}
+-
+-/* Called when the fotg210_hcd module is removed.
+- */
+-static void fotg210_stop(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-
+-	fotg210_dbg(fotg210, "stop\n");
+-
+-	/* no more interrupts ... */
+-
+-	spin_lock_irq(&fotg210->lock);
+-	fotg210->enabled_hrtimer_events = 0;
+-	spin_unlock_irq(&fotg210->lock);
+-
+-	fotg210_quiesce(fotg210);
+-	fotg210_silence_controller(fotg210);
+-	fotg210_reset(fotg210);
+-
+-	hrtimer_cancel(&fotg210->hrtimer);
+-	remove_sysfs_files(fotg210);
+-	remove_debug_files(fotg210);
+-
+-	/* root hub is shut down separately (first, when possible) */
+-	spin_lock_irq(&fotg210->lock);
+-	end_free_itds(fotg210);
+-	spin_unlock_irq(&fotg210->lock);
+-	fotg210_mem_cleanup(fotg210);
+-
+-#ifdef FOTG210_STATS
+-	fotg210_dbg(fotg210, "irq normal %ld err %ld iaa %ld (lost %ld)\n",
+-			fotg210->stats.normal, fotg210->stats.error,
+-			fotg210->stats.iaa, fotg210->stats.lost_iaa);
+-	fotg210_dbg(fotg210, "complete %ld unlink %ld\n",
+-			fotg210->stats.complete, fotg210->stats.unlink);
+-#endif
+-
+-	dbg_status(fotg210, "fotg210_stop completed",
+-			fotg210_readl(fotg210, &fotg210->regs->status));
+-}
+-
+-/* one-time init, only for memory state */
+-static int hcd_fotg210_init(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	u32 temp;
+-	int retval;
+-	u32 hcc_params;
+-	struct fotg210_qh_hw *hw;
+-
+-	spin_lock_init(&fotg210->lock);
+-
+-	/*
+-	 * keep io watchdog by default, those good HCDs could turn off it later
+-	 */
+-	fotg210->need_io_watchdog = 1;
+-
+-	hrtimer_init(&fotg210->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
+-	fotg210->hrtimer.function = fotg210_hrtimer_func;
+-	fotg210->next_hrtimer_event = FOTG210_HRTIMER_NO_EVENT;
+-
+-	hcc_params = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
+-
+-	/*
+-	 * by default set standard 80% (== 100 usec/uframe) max periodic
+-	 * bandwidth as required by USB 2.0
+-	 */
+-	fotg210->uframe_periodic_max = 100;
+-
+-	/*
+-	 * hw default: 1K periodic list heads, one per frame.
+-	 * periodic_size can shrink by USBCMD update if hcc_params allows.
+-	 */
+-	fotg210->periodic_size = DEFAULT_I_TDPS;
+-	INIT_LIST_HEAD(&fotg210->intr_qh_list);
+-	INIT_LIST_HEAD(&fotg210->cached_itd_list);
+-
+-	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
+-		/* periodic schedule size can be smaller than default */
+-		switch (FOTG210_TUNE_FLS) {
+-		case 0:
+-			fotg210->periodic_size = 1024;
+-			break;
+-		case 1:
+-			fotg210->periodic_size = 512;
+-			break;
+-		case 2:
+-			fotg210->periodic_size = 256;
+-			break;
+-		default:
+-			BUG();
+-		}
+-	}
+-	retval = fotg210_mem_init(fotg210, GFP_KERNEL);
+-	if (retval < 0)
+-		return retval;
+-
+-	/* controllers may cache some of the periodic schedule ... */
+-	fotg210->i_thresh = 2;
+-
+-	/*
+-	 * dedicate a qh for the async ring head, since we couldn't unlink
+-	 * a 'real' qh without stopping the async schedule [4.8].  use it
+-	 * as the 'reclamation list head' too.
+-	 * its dummy is used in hw_alt_next of many tds, to prevent the qh
+-	 * from automatically advancing to the next td after short reads.
+-	 */
+-	fotg210->async->qh_next.qh = NULL;
+-	hw = fotg210->async->hw;
+-	hw->hw_next = QH_NEXT(fotg210, fotg210->async->qh_dma);
+-	hw->hw_info1 = cpu_to_hc32(fotg210, QH_HEAD);
+-	hw->hw_token = cpu_to_hc32(fotg210, QTD_STS_HALT);
+-	hw->hw_qtd_next = FOTG210_LIST_END(fotg210);
+-	fotg210->async->qh_state = QH_STATE_LINKED;
+-	hw->hw_alt_next = QTD_NEXT(fotg210, fotg210->async->dummy->qtd_dma);
+-
+-	/* clear interrupt enables, set irq latency */
+-	if (log2_irq_thresh < 0 || log2_irq_thresh > 6)
+-		log2_irq_thresh = 0;
+-	temp = 1 << (16 + log2_irq_thresh);
+-	if (HCC_CANPARK(hcc_params)) {
+-		/* HW default park == 3, on hardware that supports it (like
+-		 * NVidia and ALI silicon), maximizes throughput on the async
+-		 * schedule by avoiding QH fetches between transfers.
+-		 *
+-		 * With fast usb storage devices and NForce2, "park" seems to
+-		 * make problems:  throughput reduction (!), data errors...
+-		 */
+-		if (park) {
+-			park = min_t(unsigned, park, 3);
+-			temp |= CMD_PARK;
+-			temp |= park << 8;
+-		}
+-		fotg210_dbg(fotg210, "park %d\n", park);
+-	}
+-	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
+-		/* periodic schedule size can be smaller than default */
+-		temp &= ~(3 << 2);
+-		temp |= (FOTG210_TUNE_FLS << 2);
+-	}
+-	fotg210->command = temp;
+-
+-	/* Accept arbitrarily long scatter-gather lists */
+-	if (!hcd->localmem_pool)
+-		hcd->self.sg_tablesize = ~0;
+-	return 0;
+-}
+-
+-/* start HC running; it's halted, hcd_fotg210_init() has been run (once) */
+-static int fotg210_run(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	u32 temp;
+-
+-	hcd->uses_new_polling = 1;
+-
+-	/* EHCI spec section 4.1 */
+-
+-	fotg210_writel(fotg210, fotg210->periodic_dma,
+-			&fotg210->regs->frame_list);
+-	fotg210_writel(fotg210, (u32)fotg210->async->qh_dma,
+-			&fotg210->regs->async_next);
+-
+-	/*
+-	 * hcc_params controls whether fotg210->regs->segment must (!!!)
+-	 * be used; it constrains QH/ITD/SITD and QTD locations.
+-	 * dma_pool consistent memory always uses segment zero.
+-	 * streaming mappings for I/O buffers, like dma_map_single(),
+-	 * can return segments above 4GB, if the device allows.
+-	 *
+-	 * NOTE:  the dma mask is visible through dev->dma_mask, so
+-	 * drivers can pass this info along ... like NETIF_F_HIGHDMA,
+-	 * Scsi_Host.highmem_io, and so forth.  It's readonly to all
+-	 * host side drivers though.
+-	 */
+-	fotg210_readl(fotg210, &fotg210->caps->hcc_params);
+-
+-	/*
+-	 * Philips, Intel, and maybe others need CMD_RUN before the
+-	 * root hub will detect new devices (why?); NEC doesn't
+-	 */
+-	fotg210->command &= ~(CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET);
+-	fotg210->command |= CMD_RUN;
+-	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
+-	dbg_cmd(fotg210, "init", fotg210->command);
+-
+-	/*
+-	 * Start, enabling full USB 2.0 functionality ... usb 1.1 devices
+-	 * are explicitly handed to companion controller(s), so no TT is
+-	 * involved with the root hub.  (Except where one is integrated,
+-	 * and there's no companion controller unless maybe for USB OTG.)
+-	 *
+-	 * Turning on the CF flag will transfer ownership of all ports
+-	 * from the companions to the EHCI controller.  If any of the
+-	 * companions are in the middle of a port reset at the time, it
+-	 * could cause trouble.  Write-locking ehci_cf_port_reset_rwsem
+-	 * guarantees that no resets are in progress.  After we set CF,
+-	 * a short delay lets the hardware catch up; new resets shouldn't
+-	 * be started before the port switching actions could complete.
+-	 */
+-	down_write(&ehci_cf_port_reset_rwsem);
+-	fotg210->rh_state = FOTG210_RH_RUNNING;
+-	/* unblock posted writes */
+-	fotg210_readl(fotg210, &fotg210->regs->command);
+-	usleep_range(5000, 10000);
+-	up_write(&ehci_cf_port_reset_rwsem);
+-	fotg210->last_periodic_enable = ktime_get_real();
+-
+-	temp = HC_VERSION(fotg210,
+-			fotg210_readl(fotg210, &fotg210->caps->hc_capbase));
+-	fotg210_info(fotg210,
+-			"USB %x.%x started, EHCI %x.%02x\n",
+-			((fotg210->sbrn & 0xf0) >> 4), (fotg210->sbrn & 0x0f),
+-			temp >> 8, temp & 0xff);
+-
+-	fotg210_writel(fotg210, INTR_MASK,
+-			&fotg210->regs->intr_enable); /* Turn On Interrupts */
+-
+-	/* GRR this is run-once init(), being done every time the HC starts.
+-	 * So long as they're part of class devices, we can't do it init()
+-	 * since the class device isn't created that early.
+-	 */
+-	create_debug_files(fotg210);
+-	create_sysfs_files(fotg210);
+-
+-	return 0;
+-}
+-
+-static int fotg210_setup(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	int retval;
+-
+-	fotg210->regs = (void __iomem *)fotg210->caps +
+-			HC_LENGTH(fotg210,
+-			fotg210_readl(fotg210, &fotg210->caps->hc_capbase));
+-	dbg_hcs_params(fotg210, "reset");
+-	dbg_hcc_params(fotg210, "reset");
+-
+-	/* cache this readonly data; minimize chip reads */
+-	fotg210->hcs_params = fotg210_readl(fotg210,
+-			&fotg210->caps->hcs_params);
+-
+-	fotg210->sbrn = HCD_USB2;
+-
+-	/* data structure init */
+-	retval = hcd_fotg210_init(hcd);
+-	if (retval)
+-		return retval;
+-
+-	retval = fotg210_halt(fotg210);
+-	if (retval)
+-		return retval;
+-
+-	fotg210_reset(fotg210);
+-
+-	return 0;
+-}
+-
+-static irqreturn_t fotg210_irq(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	u32 status, masked_status, pcd_status = 0, cmd;
+-	int bh;
+-
+-	spin_lock(&fotg210->lock);
+-
+-	status = fotg210_readl(fotg210, &fotg210->regs->status);
+-
+-	/* e.g. cardbus physical eject */
+-	if (status == ~(u32) 0) {
+-		fotg210_dbg(fotg210, "device removed\n");
+-		goto dead;
+-	}
+-
+-	/*
+-	 * We don't use STS_FLR, but some controllers don't like it to
+-	 * remain on, so mask it out along with the other status bits.
+-	 */
+-	masked_status = status & (INTR_MASK | STS_FLR);
+-
+-	/* Shared IRQ? */
+-	if (!masked_status ||
+-			unlikely(fotg210->rh_state == FOTG210_RH_HALTED)) {
+-		spin_unlock(&fotg210->lock);
+-		return IRQ_NONE;
+-	}
+-
+-	/* clear (just) interrupts */
+-	fotg210_writel(fotg210, masked_status, &fotg210->regs->status);
+-	cmd = fotg210_readl(fotg210, &fotg210->regs->command);
+-	bh = 0;
+-
+-	/* unrequested/ignored: Frame List Rollover */
+-	dbg_status(fotg210, "irq", status);
+-
+-	/* INT, ERR, and IAA interrupt rates can be throttled */
+-
+-	/* 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))
+-			INCR(fotg210->stats.normal);
+-		else
+-			INCR(fotg210->stats.error);
+-		bh = 1;
+-	}
+-
+-	/* complete the unlinking of some qh [4.15.2.3] */
+-	if (status & STS_IAA) {
+-
+-		/* Turn off the IAA watchdog */
+-		fotg210->enabled_hrtimer_events &=
+-			~BIT(FOTG210_HRTIMER_IAA_WATCHDOG);
+-
+-		/*
+-		 * Mild optimization: Allow another IAAD to reset the
+-		 * hrtimer, if one occurs before the next expiration.
+-		 * In theory we could always cancel the hrtimer, but
+-		 * tests show that about half the time it will be reset
+-		 * for some other event anyway.
+-		 */
+-		if (fotg210->next_hrtimer_event == FOTG210_HRTIMER_IAA_WATCHDOG)
+-			++fotg210->next_hrtimer_event;
+-
+-		/* guard against (alleged) silicon errata */
+-		if (cmd & CMD_IAAD)
+-			fotg210_dbg(fotg210, "IAA with IAAD still set?\n");
+-		if (fotg210->async_iaa) {
+-			INCR(fotg210->stats.iaa);
+-			end_unlink_async(fotg210);
+-		} else
+-			fotg210_dbg(fotg210, "IAA with nothing unlinked?\n");
+-	}
+-
+-	/* remote wakeup [4.3.1] */
+-	if (status & STS_PCD) {
+-		int pstatus;
+-		u32 __iomem *status_reg = &fotg210->regs->port_status;
+-
+-		/* kick root hub later */
+-		pcd_status = status;
+-
+-		/* resume root hub? */
+-		if (fotg210->rh_state == FOTG210_RH_SUSPENDED)
+-			usb_hcd_resume_root_hub(hcd);
+-
+-		pstatus = fotg210_readl(fotg210, status_reg);
+-
+-		if (test_bit(0, &fotg210->suspended_ports) &&
+-				((pstatus & PORT_RESUME) ||
+-				!(pstatus & PORT_SUSPEND)) &&
+-				(pstatus & PORT_PE) &&
+-				fotg210->reset_done[0] == 0) {
+-
+-			/* start 20 msec resume signaling from this port,
+-			 * and make hub_wq collect PORT_STAT_C_SUSPEND to
+-			 * stop that signaling.  Use 5 ms extra for safety,
+-			 * like usb_port_resume() does.
+-			 */
+-			fotg210->reset_done[0] = jiffies + msecs_to_jiffies(25);
+-			set_bit(0, &fotg210->resuming_ports);
+-			fotg210_dbg(fotg210, "port 1 remote wakeup\n");
+-			mod_timer(&hcd->rh_timer, fotg210->reset_done[0]);
+-		}
+-	}
+-
+-	/* PCI errors [4.15.2.4] */
+-	if (unlikely((status & STS_FATAL) != 0)) {
+-		fotg210_err(fotg210, "fatal error\n");
+-		dbg_cmd(fotg210, "fatal", cmd);
+-		dbg_status(fotg210, "fatal", status);
+-dead:
+-		usb_hc_died(hcd);
+-
+-		/* Don't let the controller do anything more */
+-		fotg210->shutdown = true;
+-		fotg210->rh_state = FOTG210_RH_STOPPING;
+-		fotg210->command &= ~(CMD_RUN | CMD_ASE | CMD_PSE);
+-		fotg210_writel(fotg210, fotg210->command,
+-				&fotg210->regs->command);
+-		fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
+-		fotg210_handle_controller_death(fotg210);
+-
+-		/* Handle completions when the controller stops */
+-		bh = 0;
+-	}
+-
+-	if (bh)
+-		fotg210_work(fotg210);
+-	spin_unlock(&fotg210->lock);
+-	if (pcd_status)
+-		usb_hcd_poll_rh_status(hcd);
+-	return IRQ_HANDLED;
+-}
+-
+-/* non-error returns are a promise to giveback() the urb later
+- * we drop ownership so next owner (or urb unlink) can get it
+- *
+- * urb + dev is in hcd.self.controller.urb_list
+- * we're queueing TDs onto software and hardware lists
+- *
+- * hcd-specific init for hcpriv hasn't been done yet
+- *
+- * 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 fotg210_urb_enqueue(struct usb_hcd *hcd, struct urb *urb,
+-		gfp_t mem_flags)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	struct list_head qtd_list;
+-
+-	INIT_LIST_HEAD(&qtd_list);
+-
+-	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.
+-		 */
+-		if (urb->transfer_buffer_length > (16 * 1024))
+-			return -EMSGSIZE;
+-		fallthrough;
+-	/* case PIPE_BULK: */
+-	default:
+-		if (!qh_urb_transaction(fotg210, urb, &qtd_list, mem_flags))
+-			return -ENOMEM;
+-		return submit_async(fotg210, urb, &qtd_list, mem_flags);
+-
+-	case PIPE_INTERRUPT:
+-		if (!qh_urb_transaction(fotg210, urb, &qtd_list, mem_flags))
+-			return -ENOMEM;
+-		return intr_submit(fotg210, urb, &qtd_list, mem_flags);
+-
+-	case PIPE_ISOCHRONOUS:
+-		return itd_submit(fotg210, urb, mem_flags);
+-	}
+-}
+-
+-/* remove from hardware lists
+- * completions normally happen asynchronously
+- */
+-
+-static int fotg210_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	struct fotg210_qh *qh;
+-	unsigned long flags;
+-	int rc;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	rc = usb_hcd_check_unlink_urb(hcd, urb, status);
+-	if (rc)
+-		goto done;
+-
+-	switch (usb_pipetype(urb->pipe)) {
+-	/* case PIPE_CONTROL: */
+-	/* case PIPE_BULK:*/
+-	default:
+-		qh = (struct fotg210_qh *) urb->hcpriv;
+-		if (!qh)
+-			break;
+-		switch (qh->qh_state) {
+-		case QH_STATE_LINKED:
+-		case QH_STATE_COMPLETING:
+-			start_unlink_async(fotg210, qh);
+-			break;
+-		case QH_STATE_UNLINK:
+-		case QH_STATE_UNLINK_WAIT:
+-			/* already started */
+-			break;
+-		case QH_STATE_IDLE:
+-			/* QH might be waiting for a Clear-TT-Buffer */
+-			qh_completions(fotg210, qh);
+-			break;
+-		}
+-		break;
+-
+-	case PIPE_INTERRUPT:
+-		qh = (struct fotg210_qh *) urb->hcpriv;
+-		if (!qh)
+-			break;
+-		switch (qh->qh_state) {
+-		case QH_STATE_LINKED:
+-		case QH_STATE_COMPLETING:
+-			start_unlink_intr(fotg210, qh);
+-			break;
+-		case QH_STATE_IDLE:
+-			qh_completions(fotg210, qh);
+-			break;
+-		default:
+-			fotg210_dbg(fotg210, "bogus qh %p state %d\n",
+-					qh, qh->qh_state);
+-			goto done;
+-		}
+-		break;
+-
+-	case PIPE_ISOCHRONOUS:
+-		/* itd... */
+-
+-		/* wait till next completion, do it then. */
+-		/* completion irqs can wait up to 1024 msec, */
+-		break;
+-	}
+-done:
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-	return rc;
+-}
+-
+-/* bulk qh holds the data toggle */
+-
+-static void fotg210_endpoint_disable(struct usb_hcd *hcd,
+-		struct usb_host_endpoint *ep)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	unsigned long flags;
+-	struct fotg210_qh *qh, *tmp;
+-
+-	/* ASSERT:  any requests/urbs are being unlinked */
+-	/* ASSERT:  nobody can be submitting urbs for this any more */
+-
+-rescan:
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	qh = ep->hcpriv;
+-	if (!qh)
+-		goto done;
+-
+-	/* endpoints can be iso streams.  for now, we don't
+-	 * accelerate iso completions ... so spin a while.
+-	 */
+-	if (qh->hw == NULL) {
+-		struct fotg210_iso_stream *stream = ep->hcpriv;
+-
+-		if (!list_empty(&stream->td_list))
+-			goto idle_timeout;
+-
+-		/* BUG_ON(!list_empty(&stream->free_list)); */
+-		kfree(stream);
+-		goto done;
+-	}
+-
+-	if (fotg210->rh_state < FOTG210_RH_RUNNING)
+-		qh->qh_state = QH_STATE_IDLE;
+-	switch (qh->qh_state) {
+-	case QH_STATE_LINKED:
+-	case QH_STATE_COMPLETING:
+-		for (tmp = fotg210->async->qh_next.qh;
+-				tmp && tmp != qh;
+-				tmp = tmp->qh_next.qh)
+-			continue;
+-		/* periodic qh self-unlinks on empty, and a COMPLETING qh
+-		 * may already be unlinked.
+-		 */
+-		if (tmp)
+-			start_unlink_async(fotg210, qh);
+-		fallthrough;
+-	case QH_STATE_UNLINK:		/* wait for hw to finish? */
+-	case QH_STATE_UNLINK_WAIT:
+-idle_timeout:
+-		spin_unlock_irqrestore(&fotg210->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)) {
+-			qh_destroy(fotg210, qh);
+-			break;
+-		}
+-		fallthrough;
+-	default:
+-		/* caller was supposed to have unlinked any requests;
+-		 * that's not our job.  just leak this memory.
+-		 */
+-		fotg210_err(fotg210, "qh %p (#%02x) state %d%s\n",
+-				qh, ep->desc.bEndpointAddress, qh->qh_state,
+-				list_empty(&qh->qtd_list) ? "" : "(has tds)");
+-		break;
+-	}
+-done:
+-	ep->hcpriv = NULL;
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-}
+-
+-static void fotg210_endpoint_reset(struct usb_hcd *hcd,
+-		struct usb_host_endpoint *ep)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-	struct fotg210_qh *qh;
+-	int eptype = usb_endpoint_type(&ep->desc);
+-	int epnum = usb_endpoint_num(&ep->desc);
+-	int is_out = usb_endpoint_dir_out(&ep->desc);
+-	unsigned long flags;
+-
+-	if (eptype != USB_ENDPOINT_XFER_BULK && eptype != USB_ENDPOINT_XFER_INT)
+-		return;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-	qh = ep->hcpriv;
+-
+-	/* For Bulk and Interrupt endpoints we maintain the toggle state
+-	 * in the hardware; the toggle bits in udev aren't used at all.
+-	 * When an endpoint is reset by usb_clear_halt() we must reset
+-	 * the toggle bit in the QH.
+-	 */
+-	if (qh) {
+-		usb_settoggle(qh->dev, epnum, is_out, 0);
+-		if (!list_empty(&qh->qtd_list)) {
+-			WARN_ONCE(1, "clear_halt for a busy endpoint\n");
+-		} else if (qh->qh_state == QH_STATE_LINKED ||
+-				qh->qh_state == QH_STATE_COMPLETING) {
+-
+-			/* The toggle value in the QH can't be updated
+-			 * while the QH is active.  Unlink it now;
+-			 * re-linking will call qh_refresh().
+-			 */
+-			if (eptype == USB_ENDPOINT_XFER_BULK)
+-				start_unlink_async(fotg210, qh);
+-			else
+-				start_unlink_intr(fotg210, qh);
+-		}
+-	}
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-}
+-
+-static int fotg210_get_frame(struct usb_hcd *hcd)
+-{
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-
+-	return (fotg210_read_frame_index(fotg210) >> 3) %
+-		fotg210->periodic_size;
+-}
+-
+-/* The EHCI in ChipIdea HDRC cannot be a separate module or device,
+- * because its registers (and irq) are shared between host/gadget/otg
+- * functions  and in order to facilitate role switching we cannot
+- * give the fotg210 driver exclusive access to those.
+- */
+-MODULE_DESCRIPTION(DRIVER_DESC);
+-MODULE_AUTHOR(DRIVER_AUTHOR);
+-MODULE_LICENSE("GPL");
+-
+-static const struct hc_driver fotg210_fotg210_hc_driver = {
+-	.description		= hcd_name,
+-	.product_desc		= "Faraday USB2.0 Host Controller",
+-	.hcd_priv_size		= sizeof(struct fotg210_hcd),
+-
+-	/*
+-	 * generic hardware linkage
+-	 */
+-	.irq			= fotg210_irq,
+-	.flags			= HCD_MEMORY | HCD_DMA | HCD_USB2,
+-
+-	/*
+-	 * basic lifecycle operations
+-	 */
+-	.reset			= hcd_fotg210_init,
+-	.start			= fotg210_run,
+-	.stop			= fotg210_stop,
+-	.shutdown		= fotg210_shutdown,
+-
+-	/*
+-	 * managing i/o requests and associated device resources
+-	 */
+-	.urb_enqueue		= fotg210_urb_enqueue,
+-	.urb_dequeue		= fotg210_urb_dequeue,
+-	.endpoint_disable	= fotg210_endpoint_disable,
+-	.endpoint_reset		= fotg210_endpoint_reset,
+-
+-	/*
+-	 * scheduling support
+-	 */
+-	.get_frame_number	= fotg210_get_frame,
+-
+-	/*
+-	 * root hub support
+-	 */
+-	.hub_status_data	= fotg210_hub_status_data,
+-	.hub_control		= fotg210_hub_control,
+-	.bus_suspend		= fotg210_bus_suspend,
+-	.bus_resume		= fotg210_bus_resume,
+-
+-	.relinquish_port	= fotg210_relinquish_port,
+-	.port_handed_over	= fotg210_port_handed_over,
+-
+-	.clear_tt_buffer_complete = fotg210_clear_tt_buffer_complete,
+-};
+-
+-static void fotg210_init(struct fotg210_hcd *fotg210)
+-{
+-	u32 value;
+-
+-	iowrite32(GMIR_MDEV_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
+-			&fotg210->regs->gmir);
+-
+-	value = ioread32(&fotg210->regs->otgcsr);
+-	value &= ~OTGCSR_A_BUS_DROP;
+-	value |= OTGCSR_A_BUS_REQ;
+-	iowrite32(value, &fotg210->regs->otgcsr);
+-}
+-
+-/*
+- * fotg210_hcd_probe - initialize faraday FOTG210 HCDs
+- *
+- * Allocates basic resources for this USB host controller, and
+- * then invokes the start() method for the HCD associated with it
+- * through the hotplug entry's driver_data.
+- */
+-static int fotg210_hcd_probe(struct platform_device *pdev)
+-{
+-	struct device *dev = &pdev->dev;
+-	struct usb_hcd *hcd;
+-	struct resource *res;
+-	int irq;
+-	int retval;
+-	struct fotg210_hcd *fotg210;
+-
+-	if (usb_disabled())
+-		return -ENODEV;
+-
+-	pdev->dev.power.power_state = PMSG_ON;
+-
+-	irq = platform_get_irq(pdev, 0);
+-	if (irq < 0)
+-		return irq;
+-
+-	hcd = usb_create_hcd(&fotg210_fotg210_hc_driver, dev,
+-			dev_name(dev));
+-	if (!hcd) {
+-		dev_err(dev, "failed to create hcd\n");
+-		retval = -ENOMEM;
+-		goto fail_create_hcd;
+-	}
+-
+-	hcd->has_tt = 1;
+-
+-	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
+-	if (IS_ERR(hcd->regs)) {
+-		retval = PTR_ERR(hcd->regs);
+-		goto failed_put_hcd;
+-	}
+-
+-	hcd->rsrc_start = res->start;
+-	hcd->rsrc_len = resource_size(res);
+-
+-	fotg210 = hcd_to_fotg210(hcd);
+-
+-	fotg210->caps = hcd->regs;
+-
+-	/* It's OK not to supply this clock */
+-	fotg210->pclk = clk_get(dev, "PCLK");
+-	if (!IS_ERR(fotg210->pclk)) {
+-		retval = clk_prepare_enable(fotg210->pclk);
+-		if (retval) {
+-			dev_err(dev, "failed to enable PCLK\n");
+-			goto failed_put_hcd;
+-		}
+-	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
+-		/*
+-		 * Percolate deferrals, for anything else,
+-		 * just live without the clocking.
+-		 */
+-		retval = PTR_ERR(fotg210->pclk);
+-		goto failed_dis_clk;
+-	}
+-
+-	retval = fotg210_setup(hcd);
+-	if (retval)
+-		goto failed_dis_clk;
+-
+-	fotg210_init(fotg210);
+-
+-	retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
+-	if (retval) {
+-		dev_err(dev, "failed to add hcd with err %d\n", retval);
+-		goto failed_dis_clk;
+-	}
+-	device_wakeup_enable(hcd->self.controller);
+-	platform_set_drvdata(pdev, hcd);
+-
+-	return retval;
+-
+-failed_dis_clk:
+-	if (!IS_ERR(fotg210->pclk)) {
+-		clk_disable_unprepare(fotg210->pclk);
+-		clk_put(fotg210->pclk);
+-	}
+-failed_put_hcd:
+-	usb_put_hcd(hcd);
+-fail_create_hcd:
+-	dev_err(dev, "init %s fail, %d\n", dev_name(dev), retval);
+-	return retval;
+-}
+-
+-/*
+- * fotg210_hcd_remove - shutdown processing for EHCI HCDs
+- * @dev: USB Host Controller being removed
+- *
+- */
+-static int fotg210_hcd_remove(struct platform_device *pdev)
+-{
+-	struct usb_hcd *hcd = platform_get_drvdata(pdev);
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-
+-	if (!IS_ERR(fotg210->pclk)) {
+-		clk_disable_unprepare(fotg210->pclk);
+-		clk_put(fotg210->pclk);
+-	}
+-
+-	usb_remove_hcd(hcd);
+-	usb_put_hcd(hcd);
+-
+-	return 0;
+-}
+-
+-#ifdef CONFIG_OF
+-static const struct of_device_id fotg210_of_match[] = {
+-	{ .compatible = "faraday,fotg210" },
+-	{},
+-};
+-MODULE_DEVICE_TABLE(of, fotg210_of_match);
+-#endif
+-
+-static struct platform_driver fotg210_hcd_driver = {
+-	.driver = {
+-		.name   = "fotg210-hcd",
+-		.of_match_table = of_match_ptr(fotg210_of_match),
+-	},
+-	.probe  = fotg210_hcd_probe,
+-	.remove = fotg210_hcd_remove,
+-};
+-
+-static int __init fotg210_hcd_init(void)
+-{
+-	int retval = 0;
+-
+-	if (usb_disabled())
+-		return -ENODEV;
+-
+-	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))
+-		pr_warn("Warning! fotg210_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\n",
+-			hcd_name, sizeof(struct fotg210_qh),
+-			sizeof(struct fotg210_qtd),
+-			sizeof(struct fotg210_itd));
+-
+-	fotg210_debug_root = debugfs_create_dir("fotg210", usb_debug_root);
+-
+-	retval = platform_driver_register(&fotg210_hcd_driver);
+-	if (retval < 0)
+-		goto clean;
+-	return retval;
+-
+-clean:
+-	debugfs_remove(fotg210_debug_root);
+-	fotg210_debug_root = NULL;
+-
+-	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
+-	return retval;
+-}
+-module_init(fotg210_hcd_init);
+-
+-static void __exit fotg210_hcd_cleanup(void)
+-{
+-	platform_driver_unregister(&fotg210_hcd_driver);
+-	debugfs_remove(fotg210_debug_root);
+-	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
+-}
+-module_exit(fotg210_hcd_cleanup);
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210-hcd.c
+@@ -0,0 +1,5727 @@
++// SPDX-License-Identifier: GPL-2.0+
++/* Faraday FOTG210 EHCI-like driver
++ *
++ * Copyright (c) 2013 Faraday Technology Corporation
++ *
++ * Author: Yuan-Hsin Chen <yhchen at faraday-tech.com>
++ *	   Feng-Hsin Chiang <john453 at faraday-tech.com>
++ *	   Po-Yu Chuang <ratbert.chuang at gmail.com>
++ *
++ * Most of code borrowed from the Linux-3.7 EHCI driver
++ */
++#include <linux/module.h>
++#include <linux/of.h>
++#include <linux/device.h>
++#include <linux/dmapool.h>
++#include <linux/kernel.h>
++#include <linux/delay.h>
++#include <linux/ioport.h>
++#include <linux/sched.h>
++#include <linux/vmalloc.h>
++#include <linux/errno.h>
++#include <linux/init.h>
++#include <linux/hrtimer.h>
++#include <linux/list.h>
++#include <linux/interrupt.h>
++#include <linux/usb.h>
++#include <linux/usb/hcd.h>
++#include <linux/moduleparam.h>
++#include <linux/dma-mapping.h>
++#include <linux/debugfs.h>
++#include <linux/slab.h>
++#include <linux/uaccess.h>
++#include <linux/platform_device.h>
++#include <linux/io.h>
++#include <linux/iopoll.h>
++#include <linux/clk.h>
++
++#include <asm/byteorder.h>
++#include <asm/irq.h>
++#include <asm/unaligned.h>
++
++#define DRIVER_AUTHOR "Yuan-Hsin Chen"
++#define DRIVER_DESC "FOTG210 Host Controller (EHCI) Driver"
++static const char hcd_name[] = "fotg210_hcd";
++
++#undef FOTG210_URB_TRACE
++#define FOTG210_STATS
++
++/* magic numbers that can affect system performance */
++#define FOTG210_TUNE_CERR	3 /* 0-3 qtd retries; 0 == don't stop */
++#define FOTG210_TUNE_RL_HS	4 /* nak throttle; see 4.9 */
++#define FOTG210_TUNE_RL_TT	0
++#define FOTG210_TUNE_MULT_HS	1 /* 1-3 transactions/uframe; 4.10.3 */
++#define FOTG210_TUNE_MULT_TT	1
++
++/* Some drivers think it's safe to schedule isochronous transfers more than 256
++ * ms into the future (partly as a result of an old bug in the scheduling
++ * code).  In an attempt to avoid trouble, we will use a minimum scheduling
++ * length of 512 frames instead of 256.
++ */
++#define FOTG210_TUNE_FLS 1 /* (medium) 512-frame schedule */
++
++/* Initial IRQ latency:  faster than hw default */
++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;
++module_param(park, uint, S_IRUGO);
++MODULE_PARM_DESC(park, "park setting; 1-3 back-to-back async packets");
++
++/* for link power management(LPM) feature */
++static unsigned int hird;
++module_param(hird, int, S_IRUGO);
++MODULE_PARM_DESC(hird, "host initiated resume duration, +1 for each 75us");
++
++#define INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT)
++
++#include "fotg210-hcd.h"
++
++#define fotg210_dbg(fotg210, fmt, args...) \
++	dev_dbg(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
++#define fotg210_err(fotg210, fmt, args...) \
++	dev_err(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
++#define fotg210_info(fotg210, fmt, args...) \
++	dev_info(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
++#define fotg210_warn(fotg210, fmt, args...) \
++	dev_warn(fotg210_to_hcd(fotg210)->self.controller, fmt, ## args)
++
++/* check the values in the HCSPARAMS register (host controller _Structural_
++ * parameters) see EHCI spec, Table 2-4 for each value
++ */
++static void dbg_hcs_params(struct fotg210_hcd *fotg210, char *label)
++{
++	u32 params = fotg210_readl(fotg210, &fotg210->caps->hcs_params);
++
++	fotg210_dbg(fotg210, "%s hcs_params 0x%x ports=%d\n", label, params,
++			HCS_N_PORTS(params));
++}
++
++/* check the values in the HCCPARAMS register (host controller _Capability_
++ * parameters) see EHCI Spec, Table 2-5 for each value
++ */
++static void dbg_hcc_params(struct fotg210_hcd *fotg210, char *label)
++{
++	u32 params = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
++
++	fotg210_dbg(fotg210, "%s hcc_params %04x uframes %s%s\n", label,
++			params,
++			HCC_PGM_FRAMELISTLEN(params) ? "256/512/1024" : "1024",
++			HCC_CANPARK(params) ? " park" : "");
++}
++
++static void __maybe_unused
++dbg_qtd(const char *label, struct fotg210_hcd *fotg210, struct fotg210_qtd *qtd)
++{
++	fotg210_dbg(fotg210, "%s td %p n%08x %08x t%08x p0=%08x\n", label, qtd,
++			hc32_to_cpup(fotg210, &qtd->hw_next),
++			hc32_to_cpup(fotg210, &qtd->hw_alt_next),
++			hc32_to_cpup(fotg210, &qtd->hw_token),
++			hc32_to_cpup(fotg210, &qtd->hw_buf[0]));
++	if (qtd->hw_buf[1])
++		fotg210_dbg(fotg210, "  p1=%08x p2=%08x p3=%08x p4=%08x\n",
++				hc32_to_cpup(fotg210, &qtd->hw_buf[1]),
++				hc32_to_cpup(fotg210, &qtd->hw_buf[2]),
++				hc32_to_cpup(fotg210, &qtd->hw_buf[3]),
++				hc32_to_cpup(fotg210, &qtd->hw_buf[4]));
++}
++
++static void __maybe_unused
++dbg_qh(const char *label, struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	struct fotg210_qh_hw *hw = qh->hw;
++
++	fotg210_dbg(fotg210, "%s qh %p n%08x info %x %x qtd %x\n", label, qh,
++			hw->hw_next, hw->hw_info1, hw->hw_info2,
++			hw->hw_current);
++
++	dbg_qtd("overlay", fotg210, (struct fotg210_qtd *) &hw->hw_qtd_next);
++}
++
++static void __maybe_unused
++dbg_itd(const char *label, struct fotg210_hcd *fotg210, struct fotg210_itd *itd)
++{
++	fotg210_dbg(fotg210, "%s[%d] itd %p, next %08x, urb %p\n", label,
++			itd->frame, itd, hc32_to_cpu(fotg210, itd->hw_next),
++			itd->urb);
++
++	fotg210_dbg(fotg210,
++			"  trans: %08x %08x %08x %08x %08x %08x %08x %08x\n",
++			hc32_to_cpu(fotg210, itd->hw_transaction[0]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[1]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[2]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[3]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[4]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[5]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[6]),
++			hc32_to_cpu(fotg210, itd->hw_transaction[7]));
++
++	fotg210_dbg(fotg210,
++			"  buf:   %08x %08x %08x %08x %08x %08x %08x\n",
++			hc32_to_cpu(fotg210, itd->hw_bufp[0]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[1]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[2]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[3]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[4]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[5]),
++			hc32_to_cpu(fotg210, itd->hw_bufp[6]));
++
++	fotg210_dbg(fotg210, "  index: %d %d %d %d %d %d %d %d\n",
++			itd->index[0], itd->index[1], itd->index[2],
++			itd->index[3], itd->index[4], itd->index[5],
++			itd->index[6], itd->index[7]);
++}
++
++static int __maybe_unused
++dbg_status_buf(char *buf, unsigned len, const char *label, u32 status)
++{
++	return scnprintf(buf, len, "%s%sstatus %04x%s%s%s%s%s%s%s%s%s%s",
++			label, label[0] ? " " : "", status,
++			(status & STS_ASS) ? " Async" : "",
++			(status & STS_PSS) ? " Periodic" : "",
++			(status & STS_RECL) ? " Recl" : "",
++			(status & STS_HALT) ? " Halt" : "",
++			(status & STS_IAA) ? " IAA" : "",
++			(status & STS_FATAL) ? " FATAL" : "",
++			(status & STS_FLR) ? " FLR" : "",
++			(status & STS_PCD) ? " PCD" : "",
++			(status & STS_ERR) ? " ERR" : "",
++			(status & STS_INT) ? " INT" : "");
++}
++
++static int __maybe_unused
++dbg_intr_buf(char *buf, unsigned len, const char *label, u32 enable)
++{
++	return scnprintf(buf, len, "%s%sintrenable %02x%s%s%s%s%s%s",
++			label, label[0] ? " " : "", enable,
++			(enable & STS_IAA) ? " IAA" : "",
++			(enable & STS_FATAL) ? " FATAL" : "",
++			(enable & STS_FLR) ? " FLR" : "",
++			(enable & STS_PCD) ? " PCD" : "",
++			(enable & STS_ERR) ? " ERR" : "",
++			(enable & STS_INT) ? " INT" : "");
++}
++
++static const char *const fls_strings[] = { "1024", "512", "256", "??" };
++
++static int dbg_command_buf(char *buf, unsigned len, const char *label,
++		u32 command)
++{
++	return scnprintf(buf, len,
++			"%s%scommand %07x %s=%d ithresh=%d%s%s%s period=%s%s %s",
++			label, label[0] ? " " : "", command,
++			(command & CMD_PARK) ? " park" : "(park)",
++			CMD_PARK_CNT(command),
++			(command >> 16) & 0x3f,
++			(command & CMD_IAAD) ? " IAAD" : "",
++			(command & CMD_ASE) ? " Async" : "",
++			(command & CMD_PSE) ? " Periodic" : "",
++			fls_strings[(command >> 2) & 0x3],
++			(command & CMD_RESET) ? " Reset" : "",
++			(command & CMD_RUN) ? "RUN" : "HALT");
++}
++
++static char *dbg_port_buf(char *buf, unsigned len, const char *label, int port,
++		u32 status)
++{
++	char *sig;
++
++	/* signaling state */
++	switch (status & (3 << 10)) {
++	case 0 << 10:
++		sig = "se0";
++		break;
++	case 1 << 10:
++		sig = "k";
++		break; /* low speed */
++	case 2 << 10:
++		sig = "j";
++		break;
++	default:
++		sig = "?";
++		break;
++	}
++
++	scnprintf(buf, len, "%s%sport:%d status %06x %d sig=%s%s%s%s%s%s%s%s",
++			label, label[0] ? " " : "", port, status,
++			status >> 25, /*device address */
++			sig,
++			(status & PORT_RESET) ? " RESET" : "",
++			(status & PORT_SUSPEND) ? " SUSPEND" : "",
++			(status & PORT_RESUME) ? " RESUME" : "",
++			(status & PORT_PEC) ? " PEC" : "",
++			(status & PORT_PE) ? " PE" : "",
++			(status & PORT_CSC) ? " CSC" : "",
++			(status & PORT_CONNECT) ? " CONNECT" : "");
++
++	return buf;
++}
++
++/* functions have the "wrong" filename when they're output... */
++#define dbg_status(fotg210, label, status) {			\
++	char _buf[80];						\
++	dbg_status_buf(_buf, sizeof(_buf), label, status);	\
++	fotg210_dbg(fotg210, "%s\n", _buf);			\
++}
++
++#define dbg_cmd(fotg210, label, command) {			\
++	char _buf[80];						\
++	dbg_command_buf(_buf, sizeof(_buf), label, command);	\
++	fotg210_dbg(fotg210, "%s\n", _buf);			\
++}
++
++#define dbg_port(fotg210, label, port, status) {			       \
++	char _buf[80];							       \
++	fotg210_dbg(fotg210, "%s\n",					       \
++			dbg_port_buf(_buf, sizeof(_buf), label, port, status));\
++}
++
++/* troubleshooting help: expose state in debugfs */
++static int debug_async_open(struct inode *, struct file *);
++static int debug_periodic_open(struct inode *, struct file *);
++static int debug_registers_open(struct inode *, struct file *);
++static int debug_async_open(struct inode *, struct file *);
++
++static ssize_t debug_output(struct file*, char __user*, size_t, loff_t*);
++static int debug_close(struct inode *, struct file *);
++
++static const struct file_operations debug_async_fops = {
++	.owner		= THIS_MODULE,
++	.open		= debug_async_open,
++	.read		= debug_output,
++	.release	= debug_close,
++	.llseek		= default_llseek,
++};
++static const struct file_operations debug_periodic_fops = {
++	.owner		= THIS_MODULE,
++	.open		= debug_periodic_open,
++	.read		= debug_output,
++	.release	= debug_close,
++	.llseek		= default_llseek,
++};
++static const struct file_operations debug_registers_fops = {
++	.owner		= THIS_MODULE,
++	.open		= debug_registers_open,
++	.read		= debug_output,
++	.release	= debug_close,
++	.llseek		= default_llseek,
++};
++
++static struct dentry *fotg210_debug_root;
++
++struct debug_buffer {
++	ssize_t (*fill_func)(struct debug_buffer *);	/* fill method */
++	struct usb_bus *bus;
++	struct mutex mutex;	/* protect filling of buffer */
++	size_t count;		/* number of characters filled into buffer */
++	char *output_buf;
++	size_t alloc_size;
++};
++
++static inline char speed_char(u32 scratch)
++{
++	switch (scratch & (3 << 12)) {
++	case QH_FULL_SPEED:
++		return 'f';
++
++	case QH_LOW_SPEED:
++		return 'l';
++
++	case QH_HIGH_SPEED:
++		return 'h';
++
++	default:
++		return '?';
++	}
++}
++
++static inline char token_mark(struct fotg210_hcd *fotg210, __hc32 token)
++{
++	__u32 v = hc32_to_cpu(fotg210, token);
++
++	if (v & QTD_STS_ACTIVE)
++		return '*';
++	if (v & QTD_STS_HALT)
++		return '-';
++	if (!IS_SHORT_READ(v))
++		return ' ';
++	/* tries to advance through hw_alt_next */
++	return '/';
++}
++
++static void qh_lines(struct fotg210_hcd *fotg210, struct fotg210_qh *qh,
++		char **nextp, unsigned *sizep)
++{
++	u32 scratch;
++	u32 hw_curr;
++	struct fotg210_qtd *td;
++	unsigned temp;
++	unsigned size = *sizep;
++	char *next = *nextp;
++	char mark;
++	__le32 list_end = FOTG210_LIST_END(fotg210);
++	struct fotg210_qh_hw *hw = qh->hw;
++
++	if (hw->hw_qtd_next == list_end) /* NEC does this */
++		mark = '@';
++	else
++		mark = token_mark(fotg210, hw->hw_token);
++	if (mark == '/') { /* qh_alt_next controls qh advance? */
++		if ((hw->hw_alt_next & QTD_MASK(fotg210)) ==
++		    fotg210->async->hw->hw_alt_next)
++			mark = '#'; /* blocked */
++		else if (hw->hw_alt_next == list_end)
++			mark = '.'; /* use hw_qtd_next */
++		/* else alt_next points to some other qtd */
++	}
++	scratch = hc32_to_cpup(fotg210, &hw->hw_info1);
++	hw_curr = (mark == '*') ? hc32_to_cpup(fotg210, &hw->hw_current) : 0;
++	temp = scnprintf(next, size,
++			"qh/%p dev%d %cs ep%d %08x %08x(%08x%c %s nak%d)",
++			qh, scratch & 0x007f,
++			speed_char(scratch),
++			(scratch >> 8) & 0x000f,
++			scratch, hc32_to_cpup(fotg210, &hw->hw_info2),
++			hc32_to_cpup(fotg210, &hw->hw_token), mark,
++			(cpu_to_hc32(fotg210, QTD_TOGGLE) & hw->hw_token)
++				? "data1" : "data0",
++			(hc32_to_cpup(fotg210, &hw->hw_alt_next) >> 1) & 0x0f);
++	size -= temp;
++	next += temp;
++
++	/* hc may be modifying the list as we read it ... */
++	list_for_each_entry(td, &qh->qtd_list, qtd_list) {
++		scratch = hc32_to_cpup(fotg210, &td->hw_token);
++		mark = ' ';
++		if (hw_curr == td->qtd_dma)
++			mark = '*';
++		else if (hw->hw_qtd_next == cpu_to_hc32(fotg210, td->qtd_dma))
++			mark = '+';
++		else if (QTD_LENGTH(scratch)) {
++			if (td->hw_alt_next == fotg210->async->hw->hw_alt_next)
++				mark = '#';
++			else if (td->hw_alt_next != list_end)
++				mark = '/';
++		}
++		temp = snprintf(next, size,
++				"\n\t%p%c%s len=%d %08x urb %p",
++				td, mark, ({ char *tmp;
++				switch ((scratch>>8)&0x03) {
++				case 0:
++					tmp = "out";
++					break;
++				case 1:
++					tmp = "in";
++					break;
++				case 2:
++					tmp = "setup";
++					break;
++				default:
++					tmp = "?";
++					break;
++				 } tmp; }),
++				(scratch >> 16) & 0x7fff,
++				scratch,
++				td->urb);
++		if (size < temp)
++			temp = size;
++		size -= temp;
++		next += temp;
++		if (temp == size)
++			goto done;
++	}
++
++	temp = snprintf(next, size, "\n");
++	if (size < temp)
++		temp = size;
++
++	size -= temp;
++	next += temp;
++
++done:
++	*sizep = size;
++	*nextp = next;
++}
++
++static ssize_t fill_async_buffer(struct debug_buffer *buf)
++{
++	struct usb_hcd *hcd;
++	struct fotg210_hcd *fotg210;
++	unsigned long flags;
++	unsigned temp, size;
++	char *next;
++	struct fotg210_qh *qh;
++
++	hcd = bus_to_hcd(buf->bus);
++	fotg210 = hcd_to_fotg210(hcd);
++	next = buf->output_buf;
++	size = buf->alloc_size;
++
++	*next = 0;
++
++	/* dumps a snapshot of the async schedule.
++	 * usually empty except for long-term bulk reads, or head.
++	 * one QH per line, and TDs we know about
++	 */
++	spin_lock_irqsave(&fotg210->lock, flags);
++	for (qh = fotg210->async->qh_next.qh; size > 0 && qh;
++			qh = qh->qh_next.qh)
++		qh_lines(fotg210, qh, &next, &size);
++	if (fotg210->async_unlink && size > 0) {
++		temp = scnprintf(next, size, "\nunlink =\n");
++		size -= temp;
++		next += temp;
++
++		for (qh = fotg210->async_unlink; size > 0 && qh;
++				qh = qh->unlink_next)
++			qh_lines(fotg210, qh, &next, &size);
++	}
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++
++	return strlen(buf->output_buf);
++}
++
++/* count tds, get ep direction */
++static unsigned output_buf_tds_dir(char *buf, struct fotg210_hcd *fotg210,
++		struct fotg210_qh_hw *hw, struct fotg210_qh *qh, unsigned size)
++{
++	u32 scratch = hc32_to_cpup(fotg210, &hw->hw_info1);
++	struct fotg210_qtd *qtd;
++	char *type = "";
++	unsigned temp = 0;
++
++	/* count tds, get ep direction */
++	list_for_each_entry(qtd, &qh->qtd_list, qtd_list) {
++		temp++;
++		switch ((hc32_to_cpu(fotg210, qtd->hw_token) >> 8) & 0x03) {
++		case 0:
++			type = "out";
++			continue;
++		case 1:
++			type = "in";
++			continue;
++		}
++	}
++
++	return scnprintf(buf, size, "(%c%d ep%d%s [%d/%d] q%d p%d)",
++			speed_char(scratch), scratch & 0x007f,
++			(scratch >> 8) & 0x000f, type, qh->usecs,
++			qh->c_usecs, temp, (scratch >> 16) & 0x7ff);
++}
++
++#define DBG_SCHED_LIMIT 64
++static ssize_t fill_periodic_buffer(struct debug_buffer *buf)
++{
++	struct usb_hcd *hcd;
++	struct fotg210_hcd *fotg210;
++	unsigned long flags;
++	union fotg210_shadow p, *seen;
++	unsigned temp, size, seen_count;
++	char *next;
++	unsigned i;
++	__hc32 tag;
++
++	seen = kmalloc_array(DBG_SCHED_LIMIT, sizeof(*seen), GFP_ATOMIC);
++	if (!seen)
++		return 0;
++
++	seen_count = 0;
++
++	hcd = bus_to_hcd(buf->bus);
++	fotg210 = hcd_to_fotg210(hcd);
++	next = buf->output_buf;
++	size = buf->alloc_size;
++
++	temp = scnprintf(next, size, "size = %d\n", fotg210->periodic_size);
++	size -= temp;
++	next += temp;
++
++	/* dump a snapshot of the periodic schedule.
++	 * iso changes, interrupt usually doesn't.
++	 */
++	spin_lock_irqsave(&fotg210->lock, flags);
++	for (i = 0; i < fotg210->periodic_size; i++) {
++		p = fotg210->pshadow[i];
++		if (likely(!p.ptr))
++			continue;
++
++		tag = Q_NEXT_TYPE(fotg210, fotg210->periodic[i]);
++
++		temp = scnprintf(next, size, "%4d: ", i);
++		size -= temp;
++		next += temp;
++
++		do {
++			struct fotg210_qh_hw *hw;
++
++			switch (hc32_to_cpu(fotg210, tag)) {
++			case Q_TYPE_QH:
++				hw = p.qh->hw;
++				temp = scnprintf(next, size, " qh%d-%04x/%p",
++						p.qh->period,
++						hc32_to_cpup(fotg210,
++							&hw->hw_info2)
++							/* uframe masks */
++							& (QH_CMASK | QH_SMASK),
++						p.qh);
++				size -= temp;
++				next += temp;
++				/* don't repeat what follows this qh */
++				for (temp = 0; temp < seen_count; temp++) {
++					if (seen[temp].ptr != p.ptr)
++						continue;
++					if (p.qh->qh_next.ptr) {
++						temp = scnprintf(next, size,
++								" ...");
++						size -= temp;
++						next += temp;
++					}
++					break;
++				}
++				/* show more info the first time around */
++				if (temp == seen_count) {
++					temp = output_buf_tds_dir(next,
++							fotg210, hw,
++							p.qh, size);
++
++					if (seen_count < DBG_SCHED_LIMIT)
++						seen[seen_count++].qh = p.qh;
++				} else
++					temp = 0;
++				tag = Q_NEXT_TYPE(fotg210, hw->hw_next);
++				p = p.qh->qh_next;
++				break;
++			case Q_TYPE_FSTN:
++				temp = scnprintf(next, size,
++						" fstn-%8x/%p",
++						p.fstn->hw_prev, p.fstn);
++				tag = Q_NEXT_TYPE(fotg210, p.fstn->hw_next);
++				p = p.fstn->fstn_next;
++				break;
++			case Q_TYPE_ITD:
++				temp = scnprintf(next, size,
++						" itd/%p", p.itd);
++				tag = Q_NEXT_TYPE(fotg210, p.itd->hw_next);
++				p = p.itd->itd_next;
++				break;
++			}
++			size -= temp;
++			next += temp;
++		} while (p.ptr);
++
++		temp = scnprintf(next, size, "\n");
++		size -= temp;
++		next += temp;
++	}
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	kfree(seen);
++
++	return buf->alloc_size - size;
++}
++#undef DBG_SCHED_LIMIT
++
++static const char *rh_state_string(struct fotg210_hcd *fotg210)
++{
++	switch (fotg210->rh_state) {
++	case FOTG210_RH_HALTED:
++		return "halted";
++	case FOTG210_RH_SUSPENDED:
++		return "suspended";
++	case FOTG210_RH_RUNNING:
++		return "running";
++	case FOTG210_RH_STOPPING:
++		return "stopping";
++	}
++	return "?";
++}
++
++static ssize_t fill_registers_buffer(struct debug_buffer *buf)
++{
++	struct usb_hcd *hcd;
++	struct fotg210_hcd *fotg210;
++	unsigned long flags;
++	unsigned temp, size, i;
++	char *next, scratch[80];
++	static const char fmt[] = "%*s\n";
++	static const char label[] = "";
++
++	hcd = bus_to_hcd(buf->bus);
++	fotg210 = hcd_to_fotg210(hcd);
++	next = buf->output_buf;
++	size = buf->alloc_size;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	if (!HCD_HW_ACCESSIBLE(hcd)) {
++		size = scnprintf(next, size,
++				"bus %s, device %s\n"
++				"%s\n"
++				"SUSPENDED(no register access)\n",
++				hcd->self.controller->bus->name,
++				dev_name(hcd->self.controller),
++				hcd->product_desc);
++		goto done;
++	}
++
++	/* Capability Registers */
++	i = HC_VERSION(fotg210, fotg210_readl(fotg210,
++			&fotg210->caps->hc_capbase));
++	temp = scnprintf(next, size,
++			"bus %s, device %s\n"
++			"%s\n"
++			"EHCI %x.%02x, rh state %s\n",
++			hcd->self.controller->bus->name,
++			dev_name(hcd->self.controller),
++			hcd->product_desc,
++			i >> 8, i & 0x0ff, rh_state_string(fotg210));
++	size -= temp;
++	next += temp;
++
++	/* FIXME interpret both types of params */
++	i = fotg210_readl(fotg210, &fotg210->caps->hcs_params);
++	temp = scnprintf(next, size, "structural params 0x%08x\n", i);
++	size -= temp;
++	next += temp;
++
++	i = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
++	temp = scnprintf(next, size, "capability params 0x%08x\n", i);
++	size -= temp;
++	next += temp;
++
++	/* Operational Registers */
++	temp = dbg_status_buf(scratch, sizeof(scratch), label,
++			fotg210_readl(fotg210, &fotg210->regs->status));
++	temp = scnprintf(next, size, fmt, temp, scratch);
++	size -= temp;
++	next += temp;
++
++	temp = dbg_command_buf(scratch, sizeof(scratch), label,
++			fotg210_readl(fotg210, &fotg210->regs->command));
++	temp = scnprintf(next, size, fmt, temp, scratch);
++	size -= temp;
++	next += temp;
++
++	temp = dbg_intr_buf(scratch, sizeof(scratch), label,
++			fotg210_readl(fotg210, &fotg210->regs->intr_enable));
++	temp = scnprintf(next, size, fmt, temp, scratch);
++	size -= temp;
++	next += temp;
++
++	temp = scnprintf(next, size, "uframe %04x\n",
++			fotg210_read_frame_index(fotg210));
++	size -= temp;
++	next += temp;
++
++	if (fotg210->async_unlink) {
++		temp = scnprintf(next, size, "async unlink qh %p\n",
++				fotg210->async_unlink);
++		size -= temp;
++		next += temp;
++	}
++
++#ifdef FOTG210_STATS
++	temp = scnprintf(next, size,
++			"irq normal %ld err %ld iaa %ld(lost %ld)\n",
++			fotg210->stats.normal, fotg210->stats.error,
++			fotg210->stats.iaa, fotg210->stats.lost_iaa);
++	size -= temp;
++	next += temp;
++
++	temp = scnprintf(next, size, "complete %ld unlink %ld\n",
++			fotg210->stats.complete, fotg210->stats.unlink);
++	size -= temp;
++	next += temp;
++#endif
++
++done:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++
++	return buf->alloc_size - size;
++}
++
++static struct debug_buffer
++*alloc_buffer(struct usb_bus *bus, ssize_t (*fill_func)(struct debug_buffer *))
++{
++	struct debug_buffer *buf;
++
++	buf = kzalloc(sizeof(struct debug_buffer), GFP_KERNEL);
++
++	if (buf) {
++		buf->bus = bus;
++		buf->fill_func = fill_func;
++		mutex_init(&buf->mutex);
++		buf->alloc_size = PAGE_SIZE;
++	}
++
++	return buf;
++}
++
++static int fill_buffer(struct debug_buffer *buf)
++{
++	int ret = 0;
++
++	if (!buf->output_buf)
++		buf->output_buf = vmalloc(buf->alloc_size);
++
++	if (!buf->output_buf) {
++		ret = -ENOMEM;
++		goto out;
++	}
++
++	ret = buf->fill_func(buf);
++
++	if (ret >= 0) {
++		buf->count = ret;
++		ret = 0;
++	}
++
++out:
++	return ret;
++}
++
++static ssize_t debug_output(struct file *file, char __user *user_buf,
++		size_t len, loff_t *offset)
++{
++	struct debug_buffer *buf = file->private_data;
++	int ret = 0;
++
++	mutex_lock(&buf->mutex);
++	if (buf->count == 0) {
++		ret = fill_buffer(buf);
++		if (ret != 0) {
++			mutex_unlock(&buf->mutex);
++			goto out;
++		}
++	}
++	mutex_unlock(&buf->mutex);
++
++	ret = simple_read_from_buffer(user_buf, len, offset,
++			buf->output_buf, buf->count);
++
++out:
++	return ret;
++
++}
++
++static int debug_close(struct inode *inode, struct file *file)
++{
++	struct debug_buffer *buf = file->private_data;
++
++	if (buf) {
++		vfree(buf->output_buf);
++		kfree(buf);
++	}
++
++	return 0;
++}
++static int debug_async_open(struct inode *inode, struct file *file)
++{
++	file->private_data = alloc_buffer(inode->i_private, fill_async_buffer);
++
++	return file->private_data ? 0 : -ENOMEM;
++}
++
++static int debug_periodic_open(struct inode *inode, struct file *file)
++{
++	struct debug_buffer *buf;
++
++	buf = alloc_buffer(inode->i_private, fill_periodic_buffer);
++	if (!buf)
++		return -ENOMEM;
++
++	buf->alloc_size = (sizeof(void *) == 4 ? 6 : 8)*PAGE_SIZE;
++	file->private_data = buf;
++	return 0;
++}
++
++static int debug_registers_open(struct inode *inode, struct file *file)
++{
++	file->private_data = alloc_buffer(inode->i_private,
++			fill_registers_buffer);
++
++	return file->private_data ? 0 : -ENOMEM;
++}
++
++static inline void create_debug_files(struct fotg210_hcd *fotg210)
++{
++	struct usb_bus *bus = &fotg210_to_hcd(fotg210)->self;
++	struct dentry *root;
++
++	root = debugfs_create_dir(bus->bus_name, fotg210_debug_root);
++
++	debugfs_create_file("async", S_IRUGO, root, bus, &debug_async_fops);
++	debugfs_create_file("periodic", S_IRUGO, root, bus,
++			    &debug_periodic_fops);
++	debugfs_create_file("registers", S_IRUGO, root, bus,
++			    &debug_registers_fops);
++}
++
++static inline void remove_debug_files(struct fotg210_hcd *fotg210)
++{
++	struct usb_bus *bus = &fotg210_to_hcd(fotg210)->self;
++
++	debugfs_lookup_and_remove(bus->bus_name, fotg210_debug_root);
++}
++
++/* handshake - spin reading hc until handshake completes or fails
++ * @ptr: address of hc register to be read
++ * @mask: bits to look at in result of read
++ * @done: value of those bits when handshake succeeds
++ * @usec: timeout in microseconds
++ *
++ * Returns negative errno, or zero on success
++ *
++ * Success happens when the "mask" bits have the specified value (hardware
++ * handshake done).  There are two failure modes:  "usec" have passed (major
++ * hardware flakeout), or the register reads as all-ones (hardware removed).
++ *
++ * That last failure should_only happen in cases like physical cardbus eject
++ * before driver shutdown. But it also seems to be caused by bugs in cardbus
++ * bridge shutdown:  shutting down the bridge before the devices using it.
++ */
++static int handshake(struct fotg210_hcd *fotg210, void __iomem *ptr,
++		u32 mask, u32 done, int usec)
++{
++	u32 result;
++	int ret;
++
++	ret = readl_poll_timeout_atomic(ptr, result,
++					((result & mask) == done ||
++					 result == U32_MAX), 1, usec);
++	if (result == U32_MAX)		/* card removed */
++		return -ENODEV;
++
++	return ret;
++}
++
++/* 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 fotg210_halt(struct fotg210_hcd *fotg210)
++{
++	u32 temp;
++
++	spin_lock_irq(&fotg210->lock);
++
++	/* disable any irqs left enabled by previous code */
++	fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
++
++	/*
++	 * This routine gets called during probe before fotg210->command
++	 * has been initialized, so we can't rely on its value.
++	 */
++	fotg210->command &= ~CMD_RUN;
++	temp = fotg210_readl(fotg210, &fotg210->regs->command);
++	temp &= ~(CMD_RUN | CMD_IAAD);
++	fotg210_writel(fotg210, temp, &fotg210->regs->command);
++
++	spin_unlock_irq(&fotg210->lock);
++	synchronize_irq(fotg210_to_hcd(fotg210)->irq);
++
++	return handshake(fotg210, &fotg210->regs->status,
++			STS_HALT, STS_HALT, 16 * 125);
++}
++
++/* Reset a non-running (STS_HALT == 1) controller.
++ * Must be called with interrupts enabled and the lock not held.
++ */
++static int fotg210_reset(struct fotg210_hcd *fotg210)
++{
++	int retval;
++	u32 command = fotg210_readl(fotg210, &fotg210->regs->command);
++
++	/* If the EHCI debug controller is active, special care must be
++	 * taken before and after a host controller reset
++	 */
++	if (fotg210->debug && !dbgp_reset_prep(fotg210_to_hcd(fotg210)))
++		fotg210->debug = NULL;
++
++	command |= CMD_RESET;
++	dbg_cmd(fotg210, "reset", command);
++	fotg210_writel(fotg210, command, &fotg210->regs->command);
++	fotg210->rh_state = FOTG210_RH_HALTED;
++	fotg210->next_statechange = jiffies;
++	retval = handshake(fotg210, &fotg210->regs->command,
++			CMD_RESET, 0, 250 * 1000);
++
++	if (retval)
++		return retval;
++
++	if (fotg210->debug)
++		dbgp_external_startup(fotg210_to_hcd(fotg210));
++
++	fotg210->port_c_suspend = fotg210->suspended_ports =
++			fotg210->resuming_ports = 0;
++	return retval;
++}
++
++/* Idle the controller (turn off the schedules).
++ * Must be called with interrupts enabled and the lock not held.
++ */
++static void fotg210_quiesce(struct fotg210_hcd *fotg210)
++{
++	u32 temp;
++
++	if (fotg210->rh_state != FOTG210_RH_RUNNING)
++		return;
++
++	/* wait for any schedule enables/disables to take effect */
++	temp = (fotg210->command << 10) & (STS_ASS | STS_PSS);
++	handshake(fotg210, &fotg210->regs->status, STS_ASS | STS_PSS, temp,
++			16 * 125);
++
++	/* then disable anything that's still active */
++	spin_lock_irq(&fotg210->lock);
++	fotg210->command &= ~(CMD_ASE | CMD_PSE);
++	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
++	spin_unlock_irq(&fotg210->lock);
++
++	/* hardware can take 16 microframes to turn off ... */
++	handshake(fotg210, &fotg210->regs->status, STS_ASS | STS_PSS, 0,
++			16 * 125);
++}
++
++static void end_unlink_async(struct fotg210_hcd *fotg210);
++static void unlink_empty_async(struct fotg210_hcd *fotg210);
++static void fotg210_work(struct fotg210_hcd *fotg210);
++static void start_unlink_intr(struct fotg210_hcd *fotg210,
++			      struct fotg210_qh *qh);
++static void end_unlink_intr(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
++
++/* Set a bit in the USBCMD register */
++static void fotg210_set_command_bit(struct fotg210_hcd *fotg210, u32 bit)
++{
++	fotg210->command |= bit;
++	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
++
++	/* unblock posted write */
++	fotg210_readl(fotg210, &fotg210->regs->command);
++}
++
++/* Clear a bit in the USBCMD register */
++static void fotg210_clear_command_bit(struct fotg210_hcd *fotg210, u32 bit)
++{
++	fotg210->command &= ~bit;
++	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
++
++	/* unblock posted write */
++	fotg210_readl(fotg210, &fotg210->regs->command);
++}
++
++/* EHCI timer support...  Now using hrtimers.
++ *
++ * Lots of different events are triggered from fotg210->hrtimer.  Whenever
++ * the timer routine runs, it checks each possible event; events that are
++ * currently enabled and whose expiration time has passed get handled.
++ * The set of enabled events is stored as a collection of bitflags in
++ * fotg210->enabled_hrtimer_events, and they are numbered in order of
++ * increasing delay values (ranging between 1 ms and 100 ms).
++ *
++ * Rather than implementing a sorted list or tree of all pending events,
++ * we keep track only of the lowest-numbered pending event, in
++ * fotg210->next_hrtimer_event.  Whenever fotg210->hrtimer gets restarted, its
++ * expiration time is set to the timeout value for this event.
++ *
++ * As a result, events might not get handled right away; the actual delay
++ * could be anywhere up to twice the requested delay.  This doesn't
++ * matter, because none of the events are especially time-critical.  The
++ * ones that matter most all have a delay of 1 ms, so they will be
++ * handled after 2 ms at most, which is okay.  In addition to this, we
++ * allow for an expiration range of 1 ms.
++ */
++
++/* Delay lengths for the hrtimer event types.
++ * Keep this list sorted by delay length, in the same order as
++ * the event types indexed by enum fotg210_hrtimer_event in fotg210.h.
++ */
++static unsigned event_delays_ns[] = {
++	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_ASS */
++	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_PSS */
++	1 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_POLL_DEAD */
++	1125 * NSEC_PER_USEC,	/* FOTG210_HRTIMER_UNLINK_INTR */
++	2 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_FREE_ITDS */
++	6 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_ASYNC_UNLINKS */
++	10 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_IAA_WATCHDOG */
++	10 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_DISABLE_PERIODIC */
++	15 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_DISABLE_ASYNC */
++	100 * NSEC_PER_MSEC,	/* FOTG210_HRTIMER_IO_WATCHDOG */
++};
++
++/* Enable a pending hrtimer event */
++static void fotg210_enable_event(struct fotg210_hcd *fotg210, unsigned event,
++		bool resched)
++{
++	ktime_t *timeout = &fotg210->hr_timeouts[event];
++
++	if (resched)
++		*timeout = ktime_add(ktime_get(), event_delays_ns[event]);
++	fotg210->enabled_hrtimer_events |= (1 << event);
++
++	/* Track only the lowest-numbered pending event */
++	if (event < fotg210->next_hrtimer_event) {
++		fotg210->next_hrtimer_event = event;
++		hrtimer_start_range_ns(&fotg210->hrtimer, *timeout,
++				NSEC_PER_MSEC, HRTIMER_MODE_ABS);
++	}
++}
++
++
++/* Poll the STS_ASS status bit; see when it agrees with CMD_ASE */
++static void fotg210_poll_ASS(struct fotg210_hcd *fotg210)
++{
++	unsigned actual, want;
++
++	/* Don't enable anything if the controller isn't running (e.g., died) */
++	if (fotg210->rh_state != FOTG210_RH_RUNNING)
++		return;
++
++	want = (fotg210->command & CMD_ASE) ? STS_ASS : 0;
++	actual = fotg210_readl(fotg210, &fotg210->regs->status) & STS_ASS;
++
++	if (want != actual) {
++
++		/* Poll again later, but give up after about 20 ms */
++		if (fotg210->ASS_poll_count++ < 20) {
++			fotg210_enable_event(fotg210, FOTG210_HRTIMER_POLL_ASS,
++					true);
++			return;
++		}
++		fotg210_dbg(fotg210, "Waited too long for the async schedule status (%x/%x), giving up\n",
++				want, actual);
++	}
++	fotg210->ASS_poll_count = 0;
++
++	/* The status is up-to-date; restart or stop the schedule as needed */
++	if (want == 0) {	/* Stopped */
++		if (fotg210->async_count > 0)
++			fotg210_set_command_bit(fotg210, CMD_ASE);
++
++	} else {		/* Running */
++		if (fotg210->async_count == 0) {
++
++			/* Turn off the schedule after a while */
++			fotg210_enable_event(fotg210,
++					FOTG210_HRTIMER_DISABLE_ASYNC,
++					true);
++		}
++	}
++}
++
++/* Turn off the async schedule after a brief delay */
++static void fotg210_disable_ASE(struct fotg210_hcd *fotg210)
++{
++	fotg210_clear_command_bit(fotg210, CMD_ASE);
++}
++
++
++/* Poll the STS_PSS status bit; see when it agrees with CMD_PSE */
++static void fotg210_poll_PSS(struct fotg210_hcd *fotg210)
++{
++	unsigned actual, want;
++
++	/* Don't do anything if the controller isn't running (e.g., died) */
++	if (fotg210->rh_state != FOTG210_RH_RUNNING)
++		return;
++
++	want = (fotg210->command & CMD_PSE) ? STS_PSS : 0;
++	actual = fotg210_readl(fotg210, &fotg210->regs->status) & STS_PSS;
++
++	if (want != actual) {
++
++		/* Poll again later, but give up after about 20 ms */
++		if (fotg210->PSS_poll_count++ < 20) {
++			fotg210_enable_event(fotg210, FOTG210_HRTIMER_POLL_PSS,
++					true);
++			return;
++		}
++		fotg210_dbg(fotg210, "Waited too long for the periodic schedule status (%x/%x), giving up\n",
++				want, actual);
++	}
++	fotg210->PSS_poll_count = 0;
++
++	/* The status is up-to-date; restart or stop the schedule as needed */
++	if (want == 0) {	/* Stopped */
++		if (fotg210->periodic_count > 0)
++			fotg210_set_command_bit(fotg210, CMD_PSE);
++
++	} else {		/* Running */
++		if (fotg210->periodic_count == 0) {
++
++			/* Turn off the schedule after a while */
++			fotg210_enable_event(fotg210,
++					FOTG210_HRTIMER_DISABLE_PERIODIC,
++					true);
++		}
++	}
++}
++
++/* Turn off the periodic schedule after a brief delay */
++static void fotg210_disable_PSE(struct fotg210_hcd *fotg210)
++{
++	fotg210_clear_command_bit(fotg210, CMD_PSE);
++}
++
++
++/* Poll the STS_HALT status bit; see when a dead controller stops */
++static void fotg210_handle_controller_death(struct fotg210_hcd *fotg210)
++{
++	if (!(fotg210_readl(fotg210, &fotg210->regs->status) & STS_HALT)) {
++
++		/* Give up after a few milliseconds */
++		if (fotg210->died_poll_count++ < 5) {
++			/* Try again later */
++			fotg210_enable_event(fotg210,
++					FOTG210_HRTIMER_POLL_DEAD, true);
++			return;
++		}
++		fotg210_warn(fotg210, "Waited too long for the controller to stop, giving up\n");
++	}
++
++	/* Clean up the mess */
++	fotg210->rh_state = FOTG210_RH_HALTED;
++	fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
++	fotg210_work(fotg210);
++	end_unlink_async(fotg210);
++
++	/* Not in process context, so don't try to reset the controller */
++}
++
++
++/* Handle unlinked interrupt QHs once they are gone from the hardware */
++static void fotg210_handle_intr_unlinks(struct fotg210_hcd *fotg210)
++{
++	bool stopped = (fotg210->rh_state < FOTG210_RH_RUNNING);
++
++	/*
++	 * Process all the QHs on the intr_unlink list that were added
++	 * before the current unlink cycle began.  The list is in
++	 * temporal order, so stop when we reach the first entry in the
++	 * current cycle.  But if the root hub isn't running then
++	 * process all the QHs on the list.
++	 */
++	fotg210->intr_unlinking = true;
++	while (fotg210->intr_unlink) {
++		struct fotg210_qh *qh = fotg210->intr_unlink;
++
++		if (!stopped && qh->unlink_cycle == fotg210->intr_unlink_cycle)
++			break;
++		fotg210->intr_unlink = qh->unlink_next;
++		qh->unlink_next = NULL;
++		end_unlink_intr(fotg210, qh);
++	}
++
++	/* Handle remaining entries later */
++	if (fotg210->intr_unlink) {
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_UNLINK_INTR,
++				true);
++		++fotg210->intr_unlink_cycle;
++	}
++	fotg210->intr_unlinking = false;
++}
++
++
++/* Start another free-iTDs/siTDs cycle */
++static void start_free_itds(struct fotg210_hcd *fotg210)
++{
++	if (!(fotg210->enabled_hrtimer_events &
++			BIT(FOTG210_HRTIMER_FREE_ITDS))) {
++		fotg210->last_itd_to_free = list_entry(
++				fotg210->cached_itd_list.prev,
++				struct fotg210_itd, itd_list);
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_FREE_ITDS, true);
++	}
++}
++
++/* Wait for controller to stop using old iTDs and siTDs */
++static void end_free_itds(struct fotg210_hcd *fotg210)
++{
++	struct fotg210_itd *itd, *n;
++
++	if (fotg210->rh_state < FOTG210_RH_RUNNING)
++		fotg210->last_itd_to_free = NULL;
++
++	list_for_each_entry_safe(itd, n, &fotg210->cached_itd_list, itd_list) {
++		list_del(&itd->itd_list);
++		dma_pool_free(fotg210->itd_pool, itd, itd->itd_dma);
++		if (itd == fotg210->last_itd_to_free)
++			break;
++	}
++
++	if (!list_empty(&fotg210->cached_itd_list))
++		start_free_itds(fotg210);
++}
++
++
++/* Handle lost (or very late) IAA interrupts */
++static void fotg210_iaa_watchdog(struct fotg210_hcd *fotg210)
++{
++	if (fotg210->rh_state != FOTG210_RH_RUNNING)
++		return;
++
++	/*
++	 * Lost IAA irqs wedge things badly; seen first with a vt8235.
++	 * So we need this watchdog, but must protect it against both
++	 * (a) SMP races against real IAA firing and retriggering, and
++	 * (b) clean HC shutdown, when IAA watchdog was pending.
++	 */
++	if (fotg210->async_iaa) {
++		u32 cmd, status;
++
++		/* If we get here, IAA is *REALLY* late.  It's barely
++		 * conceivable that the system is so busy that CMD_IAAD
++		 * is still legitimately set, so let's be sure it's
++		 * clear before we read STS_IAA.  (The HC should clear
++		 * CMD_IAAD when it sets STS_IAA.)
++		 */
++		cmd = fotg210_readl(fotg210, &fotg210->regs->command);
++
++		/*
++		 * If IAA is set here it either legitimately triggered
++		 * after the watchdog timer expired (_way_ late, so we'll
++		 * still count it as lost) ... or a silicon erratum:
++		 * - VIA seems to set IAA without triggering the IRQ;
++		 * - IAAD potentially cleared without setting IAA.
++		 */
++		status = fotg210_readl(fotg210, &fotg210->regs->status);
++		if ((status & STS_IAA) || !(cmd & CMD_IAAD)) {
++			INCR(fotg210->stats.lost_iaa);
++			fotg210_writel(fotg210, STS_IAA,
++					&fotg210->regs->status);
++		}
++
++		fotg210_dbg(fotg210, "IAA watchdog: status %x cmd %x\n",
++				status, cmd);
++		end_unlink_async(fotg210);
++	}
++}
++
++
++/* Enable the I/O watchdog, if appropriate */
++static void turn_on_io_watchdog(struct fotg210_hcd *fotg210)
++{
++	/* Not needed if the controller isn't running or it's already enabled */
++	if (fotg210->rh_state != FOTG210_RH_RUNNING ||
++			(fotg210->enabled_hrtimer_events &
++			BIT(FOTG210_HRTIMER_IO_WATCHDOG)))
++		return;
++
++	/*
++	 * Isochronous transfers always need the watchdog.
++	 * For other sorts we use it only if the flag is set.
++	 */
++	if (fotg210->isoc_count > 0 || (fotg210->need_io_watchdog &&
++			fotg210->async_count + fotg210->intr_count > 0))
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_IO_WATCHDOG,
++				true);
++}
++
++
++/* Handler functions for the hrtimer event types.
++ * Keep this array in the same order as the event types indexed by
++ * enum fotg210_hrtimer_event in fotg210.h.
++ */
++static void (*event_handlers[])(struct fotg210_hcd *) = {
++	fotg210_poll_ASS,			/* FOTG210_HRTIMER_POLL_ASS */
++	fotg210_poll_PSS,			/* FOTG210_HRTIMER_POLL_PSS */
++	fotg210_handle_controller_death,	/* FOTG210_HRTIMER_POLL_DEAD */
++	fotg210_handle_intr_unlinks,	/* FOTG210_HRTIMER_UNLINK_INTR */
++	end_free_itds,			/* FOTG210_HRTIMER_FREE_ITDS */
++	unlink_empty_async,		/* FOTG210_HRTIMER_ASYNC_UNLINKS */
++	fotg210_iaa_watchdog,		/* FOTG210_HRTIMER_IAA_WATCHDOG */
++	fotg210_disable_PSE,		/* FOTG210_HRTIMER_DISABLE_PERIODIC */
++	fotg210_disable_ASE,		/* FOTG210_HRTIMER_DISABLE_ASYNC */
++	fotg210_work,			/* FOTG210_HRTIMER_IO_WATCHDOG */
++};
++
++static enum hrtimer_restart fotg210_hrtimer_func(struct hrtimer *t)
++{
++	struct fotg210_hcd *fotg210 =
++			container_of(t, struct fotg210_hcd, hrtimer);
++	ktime_t now;
++	unsigned long events;
++	unsigned long flags;
++	unsigned e;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	events = fotg210->enabled_hrtimer_events;
++	fotg210->enabled_hrtimer_events = 0;
++	fotg210->next_hrtimer_event = FOTG210_HRTIMER_NO_EVENT;
++
++	/*
++	 * Check each pending event.  If its time has expired, handle
++	 * the event; otherwise re-enable it.
++	 */
++	now = ktime_get();
++	for_each_set_bit(e, &events, FOTG210_HRTIMER_NUM_EVENTS) {
++		if (ktime_compare(now, fotg210->hr_timeouts[e]) >= 0)
++			event_handlers[e](fotg210);
++		else
++			fotg210_enable_event(fotg210, e, false);
++	}
++
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return HRTIMER_NORESTART;
++}
++
++#define fotg210_bus_suspend NULL
++#define fotg210_bus_resume NULL
++
++static int check_reset_complete(struct fotg210_hcd *fotg210, int index,
++		u32 __iomem *status_reg, int port_status)
++{
++	if (!(port_status & PORT_CONNECT))
++		return port_status;
++
++	/* if reset finished and it's still not enabled -- handoff */
++	if (!(port_status & PORT_PE))
++		/* with integrated TT, there's nobody to hand it to! */
++		fotg210_dbg(fotg210, "Failed to enable port %d on root hub TT\n",
++				index + 1);
++	else
++		fotg210_dbg(fotg210, "port %d reset complete, port enabled\n",
++				index + 1);
++
++	return port_status;
++}
++
++
++/* build "status change" packet (one or two bytes) from HC registers */
++
++static int fotg210_hub_status_data(struct usb_hcd *hcd, char *buf)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	u32 temp, status;
++	u32 mask;
++	int retval = 1;
++	unsigned long flags;
++
++	/* init status to no-changes */
++	buf[0] = 0;
++
++	/* Inform the core about resumes-in-progress by returning
++	 * a non-zero value even if there are no status changes.
++	 */
++	status = fotg210->resuming_ports;
++
++	mask = PORT_CSC | PORT_PEC;
++	/* PORT_RESUME from hardware ~= PORT_STAT_C_SUSPEND */
++
++	/* no hub change reports (bit 0) for now (power, ...) */
++
++	/* port N changes (bit N)? */
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	temp = fotg210_readl(fotg210, &fotg210->regs->port_status);
++
++	/*
++	 * Return status information even for ports with OWNER set.
++	 * Otherwise hub_wq wouldn't see the disconnect event when a
++	 * high-speed device is switched over to the companion
++	 * controller by the user.
++	 */
++
++	if ((temp & mask) != 0 || test_bit(0, &fotg210->port_c_suspend) ||
++			(fotg210->reset_done[0] &&
++			time_after_eq(jiffies, fotg210->reset_done[0]))) {
++		buf[0] |= 1 << 1;
++		status = STS_PCD;
++	}
++	/* FIXME autosuspend idle root hubs */
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return status ? retval : 0;
++}
++
++static void fotg210_hub_descriptor(struct fotg210_hcd *fotg210,
++		struct usb_hub_descriptor *desc)
++{
++	int ports = HCS_N_PORTS(fotg210->hcs_params);
++	u16 temp;
++
++	desc->bDescriptorType = USB_DT_HUB;
++	desc->bPwrOn2PwrGood = 10;	/* fotg210 1.0, 2.3.9 says 20ms max */
++	desc->bHubContrCurrent = 0;
++
++	desc->bNbrPorts = ports;
++	temp = 1 + (ports / 8);
++	desc->bDescLength = 7 + 2 * temp;
++
++	/* two bitmaps:  ports removable, and usb 1.0 legacy PortPwrCtrlMask */
++	memset(&desc->u.hs.DeviceRemovable[0], 0, temp);
++	memset(&desc->u.hs.DeviceRemovable[temp], 0xff, temp);
++
++	temp = HUB_CHAR_INDV_PORT_OCPM;	/* per-port overcurrent reporting */
++	temp |= HUB_CHAR_NO_LPSM;	/* no power switching */
++	desc->wHubCharacteristics = cpu_to_le16(temp);
++}
++
++static int fotg210_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
++		u16 wIndex, char *buf, u16 wLength)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	int ports = HCS_N_PORTS(fotg210->hcs_params);
++	u32 __iomem *status_reg = &fotg210->regs->port_status;
++	u32 temp, temp1, status;
++	unsigned long flags;
++	int retval = 0;
++	unsigned selector;
++
++	/*
++	 * FIXME:  support SetPortFeatures USB_PORT_FEAT_INDICATOR.
++	 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
++	 * (track current state ourselves) ... blink for diagnostics,
++	 * power, "this is the one", etc.  EHCI spec supports this.
++	 */
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	switch (typeReq) {
++	case ClearHubFeature:
++		switch (wValue) {
++		case C_HUB_LOCAL_POWER:
++		case C_HUB_OVER_CURRENT:
++			/* no hub-wide feature/status flags */
++			break;
++		default:
++			goto error;
++		}
++		break;
++	case ClearPortFeature:
++		if (!wIndex || wIndex > ports)
++			goto error;
++		wIndex--;
++		temp = fotg210_readl(fotg210, status_reg);
++		temp &= ~PORT_RWC_BITS;
++
++		/*
++		 * Even if OWNER is set, so the port is owned by the
++		 * companion controller, hub_wq needs to be able to clear
++		 * the port-change status bits (especially
++		 * USB_PORT_STAT_C_CONNECTION).
++		 */
++
++		switch (wValue) {
++		case USB_PORT_FEAT_ENABLE:
++			fotg210_writel(fotg210, temp & ~PORT_PE, status_reg);
++			break;
++		case USB_PORT_FEAT_C_ENABLE:
++			fotg210_writel(fotg210, temp | PORT_PEC, status_reg);
++			break;
++		case USB_PORT_FEAT_SUSPEND:
++			if (temp & PORT_RESET)
++				goto error;
++			if (!(temp & PORT_SUSPEND))
++				break;
++			if ((temp & PORT_PE) == 0)
++				goto error;
++
++			/* resume signaling for 20 msec */
++			fotg210_writel(fotg210, temp | PORT_RESUME, status_reg);
++			fotg210->reset_done[wIndex] = jiffies
++					+ msecs_to_jiffies(USB_RESUME_TIMEOUT);
++			break;
++		case USB_PORT_FEAT_C_SUSPEND:
++			clear_bit(wIndex, &fotg210->port_c_suspend);
++			break;
++		case USB_PORT_FEAT_C_CONNECTION:
++			fotg210_writel(fotg210, temp | PORT_CSC, status_reg);
++			break;
++		case USB_PORT_FEAT_C_OVER_CURRENT:
++			fotg210_writel(fotg210, temp | OTGISR_OVC,
++					&fotg210->regs->otgisr);
++			break;
++		case USB_PORT_FEAT_C_RESET:
++			/* GetPortStatus clears reset */
++			break;
++		default:
++			goto error;
++		}
++		fotg210_readl(fotg210, &fotg210->regs->command);
++		break;
++	case GetHubDescriptor:
++		fotg210_hub_descriptor(fotg210, (struct usb_hub_descriptor *)
++				buf);
++		break;
++	case GetHubStatus:
++		/* no hub-wide feature/status flags */
++		memset(buf, 0, 4);
++		/*cpu_to_le32s ((u32 *) buf); */
++		break;
++	case GetPortStatus:
++		if (!wIndex || wIndex > ports)
++			goto error;
++		wIndex--;
++		status = 0;
++		temp = fotg210_readl(fotg210, status_reg);
++
++		/* wPortChange bits */
++		if (temp & PORT_CSC)
++			status |= USB_PORT_STAT_C_CONNECTION << 16;
++		if (temp & PORT_PEC)
++			status |= USB_PORT_STAT_C_ENABLE << 16;
++
++		temp1 = fotg210_readl(fotg210, &fotg210->regs->otgisr);
++		if (temp1 & OTGISR_OVC)
++			status |= USB_PORT_STAT_C_OVERCURRENT << 16;
++
++		/* whoever resumes must GetPortStatus to complete it!! */
++		if (temp & PORT_RESUME) {
++
++			/* Remote Wakeup received? */
++			if (!fotg210->reset_done[wIndex]) {
++				/* resume signaling for 20 msec */
++				fotg210->reset_done[wIndex] = jiffies
++						+ msecs_to_jiffies(20);
++				/* check the port again */
++				mod_timer(&fotg210_to_hcd(fotg210)->rh_timer,
++						fotg210->reset_done[wIndex]);
++			}
++
++			/* resume completed? */
++			else if (time_after_eq(jiffies,
++					fotg210->reset_done[wIndex])) {
++				clear_bit(wIndex, &fotg210->suspended_ports);
++				set_bit(wIndex, &fotg210->port_c_suspend);
++				fotg210->reset_done[wIndex] = 0;
++
++				/* stop resume signaling */
++				temp = fotg210_readl(fotg210, status_reg);
++				fotg210_writel(fotg210, temp &
++						~(PORT_RWC_BITS | PORT_RESUME),
++						status_reg);
++				clear_bit(wIndex, &fotg210->resuming_ports);
++				retval = handshake(fotg210, status_reg,
++						PORT_RESUME, 0, 2000);/* 2ms */
++				if (retval != 0) {
++					fotg210_err(fotg210,
++							"port %d resume error %d\n",
++							wIndex + 1, retval);
++					goto error;
++				}
++				temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
++			}
++		}
++
++		/* whoever resets must GetPortStatus to complete it!! */
++		if ((temp & PORT_RESET) && time_after_eq(jiffies,
++				fotg210->reset_done[wIndex])) {
++			status |= USB_PORT_STAT_C_RESET << 16;
++			fotg210->reset_done[wIndex] = 0;
++			clear_bit(wIndex, &fotg210->resuming_ports);
++
++			/* force reset to complete */
++			fotg210_writel(fotg210,
++					temp & ~(PORT_RWC_BITS | PORT_RESET),
++					status_reg);
++			/* REVISIT:  some hardware needs 550+ usec to clear
++			 * this bit; seems too long to spin routinely...
++			 */
++			retval = handshake(fotg210, status_reg,
++					PORT_RESET, 0, 1000);
++			if (retval != 0) {
++				fotg210_err(fotg210, "port %d reset error %d\n",
++						wIndex + 1, retval);
++				goto error;
++			}
++
++			/* see what we found out */
++			temp = check_reset_complete(fotg210, wIndex, status_reg,
++					fotg210_readl(fotg210, status_reg));
++
++			/* restart schedule */
++			fotg210->command |= CMD_RUN;
++			fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
++		}
++
++		if (!(temp & (PORT_RESUME|PORT_RESET))) {
++			fotg210->reset_done[wIndex] = 0;
++			clear_bit(wIndex, &fotg210->resuming_ports);
++		}
++
++		/* transfer dedicated ports to the companion hc */
++		if ((temp & PORT_CONNECT) &&
++				test_bit(wIndex, &fotg210->companion_ports)) {
++			temp &= ~PORT_RWC_BITS;
++			fotg210_writel(fotg210, temp, status_reg);
++			fotg210_dbg(fotg210, "port %d --> companion\n",
++					wIndex + 1);
++			temp = fotg210_readl(fotg210, status_reg);
++		}
++
++		/*
++		 * Even if OWNER is set, there's no harm letting hub_wq
++		 * see the wPortStatus values (they should all be 0 except
++		 * for PORT_POWER anyway).
++		 */
++
++		if (temp & PORT_CONNECT) {
++			status |= USB_PORT_STAT_CONNECTION;
++			status |= fotg210_port_speed(fotg210, temp);
++		}
++		if (temp & PORT_PE)
++			status |= USB_PORT_STAT_ENABLE;
++
++		/* maybe the port was unsuspended without our knowledge */
++		if (temp & (PORT_SUSPEND|PORT_RESUME)) {
++			status |= USB_PORT_STAT_SUSPEND;
++		} else if (test_bit(wIndex, &fotg210->suspended_ports)) {
++			clear_bit(wIndex, &fotg210->suspended_ports);
++			clear_bit(wIndex, &fotg210->resuming_ports);
++			fotg210->reset_done[wIndex] = 0;
++			if (temp & PORT_PE)
++				set_bit(wIndex, &fotg210->port_c_suspend);
++		}
++
++		temp1 = fotg210_readl(fotg210, &fotg210->regs->otgisr);
++		if (temp1 & OTGISR_OVC)
++			status |= USB_PORT_STAT_OVERCURRENT;
++		if (temp & PORT_RESET)
++			status |= USB_PORT_STAT_RESET;
++		if (test_bit(wIndex, &fotg210->port_c_suspend))
++			status |= USB_PORT_STAT_C_SUSPEND << 16;
++
++		if (status & ~0xffff)	/* only if wPortChange is interesting */
++			dbg_port(fotg210, "GetStatus", wIndex + 1, temp);
++		put_unaligned_le32(status, buf);
++		break;
++	case SetHubFeature:
++		switch (wValue) {
++		case C_HUB_LOCAL_POWER:
++		case C_HUB_OVER_CURRENT:
++			/* no hub-wide feature/status flags */
++			break;
++		default:
++			goto error;
++		}
++		break;
++	case SetPortFeature:
++		selector = wIndex >> 8;
++		wIndex &= 0xff;
++
++		if (!wIndex || wIndex > ports)
++			goto error;
++		wIndex--;
++		temp = fotg210_readl(fotg210, status_reg);
++		temp &= ~PORT_RWC_BITS;
++		switch (wValue) {
++		case USB_PORT_FEAT_SUSPEND:
++			if ((temp & PORT_PE) == 0
++					|| (temp & PORT_RESET) != 0)
++				goto error;
++
++			/* After above check the port must be connected.
++			 * Set appropriate bit thus could put phy into low power
++			 * mode if we have hostpc feature
++			 */
++			fotg210_writel(fotg210, temp | PORT_SUSPEND,
++					status_reg);
++			set_bit(wIndex, &fotg210->suspended_ports);
++			break;
++		case USB_PORT_FEAT_RESET:
++			if (temp & PORT_RESUME)
++				goto error;
++			/* line status bits may report this as low speed,
++			 * which can be fine if this root hub has a
++			 * transaction translator built in.
++			 */
++			fotg210_dbg(fotg210, "port %d reset\n", wIndex + 1);
++			temp |= PORT_RESET;
++			temp &= ~PORT_PE;
++
++			/*
++			 * caller must wait, then call GetPortStatus
++			 * usb 2.0 spec says 50 ms resets on root
++			 */
++			fotg210->reset_done[wIndex] = jiffies
++					+ msecs_to_jiffies(50);
++			fotg210_writel(fotg210, temp, status_reg);
++			break;
++
++		/* For downstream facing ports (these):  one hub port is put
++		 * into test mode according to USB2 11.24.2.13, then the hub
++		 * must be reset (which for root hub now means rmmod+modprobe,
++		 * or else system reboot).  See EHCI 2.3.9 and 4.14 for info
++		 * about the EHCI-specific stuff.
++		 */
++		case USB_PORT_FEAT_TEST:
++			if (!selector || selector > 5)
++				goto error;
++			spin_unlock_irqrestore(&fotg210->lock, flags);
++			fotg210_quiesce(fotg210);
++			spin_lock_irqsave(&fotg210->lock, flags);
++
++			/* Put all enabled ports into suspend */
++			temp = fotg210_readl(fotg210, status_reg) &
++				~PORT_RWC_BITS;
++			if (temp & PORT_PE)
++				fotg210_writel(fotg210, temp | PORT_SUSPEND,
++						status_reg);
++
++			spin_unlock_irqrestore(&fotg210->lock, flags);
++			fotg210_halt(fotg210);
++			spin_lock_irqsave(&fotg210->lock, flags);
++
++			temp = fotg210_readl(fotg210, status_reg);
++			temp |= selector << 16;
++			fotg210_writel(fotg210, temp, status_reg);
++			break;
++
++		default:
++			goto error;
++		}
++		fotg210_readl(fotg210, &fotg210->regs->command);
++		break;
++
++	default:
++error:
++		/* "stall" on error */
++		retval = -EPIPE;
++	}
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return retval;
++}
++
++static void __maybe_unused fotg210_relinquish_port(struct usb_hcd *hcd,
++		int portnum)
++{
++	return;
++}
++
++static int __maybe_unused fotg210_port_handed_over(struct usb_hcd *hcd,
++		int portnum)
++{
++	return 0;
++}
++
++/* There's basically three types of memory:
++ *	- data used only by the HCD ... kmalloc is fine
++ *	- async and periodic schedules, shared by HC and HCD ... these
++ *	  need to use dma_pool or dma_alloc_coherent
++ *	- driver buffers, read/written by HC ... single shot DMA mapped
++ *
++ * There's also "register" data (e.g. PCI or SOC), which is memory mapped.
++ * No memory seen by this driver is pageable.
++ */
++
++/* Allocate the key transfer structures from the previously allocated pool */
++static inline void fotg210_qtd_init(struct fotg210_hcd *fotg210,
++		struct fotg210_qtd *qtd, dma_addr_t dma)
++{
++	memset(qtd, 0, sizeof(*qtd));
++	qtd->qtd_dma = dma;
++	qtd->hw_token = cpu_to_hc32(fotg210, QTD_STS_HALT);
++	qtd->hw_next = FOTG210_LIST_END(fotg210);
++	qtd->hw_alt_next = FOTG210_LIST_END(fotg210);
++	INIT_LIST_HEAD(&qtd->qtd_list);
++}
++
++static struct fotg210_qtd *fotg210_qtd_alloc(struct fotg210_hcd *fotg210,
++		gfp_t flags)
++{
++	struct fotg210_qtd *qtd;
++	dma_addr_t dma;
++
++	qtd = dma_pool_alloc(fotg210->qtd_pool, flags, &dma);
++	if (qtd != NULL)
++		fotg210_qtd_init(fotg210, qtd, dma);
++
++	return qtd;
++}
++
++static inline void fotg210_qtd_free(struct fotg210_hcd *fotg210,
++		struct fotg210_qtd *qtd)
++{
++	dma_pool_free(fotg210->qtd_pool, qtd, qtd->qtd_dma);
++}
++
++
++static void qh_destroy(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	/* clean qtds first, and know this is not linked */
++	if (!list_empty(&qh->qtd_list) || qh->qh_next.ptr) {
++		fotg210_dbg(fotg210, "unused qh not empty!\n");
++		BUG();
++	}
++	if (qh->dummy)
++		fotg210_qtd_free(fotg210, qh->dummy);
++	dma_pool_free(fotg210->qh_pool, qh->hw, qh->qh_dma);
++	kfree(qh);
++}
++
++static struct fotg210_qh *fotg210_qh_alloc(struct fotg210_hcd *fotg210,
++		gfp_t flags)
++{
++	struct fotg210_qh *qh;
++	dma_addr_t dma;
++
++	qh = kzalloc(sizeof(*qh), GFP_ATOMIC);
++	if (!qh)
++		goto done;
++	qh->hw = (struct fotg210_qh_hw *)
++		dma_pool_zalloc(fotg210->qh_pool, flags, &dma);
++	if (!qh->hw)
++		goto fail;
++	qh->qh_dma = dma;
++	INIT_LIST_HEAD(&qh->qtd_list);
++
++	/* dummy td enables safe urb queuing */
++	qh->dummy = fotg210_qtd_alloc(fotg210, flags);
++	if (qh->dummy == NULL) {
++		fotg210_dbg(fotg210, "no dummy td\n");
++		goto fail1;
++	}
++done:
++	return qh;
++fail1:
++	dma_pool_free(fotg210->qh_pool, qh->hw, qh->qh_dma);
++fail:
++	kfree(qh);
++	return NULL;
++}
++
++/* The queue heads and transfer descriptors are managed from pools tied
++ * to each of the "per device" structures.
++ * This is the initialisation and cleanup code.
++ */
++
++static void fotg210_mem_cleanup(struct fotg210_hcd *fotg210)
++{
++	if (fotg210->async)
++		qh_destroy(fotg210, fotg210->async);
++	fotg210->async = NULL;
++
++	if (fotg210->dummy)
++		qh_destroy(fotg210, fotg210->dummy);
++	fotg210->dummy = NULL;
++
++	/* DMA consistent memory and pools */
++	dma_pool_destroy(fotg210->qtd_pool);
++	fotg210->qtd_pool = NULL;
++
++	dma_pool_destroy(fotg210->qh_pool);
++	fotg210->qh_pool = NULL;
++
++	dma_pool_destroy(fotg210->itd_pool);
++	fotg210->itd_pool = NULL;
++
++	if (fotg210->periodic)
++		dma_free_coherent(fotg210_to_hcd(fotg210)->self.controller,
++				fotg210->periodic_size * sizeof(u32),
++				fotg210->periodic, fotg210->periodic_dma);
++	fotg210->periodic = NULL;
++
++	/* shadow periodic table */
++	kfree(fotg210->pshadow);
++	fotg210->pshadow = NULL;
++}
++
++/* remember to add cleanup code (above) if you add anything here */
++static int fotg210_mem_init(struct fotg210_hcd *fotg210, gfp_t flags)
++{
++	int i;
++
++	/* QTDs for control/bulk/intr transfers */
++	fotg210->qtd_pool = dma_pool_create("fotg210_qtd",
++			fotg210_to_hcd(fotg210)->self.controller,
++			sizeof(struct fotg210_qtd),
++			32 /* byte alignment (for hw parts) */,
++			4096 /* can't cross 4K */);
++	if (!fotg210->qtd_pool)
++		goto fail;
++
++	/* QHs for control/bulk/intr transfers */
++	fotg210->qh_pool = dma_pool_create("fotg210_qh",
++			fotg210_to_hcd(fotg210)->self.controller,
++			sizeof(struct fotg210_qh_hw),
++			32 /* byte alignment (for hw parts) */,
++			4096 /* can't cross 4K */);
++	if (!fotg210->qh_pool)
++		goto fail;
++
++	fotg210->async = fotg210_qh_alloc(fotg210, flags);
++	if (!fotg210->async)
++		goto fail;
++
++	/* ITD for high speed ISO transfers */
++	fotg210->itd_pool = dma_pool_create("fotg210_itd",
++			fotg210_to_hcd(fotg210)->self.controller,
++			sizeof(struct fotg210_itd),
++			64 /* byte alignment (for hw parts) */,
++			4096 /* can't cross 4K */);
++	if (!fotg210->itd_pool)
++		goto fail;
++
++	/* Hardware periodic table */
++	fotg210->periodic =
++		dma_alloc_coherent(fotg210_to_hcd(fotg210)->self.controller,
++				fotg210->periodic_size * sizeof(__le32),
++				&fotg210->periodic_dma, 0);
++	if (fotg210->periodic == NULL)
++		goto fail;
++
++	for (i = 0; i < fotg210->periodic_size; i++)
++		fotg210->periodic[i] = FOTG210_LIST_END(fotg210);
++
++	/* software shadow of hardware table */
++	fotg210->pshadow = kcalloc(fotg210->periodic_size, sizeof(void *),
++			flags);
++	if (fotg210->pshadow != NULL)
++		return 0;
++
++fail:
++	fotg210_dbg(fotg210, "couldn't init memory\n");
++	fotg210_mem_cleanup(fotg210);
++	return -ENOMEM;
++}
++/* EHCI hardware queue manipulation ... the core.  QH/QTD manipulation.
++ *
++ * Control, bulk, and interrupt traffic all use "qh" lists.  They list "qtd"
++ * entries describing USB transactions, max 16-20kB/entry (with 4kB-aligned
++ * buffers needed for the larger number).  We use one QH per endpoint, queue
++ * multiple urbs (all three types) per endpoint.  URBs may need several qtds.
++ *
++ * ISO traffic uses "ISO TD" (itd) records, and (along with
++ * interrupts) needs careful scheduling.  Performance improvements can be
++ * an ongoing challenge.  That's in "ehci-sched.c".
++ *
++ * USB 1.1 devices are handled (a) by "companion" OHCI or UHCI root hubs,
++ * or otherwise through transaction translators (TTs) in USB 2.0 hubs using
++ * (b) special fields in qh entries or (c) split iso entries.  TTs will
++ * buffer low/full speed data so the host collects it at high speed.
++ */
++
++/* fill a qtd, returning how much of the buffer we were able to queue up */
++static int qtd_fill(struct fotg210_hcd *fotg210, struct fotg210_qtd *qtd,
++		dma_addr_t buf, size_t len, int token, int maxpacket)
++{
++	int i, count;
++	u64 addr = buf;
++
++	/* one buffer entry per 4K ... first might be short or unaligned */
++	qtd->hw_buf[0] = cpu_to_hc32(fotg210, (u32)addr);
++	qtd->hw_buf_hi[0] = cpu_to_hc32(fotg210, (u32)(addr >> 32));
++	count = 0x1000 - (buf & 0x0fff);	/* rest of that page */
++	if (likely(len < count))		/* ... iff needed */
++		count = len;
++	else {
++		buf +=  0x1000;
++		buf &= ~0x0fff;
++
++		/* per-qtd limit: from 16K to 20K (best alignment) */
++		for (i = 1; count < len && i < 5; i++) {
++			addr = buf;
++			qtd->hw_buf[i] = cpu_to_hc32(fotg210, (u32)addr);
++			qtd->hw_buf_hi[i] = cpu_to_hc32(fotg210,
++					(u32)(addr >> 32));
++			buf += 0x1000;
++			if ((count + 0x1000) < len)
++				count += 0x1000;
++			else
++				count = len;
++		}
++
++		/* short packets may only terminate transfers */
++		if (count != len)
++			count -= (count % maxpacket);
++	}
++	qtd->hw_token = cpu_to_hc32(fotg210, (count << 16) | token);
++	qtd->length = count;
++
++	return count;
++}
++
++static inline void qh_update(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh, struct fotg210_qtd *qtd)
++{
++	struct fotg210_qh_hw *hw = qh->hw;
++
++	/* writes to an active overlay are unsafe */
++	BUG_ON(qh->qh_state != QH_STATE_IDLE);
++
++	hw->hw_qtd_next = QTD_NEXT(fotg210, qtd->qtd_dma);
++	hw->hw_alt_next = FOTG210_LIST_END(fotg210);
++
++	/* Except for control endpoints, we make hardware maintain data
++	 * toggle (like OHCI) ... here (re)initialize the toggle in the QH,
++	 * and set the pseudo-toggle in udev. Only usb_clear_halt() will
++	 * ever clear it.
++	 */
++	if (!(hw->hw_info1 & cpu_to_hc32(fotg210, QH_TOGGLE_CTL))) {
++		unsigned is_out, epnum;
++
++		is_out = qh->is_out;
++		epnum = (hc32_to_cpup(fotg210, &hw->hw_info1) >> 8) & 0x0f;
++		if (unlikely(!usb_gettoggle(qh->dev, epnum, is_out))) {
++			hw->hw_token &= ~cpu_to_hc32(fotg210, QTD_TOGGLE);
++			usb_settoggle(qh->dev, epnum, is_out, 1);
++		}
++	}
++
++	hw->hw_token &= cpu_to_hc32(fotg210, QTD_TOGGLE | QTD_STS_PING);
++}
++
++/* if it weren't for a common silicon quirk (writing the dummy into the qh
++ * overlay, so qh->hw_token wrongly becomes inactive/halted), only fault
++ * recovery (including urb dequeue) would need software changes to a QH...
++ */
++static void qh_refresh(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	struct fotg210_qtd *qtd;
++
++	if (list_empty(&qh->qtd_list))
++		qtd = qh->dummy;
++	else {
++		qtd = list_entry(qh->qtd_list.next,
++				struct fotg210_qtd, qtd_list);
++		/*
++		 * first qtd may already be partially processed.
++		 * If we come here during unlink, the QH overlay region
++		 * might have reference to the just unlinked qtd. The
++		 * qtd is updated in qh_completions(). Update the QH
++		 * overlay here.
++		 */
++		if (cpu_to_hc32(fotg210, qtd->qtd_dma) == qh->hw->hw_current) {
++			qh->hw->hw_qtd_next = qtd->hw_next;
++			qtd = NULL;
++		}
++	}
++
++	if (qtd)
++		qh_update(fotg210, qh, qtd);
++}
++
++static void qh_link_async(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
++
++static void fotg210_clear_tt_buffer_complete(struct usb_hcd *hcd,
++		struct usb_host_endpoint *ep)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	struct fotg210_qh *qh = ep->hcpriv;
++	unsigned long flags;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	qh->clearing_tt = 0;
++	if (qh->qh_state == QH_STATE_IDLE && !list_empty(&qh->qtd_list)
++			&& fotg210->rh_state == FOTG210_RH_RUNNING)
++		qh_link_async(fotg210, qh);
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++}
++
++static void fotg210_clear_tt_buffer(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh, struct urb *urb, u32 token)
++{
++
++	/* If an async split transaction gets an error or is unlinked,
++	 * the TT buffer may be left in an indeterminate state.  We
++	 * have to clear the TT buffer.
++	 *
++	 * Note: this routine is never called for Isochronous transfers.
++	 */
++	if (urb->dev->tt && !usb_pipeint(urb->pipe) && !qh->clearing_tt) {
++		struct usb_device *tt = urb->dev->tt->hub;
++
++		dev_dbg(&tt->dev,
++				"clear tt buffer port %d, a%d ep%d t%08x\n",
++				urb->dev->ttport, urb->dev->devnum,
++				usb_pipeendpoint(urb->pipe), token);
++
++		if (urb->dev->tt->hub !=
++				fotg210_to_hcd(fotg210)->self.root_hub) {
++			if (usb_hub_clear_tt_buffer(urb) == 0)
++				qh->clearing_tt = 1;
++		}
++	}
++}
++
++static int qtd_copy_status(struct fotg210_hcd *fotg210, struct urb *urb,
++		size_t length, u32 token)
++{
++	int status = -EINPROGRESS;
++
++	/* count IN/OUT bytes, not SETUP (even short packets) */
++	if (likely(QTD_PID(token) != 2))
++		urb->actual_length += length - QTD_LENGTH(token);
++
++	/* don't modify error codes */
++	if (unlikely(urb->unlinked))
++		return status;
++
++	/* force cleanup after short read; not always an error */
++	if (unlikely(IS_SHORT_READ(token)))
++		status = -EREMOTEIO;
++
++	/* serious "can't proceed" faults reported by the hardware */
++	if (token & QTD_STS_HALT) {
++		if (token & QTD_STS_BABBLE) {
++			/* FIXME "must" disable babbling device's port too */
++			status = -EOVERFLOW;
++		/* CERR nonzero + halt --> stall */
++		} else if (QTD_CERR(token)) {
++			status = -EPIPE;
++
++		/* In theory, more than one of the following bits can be set
++		 * since they are sticky and the transaction is retried.
++		 * Which to test first is rather arbitrary.
++		 */
++		} else if (token & QTD_STS_MMF) {
++			/* fs/ls interrupt xfer missed the complete-split */
++			status = -EPROTO;
++		} else if (token & QTD_STS_DBE) {
++			status = (QTD_PID(token) == 1) /* IN ? */
++				? -ENOSR  /* hc couldn't read data */
++				: -ECOMM; /* hc couldn't write data */
++		} else if (token & QTD_STS_XACT) {
++			/* timeout, bad CRC, wrong PID, etc */
++			fotg210_dbg(fotg210, "devpath %s ep%d%s 3strikes\n",
++					urb->dev->devpath,
++					usb_pipeendpoint(urb->pipe),
++					usb_pipein(urb->pipe) ? "in" : "out");
++			status = -EPROTO;
++		} else {	/* unknown */
++			status = -EPROTO;
++		}
++
++		fotg210_dbg(fotg210,
++				"dev%d ep%d%s qtd token %08x --> status %d\n",
++				usb_pipedevice(urb->pipe),
++				usb_pipeendpoint(urb->pipe),
++				usb_pipein(urb->pipe) ? "in" : "out",
++				token, status);
++	}
++
++	return status;
++}
++
++static void fotg210_urb_done(struct fotg210_hcd *fotg210, struct urb *urb,
++		int status)
++__releases(fotg210->lock)
++__acquires(fotg210->lock)
++{
++	if (likely(urb->hcpriv != NULL)) {
++		struct fotg210_qh *qh = (struct fotg210_qh *) urb->hcpriv;
++
++		/* S-mask in a QH means it's an interrupt urb */
++		if ((qh->hw->hw_info2 & cpu_to_hc32(fotg210, QH_SMASK)) != 0) {
++
++			/* ... update hc-wide periodic stats (for usbfs) */
++			fotg210_to_hcd(fotg210)->self.bandwidth_int_reqs--;
++		}
++	}
++
++	if (unlikely(urb->unlinked)) {
++		INCR(fotg210->stats.unlink);
++	} else {
++		/* report non-error and short read status as zero */
++		if (status == -EINPROGRESS || status == -EREMOTEIO)
++			status = 0;
++		INCR(fotg210->stats.complete);
++	}
++
++#ifdef FOTG210_URB_TRACE
++	fotg210_dbg(fotg210,
++			"%s %s urb %p ep%d%s status %d len %d/%d\n",
++			__func__, urb->dev->devpath, urb,
++			usb_pipeendpoint(urb->pipe),
++			usb_pipein(urb->pipe) ? "in" : "out",
++			status,
++			urb->actual_length, urb->transfer_buffer_length);
++#endif
++
++	/* complete() can reenter this HCD */
++	usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
++	spin_unlock(&fotg210->lock);
++	usb_hcd_giveback_urb(fotg210_to_hcd(fotg210), urb, status);
++	spin_lock(&fotg210->lock);
++}
++
++static int qh_schedule(struct fotg210_hcd *fotg210, struct fotg210_qh *qh);
++
++/* Process and free completed qtds for a qh, returning URBs to drivers.
++ * Chases up to qh->hw_current.  Returns number of completions called,
++ * indicating how much "real" work we did.
++ */
++static unsigned qh_completions(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh)
++{
++	struct fotg210_qtd *last, *end = qh->dummy;
++	struct fotg210_qtd *qtd, *tmp;
++	int last_status;
++	int stopped;
++	unsigned count = 0;
++	u8 state;
++	struct fotg210_qh_hw *hw = qh->hw;
++
++	if (unlikely(list_empty(&qh->qtd_list)))
++		return count;
++
++	/* completions (or tasks on other cpus) must never clobber HALT
++	 * till we've gone through and cleaned everything up, even when
++	 * they add urbs to this qh's queue or mark them for unlinking.
++	 *
++	 * NOTE:  unlinking expects to be done in queue order.
++	 *
++	 * It's a bug for qh->qh_state to be anything other than
++	 * QH_STATE_IDLE, unless our caller is scan_async() or
++	 * scan_intr().
++	 */
++	state = qh->qh_state;
++	qh->qh_state = QH_STATE_COMPLETING;
++	stopped = (state == QH_STATE_IDLE);
++
++rescan:
++	last = NULL;
++	last_status = -EINPROGRESS;
++	qh->needs_rescan = 0;
++
++	/* remove de-activated QTDs from front of queue.
++	 * after faults (including short reads), cleanup this urb
++	 * then let the queue advance.
++	 * if queue is stopped, handles unlinks.
++	 */
++	list_for_each_entry_safe(qtd, tmp, &qh->qtd_list, qtd_list) {
++		struct urb *urb;
++		u32 token = 0;
++
++		urb = qtd->urb;
++
++		/* clean up any state from previous QTD ...*/
++		if (last) {
++			if (likely(last->urb != urb)) {
++				fotg210_urb_done(fotg210, last->urb,
++						last_status);
++				count++;
++				last_status = -EINPROGRESS;
++			}
++			fotg210_qtd_free(fotg210, last);
++			last = NULL;
++		}
++
++		/* ignore urbs submitted during completions we reported */
++		if (qtd == end)
++			break;
++
++		/* hardware copies qtd out of qh overlay */
++		rmb();
++		token = hc32_to_cpu(fotg210, qtd->hw_token);
++
++		/* always clean up qtds the hc de-activated */
++retry_xacterr:
++		if ((token & QTD_STS_ACTIVE) == 0) {
++
++			/* Report Data Buffer Error: non-fatal but useful */
++			if (token & QTD_STS_DBE)
++				fotg210_dbg(fotg210,
++					"detected DataBufferErr for urb %p ep%d%s len %d, qtd %p [qh %p]\n",
++					urb, usb_endpoint_num(&urb->ep->desc),
++					usb_endpoint_dir_in(&urb->ep->desc)
++						? "in" : "out",
++					urb->transfer_buffer_length, qtd, qh);
++
++			/* on STALL, error, and short reads this urb must
++			 * complete and all its qtds must be recycled.
++			 */
++			if ((token & QTD_STS_HALT) != 0) {
++
++				/* retry transaction errors until we
++				 * reach the software xacterr limit
++				 */
++				if ((token & QTD_STS_XACT) &&
++						QTD_CERR(token) == 0 &&
++						++qh->xacterrs < QH_XACTERR_MAX &&
++						!urb->unlinked) {
++					fotg210_dbg(fotg210,
++						"detected XactErr len %zu/%zu retry %d\n",
++						qtd->length - QTD_LENGTH(token),
++						qtd->length,
++						qh->xacterrs);
++
++					/* reset the token in the qtd and the
++					 * qh overlay (which still contains
++					 * the qtd) so that we pick up from
++					 * where we left off
++					 */
++					token &= ~QTD_STS_HALT;
++					token |= QTD_STS_ACTIVE |
++						 (FOTG210_TUNE_CERR << 10);
++					qtd->hw_token = cpu_to_hc32(fotg210,
++							token);
++					wmb();
++					hw->hw_token = cpu_to_hc32(fotg210,
++							token);
++					goto retry_xacterr;
++				}
++				stopped = 1;
++
++			/* magic dummy for some short reads; qh won't advance.
++			 * that silicon quirk can kick in with this dummy too.
++			 *
++			 * other short reads won't stop the queue, including
++			 * control transfers (status stage handles that) or
++			 * most other single-qtd reads ... the queue stops if
++			 * URB_SHORT_NOT_OK was set so the driver submitting
++			 * the urbs could clean it up.
++			 */
++			} else if (IS_SHORT_READ(token) &&
++					!(qtd->hw_alt_next &
++					FOTG210_LIST_END(fotg210))) {
++				stopped = 1;
++			}
++
++		/* stop scanning when we reach qtds the hc is using */
++		} else if (likely(!stopped
++				&& fotg210->rh_state >= FOTG210_RH_RUNNING)) {
++			break;
++
++		/* scan the whole queue for unlinks whenever it stops */
++		} else {
++			stopped = 1;
++
++			/* cancel everything if we halt, suspend, etc */
++			if (fotg210->rh_state < FOTG210_RH_RUNNING)
++				last_status = -ESHUTDOWN;
++
++			/* this qtd is active; skip it unless a previous qtd
++			 * for its urb faulted, or its urb was canceled.
++			 */
++			else if (last_status == -EINPROGRESS && !urb->unlinked)
++				continue;
++
++			/* qh unlinked; token in overlay may be most current */
++			if (state == QH_STATE_IDLE &&
++					cpu_to_hc32(fotg210, qtd->qtd_dma)
++					== hw->hw_current) {
++				token = hc32_to_cpu(fotg210, hw->hw_token);
++
++				/* An unlink may leave an incomplete
++				 * async transaction in the TT buffer.
++				 * We have to clear it.
++				 */
++				fotg210_clear_tt_buffer(fotg210, qh, urb,
++						token);
++			}
++		}
++
++		/* unless we already know the urb's status, collect qtd status
++		 * and update count of bytes transferred.  in common short read
++		 * cases with only one data qtd (including control transfers),
++		 * queue processing won't halt.  but with two or more qtds (for
++		 * example, with a 32 KB transfer), when the first qtd gets a
++		 * short read the second must be removed by hand.
++		 */
++		if (last_status == -EINPROGRESS) {
++			last_status = qtd_copy_status(fotg210, urb,
++					qtd->length, token);
++			if (last_status == -EREMOTEIO &&
++					(qtd->hw_alt_next &
++					FOTG210_LIST_END(fotg210)))
++				last_status = -EINPROGRESS;
++
++			/* As part of low/full-speed endpoint-halt processing
++			 * we must clear the TT buffer (11.17.5).
++			 */
++			if (unlikely(last_status != -EINPROGRESS &&
++					last_status != -EREMOTEIO)) {
++				/* The TT's in some hubs malfunction when they
++				 * receive this request following a STALL (they
++				 * stop sending isochronous packets).  Since a
++				 * STALL can't leave the TT buffer in a busy
++				 * state (if you believe Figures 11-48 - 11-51
++				 * in the USB 2.0 spec), we won't clear the TT
++				 * buffer in this case.  Strictly speaking this
++				 * is a violation of the spec.
++				 */
++				if (last_status != -EPIPE)
++					fotg210_clear_tt_buffer(fotg210, qh,
++							urb, token);
++			}
++		}
++
++		/* if we're removing something not at the queue head,
++		 * patch the hardware queue pointer.
++		 */
++		if (stopped && qtd->qtd_list.prev != &qh->qtd_list) {
++			last = list_entry(qtd->qtd_list.prev,
++					struct fotg210_qtd, qtd_list);
++			last->hw_next = qtd->hw_next;
++		}
++
++		/* remove qtd; it's recycled after possible urb completion */
++		list_del(&qtd->qtd_list);
++		last = qtd;
++
++		/* reinit the xacterr counter for the next qtd */
++		qh->xacterrs = 0;
++	}
++
++	/* last urb's completion might still need calling */
++	if (likely(last != NULL)) {
++		fotg210_urb_done(fotg210, last->urb, last_status);
++		count++;
++		fotg210_qtd_free(fotg210, last);
++	}
++
++	/* Do we need to rescan for URBs dequeued during a giveback? */
++	if (unlikely(qh->needs_rescan)) {
++		/* If the QH is already unlinked, do the rescan now. */
++		if (state == QH_STATE_IDLE)
++			goto rescan;
++
++		/* Otherwise we have to wait until the QH is fully unlinked.
++		 * Our caller will start an unlink if qh->needs_rescan is
++		 * set.  But if an unlink has already started, nothing needs
++		 * to be done.
++		 */
++		if (state != QH_STATE_LINKED)
++			qh->needs_rescan = 0;
++	}
++
++	/* restore original state; caller must unlink or relink */
++	qh->qh_state = state;
++
++	/* be sure the hardware's done with the qh before refreshing
++	 * it after fault cleanup, or recovering from silicon wrongly
++	 * overlaying the dummy qtd (which reduces DMA chatter).
++	 */
++	if (stopped != 0 || hw->hw_qtd_next == FOTG210_LIST_END(fotg210)) {
++		switch (state) {
++		case QH_STATE_IDLE:
++			qh_refresh(fotg210, qh);
++			break;
++		case QH_STATE_LINKED:
++			/* We won't refresh a QH that's linked (after the HC
++			 * stopped the queue).  That avoids a race:
++			 *  - HC reads first part of QH;
++			 *  - CPU updates that first part and the token;
++			 *  - HC reads rest of that QH, including token
++			 * Result:  HC gets an inconsistent image, and then
++			 * DMAs to/from the wrong memory (corrupting it).
++			 *
++			 * That should be rare for interrupt transfers,
++			 * except maybe high bandwidth ...
++			 */
++
++			/* Tell the caller to start an unlink */
++			qh->needs_rescan = 1;
++			break;
++		/* otherwise, unlink already started */
++		}
++	}
++
++	return count;
++}
++
++/* reverse of qh_urb_transaction:  free a list of TDs.
++ * used for cleanup after errors, before HC sees an URB's TDs.
++ */
++static void qtd_list_free(struct fotg210_hcd *fotg210, struct urb *urb,
++		struct list_head *head)
++{
++	struct fotg210_qtd *qtd, *temp;
++
++	list_for_each_entry_safe(qtd, temp, head, qtd_list) {
++		list_del(&qtd->qtd_list);
++		fotg210_qtd_free(fotg210, qtd);
++	}
++}
++
++/* create a list of filled qtds for this URB; won't link into qh.
++ */
++static struct list_head *qh_urb_transaction(struct fotg210_hcd *fotg210,
++		struct urb *urb, struct list_head *head, gfp_t flags)
++{
++	struct fotg210_qtd *qtd, *qtd_prev;
++	dma_addr_t buf;
++	int len, this_sg_len, maxpacket;
++	int is_input;
++	u32 token;
++	int i;
++	struct scatterlist *sg;
++
++	/*
++	 * URBs map to sequences of QTDs:  one logical transaction
++	 */
++	qtd = fotg210_qtd_alloc(fotg210, flags);
++	if (unlikely(!qtd))
++		return NULL;
++	list_add_tail(&qtd->qtd_list, head);
++	qtd->urb = urb;
++
++	token = QTD_STS_ACTIVE;
++	token |= (FOTG210_TUNE_CERR << 10);
++	/* for split transactions, SplitXState initialized to zero */
++
++	len = urb->transfer_buffer_length;
++	is_input = usb_pipein(urb->pipe);
++	if (usb_pipecontrol(urb->pipe)) {
++		/* SETUP pid */
++		qtd_fill(fotg210, qtd, urb->setup_dma,
++				sizeof(struct usb_ctrlrequest),
++				token | (2 /* "setup" */ << 8), 8);
++
++		/* ... and always at least one more pid */
++		token ^= QTD_TOGGLE;
++		qtd_prev = qtd;
++		qtd = fotg210_qtd_alloc(fotg210, flags);
++		if (unlikely(!qtd))
++			goto cleanup;
++		qtd->urb = urb;
++		qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
++		list_add_tail(&qtd->qtd_list, head);
++
++		/* for zero length DATA stages, STATUS is always IN */
++		if (len == 0)
++			token |= (1 /* "in" */ << 8);
++	}
++
++	/*
++	 * data transfer stage:  buffer setup
++	 */
++	i = urb->num_mapped_sgs;
++	if (len > 0 && i > 0) {
++		sg = urb->sg;
++		buf = sg_dma_address(sg);
++
++		/* urb->transfer_buffer_length may be smaller than the
++		 * size of the scatterlist (or vice versa)
++		 */
++		this_sg_len = min_t(int, sg_dma_len(sg), len);
++	} else {
++		sg = NULL;
++		buf = urb->transfer_dma;
++		this_sg_len = len;
++	}
++
++	if (is_input)
++		token |= (1 /* "in" */ << 8);
++	/* else it's already initted to "out" pid (0 << 8) */
++
++	maxpacket = usb_maxpacket(urb->dev, urb->pipe);
++
++	/*
++	 * buffer gets wrapped in one or more qtds;
++	 * last one may be "short" (including zero len)
++	 * and may serve as a control status ack
++	 */
++	for (;;) {
++		int this_qtd_len;
++
++		this_qtd_len = qtd_fill(fotg210, qtd, buf, this_sg_len, token,
++				maxpacket);
++		this_sg_len -= this_qtd_len;
++		len -= this_qtd_len;
++		buf += this_qtd_len;
++
++		/*
++		 * short reads advance to a "magic" dummy instead of the next
++		 * qtd ... that forces the queue to stop, for manual cleanup.
++		 * (this will usually be overridden later.)
++		 */
++		if (is_input)
++			qtd->hw_alt_next = fotg210->async->hw->hw_alt_next;
++
++		/* qh makes control packets use qtd toggle; maybe switch it */
++		if ((maxpacket & (this_qtd_len + (maxpacket - 1))) == 0)
++			token ^= QTD_TOGGLE;
++
++		if (likely(this_sg_len <= 0)) {
++			if (--i <= 0 || len <= 0)
++				break;
++			sg = sg_next(sg);
++			buf = sg_dma_address(sg);
++			this_sg_len = min_t(int, sg_dma_len(sg), len);
++		}
++
++		qtd_prev = qtd;
++		qtd = fotg210_qtd_alloc(fotg210, flags);
++		if (unlikely(!qtd))
++			goto cleanup;
++		qtd->urb = urb;
++		qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
++		list_add_tail(&qtd->qtd_list, head);
++	}
++
++	/*
++	 * unless the caller requires manual cleanup after short reads,
++	 * have the alt_next mechanism keep the queue running after the
++	 * last data qtd (the only one, for control and most other cases).
++	 */
++	if (likely((urb->transfer_flags & URB_SHORT_NOT_OK) == 0 ||
++			usb_pipecontrol(urb->pipe)))
++		qtd->hw_alt_next = FOTG210_LIST_END(fotg210);
++
++	/*
++	 * control requests may need a terminating data "status" ack;
++	 * other OUT ones may need a terminating short packet
++	 * (zero length).
++	 */
++	if (likely(urb->transfer_buffer_length != 0)) {
++		int one_more = 0;
++
++		if (usb_pipecontrol(urb->pipe)) {
++			one_more = 1;
++			token ^= 0x0100;	/* "in" <--> "out"  */
++			token |= QTD_TOGGLE;	/* force DATA1 */
++		} else if (usb_pipeout(urb->pipe)
++				&& (urb->transfer_flags & URB_ZERO_PACKET)
++				&& !(urb->transfer_buffer_length % maxpacket)) {
++			one_more = 1;
++		}
++		if (one_more) {
++			qtd_prev = qtd;
++			qtd = fotg210_qtd_alloc(fotg210, flags);
++			if (unlikely(!qtd))
++				goto cleanup;
++			qtd->urb = urb;
++			qtd_prev->hw_next = QTD_NEXT(fotg210, qtd->qtd_dma);
++			list_add_tail(&qtd->qtd_list, head);
++
++			/* never any data in such packets */
++			qtd_fill(fotg210, qtd, 0, 0, token, 0);
++		}
++	}
++
++	/* by default, enable interrupt on urb completion */
++	if (likely(!(urb->transfer_flags & URB_NO_INTERRUPT)))
++		qtd->hw_token |= cpu_to_hc32(fotg210, QTD_IOC);
++	return head;
++
++cleanup:
++	qtd_list_free(fotg210, urb, head);
++	return NULL;
++}
++
++/* Would be best to create all qh's from config descriptors,
++ * when each interface/altsetting is established.  Unlink
++ * any previous qh and cancel its urbs first; endpoints are
++ * implicitly reset then (data toggle too).
++ * That'd mean updating how usbcore talks to HCDs. (2.7?)
++ */
++
++
++/* Each QH holds a qtd list; a QH is used for everything except iso.
++ *
++ * For interrupt urbs, the scheduler must set the microframe scheduling
++ * mask(s) each time the QH gets scheduled.  For highspeed, that's
++ * just one microframe in the s-mask.  For split interrupt transactions
++ * there are additional complications: c-mask, maybe FSTNs.
++ */
++static struct fotg210_qh *qh_make(struct fotg210_hcd *fotg210, struct urb *urb,
++		gfp_t flags)
++{
++	struct fotg210_qh *qh = fotg210_qh_alloc(fotg210, flags);
++	struct usb_host_endpoint *ep;
++	u32 info1 = 0, info2 = 0;
++	int is_input, type;
++	int maxp = 0;
++	int mult;
++	struct usb_tt *tt = urb->dev->tt;
++	struct fotg210_qh_hw *hw;
++
++	if (!qh)
++		return qh;
++
++	/*
++	 * init endpoint/device data for this QH
++	 */
++	info1 |= usb_pipeendpoint(urb->pipe) << 8;
++	info1 |= usb_pipedevice(urb->pipe) << 0;
++
++	is_input = usb_pipein(urb->pipe);
++	type = usb_pipetype(urb->pipe);
++	ep = usb_pipe_endpoint(urb->dev, urb->pipe);
++	maxp = usb_endpoint_maxp(&ep->desc);
++	mult = usb_endpoint_maxp_mult(&ep->desc);
++
++	/* 1024 byte maxpacket is a hardware ceiling.  High bandwidth
++	 * acts like up to 3KB, but is built from smaller packets.
++	 */
++	if (maxp > 1024) {
++		fotg210_dbg(fotg210, "bogus qh maxpacket %d\n", maxp);
++		goto done;
++	}
++
++	/* Compute interrupt scheduling parameters just once, and save.
++	 * - allowing for high bandwidth, how many nsec/uframe are used?
++	 * - split transactions need a second CSPLIT uframe; same question
++	 * - splits also need a schedule gap (for full/low speed I/O)
++	 * - qh has a polling interval
++	 *
++	 * For control/bulk requests, the HC or TT handles these.
++	 */
++	if (type == PIPE_INTERRUPT) {
++		qh->usecs = NS_TO_US(usb_calc_bus_time(USB_SPEED_HIGH,
++				is_input, 0, mult * maxp));
++		qh->start = NO_FRAME;
++
++		if (urb->dev->speed == USB_SPEED_HIGH) {
++			qh->c_usecs = 0;
++			qh->gap_uf = 0;
++
++			qh->period = urb->interval >> 3;
++			if (qh->period == 0 && urb->interval != 1) {
++				/* NOTE interval 2 or 4 uframes could work.
++				 * But interval 1 scheduling is simpler, and
++				 * includes high bandwidth.
++				 */
++				urb->interval = 1;
++			} else if (qh->period > fotg210->periodic_size) {
++				qh->period = fotg210->periodic_size;
++				urb->interval = qh->period << 3;
++			}
++		} else {
++			int think_time;
++
++			/* gap is f(FS/LS transfer times) */
++			qh->gap_uf = 1 + usb_calc_bus_time(urb->dev->speed,
++					is_input, 0, maxp) / (125 * 1000);
++
++			/* FIXME this just approximates SPLIT/CSPLIT times */
++			if (is_input) {		/* SPLIT, gap, CSPLIT+DATA */
++				qh->c_usecs = qh->usecs + HS_USECS(0);
++				qh->usecs = HS_USECS(1);
++			} else {		/* SPLIT+DATA, gap, CSPLIT */
++				qh->usecs += HS_USECS(1);
++				qh->c_usecs = HS_USECS(0);
++			}
++
++			think_time = tt ? tt->think_time : 0;
++			qh->tt_usecs = NS_TO_US(think_time +
++					usb_calc_bus_time(urb->dev->speed,
++					is_input, 0, maxp));
++			qh->period = urb->interval;
++			if (qh->period > fotg210->periodic_size) {
++				qh->period = fotg210->periodic_size;
++				urb->interval = qh->period;
++			}
++		}
++	}
++
++	/* support for tt scheduling, and access to toggles */
++	qh->dev = urb->dev;
++
++	/* using TT? */
++	switch (urb->dev->speed) {
++	case USB_SPEED_LOW:
++		info1 |= QH_LOW_SPEED;
++		fallthrough;
++
++	case USB_SPEED_FULL:
++		/* EPS 0 means "full" */
++		if (type != PIPE_INTERRUPT)
++			info1 |= (FOTG210_TUNE_RL_TT << 28);
++		if (type == PIPE_CONTROL) {
++			info1 |= QH_CONTROL_EP;		/* for TT */
++			info1 |= QH_TOGGLE_CTL;		/* toggle from qtd */
++		}
++		info1 |= maxp << 16;
++
++		info2 |= (FOTG210_TUNE_MULT_TT << 30);
++
++		/* Some Freescale processors have an erratum in which the
++		 * port number in the queue head was 0..N-1 instead of 1..N.
++		 */
++		if (fotg210_has_fsl_portno_bug(fotg210))
++			info2 |= (urb->dev->ttport-1) << 23;
++		else
++			info2 |= urb->dev->ttport << 23;
++
++		/* set the address of the TT; for TDI's integrated
++		 * root hub tt, leave it zeroed.
++		 */
++		if (tt && tt->hub != fotg210_to_hcd(fotg210)->self.root_hub)
++			info2 |= tt->hub->devnum << 16;
++
++		/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets c-mask } */
++
++		break;
++
++	case USB_SPEED_HIGH:		/* no TT involved */
++		info1 |= QH_HIGH_SPEED;
++		if (type == PIPE_CONTROL) {
++			info1 |= (FOTG210_TUNE_RL_HS << 28);
++			info1 |= 64 << 16;	/* usb2 fixed maxpacket */
++			info1 |= QH_TOGGLE_CTL;	/* toggle from qtd */
++			info2 |= (FOTG210_TUNE_MULT_HS << 30);
++		} else if (type == PIPE_BULK) {
++			info1 |= (FOTG210_TUNE_RL_HS << 28);
++			/* The USB spec says that high speed bulk endpoints
++			 * always use 512 byte maxpacket.  But some device
++			 * vendors decided to ignore that, and MSFT is happy
++			 * to help them do so.  So now people expect to use
++			 * such nonconformant devices with Linux too; sigh.
++			 */
++			info1 |= maxp << 16;
++			info2 |= (FOTG210_TUNE_MULT_HS << 30);
++		} else {		/* PIPE_INTERRUPT */
++			info1 |= maxp << 16;
++			info2 |= mult << 30;
++		}
++		break;
++	default:
++		fotg210_dbg(fotg210, "bogus dev %p speed %d\n", urb->dev,
++				urb->dev->speed);
++done:
++		qh_destroy(fotg210, qh);
++		return NULL;
++	}
++
++	/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets s-mask } */
++
++	/* init as live, toggle clear, advance to dummy */
++	qh->qh_state = QH_STATE_IDLE;
++	hw = qh->hw;
++	hw->hw_info1 = cpu_to_hc32(fotg210, info1);
++	hw->hw_info2 = cpu_to_hc32(fotg210, info2);
++	qh->is_out = !is_input;
++	usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), !is_input, 1);
++	qh_refresh(fotg210, qh);
++	return qh;
++}
++
++static void enable_async(struct fotg210_hcd *fotg210)
++{
++	if (fotg210->async_count++)
++		return;
++
++	/* Stop waiting to turn off the async schedule */
++	fotg210->enabled_hrtimer_events &= ~BIT(FOTG210_HRTIMER_DISABLE_ASYNC);
++
++	/* Don't start the schedule until ASS is 0 */
++	fotg210_poll_ASS(fotg210);
++	turn_on_io_watchdog(fotg210);
++}
++
++static void disable_async(struct fotg210_hcd *fotg210)
++{
++	if (--fotg210->async_count)
++		return;
++
++	/* The async schedule and async_unlink list are supposed to be empty */
++	WARN_ON(fotg210->async->qh_next.qh || fotg210->async_unlink);
++
++	/* Don't turn off the schedule until ASS is 1 */
++	fotg210_poll_ASS(fotg210);
++}
++
++/* move qh (and its qtds) onto async queue; maybe enable queue.  */
++
++static void qh_link_async(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	__hc32 dma = QH_NEXT(fotg210, qh->qh_dma);
++	struct fotg210_qh *head;
++
++	/* Don't link a QH if there's a Clear-TT-Buffer pending */
++	if (unlikely(qh->clearing_tt))
++		return;
++
++	WARN_ON(qh->qh_state != QH_STATE_IDLE);
++
++	/* clear halt and/or toggle; and maybe recover from silicon quirk */
++	qh_refresh(fotg210, qh);
++
++	/* splice right after start */
++	head = fotg210->async;
++	qh->qh_next = head->qh_next;
++	qh->hw->hw_next = head->hw->hw_next;
++	wmb();
++
++	head->qh_next.qh = qh;
++	head->hw->hw_next = dma;
++
++	qh->xacterrs = 0;
++	qh->qh_state = QH_STATE_LINKED;
++	/* qtd completions reported later by interrupt */
++
++	enable_async(fotg210);
++}
++
++/* For control/bulk/interrupt, return QH with these TDs appended.
++ * Allocates and initializes the QH if necessary.
++ * Returns null if it can't allocate a QH it needs to.
++ * If the QH has TDs (urbs) already, that's great.
++ */
++static struct fotg210_qh *qh_append_tds(struct fotg210_hcd *fotg210,
++		struct urb *urb, struct list_head *qtd_list,
++		int epnum, void **ptr)
++{
++	struct fotg210_qh *qh = NULL;
++	__hc32 qh_addr_mask = cpu_to_hc32(fotg210, 0x7f);
++
++	qh = (struct fotg210_qh *) *ptr;
++	if (unlikely(qh == NULL)) {
++		/* can't sleep here, we have fotg210->lock... */
++		qh = qh_make(fotg210, urb, GFP_ATOMIC);
++		*ptr = qh;
++	}
++	if (likely(qh != NULL)) {
++		struct fotg210_qtd *qtd;
++
++		if (unlikely(list_empty(qtd_list)))
++			qtd = NULL;
++		else
++			qtd = list_entry(qtd_list->next, struct fotg210_qtd,
++					qtd_list);
++
++		/* control qh may need patching ... */
++		if (unlikely(epnum == 0)) {
++			/* usb_reset_device() briefly reverts to address 0 */
++			if (usb_pipedevice(urb->pipe) == 0)
++				qh->hw->hw_info1 &= ~qh_addr_mask;
++		}
++
++		/* just one way to queue requests: swap with the dummy qtd.
++		 * only hc or qh_refresh() ever modify the overlay.
++		 */
++		if (likely(qtd != NULL)) {
++			struct fotg210_qtd *dummy;
++			dma_addr_t dma;
++			__hc32 token;
++
++			/* to avoid racing the HC, use the dummy td instead of
++			 * the first td of our list (becomes new dummy).  both
++			 * tds stay deactivated until we're done, when the
++			 * HC is allowed to fetch the old dummy (4.10.2).
++			 */
++			token = qtd->hw_token;
++			qtd->hw_token = HALT_BIT(fotg210);
++
++			dummy = qh->dummy;
++
++			dma = dummy->qtd_dma;
++			*dummy = *qtd;
++			dummy->qtd_dma = dma;
++
++			list_del(&qtd->qtd_list);
++			list_add(&dummy->qtd_list, qtd_list);
++			list_splice_tail(qtd_list, &qh->qtd_list);
++
++			fotg210_qtd_init(fotg210, qtd, qtd->qtd_dma);
++			qh->dummy = qtd;
++
++			/* hc must see the new dummy at list end */
++			dma = qtd->qtd_dma;
++			qtd = list_entry(qh->qtd_list.prev,
++					struct fotg210_qtd, qtd_list);
++			qtd->hw_next = QTD_NEXT(fotg210, dma);
++
++			/* let the hc process these next qtds */
++			wmb();
++			dummy->hw_token = token;
++
++			urb->hcpriv = qh;
++		}
++	}
++	return qh;
++}
++
++static int submit_async(struct fotg210_hcd *fotg210, struct urb *urb,
++		struct list_head *qtd_list, gfp_t mem_flags)
++{
++	int epnum;
++	unsigned long flags;
++	struct fotg210_qh *qh = NULL;
++	int rc;
++
++	epnum = urb->ep->desc.bEndpointAddress;
++
++#ifdef FOTG210_URB_TRACE
++	{
++		struct fotg210_qtd *qtd;
++
++		qtd = list_entry(qtd_list->next, struct fotg210_qtd, qtd_list);
++		fotg210_dbg(fotg210,
++				"%s %s urb %p ep%d%s len %d, qtd %p [qh %p]\n",
++				__func__, urb->dev->devpath, urb,
++				epnum & 0x0f, (epnum & USB_DIR_IN)
++					? "in" : "out",
++				urb->transfer_buffer_length,
++				qtd, urb->ep->hcpriv);
++	}
++#endif
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
++		rc = -ESHUTDOWN;
++		goto done;
++	}
++	rc = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
++	if (unlikely(rc))
++		goto done;
++
++	qh = qh_append_tds(fotg210, urb, qtd_list, epnum, &urb->ep->hcpriv);
++	if (unlikely(qh == NULL)) {
++		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
++		rc = -ENOMEM;
++		goto done;
++	}
++
++	/* Control/bulk operations through TTs don't need scheduling,
++	 * the HC and TT handle it when the TT has a buffer ready.
++	 */
++	if (likely(qh->qh_state == QH_STATE_IDLE))
++		qh_link_async(fotg210, qh);
++done:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	if (unlikely(qh == NULL))
++		qtd_list_free(fotg210, urb, qtd_list);
++	return rc;
++}
++
++static void single_unlink_async(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh)
++{
++	struct fotg210_qh *prev;
++
++	/* Add to the end of the list of QHs waiting for the next IAAD */
++	qh->qh_state = QH_STATE_UNLINK;
++	if (fotg210->async_unlink)
++		fotg210->async_unlink_last->unlink_next = qh;
++	else
++		fotg210->async_unlink = qh;
++	fotg210->async_unlink_last = qh;
++
++	/* Unlink it from the schedule */
++	prev = fotg210->async;
++	while (prev->qh_next.qh != qh)
++		prev = prev->qh_next.qh;
++
++	prev->hw->hw_next = qh->hw->hw_next;
++	prev->qh_next = qh->qh_next;
++	if (fotg210->qh_scan_next == qh)
++		fotg210->qh_scan_next = qh->qh_next.qh;
++}
++
++static void start_iaa_cycle(struct fotg210_hcd *fotg210, bool nested)
++{
++	/*
++	 * Do nothing if an IAA cycle is already running or
++	 * if one will be started shortly.
++	 */
++	if (fotg210->async_iaa || fotg210->async_unlinking)
++		return;
++
++	/* Do all the waiting QHs at once */
++	fotg210->async_iaa = fotg210->async_unlink;
++	fotg210->async_unlink = NULL;
++
++	/* If the controller isn't running, we don't have to wait for it */
++	if (unlikely(fotg210->rh_state < FOTG210_RH_RUNNING)) {
++		if (!nested)		/* Avoid recursion */
++			end_unlink_async(fotg210);
++
++	/* Otherwise start a new IAA cycle */
++	} else if (likely(fotg210->rh_state == FOTG210_RH_RUNNING)) {
++		/* Make sure the unlinks are all visible to the hardware */
++		wmb();
++
++		fotg210_writel(fotg210, fotg210->command | CMD_IAAD,
++				&fotg210->regs->command);
++		fotg210_readl(fotg210, &fotg210->regs->command);
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_IAA_WATCHDOG,
++				true);
++	}
++}
++
++/* the async qh for the qtds being unlinked are now gone from the HC */
++
++static void end_unlink_async(struct fotg210_hcd *fotg210)
++{
++	struct fotg210_qh *qh;
++
++	/* Process the idle QHs */
++restart:
++	fotg210->async_unlinking = true;
++	while (fotg210->async_iaa) {
++		qh = fotg210->async_iaa;
++		fotg210->async_iaa = qh->unlink_next;
++		qh->unlink_next = NULL;
++
++		qh->qh_state = QH_STATE_IDLE;
++		qh->qh_next.qh = NULL;
++
++		qh_completions(fotg210, qh);
++		if (!list_empty(&qh->qtd_list) &&
++				fotg210->rh_state == FOTG210_RH_RUNNING)
++			qh_link_async(fotg210, qh);
++		disable_async(fotg210);
++	}
++	fotg210->async_unlinking = false;
++
++	/* Start a new IAA cycle if any QHs are waiting for it */
++	if (fotg210->async_unlink) {
++		start_iaa_cycle(fotg210, true);
++		if (unlikely(fotg210->rh_state < FOTG210_RH_RUNNING))
++			goto restart;
++	}
++}
++
++static void unlink_empty_async(struct fotg210_hcd *fotg210)
++{
++	struct fotg210_qh *qh, *next;
++	bool stopped = (fotg210->rh_state < FOTG210_RH_RUNNING);
++	bool check_unlinks_later = false;
++
++	/* Unlink all the async QHs that have been empty for a timer cycle */
++	next = fotg210->async->qh_next.qh;
++	while (next) {
++		qh = next;
++		next = qh->qh_next.qh;
++
++		if (list_empty(&qh->qtd_list) &&
++				qh->qh_state == QH_STATE_LINKED) {
++			if (!stopped && qh->unlink_cycle ==
++					fotg210->async_unlink_cycle)
++				check_unlinks_later = true;
++			else
++				single_unlink_async(fotg210, qh);
++		}
++	}
++
++	/* Start a new IAA cycle if any QHs are waiting for it */
++	if (fotg210->async_unlink)
++		start_iaa_cycle(fotg210, false);
++
++	/* QHs that haven't been empty for long enough will be handled later */
++	if (check_unlinks_later) {
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_ASYNC_UNLINKS,
++				true);
++		++fotg210->async_unlink_cycle;
++	}
++}
++
++/* makes sure the async qh will become idle */
++/* caller must own fotg210->lock */
++
++static void start_unlink_async(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh)
++{
++	/*
++	 * If the QH isn't linked then there's nothing we can do
++	 * unless we were called during a giveback, in which case
++	 * qh_completions() has to deal with it.
++	 */
++	if (qh->qh_state != QH_STATE_LINKED) {
++		if (qh->qh_state == QH_STATE_COMPLETING)
++			qh->needs_rescan = 1;
++		return;
++	}
++
++	single_unlink_async(fotg210, qh);
++	start_iaa_cycle(fotg210, false);
++}
++
++static void scan_async(struct fotg210_hcd *fotg210)
++{
++	struct fotg210_qh *qh;
++	bool check_unlinks_later = false;
++
++	fotg210->qh_scan_next = fotg210->async->qh_next.qh;
++	while (fotg210->qh_scan_next) {
++		qh = fotg210->qh_scan_next;
++		fotg210->qh_scan_next = qh->qh_next.qh;
++rescan:
++		/* clean any finished work for this qh */
++		if (!list_empty(&qh->qtd_list)) {
++			int temp;
++
++			/*
++			 * Unlinks could happen here; completion reporting
++			 * drops the lock.  That's why fotg210->qh_scan_next
++			 * always holds the next qh to scan; if the next qh
++			 * gets unlinked then fotg210->qh_scan_next is adjusted
++			 * in single_unlink_async().
++			 */
++			temp = qh_completions(fotg210, qh);
++			if (qh->needs_rescan) {
++				start_unlink_async(fotg210, qh);
++			} else if (list_empty(&qh->qtd_list)
++					&& qh->qh_state == QH_STATE_LINKED) {
++				qh->unlink_cycle = fotg210->async_unlink_cycle;
++				check_unlinks_later = true;
++			} else if (temp != 0)
++				goto rescan;
++		}
++	}
++
++	/*
++	 * Unlink empty entries, reducing DMA usage as well
++	 * as HCD schedule-scanning costs.  Delay for any qh
++	 * we just scanned, there's a not-unusual case that it
++	 * doesn't stay idle for long.
++	 */
++	if (check_unlinks_later && fotg210->rh_state == FOTG210_RH_RUNNING &&
++			!(fotg210->enabled_hrtimer_events &
++			BIT(FOTG210_HRTIMER_ASYNC_UNLINKS))) {
++		fotg210_enable_event(fotg210,
++				FOTG210_HRTIMER_ASYNC_UNLINKS, true);
++		++fotg210->async_unlink_cycle;
++	}
++}
++/* EHCI scheduled transaction support:  interrupt, iso, split iso
++ * These are called "periodic" transactions in the EHCI spec.
++ *
++ * Note that for interrupt transfers, the QH/QTD manipulation is shared
++ * with the "asynchronous" transaction support (control/bulk transfers).
++ * The only real difference is in how interrupt transfers are scheduled.
++ *
++ * For ISO, we make an "iso_stream" head to serve the same role as a QH.
++ * It keeps track of every ITD (or SITD) that's linked, and holds enough
++ * pre-calculated schedule data to make appending to the queue be quick.
++ */
++static int fotg210_get_frame(struct usb_hcd *hcd);
++
++/* periodic_next_shadow - return "next" pointer on shadow list
++ * @periodic: host pointer to qh/itd
++ * @tag: hardware tag for type of this record
++ */
++static union fotg210_shadow *periodic_next_shadow(struct fotg210_hcd *fotg210,
++		union fotg210_shadow *periodic, __hc32 tag)
++{
++	switch (hc32_to_cpu(fotg210, tag)) {
++	case Q_TYPE_QH:
++		return &periodic->qh->qh_next;
++	case Q_TYPE_FSTN:
++		return &periodic->fstn->fstn_next;
++	default:
++		return &periodic->itd->itd_next;
++	}
++}
++
++static __hc32 *shadow_next_periodic(struct fotg210_hcd *fotg210,
++		union fotg210_shadow *periodic, __hc32 tag)
++{
++	switch (hc32_to_cpu(fotg210, tag)) {
++	/* our fotg210_shadow.qh is actually software part */
++	case Q_TYPE_QH:
++		return &periodic->qh->hw->hw_next;
++	/* others are hw parts */
++	default:
++		return periodic->hw_next;
++	}
++}
++
++/* caller must hold fotg210->lock */
++static void periodic_unlink(struct fotg210_hcd *fotg210, unsigned frame,
++		void *ptr)
++{
++	union fotg210_shadow *prev_p = &fotg210->pshadow[frame];
++	__hc32 *hw_p = &fotg210->periodic[frame];
++	union fotg210_shadow here = *prev_p;
++
++	/* find predecessor of "ptr"; hw and shadow lists are in sync */
++	while (here.ptr && here.ptr != ptr) {
++		prev_p = periodic_next_shadow(fotg210, prev_p,
++				Q_NEXT_TYPE(fotg210, *hw_p));
++		hw_p = shadow_next_periodic(fotg210, &here,
++				Q_NEXT_TYPE(fotg210, *hw_p));
++		here = *prev_p;
++	}
++	/* an interrupt entry (at list end) could have been shared */
++	if (!here.ptr)
++		return;
++
++	/* update shadow and hardware lists ... the old "next" pointers
++	 * from ptr may still be in use, the caller updates them.
++	 */
++	*prev_p = *periodic_next_shadow(fotg210, &here,
++			Q_NEXT_TYPE(fotg210, *hw_p));
++
++	*hw_p = *shadow_next_periodic(fotg210, &here,
++			Q_NEXT_TYPE(fotg210, *hw_p));
++}
++
++/* how many of the uframe's 125 usecs are allocated? */
++static unsigned short periodic_usecs(struct fotg210_hcd *fotg210,
++		unsigned frame, unsigned uframe)
++{
++	__hc32 *hw_p = &fotg210->periodic[frame];
++	union fotg210_shadow *q = &fotg210->pshadow[frame];
++	unsigned usecs = 0;
++	struct fotg210_qh_hw *hw;
++
++	while (q->ptr) {
++		switch (hc32_to_cpu(fotg210, Q_NEXT_TYPE(fotg210, *hw_p))) {
++		case Q_TYPE_QH:
++			hw = q->qh->hw;
++			/* is it in the S-mask? */
++			if (hw->hw_info2 & cpu_to_hc32(fotg210, 1 << uframe))
++				usecs += q->qh->usecs;
++			/* ... or C-mask? */
++			if (hw->hw_info2 & cpu_to_hc32(fotg210,
++					1 << (8 + uframe)))
++				usecs += q->qh->c_usecs;
++			hw_p = &hw->hw_next;
++			q = &q->qh->qh_next;
++			break;
++		/* case Q_TYPE_FSTN: */
++		default:
++			/* for "save place" FSTNs, count the relevant INTR
++			 * bandwidth from the previous frame
++			 */
++			if (q->fstn->hw_prev != FOTG210_LIST_END(fotg210))
++				fotg210_dbg(fotg210, "ignoring FSTN cost ...\n");
++
++			hw_p = &q->fstn->hw_next;
++			q = &q->fstn->fstn_next;
++			break;
++		case Q_TYPE_ITD:
++			if (q->itd->hw_transaction[uframe])
++				usecs += q->itd->stream->usecs;
++			hw_p = &q->itd->hw_next;
++			q = &q->itd->itd_next;
++			break;
++		}
++	}
++	if (usecs > fotg210->uframe_periodic_max)
++		fotg210_err(fotg210, "uframe %d sched overrun: %d usecs\n",
++				frame * 8 + uframe, usecs);
++	return usecs;
++}
++
++static int same_tt(struct usb_device *dev1, struct usb_device *dev2)
++{
++	if (!dev1->tt || !dev2->tt)
++		return 0;
++	if (dev1->tt != dev2->tt)
++		return 0;
++	if (dev1->tt->multi)
++		return dev1->ttport == dev2->ttport;
++	else
++		return 1;
++}
++
++/* return true iff the device's transaction translator is available
++ * for a periodic transfer starting at the specified frame, using
++ * all the uframes in the mask.
++ */
++static int tt_no_collision(struct fotg210_hcd *fotg210, unsigned period,
++		struct usb_device *dev, unsigned frame, u32 uf_mask)
++{
++	if (period == 0)	/* error */
++		return 0;
++
++	/* note bandwidth wastage:  split never follows csplit
++	 * (different dev or endpoint) until the next uframe.
++	 * calling convention doesn't make that distinction.
++	 */
++	for (; frame < fotg210->periodic_size; frame += period) {
++		union fotg210_shadow here;
++		__hc32 type;
++		struct fotg210_qh_hw *hw;
++
++		here = fotg210->pshadow[frame];
++		type = Q_NEXT_TYPE(fotg210, fotg210->periodic[frame]);
++		while (here.ptr) {
++			switch (hc32_to_cpu(fotg210, type)) {
++			case Q_TYPE_ITD:
++				type = Q_NEXT_TYPE(fotg210, here.itd->hw_next);
++				here = here.itd->itd_next;
++				continue;
++			case Q_TYPE_QH:
++				hw = here.qh->hw;
++				if (same_tt(dev, here.qh->dev)) {
++					u32 mask;
++
++					mask = hc32_to_cpu(fotg210,
++							hw->hw_info2);
++					/* "knows" no gap is needed */
++					mask |= mask >> 8;
++					if (mask & uf_mask)
++						break;
++				}
++				type = Q_NEXT_TYPE(fotg210, hw->hw_next);
++				here = here.qh->qh_next;
++				continue;
++			/* case Q_TYPE_FSTN: */
++			default:
++				fotg210_dbg(fotg210,
++						"periodic frame %d bogus type %d\n",
++						frame, type);
++			}
++
++			/* collision or error */
++			return 0;
++		}
++	}
++
++	/* no collision */
++	return 1;
++}
++
++static void enable_periodic(struct fotg210_hcd *fotg210)
++{
++	if (fotg210->periodic_count++)
++		return;
++
++	/* Stop waiting to turn off the periodic schedule */
++	fotg210->enabled_hrtimer_events &=
++		~BIT(FOTG210_HRTIMER_DISABLE_PERIODIC);
++
++	/* Don't start the schedule until PSS is 0 */
++	fotg210_poll_PSS(fotg210);
++	turn_on_io_watchdog(fotg210);
++}
++
++static void disable_periodic(struct fotg210_hcd *fotg210)
++{
++	if (--fotg210->periodic_count)
++		return;
++
++	/* Don't turn off the schedule until PSS is 1 */
++	fotg210_poll_PSS(fotg210);
++}
++
++/* periodic schedule slots have iso tds (normal or split) first, then a
++ * sparse tree for active interrupt transfers.
++ *
++ * this just links in a qh; caller guarantees uframe masks are set right.
++ * no FSTN support (yet; fotg210 0.96+)
++ */
++static void qh_link_periodic(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	unsigned i;
++	unsigned period = qh->period;
++
++	dev_dbg(&qh->dev->dev,
++			"link qh%d-%04x/%p start %d [%d/%d us]\n", period,
++			hc32_to_cpup(fotg210, &qh->hw->hw_info2) &
++			(QH_CMASK | QH_SMASK), qh, qh->start, qh->usecs,
++			qh->c_usecs);
++
++	/* high bandwidth, or otherwise every microframe */
++	if (period == 0)
++		period = 1;
++
++	for (i = qh->start; i < fotg210->periodic_size; i += period) {
++		union fotg210_shadow *prev = &fotg210->pshadow[i];
++		__hc32 *hw_p = &fotg210->periodic[i];
++		union fotg210_shadow here = *prev;
++		__hc32 type = 0;
++
++		/* skip the iso nodes at list head */
++		while (here.ptr) {
++			type = Q_NEXT_TYPE(fotg210, *hw_p);
++			if (type == cpu_to_hc32(fotg210, Q_TYPE_QH))
++				break;
++			prev = periodic_next_shadow(fotg210, prev, type);
++			hw_p = shadow_next_periodic(fotg210, &here, type);
++			here = *prev;
++		}
++
++		/* sorting each branch by period (slow-->fast)
++		 * enables sharing interior tree nodes
++		 */
++		while (here.ptr && qh != here.qh) {
++			if (qh->period > here.qh->period)
++				break;
++			prev = &here.qh->qh_next;
++			hw_p = &here.qh->hw->hw_next;
++			here = *prev;
++		}
++		/* link in this qh, unless some earlier pass did that */
++		if (qh != here.qh) {
++			qh->qh_next = here;
++			if (here.qh)
++				qh->hw->hw_next = *hw_p;
++			wmb();
++			prev->qh = qh;
++			*hw_p = QH_NEXT(fotg210, qh->qh_dma);
++		}
++	}
++	qh->qh_state = QH_STATE_LINKED;
++	qh->xacterrs = 0;
++
++	/* update per-qh bandwidth for usbfs */
++	fotg210_to_hcd(fotg210)->self.bandwidth_allocated += qh->period
++		? ((qh->usecs + qh->c_usecs) / qh->period)
++		: (qh->usecs * 8);
++
++	list_add(&qh->intr_node, &fotg210->intr_qh_list);
++
++	/* maybe enable periodic schedule processing */
++	++fotg210->intr_count;
++	enable_periodic(fotg210);
++}
++
++static void qh_unlink_periodic(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh)
++{
++	unsigned i;
++	unsigned period;
++
++	/*
++	 * If qh is for a low/full-speed device, simply unlinking it
++	 * could interfere with an ongoing split transaction.  To unlink
++	 * it safely would require setting the QH_INACTIVATE bit and
++	 * waiting at least one frame, as described in EHCI 4.12.2.5.
++	 *
++	 * We won't bother with any of this.  Instead, we assume that the
++	 * only reason for unlinking an interrupt QH while the current URB
++	 * is still active is to dequeue all the URBs (flush the whole
++	 * endpoint queue).
++	 *
++	 * If rebalancing the periodic schedule is ever implemented, this
++	 * approach will no longer be valid.
++	 */
++
++	/* high bandwidth, or otherwise part of every microframe */
++	period = qh->period;
++	if (!period)
++		period = 1;
++
++	for (i = qh->start; i < fotg210->periodic_size; i += period)
++		periodic_unlink(fotg210, i, qh);
++
++	/* update per-qh bandwidth for usbfs */
++	fotg210_to_hcd(fotg210)->self.bandwidth_allocated -= qh->period
++		? ((qh->usecs + qh->c_usecs) / qh->period)
++		: (qh->usecs * 8);
++
++	dev_dbg(&qh->dev->dev,
++			"unlink qh%d-%04x/%p start %d [%d/%d us]\n",
++			qh->period, hc32_to_cpup(fotg210, &qh->hw->hw_info2) &
++			(QH_CMASK | QH_SMASK), qh, qh->start, qh->usecs,
++			qh->c_usecs);
++
++	/* qh->qh_next still "live" to HC */
++	qh->qh_state = QH_STATE_UNLINK;
++	qh->qh_next.ptr = NULL;
++
++	if (fotg210->qh_scan_next == qh)
++		fotg210->qh_scan_next = list_entry(qh->intr_node.next,
++				struct fotg210_qh, intr_node);
++	list_del(&qh->intr_node);
++}
++
++static void start_unlink_intr(struct fotg210_hcd *fotg210,
++		struct fotg210_qh *qh)
++{
++	/* If the QH isn't linked then there's nothing we can do
++	 * unless we were called during a giveback, in which case
++	 * qh_completions() has to deal with it.
++	 */
++	if (qh->qh_state != QH_STATE_LINKED) {
++		if (qh->qh_state == QH_STATE_COMPLETING)
++			qh->needs_rescan = 1;
++		return;
++	}
++
++	qh_unlink_periodic(fotg210, qh);
++
++	/* Make sure the unlinks are visible before starting the timer */
++	wmb();
++
++	/*
++	 * The EHCI spec doesn't say how long it takes the controller to
++	 * stop accessing an unlinked interrupt QH.  The timer delay is
++	 * 9 uframes; presumably that will be long enough.
++	 */
++	qh->unlink_cycle = fotg210->intr_unlink_cycle;
++
++	/* New entries go at the end of the intr_unlink list */
++	if (fotg210->intr_unlink)
++		fotg210->intr_unlink_last->unlink_next = qh;
++	else
++		fotg210->intr_unlink = qh;
++	fotg210->intr_unlink_last = qh;
++
++	if (fotg210->intr_unlinking)
++		;	/* Avoid recursive calls */
++	else if (fotg210->rh_state < FOTG210_RH_RUNNING)
++		fotg210_handle_intr_unlinks(fotg210);
++	else if (fotg210->intr_unlink == qh) {
++		fotg210_enable_event(fotg210, FOTG210_HRTIMER_UNLINK_INTR,
++				true);
++		++fotg210->intr_unlink_cycle;
++	}
++}
++
++static void end_unlink_intr(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	struct fotg210_qh_hw *hw = qh->hw;
++	int rc;
++
++	qh->qh_state = QH_STATE_IDLE;
++	hw->hw_next = FOTG210_LIST_END(fotg210);
++
++	qh_completions(fotg210, qh);
++
++	/* reschedule QH iff another request is queued */
++	if (!list_empty(&qh->qtd_list) &&
++			fotg210->rh_state == FOTG210_RH_RUNNING) {
++		rc = qh_schedule(fotg210, qh);
++
++		/* An error here likely indicates handshake failure
++		 * or no space left in the schedule.  Neither fault
++		 * should happen often ...
++		 *
++		 * FIXME kill the now-dysfunctional queued urbs
++		 */
++		if (rc != 0)
++			fotg210_err(fotg210, "can't reschedule qh %p, err %d\n",
++					qh, rc);
++	}
++
++	/* maybe turn off periodic schedule */
++	--fotg210->intr_count;
++	disable_periodic(fotg210);
++}
++
++static int check_period(struct fotg210_hcd *fotg210, unsigned frame,
++		unsigned uframe, unsigned period, unsigned usecs)
++{
++	int claimed;
++
++	/* complete split running into next frame?
++	 * given FSTN support, we could sometimes check...
++	 */
++	if (uframe >= 8)
++		return 0;
++
++	/* convert "usecs we need" to "max already claimed" */
++	usecs = fotg210->uframe_periodic_max - usecs;
++
++	/* we "know" 2 and 4 uframe intervals were rejected; so
++	 * for period 0, check _every_ microframe in the schedule.
++	 */
++	if (unlikely(period == 0)) {
++		do {
++			for (uframe = 0; uframe < 7; uframe++) {
++				claimed = periodic_usecs(fotg210, frame,
++						uframe);
++				if (claimed > usecs)
++					return 0;
++			}
++		} while ((frame += 1) < fotg210->periodic_size);
++
++	/* just check the specified uframe, at that period */
++	} else {
++		do {
++			claimed = periodic_usecs(fotg210, frame, uframe);
++			if (claimed > usecs)
++				return 0;
++		} while ((frame += period) < fotg210->periodic_size);
++	}
++
++	/* success! */
++	return 1;
++}
++
++static int check_intr_schedule(struct fotg210_hcd *fotg210, unsigned frame,
++		unsigned uframe, const struct fotg210_qh *qh, __hc32 *c_maskp)
++{
++	int retval = -ENOSPC;
++	u8 mask = 0;
++
++	if (qh->c_usecs && uframe >= 6)		/* FSTN territory? */
++		goto done;
++
++	if (!check_period(fotg210, frame, uframe, qh->period, qh->usecs))
++		goto done;
++	if (!qh->c_usecs) {
++		retval = 0;
++		*c_maskp = 0;
++		goto done;
++	}
++
++	/* Make sure this tt's buffer is also available for CSPLITs.
++	 * We pessimize a bit; probably the typical full speed case
++	 * doesn't need the second CSPLIT.
++	 *
++	 * NOTE:  both SPLIT and CSPLIT could be checked in just
++	 * one smart pass...
++	 */
++	mask = 0x03 << (uframe + qh->gap_uf);
++	*c_maskp = cpu_to_hc32(fotg210, mask << 8);
++
++	mask |= 1 << uframe;
++	if (tt_no_collision(fotg210, qh->period, qh->dev, frame, mask)) {
++		if (!check_period(fotg210, frame, uframe + qh->gap_uf + 1,
++				qh->period, qh->c_usecs))
++			goto done;
++		if (!check_period(fotg210, frame, uframe + qh->gap_uf,
++				qh->period, qh->c_usecs))
++			goto done;
++		retval = 0;
++	}
++done:
++	return retval;
++}
++
++/* "first fit" scheduling policy used the first time through,
++ * or when the previous schedule slot can't be re-used.
++ */
++static int qh_schedule(struct fotg210_hcd *fotg210, struct fotg210_qh *qh)
++{
++	int status;
++	unsigned uframe;
++	__hc32 c_mask;
++	unsigned frame;	/* 0..(qh->period - 1), or NO_FRAME */
++	struct fotg210_qh_hw *hw = qh->hw;
++
++	qh_refresh(fotg210, qh);
++	hw->hw_next = FOTG210_LIST_END(fotg210);
++	frame = qh->start;
++
++	/* reuse the previous schedule slots, if we can */
++	if (frame < qh->period) {
++		uframe = ffs(hc32_to_cpup(fotg210, &hw->hw_info2) & QH_SMASK);
++		status = check_intr_schedule(fotg210, frame, --uframe,
++				qh, &c_mask);
++	} else {
++		uframe = 0;
++		c_mask = 0;
++		status = -ENOSPC;
++	}
++
++	/* else scan the schedule to find a group of slots such that all
++	 * uframes have enough periodic bandwidth available.
++	 */
++	if (status) {
++		/* "normal" case, uframing flexible except with splits */
++		if (qh->period) {
++			int i;
++
++			for (i = qh->period; status && i > 0; --i) {
++				frame = ++fotg210->random_frame % qh->period;
++				for (uframe = 0; uframe < 8; uframe++) {
++					status = check_intr_schedule(fotg210,
++							frame, uframe, qh,
++							&c_mask);
++					if (status == 0)
++						break;
++				}
++			}
++
++		/* qh->period == 0 means every uframe */
++		} else {
++			frame = 0;
++			status = check_intr_schedule(fotg210, 0, 0, qh,
++					&c_mask);
++		}
++		if (status)
++			goto done;
++		qh->start = frame;
++
++		/* reset S-frame and (maybe) C-frame masks */
++		hw->hw_info2 &= cpu_to_hc32(fotg210, ~(QH_CMASK | QH_SMASK));
++		hw->hw_info2 |= qh->period
++			? cpu_to_hc32(fotg210, 1 << uframe)
++			: cpu_to_hc32(fotg210, QH_SMASK);
++		hw->hw_info2 |= c_mask;
++	} else
++		fotg210_dbg(fotg210, "reused qh %p schedule\n", qh);
++
++	/* stuff into the periodic schedule */
++	qh_link_periodic(fotg210, qh);
++done:
++	return status;
++}
++
++static int intr_submit(struct fotg210_hcd *fotg210, struct urb *urb,
++		struct list_head *qtd_list, gfp_t mem_flags)
++{
++	unsigned epnum;
++	unsigned long flags;
++	struct fotg210_qh *qh;
++	int status;
++	struct list_head empty;
++
++	/* get endpoint and transfer/schedule data */
++	epnum = urb->ep->desc.bEndpointAddress;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
++		status = -ESHUTDOWN;
++		goto done_not_linked;
++	}
++	status = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
++	if (unlikely(status))
++		goto done_not_linked;
++
++	/* get qh and force any scheduling errors */
++	INIT_LIST_HEAD(&empty);
++	qh = qh_append_tds(fotg210, urb, &empty, epnum, &urb->ep->hcpriv);
++	if (qh == NULL) {
++		status = -ENOMEM;
++		goto done;
++	}
++	if (qh->qh_state == QH_STATE_IDLE) {
++		status = qh_schedule(fotg210, qh);
++		if (status)
++			goto done;
++	}
++
++	/* then queue the urb's tds to the qh */
++	qh = qh_append_tds(fotg210, urb, qtd_list, epnum, &urb->ep->hcpriv);
++	BUG_ON(qh == NULL);
++
++	/* ... update usbfs periodic stats */
++	fotg210_to_hcd(fotg210)->self.bandwidth_int_reqs++;
++
++done:
++	if (unlikely(status))
++		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
++done_not_linked:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	if (status)
++		qtd_list_free(fotg210, urb, qtd_list);
++
++	return status;
++}
++
++static void scan_intr(struct fotg210_hcd *fotg210)
++{
++	struct fotg210_qh *qh;
++
++	list_for_each_entry_safe(qh, fotg210->qh_scan_next,
++			&fotg210->intr_qh_list, intr_node) {
++rescan:
++		/* clean any finished work for this qh */
++		if (!list_empty(&qh->qtd_list)) {
++			int temp;
++
++			/*
++			 * Unlinks could happen here; completion reporting
++			 * drops the lock.  That's why fotg210->qh_scan_next
++			 * always holds the next qh to scan; if the next qh
++			 * gets unlinked then fotg210->qh_scan_next is adjusted
++			 * in qh_unlink_periodic().
++			 */
++			temp = qh_completions(fotg210, qh);
++			if (unlikely(qh->needs_rescan ||
++					(list_empty(&qh->qtd_list) &&
++					qh->qh_state == QH_STATE_LINKED)))
++				start_unlink_intr(fotg210, qh);
++			else if (temp != 0)
++				goto rescan;
++		}
++	}
++}
++
++/* fotg210_iso_stream ops work with both ITD and SITD */
++
++static struct fotg210_iso_stream *iso_stream_alloc(gfp_t mem_flags)
++{
++	struct fotg210_iso_stream *stream;
++
++	stream = kzalloc(sizeof(*stream), mem_flags);
++	if (likely(stream != NULL)) {
++		INIT_LIST_HEAD(&stream->td_list);
++		INIT_LIST_HEAD(&stream->free_list);
++		stream->next_uframe = -1;
++	}
++	return stream;
++}
++
++static void iso_stream_init(struct fotg210_hcd *fotg210,
++		struct fotg210_iso_stream *stream, struct usb_device *dev,
++		int pipe, unsigned interval)
++{
++	u32 buf1;
++	unsigned epnum, maxp;
++	int is_input;
++	long bandwidth;
++	unsigned multi;
++	struct usb_host_endpoint *ep;
++
++	/*
++	 * this might be a "high bandwidth" highspeed endpoint,
++	 * as encoded in the ep descriptor's wMaxPacket field
++	 */
++	epnum = usb_pipeendpoint(pipe);
++	is_input = usb_pipein(pipe) ? USB_DIR_IN : 0;
++	ep = usb_pipe_endpoint(dev, pipe);
++	maxp = usb_endpoint_maxp(&ep->desc);
++	if (is_input)
++		buf1 = (1 << 11);
++	else
++		buf1 = 0;
++
++	multi = usb_endpoint_maxp_mult(&ep->desc);
++	buf1 |= maxp;
++	maxp *= multi;
++
++	stream->buf0 = cpu_to_hc32(fotg210, (epnum << 8) | dev->devnum);
++	stream->buf1 = cpu_to_hc32(fotg210, buf1);
++	stream->buf2 = cpu_to_hc32(fotg210, multi);
++
++	/* usbfs wants to report the average usecs per frame tied up
++	 * when transfers on this endpoint are scheduled ...
++	 */
++	if (dev->speed == USB_SPEED_FULL) {
++		interval <<= 3;
++		stream->usecs = NS_TO_US(usb_calc_bus_time(dev->speed,
++				is_input, 1, maxp));
++		stream->usecs /= 8;
++	} else {
++		stream->highspeed = 1;
++		stream->usecs = HS_USECS_ISO(maxp);
++	}
++	bandwidth = stream->usecs * 8;
++	bandwidth /= interval;
++
++	stream->bandwidth = bandwidth;
++	stream->udev = dev;
++	stream->bEndpointAddress = is_input | epnum;
++	stream->interval = interval;
++	stream->maxp = maxp;
++}
++
++static struct fotg210_iso_stream *iso_stream_find(struct fotg210_hcd *fotg210,
++		struct urb *urb)
++{
++	unsigned epnum;
++	struct fotg210_iso_stream *stream;
++	struct usb_host_endpoint *ep;
++	unsigned long flags;
++
++	epnum = usb_pipeendpoint(urb->pipe);
++	if (usb_pipein(urb->pipe))
++		ep = urb->dev->ep_in[epnum];
++	else
++		ep = urb->dev->ep_out[epnum];
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	stream = ep->hcpriv;
++
++	if (unlikely(stream == NULL)) {
++		stream = iso_stream_alloc(GFP_ATOMIC);
++		if (likely(stream != NULL)) {
++			ep->hcpriv = stream;
++			stream->ep = ep;
++			iso_stream_init(fotg210, stream, urb->dev, urb->pipe,
++					urb->interval);
++		}
++
++	/* if dev->ep[epnum] is a QH, hw is set */
++	} else if (unlikely(stream->hw != NULL)) {
++		fotg210_dbg(fotg210, "dev %s ep%d%s, not iso??\n",
++				urb->dev->devpath, epnum,
++				usb_pipein(urb->pipe) ? "in" : "out");
++		stream = NULL;
++	}
++
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return stream;
++}
++
++/* fotg210_iso_sched ops can be ITD-only or SITD-only */
++
++static struct fotg210_iso_sched *iso_sched_alloc(unsigned packets,
++		gfp_t mem_flags)
++{
++	struct fotg210_iso_sched *iso_sched;
++
++	iso_sched = kzalloc(struct_size(iso_sched, packet, packets), mem_flags);
++	if (likely(iso_sched != NULL))
++		INIT_LIST_HEAD(&iso_sched->td_list);
++
++	return iso_sched;
++}
++
++static inline void itd_sched_init(struct fotg210_hcd *fotg210,
++		struct fotg210_iso_sched *iso_sched,
++		struct fotg210_iso_stream *stream, struct urb *urb)
++{
++	unsigned i;
++	dma_addr_t dma = urb->transfer_dma;
++
++	/* how many uframes are needed for these transfers */
++	iso_sched->span = urb->number_of_packets * stream->interval;
++
++	/* figure out per-uframe itd fields that we'll need later
++	 * when we fit new itds into the schedule.
++	 */
++	for (i = 0; i < urb->number_of_packets; i++) {
++		struct fotg210_iso_packet *uframe = &iso_sched->packet[i];
++		unsigned length;
++		dma_addr_t buf;
++		u32 trans;
++
++		length = urb->iso_frame_desc[i].length;
++		buf = dma + urb->iso_frame_desc[i].offset;
++
++		trans = FOTG210_ISOC_ACTIVE;
++		trans |= buf & 0x0fff;
++		if (unlikely(((i + 1) == urb->number_of_packets))
++				&& !(urb->transfer_flags & URB_NO_INTERRUPT))
++			trans |= FOTG210_ITD_IOC;
++		trans |= length << 16;
++		uframe->transaction = cpu_to_hc32(fotg210, trans);
++
++		/* might need to cross a buffer page within a uframe */
++		uframe->bufp = (buf & ~(u64)0x0fff);
++		buf += length;
++		if (unlikely((uframe->bufp != (buf & ~(u64)0x0fff))))
++			uframe->cross = 1;
++	}
++}
++
++static void iso_sched_free(struct fotg210_iso_stream *stream,
++		struct fotg210_iso_sched *iso_sched)
++{
++	if (!iso_sched)
++		return;
++	/* caller must hold fotg210->lock!*/
++	list_splice(&iso_sched->td_list, &stream->free_list);
++	kfree(iso_sched);
++}
++
++static int itd_urb_transaction(struct fotg210_iso_stream *stream,
++		struct fotg210_hcd *fotg210, struct urb *urb, gfp_t mem_flags)
++{
++	struct fotg210_itd *itd;
++	dma_addr_t itd_dma;
++	int i;
++	unsigned num_itds;
++	struct fotg210_iso_sched *sched;
++	unsigned long flags;
++
++	sched = iso_sched_alloc(urb->number_of_packets, mem_flags);
++	if (unlikely(sched == NULL))
++		return -ENOMEM;
++
++	itd_sched_init(fotg210, sched, stream, urb);
++
++	if (urb->interval < 8)
++		num_itds = 1 + (sched->span + 7) / 8;
++	else
++		num_itds = urb->number_of_packets;
++
++	/* allocate/init ITDs */
++	spin_lock_irqsave(&fotg210->lock, flags);
++	for (i = 0; i < num_itds; i++) {
++
++		/*
++		 * Use iTDs from the free list, but not iTDs that may
++		 * still be in use by the hardware.
++		 */
++		if (likely(!list_empty(&stream->free_list))) {
++			itd = list_first_entry(&stream->free_list,
++					struct fotg210_itd, itd_list);
++			if (itd->frame == fotg210->now_frame)
++				goto alloc_itd;
++			list_del(&itd->itd_list);
++			itd_dma = itd->itd_dma;
++		} else {
++alloc_itd:
++			spin_unlock_irqrestore(&fotg210->lock, flags);
++			itd = dma_pool_alloc(fotg210->itd_pool, mem_flags,
++					&itd_dma);
++			spin_lock_irqsave(&fotg210->lock, flags);
++			if (!itd) {
++				iso_sched_free(stream, sched);
++				spin_unlock_irqrestore(&fotg210->lock, flags);
++				return -ENOMEM;
++			}
++		}
++
++		memset(itd, 0, sizeof(*itd));
++		itd->itd_dma = itd_dma;
++		list_add(&itd->itd_list, &sched->td_list);
++	}
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++
++	/* temporarily store schedule info in hcpriv */
++	urb->hcpriv = sched;
++	urb->error_count = 0;
++	return 0;
++}
++
++static inline int itd_slot_ok(struct fotg210_hcd *fotg210, u32 mod, u32 uframe,
++		u8 usecs, u32 period)
++{
++	uframe %= period;
++	do {
++		/* can't commit more than uframe_periodic_max usec */
++		if (periodic_usecs(fotg210, uframe >> 3, uframe & 0x7)
++				> (fotg210->uframe_periodic_max - usecs))
++			return 0;
++
++		/* we know urb->interval is 2^N uframes */
++		uframe += period;
++	} while (uframe < mod);
++	return 1;
++}
++
++/* This scheduler plans almost as far into the future as it has actual
++ * periodic schedule slots.  (Affected by TUNE_FLS, which defaults to
++ * "as small as possible" to be cache-friendlier.)  That limits the size
++ * transfers you can stream reliably; avoid more than 64 msec per urb.
++ * Also avoid queue depths of less than fotg210's worst irq latency (affected
++ * by the per-urb URB_NO_INTERRUPT hint, the log2_irq_thresh module parameter,
++ * and other factors); or more than about 230 msec total (for portability,
++ * given FOTG210_TUNE_FLS and the slop).  Or, write a smarter scheduler!
++ */
++
++#define SCHEDULE_SLOP 80 /* microframes */
++
++static int iso_stream_schedule(struct fotg210_hcd *fotg210, struct urb *urb,
++		struct fotg210_iso_stream *stream)
++{
++	u32 now, next, start, period, span;
++	int status;
++	unsigned mod = fotg210->periodic_size << 3;
++	struct fotg210_iso_sched *sched = urb->hcpriv;
++
++	period = urb->interval;
++	span = sched->span;
++
++	if (span > mod - SCHEDULE_SLOP) {
++		fotg210_dbg(fotg210, "iso request %p too long\n", urb);
++		status = -EFBIG;
++		goto fail;
++	}
++
++	now = fotg210_read_frame_index(fotg210) & (mod - 1);
++
++	/* Typical case: reuse current schedule, stream is still active.
++	 * Hopefully there are no gaps from the host falling behind
++	 * (irq delays etc), but if there are we'll take the next
++	 * slot in the schedule, implicitly assuming URB_ISO_ASAP.
++	 */
++	if (likely(!list_empty(&stream->td_list))) {
++		u32 excess;
++
++		/* For high speed devices, allow scheduling within the
++		 * isochronous scheduling threshold.  For full speed devices
++		 * and Intel PCI-based controllers, don't (work around for
++		 * Intel ICH9 bug).
++		 */
++		if (!stream->highspeed && fotg210->fs_i_thresh)
++			next = now + fotg210->i_thresh;
++		else
++			next = now;
++
++		/* Fell behind (by up to twice the slop amount)?
++		 * We decide based on the time of the last currently-scheduled
++		 * slot, not the time of the next available slot.
++		 */
++		excess = (stream->next_uframe - period - next) & (mod - 1);
++		if (excess >= mod - 2 * SCHEDULE_SLOP)
++			start = next + excess - mod + period *
++					DIV_ROUND_UP(mod - excess, period);
++		else
++			start = next + excess + period;
++		if (start - now >= mod) {
++			fotg210_dbg(fotg210, "request %p would overflow (%d+%d >= %d)\n",
++					urb, start - now - period, period,
++					mod);
++			status = -EFBIG;
++			goto fail;
++		}
++	}
++
++	/* need to schedule; when's the next (u)frame we could start?
++	 * this is bigger than fotg210->i_thresh allows; scheduling itself
++	 * isn't free, the slop should handle reasonably slow cpus.  it
++	 * can also help high bandwidth if the dma and irq loads don't
++	 * jump until after the queue is primed.
++	 */
++	else {
++		int done = 0;
++
++		start = SCHEDULE_SLOP + (now & ~0x07);
++
++		/* NOTE:  assumes URB_ISO_ASAP, to limit complexity/bugs */
++
++		/* find a uframe slot with enough bandwidth.
++		 * Early uframes are more precious because full-speed
++		 * iso IN transfers can't use late uframes,
++		 * and therefore they should be allocated last.
++		 */
++		next = start;
++		start += period;
++		do {
++			start--;
++			/* check schedule: enough space? */
++			if (itd_slot_ok(fotg210, mod, start,
++					stream->usecs, period))
++				done = 1;
++		} while (start > next && !done);
++
++		/* no room in the schedule */
++		if (!done) {
++			fotg210_dbg(fotg210, "iso resched full %p (now %d max %d)\n",
++					urb, now, now + mod);
++			status = -ENOSPC;
++			goto fail;
++		}
++	}
++
++	/* Tried to schedule too far into the future? */
++	if (unlikely(start - now + span - period >=
++			mod - 2 * SCHEDULE_SLOP)) {
++		fotg210_dbg(fotg210, "request %p would overflow (%d+%d >= %d)\n",
++				urb, start - now, span - period,
++				mod - 2 * SCHEDULE_SLOP);
++		status = -EFBIG;
++		goto fail;
++	}
++
++	stream->next_uframe = start & (mod - 1);
++
++	/* report high speed start in uframes; full speed, in frames */
++	urb->start_frame = stream->next_uframe;
++	if (!stream->highspeed)
++		urb->start_frame >>= 3;
++
++	/* Make sure scan_isoc() sees these */
++	if (fotg210->isoc_count == 0)
++		fotg210->next_frame = now >> 3;
++	return 0;
++
++fail:
++	iso_sched_free(stream, sched);
++	urb->hcpriv = NULL;
++	return status;
++}
++
++static inline void itd_init(struct fotg210_hcd *fotg210,
++		struct fotg210_iso_stream *stream, struct fotg210_itd *itd)
++{
++	int i;
++
++	/* it's been recently zeroed */
++	itd->hw_next = FOTG210_LIST_END(fotg210);
++	itd->hw_bufp[0] = stream->buf0;
++	itd->hw_bufp[1] = stream->buf1;
++	itd->hw_bufp[2] = stream->buf2;
++
++	for (i = 0; i < 8; i++)
++		itd->index[i] = -1;
++
++	/* All other fields are filled when scheduling */
++}
++
++static inline void itd_patch(struct fotg210_hcd *fotg210,
++		struct fotg210_itd *itd, struct fotg210_iso_sched *iso_sched,
++		unsigned index, u16 uframe)
++{
++	struct fotg210_iso_packet *uf = &iso_sched->packet[index];
++	unsigned pg = itd->pg;
++
++	uframe &= 0x07;
++	itd->index[uframe] = index;
++
++	itd->hw_transaction[uframe] = uf->transaction;
++	itd->hw_transaction[uframe] |= cpu_to_hc32(fotg210, pg << 12);
++	itd->hw_bufp[pg] |= cpu_to_hc32(fotg210, uf->bufp & ~(u32)0);
++	itd->hw_bufp_hi[pg] |= cpu_to_hc32(fotg210, (u32)(uf->bufp >> 32));
++
++	/* iso_frame_desc[].offset must be strictly increasing */
++	if (unlikely(uf->cross)) {
++		u64 bufp = uf->bufp + 4096;
++
++		itd->pg = ++pg;
++		itd->hw_bufp[pg] |= cpu_to_hc32(fotg210, bufp & ~(u32)0);
++		itd->hw_bufp_hi[pg] |= cpu_to_hc32(fotg210, (u32)(bufp >> 32));
++	}
++}
++
++static inline void itd_link(struct fotg210_hcd *fotg210, unsigned frame,
++		struct fotg210_itd *itd)
++{
++	union fotg210_shadow *prev = &fotg210->pshadow[frame];
++	__hc32 *hw_p = &fotg210->periodic[frame];
++	union fotg210_shadow here = *prev;
++	__hc32 type = 0;
++
++	/* skip any iso nodes which might belong to previous microframes */
++	while (here.ptr) {
++		type = Q_NEXT_TYPE(fotg210, *hw_p);
++		if (type == cpu_to_hc32(fotg210, Q_TYPE_QH))
++			break;
++		prev = periodic_next_shadow(fotg210, prev, type);
++		hw_p = shadow_next_periodic(fotg210, &here, type);
++		here = *prev;
++	}
++
++	itd->itd_next = here;
++	itd->hw_next = *hw_p;
++	prev->itd = itd;
++	itd->frame = frame;
++	wmb();
++	*hw_p = cpu_to_hc32(fotg210, itd->itd_dma | Q_TYPE_ITD);
++}
++
++/* fit urb's itds into the selected schedule slot; activate as needed */
++static void itd_link_urb(struct fotg210_hcd *fotg210, struct urb *urb,
++		unsigned mod, struct fotg210_iso_stream *stream)
++{
++	int packet;
++	unsigned next_uframe, uframe, frame;
++	struct fotg210_iso_sched *iso_sched = urb->hcpriv;
++	struct fotg210_itd *itd;
++
++	next_uframe = stream->next_uframe & (mod - 1);
++
++	if (unlikely(list_empty(&stream->td_list))) {
++		fotg210_to_hcd(fotg210)->self.bandwidth_allocated
++				+= stream->bandwidth;
++		fotg210_dbg(fotg210,
++			"schedule devp %s ep%d%s-iso period %d start %d.%d\n",
++			urb->dev->devpath, stream->bEndpointAddress & 0x0f,
++			(stream->bEndpointAddress & USB_DIR_IN) ? "in" : "out",
++			urb->interval,
++			next_uframe >> 3, next_uframe & 0x7);
++	}
++
++	/* fill iTDs uframe by uframe */
++	for (packet = 0, itd = NULL; packet < urb->number_of_packets;) {
++		if (itd == NULL) {
++			/* ASSERT:  we have all necessary itds */
++
++			/* ASSERT:  no itds for this endpoint in this uframe */
++
++			itd = list_entry(iso_sched->td_list.next,
++					struct fotg210_itd, itd_list);
++			list_move_tail(&itd->itd_list, &stream->td_list);
++			itd->stream = stream;
++			itd->urb = urb;
++			itd_init(fotg210, stream, itd);
++		}
++
++		uframe = next_uframe & 0x07;
++		frame = next_uframe >> 3;
++
++		itd_patch(fotg210, itd, iso_sched, packet, uframe);
++
++		next_uframe += stream->interval;
++		next_uframe &= mod - 1;
++		packet++;
++
++		/* link completed itds into the schedule */
++		if (((next_uframe >> 3) != frame)
++				|| packet == urb->number_of_packets) {
++			itd_link(fotg210, frame & (fotg210->periodic_size - 1),
++					itd);
++			itd = NULL;
++		}
++	}
++	stream->next_uframe = next_uframe;
++
++	/* don't need that schedule data any more */
++	iso_sched_free(stream, iso_sched);
++	urb->hcpriv = NULL;
++
++	++fotg210->isoc_count;
++	enable_periodic(fotg210);
++}
++
++#define ISO_ERRS (FOTG210_ISOC_BUF_ERR | FOTG210_ISOC_BABBLE |\
++		FOTG210_ISOC_XACTERR)
++
++/* Process and recycle a completed ITD.  Return true iff its urb completed,
++ * and hence its completion callback probably added things to the hardware
++ * schedule.
++ *
++ * Note that we carefully avoid recycling this descriptor until after any
++ * completion callback runs, so that it won't be reused quickly.  That is,
++ * assuming (a) no more than two urbs per frame on this endpoint, and also
++ * (b) only this endpoint's completions submit URBs.  It seems some silicon
++ * corrupts things if you reuse completed descriptors very quickly...
++ */
++static bool itd_complete(struct fotg210_hcd *fotg210, struct fotg210_itd *itd)
++{
++	struct urb *urb = itd->urb;
++	struct usb_iso_packet_descriptor *desc;
++	u32 t;
++	unsigned uframe;
++	int urb_index = -1;
++	struct fotg210_iso_stream *stream = itd->stream;
++	struct usb_device *dev;
++	bool retval = false;
++
++	/* for each uframe with a packet */
++	for (uframe = 0; uframe < 8; uframe++) {
++		if (likely(itd->index[uframe] == -1))
++			continue;
++		urb_index = itd->index[uframe];
++		desc = &urb->iso_frame_desc[urb_index];
++
++		t = hc32_to_cpup(fotg210, &itd->hw_transaction[uframe]);
++		itd->hw_transaction[uframe] = 0;
++
++		/* report transfer status */
++		if (unlikely(t & ISO_ERRS)) {
++			urb->error_count++;
++			if (t & FOTG210_ISOC_BUF_ERR)
++				desc->status = usb_pipein(urb->pipe)
++					? -ENOSR  /* hc couldn't read */
++					: -ECOMM; /* hc couldn't write */
++			else if (t & FOTG210_ISOC_BABBLE)
++				desc->status = -EOVERFLOW;
++			else /* (t & FOTG210_ISOC_XACTERR) */
++				desc->status = -EPROTO;
++
++			/* HC need not update length with this error */
++			if (!(t & FOTG210_ISOC_BABBLE)) {
++				desc->actual_length = FOTG210_ITD_LENGTH(t);
++				urb->actual_length += desc->actual_length;
++			}
++		} else if (likely((t & FOTG210_ISOC_ACTIVE) == 0)) {
++			desc->status = 0;
++			desc->actual_length = FOTG210_ITD_LENGTH(t);
++			urb->actual_length += desc->actual_length;
++		} else {
++			/* URB was too late */
++			desc->status = -EXDEV;
++		}
++	}
++
++	/* handle completion now? */
++	if (likely((urb_index + 1) != urb->number_of_packets))
++		goto done;
++
++	/* ASSERT: it's really the last itd for this urb
++	 * list_for_each_entry (itd, &stream->td_list, itd_list)
++	 *	BUG_ON (itd->urb == urb);
++	 */
++
++	/* give urb back to the driver; completion often (re)submits */
++	dev = urb->dev;
++	fotg210_urb_done(fotg210, urb, 0);
++	retval = true;
++	urb = NULL;
++
++	--fotg210->isoc_count;
++	disable_periodic(fotg210);
++
++	if (unlikely(list_is_singular(&stream->td_list))) {
++		fotg210_to_hcd(fotg210)->self.bandwidth_allocated
++				-= stream->bandwidth;
++		fotg210_dbg(fotg210,
++			"deschedule devp %s ep%d%s-iso\n",
++			dev->devpath, stream->bEndpointAddress & 0x0f,
++			(stream->bEndpointAddress & USB_DIR_IN) ? "in" : "out");
++	}
++
++done:
++	itd->urb = NULL;
++
++	/* Add to the end of the free list for later reuse */
++	list_move_tail(&itd->itd_list, &stream->free_list);
++
++	/* Recycle the iTDs when the pipeline is empty (ep no longer in use) */
++	if (list_empty(&stream->td_list)) {
++		list_splice_tail_init(&stream->free_list,
++				&fotg210->cached_itd_list);
++		start_free_itds(fotg210);
++	}
++
++	return retval;
++}
++
++static int itd_submit(struct fotg210_hcd *fotg210, struct urb *urb,
++		gfp_t mem_flags)
++{
++	int status = -EINVAL;
++	unsigned long flags;
++	struct fotg210_iso_stream *stream;
++
++	/* Get iso_stream head */
++	stream = iso_stream_find(fotg210, urb);
++	if (unlikely(stream == NULL)) {
++		fotg210_dbg(fotg210, "can't get iso stream\n");
++		return -ENOMEM;
++	}
++	if (unlikely(urb->interval != stream->interval &&
++			fotg210_port_speed(fotg210, 0) ==
++			USB_PORT_STAT_HIGH_SPEED)) {
++		fotg210_dbg(fotg210, "can't change iso interval %d --> %d\n",
++				stream->interval, urb->interval);
++		goto done;
++	}
++
++#ifdef FOTG210_URB_TRACE
++	fotg210_dbg(fotg210,
++			"%s %s urb %p ep%d%s len %d, %d pkts %d uframes[%p]\n",
++			__func__, urb->dev->devpath, urb,
++			usb_pipeendpoint(urb->pipe),
++			usb_pipein(urb->pipe) ? "in" : "out",
++			urb->transfer_buffer_length,
++			urb->number_of_packets, urb->interval,
++			stream);
++#endif
++
++	/* allocate ITDs w/o locking anything */
++	status = itd_urb_transaction(stream, fotg210, urb, mem_flags);
++	if (unlikely(status < 0)) {
++		fotg210_dbg(fotg210, "can't init itds\n");
++		goto done;
++	}
++
++	/* schedule ... need to lock */
++	spin_lock_irqsave(&fotg210->lock, flags);
++	if (unlikely(!HCD_HW_ACCESSIBLE(fotg210_to_hcd(fotg210)))) {
++		status = -ESHUTDOWN;
++		goto done_not_linked;
++	}
++	status = usb_hcd_link_urb_to_ep(fotg210_to_hcd(fotg210), urb);
++	if (unlikely(status))
++		goto done_not_linked;
++	status = iso_stream_schedule(fotg210, urb, stream);
++	if (likely(status == 0))
++		itd_link_urb(fotg210, urb, fotg210->periodic_size << 3, stream);
++	else
++		usb_hcd_unlink_urb_from_ep(fotg210_to_hcd(fotg210), urb);
++done_not_linked:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++done:
++	return status;
++}
++
++static inline int scan_frame_queue(struct fotg210_hcd *fotg210, unsigned frame,
++		unsigned now_frame, bool live)
++{
++	unsigned uf;
++	bool modified;
++	union fotg210_shadow q, *q_p;
++	__hc32 type, *hw_p;
++
++	/* scan each element in frame's queue for completions */
++	q_p = &fotg210->pshadow[frame];
++	hw_p = &fotg210->periodic[frame];
++	q.ptr = q_p->ptr;
++	type = Q_NEXT_TYPE(fotg210, *hw_p);
++	modified = false;
++
++	while (q.ptr) {
++		switch (hc32_to_cpu(fotg210, type)) {
++		case Q_TYPE_ITD:
++			/* If this ITD is still active, leave it for
++			 * later processing ... check the next entry.
++			 * No need to check for activity unless the
++			 * frame is current.
++			 */
++			if (frame == now_frame && live) {
++				rmb();
++				for (uf = 0; uf < 8; uf++) {
++					if (q.itd->hw_transaction[uf] &
++							ITD_ACTIVE(fotg210))
++						break;
++				}
++				if (uf < 8) {
++					q_p = &q.itd->itd_next;
++					hw_p = &q.itd->hw_next;
++					type = Q_NEXT_TYPE(fotg210,
++							q.itd->hw_next);
++					q = *q_p;
++					break;
++				}
++			}
++
++			/* Take finished ITDs out of the schedule
++			 * and process them:  recycle, maybe report
++			 * URB completion.  HC won't cache the
++			 * pointer for much longer, if at all.
++			 */
++			*q_p = q.itd->itd_next;
++			*hw_p = q.itd->hw_next;
++			type = Q_NEXT_TYPE(fotg210, q.itd->hw_next);
++			wmb();
++			modified = itd_complete(fotg210, q.itd);
++			q = *q_p;
++			break;
++		default:
++			fotg210_dbg(fotg210, "corrupt type %d frame %d shadow %p\n",
++					type, frame, q.ptr);
++			fallthrough;
++		case Q_TYPE_QH:
++		case Q_TYPE_FSTN:
++			/* End of the iTDs and siTDs */
++			q.ptr = NULL;
++			break;
++		}
++
++		/* assume completion callbacks modify the queue */
++		if (unlikely(modified && fotg210->isoc_count > 0))
++			return -EINVAL;
++	}
++	return 0;
++}
++
++static void scan_isoc(struct fotg210_hcd *fotg210)
++{
++	unsigned uf, now_frame, frame, ret;
++	unsigned fmask = fotg210->periodic_size - 1;
++	bool live;
++
++	/*
++	 * When running, scan from last scan point up to "now"
++	 * else clean up by scanning everything that's left.
++	 * Touches as few pages as possible:  cache-friendly.
++	 */
++	if (fotg210->rh_state >= FOTG210_RH_RUNNING) {
++		uf = fotg210_read_frame_index(fotg210);
++		now_frame = (uf >> 3) & fmask;
++		live = true;
++	} else  {
++		now_frame = (fotg210->next_frame - 1) & fmask;
++		live = false;
++	}
++	fotg210->now_frame = now_frame;
++
++	frame = fotg210->next_frame;
++	for (;;) {
++		ret = 1;
++		while (ret != 0)
++			ret = scan_frame_queue(fotg210, frame,
++					now_frame, live);
++
++		/* Stop when we have reached the current frame */
++		if (frame == now_frame)
++			break;
++		frame = (frame + 1) & fmask;
++	}
++	fotg210->next_frame = now_frame;
++}
++
++/* Display / Set uframe_periodic_max
++ */
++static ssize_t uframe_periodic_max_show(struct device *dev,
++		struct device_attribute *attr, char *buf)
++{
++	struct fotg210_hcd *fotg210;
++	int n;
++
++	fotg210 = hcd_to_fotg210(bus_to_hcd(dev_get_drvdata(dev)));
++	n = scnprintf(buf, PAGE_SIZE, "%d\n", fotg210->uframe_periodic_max);
++	return n;
++}
++
++
++static ssize_t uframe_periodic_max_store(struct device *dev,
++		struct device_attribute *attr, const char *buf, size_t count)
++{
++	struct fotg210_hcd *fotg210;
++	unsigned uframe_periodic_max;
++	unsigned frame, uframe;
++	unsigned short allocated_max;
++	unsigned long flags;
++	ssize_t ret;
++
++	fotg210 = hcd_to_fotg210(bus_to_hcd(dev_get_drvdata(dev)));
++	if (kstrtouint(buf, 0, &uframe_periodic_max) < 0)
++		return -EINVAL;
++
++	if (uframe_periodic_max < 100 || uframe_periodic_max >= 125) {
++		fotg210_info(fotg210, "rejecting invalid request for uframe_periodic_max=%u\n",
++				uframe_periodic_max);
++		return -EINVAL;
++	}
++
++	ret = -EINVAL;
++
++	/*
++	 * lock, so that our checking does not race with possible periodic
++	 * bandwidth allocation through submitting new urbs.
++	 */
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	/*
++	 * for request to decrease max periodic bandwidth, we have to check
++	 * every microframe in the schedule to see whether the decrease is
++	 * possible.
++	 */
++	if (uframe_periodic_max < fotg210->uframe_periodic_max) {
++		allocated_max = 0;
++
++		for (frame = 0; frame < fotg210->periodic_size; ++frame)
++			for (uframe = 0; uframe < 7; ++uframe)
++				allocated_max = max(allocated_max,
++						periodic_usecs(fotg210, frame,
++						uframe));
++
++		if (allocated_max > uframe_periodic_max) {
++			fotg210_info(fotg210,
++					"cannot decrease uframe_periodic_max because periodic bandwidth is already allocated (%u > %u)\n",
++					allocated_max, uframe_periodic_max);
++			goto out_unlock;
++		}
++	}
++
++	/* increasing is always ok */
++
++	fotg210_info(fotg210,
++			"setting max periodic bandwidth to %u%% (== %u usec/uframe)\n",
++			100 * uframe_periodic_max/125, uframe_periodic_max);
++
++	if (uframe_periodic_max != 100)
++		fotg210_warn(fotg210, "max periodic bandwidth set is non-standard\n");
++
++	fotg210->uframe_periodic_max = uframe_periodic_max;
++	ret = count;
++
++out_unlock:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return ret;
++}
++
++static DEVICE_ATTR_RW(uframe_periodic_max);
++
++static inline int create_sysfs_files(struct fotg210_hcd *fotg210)
++{
++	struct device *controller = fotg210_to_hcd(fotg210)->self.controller;
++
++	return device_create_file(controller, &dev_attr_uframe_periodic_max);
++}
++
++static inline void remove_sysfs_files(struct fotg210_hcd *fotg210)
++{
++	struct device *controller = fotg210_to_hcd(fotg210)->self.controller;
++
++	device_remove_file(controller, &dev_attr_uframe_periodic_max);
++}
++/* On some systems, leaving remote wakeup enabled prevents system shutdown.
++ * The firmware seems to think that powering off is a wakeup event!
++ * This routine turns off remote wakeup and everything else, on all ports.
++ */
++static void fotg210_turn_off_all_ports(struct fotg210_hcd *fotg210)
++{
++	u32 __iomem *status_reg = &fotg210->regs->port_status;
++
++	fotg210_writel(fotg210, PORT_RWC_BITS, status_reg);
++}
++
++/* Halt HC, turn off all ports, and let the BIOS use the companion controllers.
++ * Must be called with interrupts enabled and the lock not held.
++ */
++static void fotg210_silence_controller(struct fotg210_hcd *fotg210)
++{
++	fotg210_halt(fotg210);
++
++	spin_lock_irq(&fotg210->lock);
++	fotg210->rh_state = FOTG210_RH_HALTED;
++	fotg210_turn_off_all_ports(fotg210);
++	spin_unlock_irq(&fotg210->lock);
++}
++
++/* fotg210_shutdown kick in for silicon on any bus (not just pci, etc).
++ * This forcibly disables dma and IRQs, helping kexec and other cases
++ * where the next system software may expect clean state.
++ */
++static void fotg210_shutdown(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++
++	spin_lock_irq(&fotg210->lock);
++	fotg210->shutdown = true;
++	fotg210->rh_state = FOTG210_RH_STOPPING;
++	fotg210->enabled_hrtimer_events = 0;
++	spin_unlock_irq(&fotg210->lock);
++
++	fotg210_silence_controller(fotg210);
++
++	hrtimer_cancel(&fotg210->hrtimer);
++}
++
++/* fotg210_work is called from some interrupts, timers, and so on.
++ * it calls driver completion functions, after dropping fotg210->lock.
++ */
++static void fotg210_work(struct fotg210_hcd *fotg210)
++{
++	/* another CPU may drop fotg210->lock during a schedule scan while
++	 * it reports urb completions.  this flag guards against bogus
++	 * attempts at re-entrant schedule scanning.
++	 */
++	if (fotg210->scanning) {
++		fotg210->need_rescan = true;
++		return;
++	}
++	fotg210->scanning = true;
++
++rescan:
++	fotg210->need_rescan = false;
++	if (fotg210->async_count)
++		scan_async(fotg210);
++	if (fotg210->intr_count > 0)
++		scan_intr(fotg210);
++	if (fotg210->isoc_count > 0)
++		scan_isoc(fotg210);
++	if (fotg210->need_rescan)
++		goto rescan;
++	fotg210->scanning = false;
++
++	/* the IO watchdog guards against hardware or driver bugs that
++	 * misplace IRQs, and should let us run completely without IRQs.
++	 * such lossage has been observed on both VT6202 and VT8235.
++	 */
++	turn_on_io_watchdog(fotg210);
++}
++
++/* Called when the fotg210_hcd module is removed.
++ */
++static void fotg210_stop(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++
++	fotg210_dbg(fotg210, "stop\n");
++
++	/* no more interrupts ... */
++
++	spin_lock_irq(&fotg210->lock);
++	fotg210->enabled_hrtimer_events = 0;
++	spin_unlock_irq(&fotg210->lock);
++
++	fotg210_quiesce(fotg210);
++	fotg210_silence_controller(fotg210);
++	fotg210_reset(fotg210);
++
++	hrtimer_cancel(&fotg210->hrtimer);
++	remove_sysfs_files(fotg210);
++	remove_debug_files(fotg210);
++
++	/* root hub is shut down separately (first, when possible) */
++	spin_lock_irq(&fotg210->lock);
++	end_free_itds(fotg210);
++	spin_unlock_irq(&fotg210->lock);
++	fotg210_mem_cleanup(fotg210);
++
++#ifdef FOTG210_STATS
++	fotg210_dbg(fotg210, "irq normal %ld err %ld iaa %ld (lost %ld)\n",
++			fotg210->stats.normal, fotg210->stats.error,
++			fotg210->stats.iaa, fotg210->stats.lost_iaa);
++	fotg210_dbg(fotg210, "complete %ld unlink %ld\n",
++			fotg210->stats.complete, fotg210->stats.unlink);
++#endif
++
++	dbg_status(fotg210, "fotg210_stop completed",
++			fotg210_readl(fotg210, &fotg210->regs->status));
++}
++
++/* one-time init, only for memory state */
++static int hcd_fotg210_init(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	u32 temp;
++	int retval;
++	u32 hcc_params;
++	struct fotg210_qh_hw *hw;
++
++	spin_lock_init(&fotg210->lock);
++
++	/*
++	 * keep io watchdog by default, those good HCDs could turn off it later
++	 */
++	fotg210->need_io_watchdog = 1;
++
++	hrtimer_init(&fotg210->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
++	fotg210->hrtimer.function = fotg210_hrtimer_func;
++	fotg210->next_hrtimer_event = FOTG210_HRTIMER_NO_EVENT;
++
++	hcc_params = fotg210_readl(fotg210, &fotg210->caps->hcc_params);
++
++	/*
++	 * by default set standard 80% (== 100 usec/uframe) max periodic
++	 * bandwidth as required by USB 2.0
++	 */
++	fotg210->uframe_periodic_max = 100;
++
++	/*
++	 * hw default: 1K periodic list heads, one per frame.
++	 * periodic_size can shrink by USBCMD update if hcc_params allows.
++	 */
++	fotg210->periodic_size = DEFAULT_I_TDPS;
++	INIT_LIST_HEAD(&fotg210->intr_qh_list);
++	INIT_LIST_HEAD(&fotg210->cached_itd_list);
++
++	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
++		/* periodic schedule size can be smaller than default */
++		switch (FOTG210_TUNE_FLS) {
++		case 0:
++			fotg210->periodic_size = 1024;
++			break;
++		case 1:
++			fotg210->periodic_size = 512;
++			break;
++		case 2:
++			fotg210->periodic_size = 256;
++			break;
++		default:
++			BUG();
++		}
++	}
++	retval = fotg210_mem_init(fotg210, GFP_KERNEL);
++	if (retval < 0)
++		return retval;
++
++	/* controllers may cache some of the periodic schedule ... */
++	fotg210->i_thresh = 2;
++
++	/*
++	 * dedicate a qh for the async ring head, since we couldn't unlink
++	 * a 'real' qh without stopping the async schedule [4.8].  use it
++	 * as the 'reclamation list head' too.
++	 * its dummy is used in hw_alt_next of many tds, to prevent the qh
++	 * from automatically advancing to the next td after short reads.
++	 */
++	fotg210->async->qh_next.qh = NULL;
++	hw = fotg210->async->hw;
++	hw->hw_next = QH_NEXT(fotg210, fotg210->async->qh_dma);
++	hw->hw_info1 = cpu_to_hc32(fotg210, QH_HEAD);
++	hw->hw_token = cpu_to_hc32(fotg210, QTD_STS_HALT);
++	hw->hw_qtd_next = FOTG210_LIST_END(fotg210);
++	fotg210->async->qh_state = QH_STATE_LINKED;
++	hw->hw_alt_next = QTD_NEXT(fotg210, fotg210->async->dummy->qtd_dma);
++
++	/* clear interrupt enables, set irq latency */
++	if (log2_irq_thresh < 0 || log2_irq_thresh > 6)
++		log2_irq_thresh = 0;
++	temp = 1 << (16 + log2_irq_thresh);
++	if (HCC_CANPARK(hcc_params)) {
++		/* HW default park == 3, on hardware that supports it (like
++		 * NVidia and ALI silicon), maximizes throughput on the async
++		 * schedule by avoiding QH fetches between transfers.
++		 *
++		 * With fast usb storage devices and NForce2, "park" seems to
++		 * make problems:  throughput reduction (!), data errors...
++		 */
++		if (park) {
++			park = min_t(unsigned, park, 3);
++			temp |= CMD_PARK;
++			temp |= park << 8;
++		}
++		fotg210_dbg(fotg210, "park %d\n", park);
++	}
++	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
++		/* periodic schedule size can be smaller than default */
++		temp &= ~(3 << 2);
++		temp |= (FOTG210_TUNE_FLS << 2);
++	}
++	fotg210->command = temp;
++
++	/* Accept arbitrarily long scatter-gather lists */
++	if (!hcd->localmem_pool)
++		hcd->self.sg_tablesize = ~0;
++	return 0;
++}
++
++/* start HC running; it's halted, hcd_fotg210_init() has been run (once) */
++static int fotg210_run(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	u32 temp;
++
++	hcd->uses_new_polling = 1;
++
++	/* EHCI spec section 4.1 */
++
++	fotg210_writel(fotg210, fotg210->periodic_dma,
++			&fotg210->regs->frame_list);
++	fotg210_writel(fotg210, (u32)fotg210->async->qh_dma,
++			&fotg210->regs->async_next);
++
++	/*
++	 * hcc_params controls whether fotg210->regs->segment must (!!!)
++	 * be used; it constrains QH/ITD/SITD and QTD locations.
++	 * dma_pool consistent memory always uses segment zero.
++	 * streaming mappings for I/O buffers, like dma_map_single(),
++	 * can return segments above 4GB, if the device allows.
++	 *
++	 * NOTE:  the dma mask is visible through dev->dma_mask, so
++	 * drivers can pass this info along ... like NETIF_F_HIGHDMA,
++	 * Scsi_Host.highmem_io, and so forth.  It's readonly to all
++	 * host side drivers though.
++	 */
++	fotg210_readl(fotg210, &fotg210->caps->hcc_params);
++
++	/*
++	 * Philips, Intel, and maybe others need CMD_RUN before the
++	 * root hub will detect new devices (why?); NEC doesn't
++	 */
++	fotg210->command &= ~(CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET);
++	fotg210->command |= CMD_RUN;
++	fotg210_writel(fotg210, fotg210->command, &fotg210->regs->command);
++	dbg_cmd(fotg210, "init", fotg210->command);
++
++	/*
++	 * Start, enabling full USB 2.0 functionality ... usb 1.1 devices
++	 * are explicitly handed to companion controller(s), so no TT is
++	 * involved with the root hub.  (Except where one is integrated,
++	 * and there's no companion controller unless maybe for USB OTG.)
++	 *
++	 * Turning on the CF flag will transfer ownership of all ports
++	 * from the companions to the EHCI controller.  If any of the
++	 * companions are in the middle of a port reset at the time, it
++	 * could cause trouble.  Write-locking ehci_cf_port_reset_rwsem
++	 * guarantees that no resets are in progress.  After we set CF,
++	 * a short delay lets the hardware catch up; new resets shouldn't
++	 * be started before the port switching actions could complete.
++	 */
++	down_write(&ehci_cf_port_reset_rwsem);
++	fotg210->rh_state = FOTG210_RH_RUNNING;
++	/* unblock posted writes */
++	fotg210_readl(fotg210, &fotg210->regs->command);
++	usleep_range(5000, 10000);
++	up_write(&ehci_cf_port_reset_rwsem);
++	fotg210->last_periodic_enable = ktime_get_real();
++
++	temp = HC_VERSION(fotg210,
++			fotg210_readl(fotg210, &fotg210->caps->hc_capbase));
++	fotg210_info(fotg210,
++			"USB %x.%x started, EHCI %x.%02x\n",
++			((fotg210->sbrn & 0xf0) >> 4), (fotg210->sbrn & 0x0f),
++			temp >> 8, temp & 0xff);
++
++	fotg210_writel(fotg210, INTR_MASK,
++			&fotg210->regs->intr_enable); /* Turn On Interrupts */
++
++	/* GRR this is run-once init(), being done every time the HC starts.
++	 * So long as they're part of class devices, we can't do it init()
++	 * since the class device isn't created that early.
++	 */
++	create_debug_files(fotg210);
++	create_sysfs_files(fotg210);
++
++	return 0;
++}
++
++static int fotg210_setup(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	int retval;
++
++	fotg210->regs = (void __iomem *)fotg210->caps +
++			HC_LENGTH(fotg210,
++			fotg210_readl(fotg210, &fotg210->caps->hc_capbase));
++	dbg_hcs_params(fotg210, "reset");
++	dbg_hcc_params(fotg210, "reset");
++
++	/* cache this readonly data; minimize chip reads */
++	fotg210->hcs_params = fotg210_readl(fotg210,
++			&fotg210->caps->hcs_params);
++
++	fotg210->sbrn = HCD_USB2;
++
++	/* data structure init */
++	retval = hcd_fotg210_init(hcd);
++	if (retval)
++		return retval;
++
++	retval = fotg210_halt(fotg210);
++	if (retval)
++		return retval;
++
++	fotg210_reset(fotg210);
++
++	return 0;
++}
++
++static irqreturn_t fotg210_irq(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	u32 status, masked_status, pcd_status = 0, cmd;
++	int bh;
++
++	spin_lock(&fotg210->lock);
++
++	status = fotg210_readl(fotg210, &fotg210->regs->status);
++
++	/* e.g. cardbus physical eject */
++	if (status == ~(u32) 0) {
++		fotg210_dbg(fotg210, "device removed\n");
++		goto dead;
++	}
++
++	/*
++	 * We don't use STS_FLR, but some controllers don't like it to
++	 * remain on, so mask it out along with the other status bits.
++	 */
++	masked_status = status & (INTR_MASK | STS_FLR);
++
++	/* Shared IRQ? */
++	if (!masked_status ||
++			unlikely(fotg210->rh_state == FOTG210_RH_HALTED)) {
++		spin_unlock(&fotg210->lock);
++		return IRQ_NONE;
++	}
++
++	/* clear (just) interrupts */
++	fotg210_writel(fotg210, masked_status, &fotg210->regs->status);
++	cmd = fotg210_readl(fotg210, &fotg210->regs->command);
++	bh = 0;
++
++	/* unrequested/ignored: Frame List Rollover */
++	dbg_status(fotg210, "irq", status);
++
++	/* INT, ERR, and IAA interrupt rates can be throttled */
++
++	/* 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))
++			INCR(fotg210->stats.normal);
++		else
++			INCR(fotg210->stats.error);
++		bh = 1;
++	}
++
++	/* complete the unlinking of some qh [4.15.2.3] */
++	if (status & STS_IAA) {
++
++		/* Turn off the IAA watchdog */
++		fotg210->enabled_hrtimer_events &=
++			~BIT(FOTG210_HRTIMER_IAA_WATCHDOG);
++
++		/*
++		 * Mild optimization: Allow another IAAD to reset the
++		 * hrtimer, if one occurs before the next expiration.
++		 * In theory we could always cancel the hrtimer, but
++		 * tests show that about half the time it will be reset
++		 * for some other event anyway.
++		 */
++		if (fotg210->next_hrtimer_event == FOTG210_HRTIMER_IAA_WATCHDOG)
++			++fotg210->next_hrtimer_event;
++
++		/* guard against (alleged) silicon errata */
++		if (cmd & CMD_IAAD)
++			fotg210_dbg(fotg210, "IAA with IAAD still set?\n");
++		if (fotg210->async_iaa) {
++			INCR(fotg210->stats.iaa);
++			end_unlink_async(fotg210);
++		} else
++			fotg210_dbg(fotg210, "IAA with nothing unlinked?\n");
++	}
++
++	/* remote wakeup [4.3.1] */
++	if (status & STS_PCD) {
++		int pstatus;
++		u32 __iomem *status_reg = &fotg210->regs->port_status;
++
++		/* kick root hub later */
++		pcd_status = status;
++
++		/* resume root hub? */
++		if (fotg210->rh_state == FOTG210_RH_SUSPENDED)
++			usb_hcd_resume_root_hub(hcd);
++
++		pstatus = fotg210_readl(fotg210, status_reg);
++
++		if (test_bit(0, &fotg210->suspended_ports) &&
++				((pstatus & PORT_RESUME) ||
++				!(pstatus & PORT_SUSPEND)) &&
++				(pstatus & PORT_PE) &&
++				fotg210->reset_done[0] == 0) {
++
++			/* start 20 msec resume signaling from this port,
++			 * and make hub_wq collect PORT_STAT_C_SUSPEND to
++			 * stop that signaling.  Use 5 ms extra for safety,
++			 * like usb_port_resume() does.
++			 */
++			fotg210->reset_done[0] = jiffies + msecs_to_jiffies(25);
++			set_bit(0, &fotg210->resuming_ports);
++			fotg210_dbg(fotg210, "port 1 remote wakeup\n");
++			mod_timer(&hcd->rh_timer, fotg210->reset_done[0]);
++		}
++	}
++
++	/* PCI errors [4.15.2.4] */
++	if (unlikely((status & STS_FATAL) != 0)) {
++		fotg210_err(fotg210, "fatal error\n");
++		dbg_cmd(fotg210, "fatal", cmd);
++		dbg_status(fotg210, "fatal", status);
++dead:
++		usb_hc_died(hcd);
++
++		/* Don't let the controller do anything more */
++		fotg210->shutdown = true;
++		fotg210->rh_state = FOTG210_RH_STOPPING;
++		fotg210->command &= ~(CMD_RUN | CMD_ASE | CMD_PSE);
++		fotg210_writel(fotg210, fotg210->command,
++				&fotg210->regs->command);
++		fotg210_writel(fotg210, 0, &fotg210->regs->intr_enable);
++		fotg210_handle_controller_death(fotg210);
++
++		/* Handle completions when the controller stops */
++		bh = 0;
++	}
++
++	if (bh)
++		fotg210_work(fotg210);
++	spin_unlock(&fotg210->lock);
++	if (pcd_status)
++		usb_hcd_poll_rh_status(hcd);
++	return IRQ_HANDLED;
++}
++
++/* non-error returns are a promise to giveback() the urb later
++ * we drop ownership so next owner (or urb unlink) can get it
++ *
++ * urb + dev is in hcd.self.controller.urb_list
++ * we're queueing TDs onto software and hardware lists
++ *
++ * hcd-specific init for hcpriv hasn't been done yet
++ *
++ * 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 fotg210_urb_enqueue(struct usb_hcd *hcd, struct urb *urb,
++		gfp_t mem_flags)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	struct list_head qtd_list;
++
++	INIT_LIST_HEAD(&qtd_list);
++
++	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.
++		 */
++		if (urb->transfer_buffer_length > (16 * 1024))
++			return -EMSGSIZE;
++		fallthrough;
++	/* case PIPE_BULK: */
++	default:
++		if (!qh_urb_transaction(fotg210, urb, &qtd_list, mem_flags))
++			return -ENOMEM;
++		return submit_async(fotg210, urb, &qtd_list, mem_flags);
++
++	case PIPE_INTERRUPT:
++		if (!qh_urb_transaction(fotg210, urb, &qtd_list, mem_flags))
++			return -ENOMEM;
++		return intr_submit(fotg210, urb, &qtd_list, mem_flags);
++
++	case PIPE_ISOCHRONOUS:
++		return itd_submit(fotg210, urb, mem_flags);
++	}
++}
++
++/* remove from hardware lists
++ * completions normally happen asynchronously
++ */
++
++static int fotg210_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	struct fotg210_qh *qh;
++	unsigned long flags;
++	int rc;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	rc = usb_hcd_check_unlink_urb(hcd, urb, status);
++	if (rc)
++		goto done;
++
++	switch (usb_pipetype(urb->pipe)) {
++	/* case PIPE_CONTROL: */
++	/* case PIPE_BULK:*/
++	default:
++		qh = (struct fotg210_qh *) urb->hcpriv;
++		if (!qh)
++			break;
++		switch (qh->qh_state) {
++		case QH_STATE_LINKED:
++		case QH_STATE_COMPLETING:
++			start_unlink_async(fotg210, qh);
++			break;
++		case QH_STATE_UNLINK:
++		case QH_STATE_UNLINK_WAIT:
++			/* already started */
++			break;
++		case QH_STATE_IDLE:
++			/* QH might be waiting for a Clear-TT-Buffer */
++			qh_completions(fotg210, qh);
++			break;
++		}
++		break;
++
++	case PIPE_INTERRUPT:
++		qh = (struct fotg210_qh *) urb->hcpriv;
++		if (!qh)
++			break;
++		switch (qh->qh_state) {
++		case QH_STATE_LINKED:
++		case QH_STATE_COMPLETING:
++			start_unlink_intr(fotg210, qh);
++			break;
++		case QH_STATE_IDLE:
++			qh_completions(fotg210, qh);
++			break;
++		default:
++			fotg210_dbg(fotg210, "bogus qh %p state %d\n",
++					qh, qh->qh_state);
++			goto done;
++		}
++		break;
++
++	case PIPE_ISOCHRONOUS:
++		/* itd... */
++
++		/* wait till next completion, do it then. */
++		/* completion irqs can wait up to 1024 msec, */
++		break;
++	}
++done:
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++	return rc;
++}
++
++/* bulk qh holds the data toggle */
++
++static void fotg210_endpoint_disable(struct usb_hcd *hcd,
++		struct usb_host_endpoint *ep)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	unsigned long flags;
++	struct fotg210_qh *qh, *tmp;
++
++	/* ASSERT:  any requests/urbs are being unlinked */
++	/* ASSERT:  nobody can be submitting urbs for this any more */
++
++rescan:
++	spin_lock_irqsave(&fotg210->lock, flags);
++	qh = ep->hcpriv;
++	if (!qh)
++		goto done;
++
++	/* endpoints can be iso streams.  for now, we don't
++	 * accelerate iso completions ... so spin a while.
++	 */
++	if (qh->hw == NULL) {
++		struct fotg210_iso_stream *stream = ep->hcpriv;
++
++		if (!list_empty(&stream->td_list))
++			goto idle_timeout;
++
++		/* BUG_ON(!list_empty(&stream->free_list)); */
++		kfree(stream);
++		goto done;
++	}
++
++	if (fotg210->rh_state < FOTG210_RH_RUNNING)
++		qh->qh_state = QH_STATE_IDLE;
++	switch (qh->qh_state) {
++	case QH_STATE_LINKED:
++	case QH_STATE_COMPLETING:
++		for (tmp = fotg210->async->qh_next.qh;
++				tmp && tmp != qh;
++				tmp = tmp->qh_next.qh)
++			continue;
++		/* periodic qh self-unlinks on empty, and a COMPLETING qh
++		 * may already be unlinked.
++		 */
++		if (tmp)
++			start_unlink_async(fotg210, qh);
++		fallthrough;
++	case QH_STATE_UNLINK:		/* wait for hw to finish? */
++	case QH_STATE_UNLINK_WAIT:
++idle_timeout:
++		spin_unlock_irqrestore(&fotg210->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)) {
++			qh_destroy(fotg210, qh);
++			break;
++		}
++		fallthrough;
++	default:
++		/* caller was supposed to have unlinked any requests;
++		 * that's not our job.  just leak this memory.
++		 */
++		fotg210_err(fotg210, "qh %p (#%02x) state %d%s\n",
++				qh, ep->desc.bEndpointAddress, qh->qh_state,
++				list_empty(&qh->qtd_list) ? "" : "(has tds)");
++		break;
++	}
++done:
++	ep->hcpriv = NULL;
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++}
++
++static void fotg210_endpoint_reset(struct usb_hcd *hcd,
++		struct usb_host_endpoint *ep)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++	struct fotg210_qh *qh;
++	int eptype = usb_endpoint_type(&ep->desc);
++	int epnum = usb_endpoint_num(&ep->desc);
++	int is_out = usb_endpoint_dir_out(&ep->desc);
++	unsigned long flags;
++
++	if (eptype != USB_ENDPOINT_XFER_BULK && eptype != USB_ENDPOINT_XFER_INT)
++		return;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++	qh = ep->hcpriv;
++
++	/* For Bulk and Interrupt endpoints we maintain the toggle state
++	 * in the hardware; the toggle bits in udev aren't used at all.
++	 * When an endpoint is reset by usb_clear_halt() we must reset
++	 * the toggle bit in the QH.
++	 */
++	if (qh) {
++		usb_settoggle(qh->dev, epnum, is_out, 0);
++		if (!list_empty(&qh->qtd_list)) {
++			WARN_ONCE(1, "clear_halt for a busy endpoint\n");
++		} else if (qh->qh_state == QH_STATE_LINKED ||
++				qh->qh_state == QH_STATE_COMPLETING) {
++
++			/* The toggle value in the QH can't be updated
++			 * while the QH is active.  Unlink it now;
++			 * re-linking will call qh_refresh().
++			 */
++			if (eptype == USB_ENDPOINT_XFER_BULK)
++				start_unlink_async(fotg210, qh);
++			else
++				start_unlink_intr(fotg210, qh);
++		}
++	}
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++}
++
++static int fotg210_get_frame(struct usb_hcd *hcd)
++{
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++
++	return (fotg210_read_frame_index(fotg210) >> 3) %
++		fotg210->periodic_size;
++}
++
++/* The EHCI in ChipIdea HDRC cannot be a separate module or device,
++ * because its registers (and irq) are shared between host/gadget/otg
++ * functions  and in order to facilitate role switching we cannot
++ * give the fotg210 driver exclusive access to those.
++ */
++MODULE_DESCRIPTION(DRIVER_DESC);
++MODULE_AUTHOR(DRIVER_AUTHOR);
++MODULE_LICENSE("GPL");
++
++static const struct hc_driver fotg210_fotg210_hc_driver = {
++	.description		= hcd_name,
++	.product_desc		= "Faraday USB2.0 Host Controller",
++	.hcd_priv_size		= sizeof(struct fotg210_hcd),
++
++	/*
++	 * generic hardware linkage
++	 */
++	.irq			= fotg210_irq,
++	.flags			= HCD_MEMORY | HCD_DMA | HCD_USB2,
++
++	/*
++	 * basic lifecycle operations
++	 */
++	.reset			= hcd_fotg210_init,
++	.start			= fotg210_run,
++	.stop			= fotg210_stop,
++	.shutdown		= fotg210_shutdown,
++
++	/*
++	 * managing i/o requests and associated device resources
++	 */
++	.urb_enqueue		= fotg210_urb_enqueue,
++	.urb_dequeue		= fotg210_urb_dequeue,
++	.endpoint_disable	= fotg210_endpoint_disable,
++	.endpoint_reset		= fotg210_endpoint_reset,
++
++	/*
++	 * scheduling support
++	 */
++	.get_frame_number	= fotg210_get_frame,
++
++	/*
++	 * root hub support
++	 */
++	.hub_status_data	= fotg210_hub_status_data,
++	.hub_control		= fotg210_hub_control,
++	.bus_suspend		= fotg210_bus_suspend,
++	.bus_resume		= fotg210_bus_resume,
++
++	.relinquish_port	= fotg210_relinquish_port,
++	.port_handed_over	= fotg210_port_handed_over,
++
++	.clear_tt_buffer_complete = fotg210_clear_tt_buffer_complete,
++};
++
++static void fotg210_init(struct fotg210_hcd *fotg210)
++{
++	u32 value;
++
++	iowrite32(GMIR_MDEV_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
++			&fotg210->regs->gmir);
++
++	value = ioread32(&fotg210->regs->otgcsr);
++	value &= ~OTGCSR_A_BUS_DROP;
++	value |= OTGCSR_A_BUS_REQ;
++	iowrite32(value, &fotg210->regs->otgcsr);
++}
++
++/*
++ * fotg210_hcd_probe - initialize faraday FOTG210 HCDs
++ *
++ * Allocates basic resources for this USB host controller, and
++ * then invokes the start() method for the HCD associated with it
++ * through the hotplug entry's driver_data.
++ */
++static int fotg210_hcd_probe(struct platform_device *pdev)
++{
++	struct device *dev = &pdev->dev;
++	struct usb_hcd *hcd;
++	struct resource *res;
++	int irq;
++	int retval;
++	struct fotg210_hcd *fotg210;
++
++	if (usb_disabled())
++		return -ENODEV;
++
++	pdev->dev.power.power_state = PMSG_ON;
++
++	irq = platform_get_irq(pdev, 0);
++	if (irq < 0)
++		return irq;
++
++	hcd = usb_create_hcd(&fotg210_fotg210_hc_driver, dev,
++			dev_name(dev));
++	if (!hcd) {
++		dev_err(dev, "failed to create hcd\n");
++		retval = -ENOMEM;
++		goto fail_create_hcd;
++	}
++
++	hcd->has_tt = 1;
++
++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
++	if (IS_ERR(hcd->regs)) {
++		retval = PTR_ERR(hcd->regs);
++		goto failed_put_hcd;
++	}
++
++	hcd->rsrc_start = res->start;
++	hcd->rsrc_len = resource_size(res);
++
++	fotg210 = hcd_to_fotg210(hcd);
++
++	fotg210->caps = hcd->regs;
++
++	/* It's OK not to supply this clock */
++	fotg210->pclk = clk_get(dev, "PCLK");
++	if (!IS_ERR(fotg210->pclk)) {
++		retval = clk_prepare_enable(fotg210->pclk);
++		if (retval) {
++			dev_err(dev, "failed to enable PCLK\n");
++			goto failed_put_hcd;
++		}
++	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
++		/*
++		 * Percolate deferrals, for anything else,
++		 * just live without the clocking.
++		 */
++		retval = PTR_ERR(fotg210->pclk);
++		goto failed_dis_clk;
++	}
++
++	retval = fotg210_setup(hcd);
++	if (retval)
++		goto failed_dis_clk;
++
++	fotg210_init(fotg210);
++
++	retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
++	if (retval) {
++		dev_err(dev, "failed to add hcd with err %d\n", retval);
++		goto failed_dis_clk;
++	}
++	device_wakeup_enable(hcd->self.controller);
++	platform_set_drvdata(pdev, hcd);
++
++	return retval;
++
++failed_dis_clk:
++	if (!IS_ERR(fotg210->pclk)) {
++		clk_disable_unprepare(fotg210->pclk);
++		clk_put(fotg210->pclk);
++	}
++failed_put_hcd:
++	usb_put_hcd(hcd);
++fail_create_hcd:
++	dev_err(dev, "init %s fail, %d\n", dev_name(dev), retval);
++	return retval;
++}
++
++/*
++ * fotg210_hcd_remove - shutdown processing for EHCI HCDs
++ * @dev: USB Host Controller being removed
++ *
++ */
++static int fotg210_hcd_remove(struct platform_device *pdev)
++{
++	struct usb_hcd *hcd = platform_get_drvdata(pdev);
++	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
++
++	if (!IS_ERR(fotg210->pclk)) {
++		clk_disable_unprepare(fotg210->pclk);
++		clk_put(fotg210->pclk);
++	}
++
++	usb_remove_hcd(hcd);
++	usb_put_hcd(hcd);
++
++	return 0;
++}
++
++#ifdef CONFIG_OF
++static const struct of_device_id fotg210_of_match[] = {
++	{ .compatible = "faraday,fotg210" },
++	{},
++};
++MODULE_DEVICE_TABLE(of, fotg210_of_match);
++#endif
++
++static struct platform_driver fotg210_hcd_driver = {
++	.driver = {
++		.name   = "fotg210-hcd",
++		.of_match_table = of_match_ptr(fotg210_of_match),
++	},
++	.probe  = fotg210_hcd_probe,
++	.remove = fotg210_hcd_remove,
++};
++
++static int __init fotg210_hcd_init(void)
++{
++	int retval = 0;
++
++	if (usb_disabled())
++		return -ENODEV;
++
++	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))
++		pr_warn("Warning! fotg210_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\n",
++			hcd_name, sizeof(struct fotg210_qh),
++			sizeof(struct fotg210_qtd),
++			sizeof(struct fotg210_itd));
++
++	fotg210_debug_root = debugfs_create_dir("fotg210", usb_debug_root);
++
++	retval = platform_driver_register(&fotg210_hcd_driver);
++	if (retval < 0)
++		goto clean;
++	return retval;
++
++clean:
++	debugfs_remove(fotg210_debug_root);
++	fotg210_debug_root = NULL;
++
++	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
++	return retval;
++}
++module_init(fotg210_hcd_init);
++
++static void __exit fotg210_hcd_cleanup(void)
++{
++	platform_driver_unregister(&fotg210_hcd_driver);
++	debugfs_remove(fotg210_debug_root);
++	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
++}
++module_exit(fotg210_hcd_cleanup);
+--- a/drivers/usb/gadget/udc/fotg210-udc.c
++++ /dev/null
+@@ -1,1239 +0,0 @@
+-// SPDX-License-Identifier: GPL-2.0
+-/*
+- * FOTG210 UDC Driver supports Bulk transfer so far
+- *
+- * Copyright (C) 2013 Faraday Technology Corporation
+- *
+- * Author : Yuan-Hsin Chen <yhchen at faraday-tech.com>
+- */
+-
+-#include <linux/dma-mapping.h>
+-#include <linux/err.h>
+-#include <linux/interrupt.h>
+-#include <linux/io.h>
+-#include <linux/module.h>
+-#include <linux/platform_device.h>
+-#include <linux/usb/ch9.h>
+-#include <linux/usb/gadget.h>
+-
+-#include "fotg210.h"
+-
+-#define	DRIVER_DESC	"FOTG210 USB Device Controller Driver"
+-#define	DRIVER_VERSION	"30-April-2013"
+-
+-static const char udc_name[] = "fotg210_udc";
+-static const char * const fotg210_ep_name[] = {
+-	"ep0", "ep1", "ep2", "ep3", "ep4"};
+-
+-static void fotg210_disable_fifo_int(struct fotg210_ep *ep)
+-{
+-	u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR1);
+-
+-	if (ep->dir_in)
+-		value |= DMISGR1_MF_IN_INT(ep->epnum - 1);
+-	else
+-		value |= DMISGR1_MF_OUTSPK_INT(ep->epnum - 1);
+-	iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR1);
+-}
+-
+-static void fotg210_enable_fifo_int(struct fotg210_ep *ep)
+-{
+-	u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR1);
+-
+-	if (ep->dir_in)
+-		value &= ~DMISGR1_MF_IN_INT(ep->epnum - 1);
+-	else
+-		value &= ~DMISGR1_MF_OUTSPK_INT(ep->epnum - 1);
+-	iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR1);
+-}
+-
+-static void fotg210_set_cxdone(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DCFESR);
+-
+-	value |= DCFESR_CX_DONE;
+-	iowrite32(value, fotg210->reg + FOTG210_DCFESR);
+-}
+-
+-static void fotg210_done(struct fotg210_ep *ep, struct fotg210_request *req,
+-			int status)
+-{
+-	list_del_init(&req->queue);
+-
+-	/* don't modify queue heads during completion callback */
+-	if (ep->fotg210->gadget.speed == USB_SPEED_UNKNOWN)
+-		req->req.status = -ESHUTDOWN;
+-	else
+-		req->req.status = status;
+-
+-	spin_unlock(&ep->fotg210->lock);
+-	usb_gadget_giveback_request(&ep->ep, &req->req);
+-	spin_lock(&ep->fotg210->lock);
+-
+-	if (ep->epnum) {
+-		if (list_empty(&ep->queue))
+-			fotg210_disable_fifo_int(ep);
+-	} else {
+-		fotg210_set_cxdone(ep->fotg210);
+-	}
+-}
+-
+-static void fotg210_fifo_ep_mapping(struct fotg210_ep *ep, u32 epnum,
+-				u32 dir_in)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 val;
+-
+-	/* Driver should map an ep to a fifo and then map the fifo
+-	 * to the ep. What a brain-damaged design!
+-	 */
+-
+-	/* map a fifo to an ep */
+-	val = ioread32(fotg210->reg + FOTG210_EPMAP);
+-	val &= ~EPMAP_FIFONOMSK(epnum, dir_in);
+-	val |= EPMAP_FIFONO(epnum, dir_in);
+-	iowrite32(val, fotg210->reg + FOTG210_EPMAP);
+-
+-	/* map the ep to the fifo */
+-	val = ioread32(fotg210->reg + FOTG210_FIFOMAP);
+-	val &= ~FIFOMAP_EPNOMSK(epnum);
+-	val |= FIFOMAP_EPNO(epnum);
+-	iowrite32(val, fotg210->reg + FOTG210_FIFOMAP);
+-
+-	/* enable fifo */
+-	val = ioread32(fotg210->reg + FOTG210_FIFOCF);
+-	val |= FIFOCF_FIFO_EN(epnum - 1);
+-	iowrite32(val, fotg210->reg + FOTG210_FIFOCF);
+-}
+-
+-static void fotg210_set_fifo_dir(struct fotg210_ep *ep, u32 epnum, u32 dir_in)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 val;
+-
+-	val = ioread32(fotg210->reg + FOTG210_FIFOMAP);
+-	val |= (dir_in ? FIFOMAP_DIRIN(epnum - 1) : FIFOMAP_DIROUT(epnum - 1));
+-	iowrite32(val, fotg210->reg + FOTG210_FIFOMAP);
+-}
+-
+-static void fotg210_set_tfrtype(struct fotg210_ep *ep, u32 epnum, u32 type)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 val;
+-
+-	val = ioread32(fotg210->reg + FOTG210_FIFOCF);
+-	val |= FIFOCF_TYPE(type, epnum - 1);
+-	iowrite32(val, fotg210->reg + FOTG210_FIFOCF);
+-}
+-
+-static void fotg210_set_mps(struct fotg210_ep *ep, u32 epnum, u32 mps,
+-				u32 dir_in)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 val;
+-	u32 offset = dir_in ? FOTG210_INEPMPSR(epnum) :
+-				FOTG210_OUTEPMPSR(epnum);
+-
+-	val = ioread32(fotg210->reg + offset);
+-	val |= INOUTEPMPSR_MPS(mps);
+-	iowrite32(val, fotg210->reg + offset);
+-}
+-
+-static int fotg210_config_ep(struct fotg210_ep *ep,
+-		     const struct usb_endpoint_descriptor *desc)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-
+-	fotg210_set_fifo_dir(ep, ep->epnum, ep->dir_in);
+-	fotg210_set_tfrtype(ep, ep->epnum, ep->type);
+-	fotg210_set_mps(ep, ep->epnum, ep->ep.maxpacket, ep->dir_in);
+-	fotg210_fifo_ep_mapping(ep, ep->epnum, ep->dir_in);
+-
+-	fotg210->ep[ep->epnum] = ep;
+-
+-	return 0;
+-}
+-
+-static int fotg210_ep_enable(struct usb_ep *_ep,
+-			  const struct usb_endpoint_descriptor *desc)
+-{
+-	struct fotg210_ep *ep;
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-
+-	ep->desc = desc;
+-	ep->epnum = usb_endpoint_num(desc);
+-	ep->type = usb_endpoint_type(desc);
+-	ep->dir_in = usb_endpoint_dir_in(desc);
+-	ep->ep.maxpacket = usb_endpoint_maxp(desc);
+-
+-	return fotg210_config_ep(ep, desc);
+-}
+-
+-static void fotg210_reset_tseq(struct fotg210_udc *fotg210, u8 epnum)
+-{
+-	struct fotg210_ep *ep = fotg210->ep[epnum];
+-	u32 value;
+-	void __iomem *reg;
+-
+-	reg = (ep->dir_in) ?
+-		fotg210->reg + FOTG210_INEPMPSR(epnum) :
+-		fotg210->reg + FOTG210_OUTEPMPSR(epnum);
+-
+-	/* Note: Driver needs to set and clear INOUTEPMPSR_RESET_TSEQ
+-	 *	 bit. Controller wouldn't clear this bit. WTF!!!
+-	 */
+-
+-	value = ioread32(reg);
+-	value |= INOUTEPMPSR_RESET_TSEQ;
+-	iowrite32(value, reg);
+-
+-	value = ioread32(reg);
+-	value &= ~INOUTEPMPSR_RESET_TSEQ;
+-	iowrite32(value, reg);
+-}
+-
+-static int fotg210_ep_release(struct fotg210_ep *ep)
+-{
+-	if (!ep->epnum)
+-		return 0;
+-	ep->epnum = 0;
+-	ep->stall = 0;
+-	ep->wedged = 0;
+-
+-	fotg210_reset_tseq(ep->fotg210, ep->epnum);
+-
+-	return 0;
+-}
+-
+-static int fotg210_ep_disable(struct usb_ep *_ep)
+-{
+-	struct fotg210_ep *ep;
+-	struct fotg210_request *req;
+-	unsigned long flags;
+-
+-	BUG_ON(!_ep);
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-
+-	while (!list_empty(&ep->queue)) {
+-		req = list_entry(ep->queue.next,
+-			struct fotg210_request, queue);
+-		spin_lock_irqsave(&ep->fotg210->lock, flags);
+-		fotg210_done(ep, req, -ECONNRESET);
+-		spin_unlock_irqrestore(&ep->fotg210->lock, flags);
+-	}
+-
+-	return fotg210_ep_release(ep);
+-}
+-
+-static struct usb_request *fotg210_ep_alloc_request(struct usb_ep *_ep,
+-						gfp_t gfp_flags)
+-{
+-	struct fotg210_request *req;
+-
+-	req = kzalloc(sizeof(struct fotg210_request), gfp_flags);
+-	if (!req)
+-		return NULL;
+-
+-	INIT_LIST_HEAD(&req->queue);
+-
+-	return &req->req;
+-}
+-
+-static void fotg210_ep_free_request(struct usb_ep *_ep,
+-					struct usb_request *_req)
+-{
+-	struct fotg210_request *req;
+-
+-	req = container_of(_req, struct fotg210_request, req);
+-	kfree(req);
+-}
+-
+-static void fotg210_enable_dma(struct fotg210_ep *ep,
+-			      dma_addr_t d, u32 len)
+-{
+-	u32 value;
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-
+-	/* set transfer length and direction */
+-	value = ioread32(fotg210->reg + FOTG210_DMACPSR1);
+-	value &= ~(DMACPSR1_DMA_LEN(0xFFFF) | DMACPSR1_DMA_TYPE(1));
+-	value |= DMACPSR1_DMA_LEN(len) | DMACPSR1_DMA_TYPE(ep->dir_in);
+-	iowrite32(value, fotg210->reg + FOTG210_DMACPSR1);
+-
+-	/* set device DMA target FIFO number */
+-	value = ioread32(fotg210->reg + FOTG210_DMATFNR);
+-	if (ep->epnum)
+-		value |= DMATFNR_ACC_FN(ep->epnum - 1);
+-	else
+-		value |= DMATFNR_ACC_CXF;
+-	iowrite32(value, fotg210->reg + FOTG210_DMATFNR);
+-
+-	/* set DMA memory address */
+-	iowrite32(d, fotg210->reg + FOTG210_DMACPSR2);
+-
+-	/* enable MDMA_EROR and MDMA_CMPLT interrupt */
+-	value = ioread32(fotg210->reg + FOTG210_DMISGR2);
+-	value &= ~(DMISGR2_MDMA_CMPLT | DMISGR2_MDMA_ERROR);
+-	iowrite32(value, fotg210->reg + FOTG210_DMISGR2);
+-
+-	/* start DMA */
+-	value = ioread32(fotg210->reg + FOTG210_DMACPSR1);
+-	value |= DMACPSR1_DMA_START;
+-	iowrite32(value, fotg210->reg + FOTG210_DMACPSR1);
+-}
+-
+-static void fotg210_disable_dma(struct fotg210_ep *ep)
+-{
+-	iowrite32(DMATFNR_DISDMA, ep->fotg210->reg + FOTG210_DMATFNR);
+-}
+-
+-static void fotg210_wait_dma_done(struct fotg210_ep *ep)
+-{
+-	u32 value;
+-
+-	do {
+-		value = ioread32(ep->fotg210->reg + FOTG210_DISGR2);
+-		if ((value & DISGR2_USBRST_INT) ||
+-		    (value & DISGR2_DMA_ERROR))
+-			goto dma_reset;
+-	} while (!(value & DISGR2_DMA_CMPLT));
+-
+-	value &= ~DISGR2_DMA_CMPLT;
+-	iowrite32(value, ep->fotg210->reg + FOTG210_DISGR2);
+-	return;
+-
+-dma_reset:
+-	value = ioread32(ep->fotg210->reg + FOTG210_DMACPSR1);
+-	value |= DMACPSR1_DMA_ABORT;
+-	iowrite32(value, ep->fotg210->reg + FOTG210_DMACPSR1);
+-
+-	/* reset fifo */
+-	if (ep->epnum) {
+-		value = ioread32(ep->fotg210->reg +
+-				FOTG210_FIBCR(ep->epnum - 1));
+-		value |= FIBCR_FFRST;
+-		iowrite32(value, ep->fotg210->reg +
+-				FOTG210_FIBCR(ep->epnum - 1));
+-	} else {
+-		value = ioread32(ep->fotg210->reg + FOTG210_DCFESR);
+-		value |= DCFESR_CX_CLR;
+-		iowrite32(value, ep->fotg210->reg + FOTG210_DCFESR);
+-	}
+-}
+-
+-static void fotg210_start_dma(struct fotg210_ep *ep,
+-			struct fotg210_request *req)
+-{
+-	struct device *dev = &ep->fotg210->gadget.dev;
+-	dma_addr_t d;
+-	u8 *buffer;
+-	u32 length;
+-
+-	if (ep->epnum) {
+-		if (ep->dir_in) {
+-			buffer = req->req.buf;
+-			length = req->req.length;
+-		} else {
+-			buffer = req->req.buf + req->req.actual;
+-			length = ioread32(ep->fotg210->reg +
+-					FOTG210_FIBCR(ep->epnum - 1)) & FIBCR_BCFX;
+-			if (length > req->req.length - req->req.actual)
+-				length = req->req.length - req->req.actual;
+-		}
+-	} else {
+-		buffer = req->req.buf + req->req.actual;
+-		if (req->req.length - req->req.actual > ep->ep.maxpacket)
+-			length = ep->ep.maxpacket;
+-		else
+-			length = req->req.length - req->req.actual;
+-	}
+-
+-	d = dma_map_single(dev, buffer, length,
+-			ep->dir_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
+-
+-	if (dma_mapping_error(dev, d)) {
+-		pr_err("dma_mapping_error\n");
+-		return;
+-	}
+-
+-	fotg210_enable_dma(ep, d, length);
+-
+-	/* check if dma is done */
+-	fotg210_wait_dma_done(ep);
+-
+-	fotg210_disable_dma(ep);
+-
+-	/* update actual transfer length */
+-	req->req.actual += length;
+-
+-	dma_unmap_single(dev, d, length, DMA_TO_DEVICE);
+-}
+-
+-static void fotg210_ep0_queue(struct fotg210_ep *ep,
+-				struct fotg210_request *req)
+-{
+-	if (!req->req.length) {
+-		fotg210_done(ep, req, 0);
+-		return;
+-	}
+-	if (ep->dir_in) { /* if IN */
+-		fotg210_start_dma(ep, req);
+-		if (req->req.length == req->req.actual)
+-			fotg210_done(ep, req, 0);
+-	} else { /* OUT */
+-		u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR0);
+-
+-		value &= ~DMISGR0_MCX_OUT_INT;
+-		iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR0);
+-	}
+-}
+-
+-static int fotg210_ep_queue(struct usb_ep *_ep, struct usb_request *_req,
+-				gfp_t gfp_flags)
+-{
+-	struct fotg210_ep *ep;
+-	struct fotg210_request *req;
+-	unsigned long flags;
+-	int request = 0;
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-	req = container_of(_req, struct fotg210_request, req);
+-
+-	if (ep->fotg210->gadget.speed == USB_SPEED_UNKNOWN)
+-		return -ESHUTDOWN;
+-
+-	spin_lock_irqsave(&ep->fotg210->lock, flags);
+-
+-	if (list_empty(&ep->queue))
+-		request = 1;
+-
+-	list_add_tail(&req->queue, &ep->queue);
+-
+-	req->req.actual = 0;
+-	req->req.status = -EINPROGRESS;
+-
+-	if (!ep->epnum) /* ep0 */
+-		fotg210_ep0_queue(ep, req);
+-	else if (request && !ep->stall)
+-		fotg210_enable_fifo_int(ep);
+-
+-	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
+-
+-	return 0;
+-}
+-
+-static int fotg210_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
+-{
+-	struct fotg210_ep *ep;
+-	struct fotg210_request *req;
+-	unsigned long flags;
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-	req = container_of(_req, struct fotg210_request, req);
+-
+-	spin_lock_irqsave(&ep->fotg210->lock, flags);
+-	if (!list_empty(&ep->queue))
+-		fotg210_done(ep, req, -ECONNRESET);
+-	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
+-
+-	return 0;
+-}
+-
+-static void fotg210_set_epnstall(struct fotg210_ep *ep)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 value;
+-	void __iomem *reg;
+-
+-	/* check if IN FIFO is empty before stall */
+-	if (ep->dir_in) {
+-		do {
+-			value = ioread32(fotg210->reg + FOTG210_DCFESR);
+-		} while (!(value & DCFESR_FIFO_EMPTY(ep->epnum - 1)));
+-	}
+-
+-	reg = (ep->dir_in) ?
+-		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
+-		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
+-	value = ioread32(reg);
+-	value |= INOUTEPMPSR_STL_EP;
+-	iowrite32(value, reg);
+-}
+-
+-static void fotg210_clear_epnstall(struct fotg210_ep *ep)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 value;
+-	void __iomem *reg;
+-
+-	reg = (ep->dir_in) ?
+-		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
+-		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
+-	value = ioread32(reg);
+-	value &= ~INOUTEPMPSR_STL_EP;
+-	iowrite32(value, reg);
+-}
+-
+-static int fotg210_set_halt_and_wedge(struct usb_ep *_ep, int value, int wedge)
+-{
+-	struct fotg210_ep *ep;
+-	struct fotg210_udc *fotg210;
+-	unsigned long flags;
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-
+-	fotg210 = ep->fotg210;
+-
+-	spin_lock_irqsave(&ep->fotg210->lock, flags);
+-
+-	if (value) {
+-		fotg210_set_epnstall(ep);
+-		ep->stall = 1;
+-		if (wedge)
+-			ep->wedged = 1;
+-	} else {
+-		fotg210_reset_tseq(fotg210, ep->epnum);
+-		fotg210_clear_epnstall(ep);
+-		ep->stall = 0;
+-		ep->wedged = 0;
+-		if (!list_empty(&ep->queue))
+-			fotg210_enable_fifo_int(ep);
+-	}
+-
+-	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
+-	return 0;
+-}
+-
+-static int fotg210_ep_set_halt(struct usb_ep *_ep, int value)
+-{
+-	return fotg210_set_halt_and_wedge(_ep, value, 0);
+-}
+-
+-static int fotg210_ep_set_wedge(struct usb_ep *_ep)
+-{
+-	return fotg210_set_halt_and_wedge(_ep, 1, 1);
+-}
+-
+-static void fotg210_ep_fifo_flush(struct usb_ep *_ep)
+-{
+-}
+-
+-static const struct usb_ep_ops fotg210_ep_ops = {
+-	.enable		= fotg210_ep_enable,
+-	.disable	= fotg210_ep_disable,
+-
+-	.alloc_request	= fotg210_ep_alloc_request,
+-	.free_request	= fotg210_ep_free_request,
+-
+-	.queue		= fotg210_ep_queue,
+-	.dequeue	= fotg210_ep_dequeue,
+-
+-	.set_halt	= fotg210_ep_set_halt,
+-	.fifo_flush	= fotg210_ep_fifo_flush,
+-	.set_wedge	= fotg210_ep_set_wedge,
+-};
+-
+-static void fotg210_clear_tx0byte(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_TX0BYTE);
+-
+-	value &= ~(TX0BYTE_EP1 | TX0BYTE_EP2 | TX0BYTE_EP3
+-		   | TX0BYTE_EP4);
+-	iowrite32(value, fotg210->reg + FOTG210_TX0BYTE);
+-}
+-
+-static void fotg210_clear_rx0byte(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_RX0BYTE);
+-
+-	value &= ~(RX0BYTE_EP1 | RX0BYTE_EP2 | RX0BYTE_EP3
+-		   | RX0BYTE_EP4);
+-	iowrite32(value, fotg210->reg + FOTG210_RX0BYTE);
+-}
+-
+-/* read 8-byte setup packet only */
+-static void fotg210_rdsetupp(struct fotg210_udc *fotg210,
+-		   u8 *buffer)
+-{
+-	int i = 0;
+-	u8 *tmp = buffer;
+-	u32 data;
+-	u32 length = 8;
+-
+-	iowrite32(DMATFNR_ACC_CXF, fotg210->reg + FOTG210_DMATFNR);
+-
+-	for (i = (length >> 2); i > 0; i--) {
+-		data = ioread32(fotg210->reg + FOTG210_CXPORT);
+-		*tmp = data & 0xFF;
+-		*(tmp + 1) = (data >> 8) & 0xFF;
+-		*(tmp + 2) = (data >> 16) & 0xFF;
+-		*(tmp + 3) = (data >> 24) & 0xFF;
+-		tmp = tmp + 4;
+-	}
+-
+-	switch (length % 4) {
+-	case 1:
+-		data = ioread32(fotg210->reg + FOTG210_CXPORT);
+-		*tmp = data & 0xFF;
+-		break;
+-	case 2:
+-		data = ioread32(fotg210->reg + FOTG210_CXPORT);
+-		*tmp = data & 0xFF;
+-		*(tmp + 1) = (data >> 8) & 0xFF;
+-		break;
+-	case 3:
+-		data = ioread32(fotg210->reg + FOTG210_CXPORT);
+-		*tmp = data & 0xFF;
+-		*(tmp + 1) = (data >> 8) & 0xFF;
+-		*(tmp + 2) = (data >> 16) & 0xFF;
+-		break;
+-	default:
+-		break;
+-	}
+-
+-	iowrite32(DMATFNR_DISDMA, fotg210->reg + FOTG210_DMATFNR);
+-}
+-
+-static void fotg210_set_configuration(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DAR);
+-
+-	value |= DAR_AFT_CONF;
+-	iowrite32(value, fotg210->reg + FOTG210_DAR);
+-}
+-
+-static void fotg210_set_dev_addr(struct fotg210_udc *fotg210, u32 addr)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DAR);
+-
+-	value |= (addr & 0x7F);
+-	iowrite32(value, fotg210->reg + FOTG210_DAR);
+-}
+-
+-static void fotg210_set_cxstall(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DCFESR);
+-
+-	value |= DCFESR_CX_STL;
+-	iowrite32(value, fotg210->reg + FOTG210_DCFESR);
+-}
+-
+-static void fotg210_request_error(struct fotg210_udc *fotg210)
+-{
+-	fotg210_set_cxstall(fotg210);
+-	pr_err("request error!!\n");
+-}
+-
+-static void fotg210_set_address(struct fotg210_udc *fotg210,
+-				struct usb_ctrlrequest *ctrl)
+-{
+-	if (le16_to_cpu(ctrl->wValue) >= 0x0100) {
+-		fotg210_request_error(fotg210);
+-	} else {
+-		fotg210_set_dev_addr(fotg210, le16_to_cpu(ctrl->wValue));
+-		fotg210_set_cxdone(fotg210);
+-	}
+-}
+-
+-static void fotg210_set_feature(struct fotg210_udc *fotg210,
+-				struct usb_ctrlrequest *ctrl)
+-{
+-	switch (ctrl->bRequestType & USB_RECIP_MASK) {
+-	case USB_RECIP_DEVICE:
+-		fotg210_set_cxdone(fotg210);
+-		break;
+-	case USB_RECIP_INTERFACE:
+-		fotg210_set_cxdone(fotg210);
+-		break;
+-	case USB_RECIP_ENDPOINT: {
+-		u8 epnum;
+-		epnum = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
+-		if (epnum)
+-			fotg210_set_epnstall(fotg210->ep[epnum]);
+-		else
+-			fotg210_set_cxstall(fotg210);
+-		fotg210_set_cxdone(fotg210);
+-		}
+-		break;
+-	default:
+-		fotg210_request_error(fotg210);
+-		break;
+-	}
+-}
+-
+-static void fotg210_clear_feature(struct fotg210_udc *fotg210,
+-				struct usb_ctrlrequest *ctrl)
+-{
+-	struct fotg210_ep *ep =
+-		fotg210->ep[ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK];
+-
+-	switch (ctrl->bRequestType & USB_RECIP_MASK) {
+-	case USB_RECIP_DEVICE:
+-		fotg210_set_cxdone(fotg210);
+-		break;
+-	case USB_RECIP_INTERFACE:
+-		fotg210_set_cxdone(fotg210);
+-		break;
+-	case USB_RECIP_ENDPOINT:
+-		if (ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK) {
+-			if (ep->wedged) {
+-				fotg210_set_cxdone(fotg210);
+-				break;
+-			}
+-			if (ep->stall)
+-				fotg210_set_halt_and_wedge(&ep->ep, 0, 0);
+-		}
+-		fotg210_set_cxdone(fotg210);
+-		break;
+-	default:
+-		fotg210_request_error(fotg210);
+-		break;
+-	}
+-}
+-
+-static int fotg210_is_epnstall(struct fotg210_ep *ep)
+-{
+-	struct fotg210_udc *fotg210 = ep->fotg210;
+-	u32 value;
+-	void __iomem *reg;
+-
+-	reg = (ep->dir_in) ?
+-		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
+-		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
+-	value = ioread32(reg);
+-	return value & INOUTEPMPSR_STL_EP ? 1 : 0;
+-}
+-
+-/* For EP0 requests triggered by this driver (currently GET_STATUS response) */
+-static void fotg210_ep0_complete(struct usb_ep *_ep, struct usb_request *req)
+-{
+-	struct fotg210_ep *ep;
+-	struct fotg210_udc *fotg210;
+-
+-	ep = container_of(_ep, struct fotg210_ep, ep);
+-	fotg210 = ep->fotg210;
+-
+-	if (req->status || req->actual != req->length) {
+-		dev_warn(&fotg210->gadget.dev, "EP0 request failed: %d\n", req->status);
+-	}
+-}
+-
+-static void fotg210_get_status(struct fotg210_udc *fotg210,
+-				struct usb_ctrlrequest *ctrl)
+-{
+-	u8 epnum;
+-
+-	switch (ctrl->bRequestType & USB_RECIP_MASK) {
+-	case USB_RECIP_DEVICE:
+-		fotg210->ep0_data = cpu_to_le16(1 << USB_DEVICE_SELF_POWERED);
+-		break;
+-	case USB_RECIP_INTERFACE:
+-		fotg210->ep0_data = cpu_to_le16(0);
+-		break;
+-	case USB_RECIP_ENDPOINT:
+-		epnum = ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK;
+-		if (epnum)
+-			fotg210->ep0_data =
+-				cpu_to_le16(fotg210_is_epnstall(fotg210->ep[epnum])
+-					    << USB_ENDPOINT_HALT);
+-		else
+-			fotg210_request_error(fotg210);
+-		break;
+-
+-	default:
+-		fotg210_request_error(fotg210);
+-		return;		/* exit */
+-	}
+-
+-	fotg210->ep0_req->buf = &fotg210->ep0_data;
+-	fotg210->ep0_req->length = 2;
+-
+-	spin_unlock(&fotg210->lock);
+-	fotg210_ep_queue(fotg210->gadget.ep0, fotg210->ep0_req, GFP_ATOMIC);
+-	spin_lock(&fotg210->lock);
+-}
+-
+-static int fotg210_setup_packet(struct fotg210_udc *fotg210,
+-				struct usb_ctrlrequest *ctrl)
+-{
+-	u8 *p = (u8 *)ctrl;
+-	u8 ret = 0;
+-
+-	fotg210_rdsetupp(fotg210, p);
+-
+-	fotg210->ep[0]->dir_in = ctrl->bRequestType & USB_DIR_IN;
+-
+-	if (fotg210->gadget.speed == USB_SPEED_UNKNOWN) {
+-		u32 value = ioread32(fotg210->reg + FOTG210_DMCR);
+-		fotg210->gadget.speed = value & DMCR_HS_EN ?
+-				USB_SPEED_HIGH : USB_SPEED_FULL;
+-	}
+-
+-	/* check request */
+-	if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
+-		switch (ctrl->bRequest) {
+-		case USB_REQ_GET_STATUS:
+-			fotg210_get_status(fotg210, ctrl);
+-			break;
+-		case USB_REQ_CLEAR_FEATURE:
+-			fotg210_clear_feature(fotg210, ctrl);
+-			break;
+-		case USB_REQ_SET_FEATURE:
+-			fotg210_set_feature(fotg210, ctrl);
+-			break;
+-		case USB_REQ_SET_ADDRESS:
+-			fotg210_set_address(fotg210, ctrl);
+-			break;
+-		case USB_REQ_SET_CONFIGURATION:
+-			fotg210_set_configuration(fotg210);
+-			ret = 1;
+-			break;
+-		default:
+-			ret = 1;
+-			break;
+-		}
+-	} else {
+-		ret = 1;
+-	}
+-
+-	return ret;
+-}
+-
+-static void fotg210_ep0out(struct fotg210_udc *fotg210)
+-{
+-	struct fotg210_ep *ep = fotg210->ep[0];
+-
+-	if (!list_empty(&ep->queue) && !ep->dir_in) {
+-		struct fotg210_request *req;
+-
+-		req = list_first_entry(&ep->queue,
+-			struct fotg210_request, queue);
+-
+-		if (req->req.length)
+-			fotg210_start_dma(ep, req);
+-
+-		if ((req->req.length - req->req.actual) < ep->ep.maxpacket)
+-			fotg210_done(ep, req, 0);
+-	} else {
+-		pr_err("%s : empty queue\n", __func__);
+-	}
+-}
+-
+-static void fotg210_ep0in(struct fotg210_udc *fotg210)
+-{
+-	struct fotg210_ep *ep = fotg210->ep[0];
+-
+-	if ((!list_empty(&ep->queue)) && (ep->dir_in)) {
+-		struct fotg210_request *req;
+-
+-		req = list_entry(ep->queue.next,
+-				struct fotg210_request, queue);
+-
+-		if (req->req.length)
+-			fotg210_start_dma(ep, req);
+-
+-		if (req->req.actual == req->req.length)
+-			fotg210_done(ep, req, 0);
+-	} else {
+-		fotg210_set_cxdone(fotg210);
+-	}
+-}
+-
+-static void fotg210_clear_comabt_int(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DISGR0);
+-
+-	value &= ~DISGR0_CX_COMABT_INT;
+-	iowrite32(value, fotg210->reg + FOTG210_DISGR0);
+-}
+-
+-static void fotg210_in_fifo_handler(struct fotg210_ep *ep)
+-{
+-	struct fotg210_request *req = list_entry(ep->queue.next,
+-					struct fotg210_request, queue);
+-
+-	if (req->req.length)
+-		fotg210_start_dma(ep, req);
+-	fotg210_done(ep, req, 0);
+-}
+-
+-static void fotg210_out_fifo_handler(struct fotg210_ep *ep)
+-{
+-	struct fotg210_request *req = list_entry(ep->queue.next,
+-						 struct fotg210_request, queue);
+-	int disgr1 = ioread32(ep->fotg210->reg + FOTG210_DISGR1);
+-
+-	fotg210_start_dma(ep, req);
+-
+-	/* Complete the request when it's full or a short packet arrived.
+-	 * Like other drivers, short_not_ok isn't handled.
+-	 */
+-
+-	if (req->req.length == req->req.actual ||
+-	    (disgr1 & DISGR1_SPK_INT(ep->epnum - 1)))
+-		fotg210_done(ep, req, 0);
+-}
+-
+-static irqreturn_t fotg210_irq(int irq, void *_fotg210)
+-{
+-	struct fotg210_udc *fotg210 = _fotg210;
+-	u32 int_grp = ioread32(fotg210->reg + FOTG210_DIGR);
+-	u32 int_msk = ioread32(fotg210->reg + FOTG210_DMIGR);
+-
+-	int_grp &= ~int_msk;
+-
+-	spin_lock(&fotg210->lock);
+-
+-	if (int_grp & DIGR_INT_G2) {
+-		void __iomem *reg = fotg210->reg + FOTG210_DISGR2;
+-		u32 int_grp2 = ioread32(reg);
+-		u32 int_msk2 = ioread32(fotg210->reg + FOTG210_DMISGR2);
+-		u32 value;
+-
+-		int_grp2 &= ~int_msk2;
+-
+-		if (int_grp2 & DISGR2_USBRST_INT) {
+-			usb_gadget_udc_reset(&fotg210->gadget,
+-					     fotg210->driver);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_USBRST_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 udc reset\n");
+-		}
+-		if (int_grp2 & DISGR2_SUSP_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_SUSP_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 udc suspend\n");
+-		}
+-		if (int_grp2 & DISGR2_RESM_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_RESM_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 udc resume\n");
+-		}
+-		if (int_grp2 & DISGR2_ISO_SEQ_ERR_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_ISO_SEQ_ERR_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 iso sequence error\n");
+-		}
+-		if (int_grp2 & DISGR2_ISO_SEQ_ABORT_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_ISO_SEQ_ABORT_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 iso sequence abort\n");
+-		}
+-		if (int_grp2 & DISGR2_TX0BYTE_INT) {
+-			fotg210_clear_tx0byte(fotg210);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_TX0BYTE_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 transferred 0 byte\n");
+-		}
+-		if (int_grp2 & DISGR2_RX0BYTE_INT) {
+-			fotg210_clear_rx0byte(fotg210);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_RX0BYTE_INT;
+-			iowrite32(value, reg);
+-			pr_info("fotg210 received 0 byte\n");
+-		}
+-		if (int_grp2 & DISGR2_DMA_ERROR) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_DMA_ERROR;
+-			iowrite32(value, reg);
+-		}
+-	}
+-
+-	if (int_grp & DIGR_INT_G0) {
+-		void __iomem *reg = fotg210->reg + FOTG210_DISGR0;
+-		u32 int_grp0 = ioread32(reg);
+-		u32 int_msk0 = ioread32(fotg210->reg + FOTG210_DMISGR0);
+-		struct usb_ctrlrequest ctrl;
+-
+-		int_grp0 &= ~int_msk0;
+-
+-		/* the highest priority in this source register */
+-		if (int_grp0 & DISGR0_CX_COMABT_INT) {
+-			fotg210_clear_comabt_int(fotg210);
+-			pr_info("fotg210 CX command abort\n");
+-		}
+-
+-		if (int_grp0 & DISGR0_CX_SETUP_INT) {
+-			if (fotg210_setup_packet(fotg210, &ctrl)) {
+-				spin_unlock(&fotg210->lock);
+-				if (fotg210->driver->setup(&fotg210->gadget,
+-							   &ctrl) < 0)
+-					fotg210_set_cxstall(fotg210);
+-				spin_lock(&fotg210->lock);
+-			}
+-		}
+-		if (int_grp0 & DISGR0_CX_COMEND_INT)
+-			pr_info("fotg210 cmd end\n");
+-
+-		if (int_grp0 & DISGR0_CX_IN_INT)
+-			fotg210_ep0in(fotg210);
+-
+-		if (int_grp0 & DISGR0_CX_OUT_INT)
+-			fotg210_ep0out(fotg210);
+-
+-		if (int_grp0 & DISGR0_CX_COMFAIL_INT) {
+-			fotg210_set_cxstall(fotg210);
+-			pr_info("fotg210 ep0 fail\n");
+-		}
+-	}
+-
+-	if (int_grp & DIGR_INT_G1) {
+-		void __iomem *reg = fotg210->reg + FOTG210_DISGR1;
+-		u32 int_grp1 = ioread32(reg);
+-		u32 int_msk1 = ioread32(fotg210->reg + FOTG210_DMISGR1);
+-		int fifo;
+-
+-		int_grp1 &= ~int_msk1;
+-
+-		for (fifo = 0; fifo < FOTG210_MAX_FIFO_NUM; fifo++) {
+-			if (int_grp1 & DISGR1_IN_INT(fifo))
+-				fotg210_in_fifo_handler(fotg210->ep[fifo + 1]);
+-
+-			if ((int_grp1 & DISGR1_OUT_INT(fifo)) ||
+-			    (int_grp1 & DISGR1_SPK_INT(fifo)))
+-				fotg210_out_fifo_handler(fotg210->ep[fifo + 1]);
+-		}
+-	}
+-
+-	spin_unlock(&fotg210->lock);
+-
+-	return IRQ_HANDLED;
+-}
+-
+-static void fotg210_disable_unplug(struct fotg210_udc *fotg210)
+-{
+-	u32 reg = ioread32(fotg210->reg + FOTG210_PHYTMSR);
+-
+-	reg &= ~PHYTMSR_UNPLUG;
+-	iowrite32(reg, fotg210->reg + FOTG210_PHYTMSR);
+-}
+-
+-static int fotg210_udc_start(struct usb_gadget *g,
+-		struct usb_gadget_driver *driver)
+-{
+-	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
+-	u32 value;
+-
+-	/* hook up the driver */
+-	fotg210->driver = driver;
+-
+-	/* enable device global interrupt */
+-	value = ioread32(fotg210->reg + FOTG210_DMCR);
+-	value |= DMCR_GLINT_EN;
+-	iowrite32(value, fotg210->reg + FOTG210_DMCR);
+-
+-	return 0;
+-}
+-
+-static void fotg210_init(struct fotg210_udc *fotg210)
+-{
+-	u32 value;
+-
+-	/* disable global interrupt and set int polarity to active high */
+-	iowrite32(GMIR_MHC_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
+-		  fotg210->reg + FOTG210_GMIR);
+-
+-	/* disable device global interrupt */
+-	value = ioread32(fotg210->reg + FOTG210_DMCR);
+-	value &= ~DMCR_GLINT_EN;
+-	iowrite32(value, fotg210->reg + FOTG210_DMCR);
+-
+-	/* enable only grp2 irqs we handle */
+-	iowrite32(~(DISGR2_DMA_ERROR | DISGR2_RX0BYTE_INT | DISGR2_TX0BYTE_INT
+-		    | DISGR2_ISO_SEQ_ABORT_INT | DISGR2_ISO_SEQ_ERR_INT
+-		    | DISGR2_RESM_INT | DISGR2_SUSP_INT | DISGR2_USBRST_INT),
+-		  fotg210->reg + FOTG210_DMISGR2);
+-
+-	/* disable all fifo interrupt */
+-	iowrite32(~(u32)0, fotg210->reg + FOTG210_DMISGR1);
+-
+-	/* disable cmd end */
+-	value = ioread32(fotg210->reg + FOTG210_DMISGR0);
+-	value |= DMISGR0_MCX_COMEND;
+-	iowrite32(value, fotg210->reg + FOTG210_DMISGR0);
+-}
+-
+-static int fotg210_udc_stop(struct usb_gadget *g)
+-{
+-	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
+-	unsigned long	flags;
+-
+-	spin_lock_irqsave(&fotg210->lock, flags);
+-
+-	fotg210_init(fotg210);
+-	fotg210->driver = NULL;
+-
+-	spin_unlock_irqrestore(&fotg210->lock, flags);
+-
+-	return 0;
+-}
+-
+-static const struct usb_gadget_ops fotg210_gadget_ops = {
+-	.udc_start		= fotg210_udc_start,
+-	.udc_stop		= fotg210_udc_stop,
+-};
+-
+-static int fotg210_udc_remove(struct platform_device *pdev)
+-{
+-	struct fotg210_udc *fotg210 = platform_get_drvdata(pdev);
+-	int i;
+-
+-	usb_del_gadget_udc(&fotg210->gadget);
+-	iounmap(fotg210->reg);
+-	free_irq(platform_get_irq(pdev, 0), fotg210);
+-
+-	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
+-	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+-		kfree(fotg210->ep[i]);
+-	kfree(fotg210);
+-
+-	return 0;
+-}
+-
+-static int fotg210_udc_probe(struct platform_device *pdev)
+-{
+-	struct resource *res, *ires;
+-	struct fotg210_udc *fotg210 = NULL;
+-	struct fotg210_ep *_ep[FOTG210_MAX_NUM_EP];
+-	int ret = 0;
+-	int i;
+-
+-	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-	if (!res) {
+-		pr_err("platform_get_resource error.\n");
+-		return -ENODEV;
+-	}
+-
+-	ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
+-	if (!ires) {
+-		pr_err("platform_get_resource IORESOURCE_IRQ error.\n");
+-		return -ENODEV;
+-	}
+-
+-	ret = -ENOMEM;
+-
+-	/* initialize udc */
+-	fotg210 = kzalloc(sizeof(struct fotg210_udc), GFP_KERNEL);
+-	if (fotg210 == NULL)
+-		goto err;
+-
+-	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
+-		_ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
+-		if (_ep[i] == NULL)
+-			goto err_alloc;
+-		fotg210->ep[i] = _ep[i];
+-	}
+-
+-	fotg210->reg = ioremap(res->start, resource_size(res));
+-	if (fotg210->reg == NULL) {
+-		pr_err("ioremap error.\n");
+-		goto err_alloc;
+-	}
+-
+-	spin_lock_init(&fotg210->lock);
+-
+-	platform_set_drvdata(pdev, fotg210);
+-
+-	fotg210->gadget.ops = &fotg210_gadget_ops;
+-
+-	fotg210->gadget.max_speed = USB_SPEED_HIGH;
+-	fotg210->gadget.dev.parent = &pdev->dev;
+-	fotg210->gadget.dev.dma_mask = pdev->dev.dma_mask;
+-	fotg210->gadget.name = udc_name;
+-
+-	INIT_LIST_HEAD(&fotg210->gadget.ep_list);
+-
+-	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
+-		struct fotg210_ep *ep = fotg210->ep[i];
+-
+-		if (i) {
+-			INIT_LIST_HEAD(&fotg210->ep[i]->ep.ep_list);
+-			list_add_tail(&fotg210->ep[i]->ep.ep_list,
+-				      &fotg210->gadget.ep_list);
+-		}
+-		ep->fotg210 = fotg210;
+-		INIT_LIST_HEAD(&ep->queue);
+-		ep->ep.name = fotg210_ep_name[i];
+-		ep->ep.ops = &fotg210_ep_ops;
+-		usb_ep_set_maxpacket_limit(&ep->ep, (unsigned short) ~0);
+-
+-		if (i == 0) {
+-			ep->ep.caps.type_control = true;
+-		} else {
+-			ep->ep.caps.type_iso = true;
+-			ep->ep.caps.type_bulk = true;
+-			ep->ep.caps.type_int = true;
+-		}
+-
+-		ep->ep.caps.dir_in = true;
+-		ep->ep.caps.dir_out = true;
+-	}
+-	usb_ep_set_maxpacket_limit(&fotg210->ep[0]->ep, 0x40);
+-	fotg210->gadget.ep0 = &fotg210->ep[0]->ep;
+-	INIT_LIST_HEAD(&fotg210->gadget.ep0->ep_list);
+-
+-	fotg210->ep0_req = fotg210_ep_alloc_request(&fotg210->ep[0]->ep,
+-				GFP_KERNEL);
+-	if (fotg210->ep0_req == NULL)
+-		goto err_map;
+-
+-	fotg210->ep0_req->complete = fotg210_ep0_complete;
+-
+-	fotg210_init(fotg210);
+-
+-	fotg210_disable_unplug(fotg210);
+-
+-	ret = request_irq(ires->start, fotg210_irq, IRQF_SHARED,
+-			  udc_name, fotg210);
+-	if (ret < 0) {
+-		pr_err("request_irq error (%d)\n", ret);
+-		goto err_req;
+-	}
+-
+-	ret = usb_add_gadget_udc(&pdev->dev, &fotg210->gadget);
+-	if (ret)
+-		goto err_add_udc;
+-
+-	dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION);
+-
+-	return 0;
+-
+-err_add_udc:
+-	free_irq(ires->start, fotg210);
+-
+-err_req:
+-	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
+-
+-err_map:
+-	iounmap(fotg210->reg);
+-
+-err_alloc:
+-	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+-		kfree(fotg210->ep[i]);
+-	kfree(fotg210);
+-
+-err:
+-	return ret;
+-}
+-
+-static struct platform_driver fotg210_driver = {
+-	.driver		= {
+-		.name =	udc_name,
+-	},
+-	.probe		= fotg210_udc_probe,
+-	.remove		= fotg210_udc_remove,
+-};
+-
+-module_platform_driver(fotg210_driver);
+-
+-MODULE_AUTHOR("Yuan-Hsin Chen, Feng-Hsin Chiang <john453 at faraday-tech.com>");
+-MODULE_LICENSE("GPL");
+-MODULE_DESCRIPTION(DRIVER_DESC);
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -0,0 +1,1239 @@
++// SPDX-License-Identifier: GPL-2.0
++/*
++ * FOTG210 UDC Driver supports Bulk transfer so far
++ *
++ * Copyright (C) 2013 Faraday Technology Corporation
++ *
++ * Author : Yuan-Hsin Chen <yhchen at faraday-tech.com>
++ */
++
++#include <linux/dma-mapping.h>
++#include <linux/err.h>
++#include <linux/interrupt.h>
++#include <linux/io.h>
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/usb/ch9.h>
++#include <linux/usb/gadget.h>
++
++#include "fotg210-udc.h"
++
++#define	DRIVER_DESC	"FOTG210 USB Device Controller Driver"
++#define	DRIVER_VERSION	"30-April-2013"
++
++static const char udc_name[] = "fotg210_udc";
++static const char * const fotg210_ep_name[] = {
++	"ep0", "ep1", "ep2", "ep3", "ep4"};
++
++static void fotg210_disable_fifo_int(struct fotg210_ep *ep)
++{
++	u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR1);
++
++	if (ep->dir_in)
++		value |= DMISGR1_MF_IN_INT(ep->epnum - 1);
++	else
++		value |= DMISGR1_MF_OUTSPK_INT(ep->epnum - 1);
++	iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR1);
++}
++
++static void fotg210_enable_fifo_int(struct fotg210_ep *ep)
++{
++	u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR1);
++
++	if (ep->dir_in)
++		value &= ~DMISGR1_MF_IN_INT(ep->epnum - 1);
++	else
++		value &= ~DMISGR1_MF_OUTSPK_INT(ep->epnum - 1);
++	iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR1);
++}
++
++static void fotg210_set_cxdone(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_DCFESR);
++
++	value |= DCFESR_CX_DONE;
++	iowrite32(value, fotg210->reg + FOTG210_DCFESR);
++}
++
++static void fotg210_done(struct fotg210_ep *ep, struct fotg210_request *req,
++			int status)
++{
++	list_del_init(&req->queue);
++
++	/* don't modify queue heads during completion callback */
++	if (ep->fotg210->gadget.speed == USB_SPEED_UNKNOWN)
++		req->req.status = -ESHUTDOWN;
++	else
++		req->req.status = status;
++
++	spin_unlock(&ep->fotg210->lock);
++	usb_gadget_giveback_request(&ep->ep, &req->req);
++	spin_lock(&ep->fotg210->lock);
++
++	if (ep->epnum) {
++		if (list_empty(&ep->queue))
++			fotg210_disable_fifo_int(ep);
++	} else {
++		fotg210_set_cxdone(ep->fotg210);
++	}
++}
++
++static void fotg210_fifo_ep_mapping(struct fotg210_ep *ep, u32 epnum,
++				u32 dir_in)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 val;
++
++	/* Driver should map an ep to a fifo and then map the fifo
++	 * to the ep. What a brain-damaged design!
++	 */
++
++	/* map a fifo to an ep */
++	val = ioread32(fotg210->reg + FOTG210_EPMAP);
++	val &= ~EPMAP_FIFONOMSK(epnum, dir_in);
++	val |= EPMAP_FIFONO(epnum, dir_in);
++	iowrite32(val, fotg210->reg + FOTG210_EPMAP);
++
++	/* map the ep to the fifo */
++	val = ioread32(fotg210->reg + FOTG210_FIFOMAP);
++	val &= ~FIFOMAP_EPNOMSK(epnum);
++	val |= FIFOMAP_EPNO(epnum);
++	iowrite32(val, fotg210->reg + FOTG210_FIFOMAP);
++
++	/* enable fifo */
++	val = ioread32(fotg210->reg + FOTG210_FIFOCF);
++	val |= FIFOCF_FIFO_EN(epnum - 1);
++	iowrite32(val, fotg210->reg + FOTG210_FIFOCF);
++}
++
++static void fotg210_set_fifo_dir(struct fotg210_ep *ep, u32 epnum, u32 dir_in)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 val;
++
++	val = ioread32(fotg210->reg + FOTG210_FIFOMAP);
++	val |= (dir_in ? FIFOMAP_DIRIN(epnum - 1) : FIFOMAP_DIROUT(epnum - 1));
++	iowrite32(val, fotg210->reg + FOTG210_FIFOMAP);
++}
++
++static void fotg210_set_tfrtype(struct fotg210_ep *ep, u32 epnum, u32 type)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 val;
++
++	val = ioread32(fotg210->reg + FOTG210_FIFOCF);
++	val |= FIFOCF_TYPE(type, epnum - 1);
++	iowrite32(val, fotg210->reg + FOTG210_FIFOCF);
++}
++
++static void fotg210_set_mps(struct fotg210_ep *ep, u32 epnum, u32 mps,
++				u32 dir_in)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 val;
++	u32 offset = dir_in ? FOTG210_INEPMPSR(epnum) :
++				FOTG210_OUTEPMPSR(epnum);
++
++	val = ioread32(fotg210->reg + offset);
++	val |= INOUTEPMPSR_MPS(mps);
++	iowrite32(val, fotg210->reg + offset);
++}
++
++static int fotg210_config_ep(struct fotg210_ep *ep,
++		     const struct usb_endpoint_descriptor *desc)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++
++	fotg210_set_fifo_dir(ep, ep->epnum, ep->dir_in);
++	fotg210_set_tfrtype(ep, ep->epnum, ep->type);
++	fotg210_set_mps(ep, ep->epnum, ep->ep.maxpacket, ep->dir_in);
++	fotg210_fifo_ep_mapping(ep, ep->epnum, ep->dir_in);
++
++	fotg210->ep[ep->epnum] = ep;
++
++	return 0;
++}
++
++static int fotg210_ep_enable(struct usb_ep *_ep,
++			  const struct usb_endpoint_descriptor *desc)
++{
++	struct fotg210_ep *ep;
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++
++	ep->desc = desc;
++	ep->epnum = usb_endpoint_num(desc);
++	ep->type = usb_endpoint_type(desc);
++	ep->dir_in = usb_endpoint_dir_in(desc);
++	ep->ep.maxpacket = usb_endpoint_maxp(desc);
++
++	return fotg210_config_ep(ep, desc);
++}
++
++static void fotg210_reset_tseq(struct fotg210_udc *fotg210, u8 epnum)
++{
++	struct fotg210_ep *ep = fotg210->ep[epnum];
++	u32 value;
++	void __iomem *reg;
++
++	reg = (ep->dir_in) ?
++		fotg210->reg + FOTG210_INEPMPSR(epnum) :
++		fotg210->reg + FOTG210_OUTEPMPSR(epnum);
++
++	/* Note: Driver needs to set and clear INOUTEPMPSR_RESET_TSEQ
++	 *	 bit. Controller wouldn't clear this bit. WTF!!!
++	 */
++
++	value = ioread32(reg);
++	value |= INOUTEPMPSR_RESET_TSEQ;
++	iowrite32(value, reg);
++
++	value = ioread32(reg);
++	value &= ~INOUTEPMPSR_RESET_TSEQ;
++	iowrite32(value, reg);
++}
++
++static int fotg210_ep_release(struct fotg210_ep *ep)
++{
++	if (!ep->epnum)
++		return 0;
++	ep->epnum = 0;
++	ep->stall = 0;
++	ep->wedged = 0;
++
++	fotg210_reset_tseq(ep->fotg210, ep->epnum);
++
++	return 0;
++}
++
++static int fotg210_ep_disable(struct usb_ep *_ep)
++{
++	struct fotg210_ep *ep;
++	struct fotg210_request *req;
++	unsigned long flags;
++
++	BUG_ON(!_ep);
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++
++	while (!list_empty(&ep->queue)) {
++		req = list_entry(ep->queue.next,
++			struct fotg210_request, queue);
++		spin_lock_irqsave(&ep->fotg210->lock, flags);
++		fotg210_done(ep, req, -ECONNRESET);
++		spin_unlock_irqrestore(&ep->fotg210->lock, flags);
++	}
++
++	return fotg210_ep_release(ep);
++}
++
++static struct usb_request *fotg210_ep_alloc_request(struct usb_ep *_ep,
++						gfp_t gfp_flags)
++{
++	struct fotg210_request *req;
++
++	req = kzalloc(sizeof(struct fotg210_request), gfp_flags);
++	if (!req)
++		return NULL;
++
++	INIT_LIST_HEAD(&req->queue);
++
++	return &req->req;
++}
++
++static void fotg210_ep_free_request(struct usb_ep *_ep,
++					struct usb_request *_req)
++{
++	struct fotg210_request *req;
++
++	req = container_of(_req, struct fotg210_request, req);
++	kfree(req);
++}
++
++static void fotg210_enable_dma(struct fotg210_ep *ep,
++			      dma_addr_t d, u32 len)
++{
++	u32 value;
++	struct fotg210_udc *fotg210 = ep->fotg210;
++
++	/* set transfer length and direction */
++	value = ioread32(fotg210->reg + FOTG210_DMACPSR1);
++	value &= ~(DMACPSR1_DMA_LEN(0xFFFF) | DMACPSR1_DMA_TYPE(1));
++	value |= DMACPSR1_DMA_LEN(len) | DMACPSR1_DMA_TYPE(ep->dir_in);
++	iowrite32(value, fotg210->reg + FOTG210_DMACPSR1);
++
++	/* set device DMA target FIFO number */
++	value = ioread32(fotg210->reg + FOTG210_DMATFNR);
++	if (ep->epnum)
++		value |= DMATFNR_ACC_FN(ep->epnum - 1);
++	else
++		value |= DMATFNR_ACC_CXF;
++	iowrite32(value, fotg210->reg + FOTG210_DMATFNR);
++
++	/* set DMA memory address */
++	iowrite32(d, fotg210->reg + FOTG210_DMACPSR2);
++
++	/* enable MDMA_EROR and MDMA_CMPLT interrupt */
++	value = ioread32(fotg210->reg + FOTG210_DMISGR2);
++	value &= ~(DMISGR2_MDMA_CMPLT | DMISGR2_MDMA_ERROR);
++	iowrite32(value, fotg210->reg + FOTG210_DMISGR2);
++
++	/* start DMA */
++	value = ioread32(fotg210->reg + FOTG210_DMACPSR1);
++	value |= DMACPSR1_DMA_START;
++	iowrite32(value, fotg210->reg + FOTG210_DMACPSR1);
++}
++
++static void fotg210_disable_dma(struct fotg210_ep *ep)
++{
++	iowrite32(DMATFNR_DISDMA, ep->fotg210->reg + FOTG210_DMATFNR);
++}
++
++static void fotg210_wait_dma_done(struct fotg210_ep *ep)
++{
++	u32 value;
++
++	do {
++		value = ioread32(ep->fotg210->reg + FOTG210_DISGR2);
++		if ((value & DISGR2_USBRST_INT) ||
++		    (value & DISGR2_DMA_ERROR))
++			goto dma_reset;
++	} while (!(value & DISGR2_DMA_CMPLT));
++
++	value &= ~DISGR2_DMA_CMPLT;
++	iowrite32(value, ep->fotg210->reg + FOTG210_DISGR2);
++	return;
++
++dma_reset:
++	value = ioread32(ep->fotg210->reg + FOTG210_DMACPSR1);
++	value |= DMACPSR1_DMA_ABORT;
++	iowrite32(value, ep->fotg210->reg + FOTG210_DMACPSR1);
++
++	/* reset fifo */
++	if (ep->epnum) {
++		value = ioread32(ep->fotg210->reg +
++				FOTG210_FIBCR(ep->epnum - 1));
++		value |= FIBCR_FFRST;
++		iowrite32(value, ep->fotg210->reg +
++				FOTG210_FIBCR(ep->epnum - 1));
++	} else {
++		value = ioread32(ep->fotg210->reg + FOTG210_DCFESR);
++		value |= DCFESR_CX_CLR;
++		iowrite32(value, ep->fotg210->reg + FOTG210_DCFESR);
++	}
++}
++
++static void fotg210_start_dma(struct fotg210_ep *ep,
++			struct fotg210_request *req)
++{
++	struct device *dev = &ep->fotg210->gadget.dev;
++	dma_addr_t d;
++	u8 *buffer;
++	u32 length;
++
++	if (ep->epnum) {
++		if (ep->dir_in) {
++			buffer = req->req.buf;
++			length = req->req.length;
++		} else {
++			buffer = req->req.buf + req->req.actual;
++			length = ioread32(ep->fotg210->reg +
++					FOTG210_FIBCR(ep->epnum - 1)) & FIBCR_BCFX;
++			if (length > req->req.length - req->req.actual)
++				length = req->req.length - req->req.actual;
++		}
++	} else {
++		buffer = req->req.buf + req->req.actual;
++		if (req->req.length - req->req.actual > ep->ep.maxpacket)
++			length = ep->ep.maxpacket;
++		else
++			length = req->req.length - req->req.actual;
++	}
++
++	d = dma_map_single(dev, buffer, length,
++			ep->dir_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
++
++	if (dma_mapping_error(dev, d)) {
++		pr_err("dma_mapping_error\n");
++		return;
++	}
++
++	fotg210_enable_dma(ep, d, length);
++
++	/* check if dma is done */
++	fotg210_wait_dma_done(ep);
++
++	fotg210_disable_dma(ep);
++
++	/* update actual transfer length */
++	req->req.actual += length;
++
++	dma_unmap_single(dev, d, length, DMA_TO_DEVICE);
++}
++
++static void fotg210_ep0_queue(struct fotg210_ep *ep,
++				struct fotg210_request *req)
++{
++	if (!req->req.length) {
++		fotg210_done(ep, req, 0);
++		return;
++	}
++	if (ep->dir_in) { /* if IN */
++		fotg210_start_dma(ep, req);
++		if (req->req.length == req->req.actual)
++			fotg210_done(ep, req, 0);
++	} else { /* OUT */
++		u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR0);
++
++		value &= ~DMISGR0_MCX_OUT_INT;
++		iowrite32(value, ep->fotg210->reg + FOTG210_DMISGR0);
++	}
++}
++
++static int fotg210_ep_queue(struct usb_ep *_ep, struct usb_request *_req,
++				gfp_t gfp_flags)
++{
++	struct fotg210_ep *ep;
++	struct fotg210_request *req;
++	unsigned long flags;
++	int request = 0;
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++	req = container_of(_req, struct fotg210_request, req);
++
++	if (ep->fotg210->gadget.speed == USB_SPEED_UNKNOWN)
++		return -ESHUTDOWN;
++
++	spin_lock_irqsave(&ep->fotg210->lock, flags);
++
++	if (list_empty(&ep->queue))
++		request = 1;
++
++	list_add_tail(&req->queue, &ep->queue);
++
++	req->req.actual = 0;
++	req->req.status = -EINPROGRESS;
++
++	if (!ep->epnum) /* ep0 */
++		fotg210_ep0_queue(ep, req);
++	else if (request && !ep->stall)
++		fotg210_enable_fifo_int(ep);
++
++	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
++
++	return 0;
++}
++
++static int fotg210_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
++{
++	struct fotg210_ep *ep;
++	struct fotg210_request *req;
++	unsigned long flags;
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++	req = container_of(_req, struct fotg210_request, req);
++
++	spin_lock_irqsave(&ep->fotg210->lock, flags);
++	if (!list_empty(&ep->queue))
++		fotg210_done(ep, req, -ECONNRESET);
++	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
++
++	return 0;
++}
++
++static void fotg210_set_epnstall(struct fotg210_ep *ep)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 value;
++	void __iomem *reg;
++
++	/* check if IN FIFO is empty before stall */
++	if (ep->dir_in) {
++		do {
++			value = ioread32(fotg210->reg + FOTG210_DCFESR);
++		} while (!(value & DCFESR_FIFO_EMPTY(ep->epnum - 1)));
++	}
++
++	reg = (ep->dir_in) ?
++		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
++		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
++	value = ioread32(reg);
++	value |= INOUTEPMPSR_STL_EP;
++	iowrite32(value, reg);
++}
++
++static void fotg210_clear_epnstall(struct fotg210_ep *ep)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 value;
++	void __iomem *reg;
++
++	reg = (ep->dir_in) ?
++		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
++		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
++	value = ioread32(reg);
++	value &= ~INOUTEPMPSR_STL_EP;
++	iowrite32(value, reg);
++}
++
++static int fotg210_set_halt_and_wedge(struct usb_ep *_ep, int value, int wedge)
++{
++	struct fotg210_ep *ep;
++	struct fotg210_udc *fotg210;
++	unsigned long flags;
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++
++	fotg210 = ep->fotg210;
++
++	spin_lock_irqsave(&ep->fotg210->lock, flags);
++
++	if (value) {
++		fotg210_set_epnstall(ep);
++		ep->stall = 1;
++		if (wedge)
++			ep->wedged = 1;
++	} else {
++		fotg210_reset_tseq(fotg210, ep->epnum);
++		fotg210_clear_epnstall(ep);
++		ep->stall = 0;
++		ep->wedged = 0;
++		if (!list_empty(&ep->queue))
++			fotg210_enable_fifo_int(ep);
++	}
++
++	spin_unlock_irqrestore(&ep->fotg210->lock, flags);
++	return 0;
++}
++
++static int fotg210_ep_set_halt(struct usb_ep *_ep, int value)
++{
++	return fotg210_set_halt_and_wedge(_ep, value, 0);
++}
++
++static int fotg210_ep_set_wedge(struct usb_ep *_ep)
++{
++	return fotg210_set_halt_and_wedge(_ep, 1, 1);
++}
++
++static void fotg210_ep_fifo_flush(struct usb_ep *_ep)
++{
++}
++
++static const struct usb_ep_ops fotg210_ep_ops = {
++	.enable		= fotg210_ep_enable,
++	.disable	= fotg210_ep_disable,
++
++	.alloc_request	= fotg210_ep_alloc_request,
++	.free_request	= fotg210_ep_free_request,
++
++	.queue		= fotg210_ep_queue,
++	.dequeue	= fotg210_ep_dequeue,
++
++	.set_halt	= fotg210_ep_set_halt,
++	.fifo_flush	= fotg210_ep_fifo_flush,
++	.set_wedge	= fotg210_ep_set_wedge,
++};
++
++static void fotg210_clear_tx0byte(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_TX0BYTE);
++
++	value &= ~(TX0BYTE_EP1 | TX0BYTE_EP2 | TX0BYTE_EP3
++		   | TX0BYTE_EP4);
++	iowrite32(value, fotg210->reg + FOTG210_TX0BYTE);
++}
++
++static void fotg210_clear_rx0byte(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_RX0BYTE);
++
++	value &= ~(RX0BYTE_EP1 | RX0BYTE_EP2 | RX0BYTE_EP3
++		   | RX0BYTE_EP4);
++	iowrite32(value, fotg210->reg + FOTG210_RX0BYTE);
++}
++
++/* read 8-byte setup packet only */
++static void fotg210_rdsetupp(struct fotg210_udc *fotg210,
++		   u8 *buffer)
++{
++	int i = 0;
++	u8 *tmp = buffer;
++	u32 data;
++	u32 length = 8;
++
++	iowrite32(DMATFNR_ACC_CXF, fotg210->reg + FOTG210_DMATFNR);
++
++	for (i = (length >> 2); i > 0; i--) {
++		data = ioread32(fotg210->reg + FOTG210_CXPORT);
++		*tmp = data & 0xFF;
++		*(tmp + 1) = (data >> 8) & 0xFF;
++		*(tmp + 2) = (data >> 16) & 0xFF;
++		*(tmp + 3) = (data >> 24) & 0xFF;
++		tmp = tmp + 4;
++	}
++
++	switch (length % 4) {
++	case 1:
++		data = ioread32(fotg210->reg + FOTG210_CXPORT);
++		*tmp = data & 0xFF;
++		break;
++	case 2:
++		data = ioread32(fotg210->reg + FOTG210_CXPORT);
++		*tmp = data & 0xFF;
++		*(tmp + 1) = (data >> 8) & 0xFF;
++		break;
++	case 3:
++		data = ioread32(fotg210->reg + FOTG210_CXPORT);
++		*tmp = data & 0xFF;
++		*(tmp + 1) = (data >> 8) & 0xFF;
++		*(tmp + 2) = (data >> 16) & 0xFF;
++		break;
++	default:
++		break;
++	}
++
++	iowrite32(DMATFNR_DISDMA, fotg210->reg + FOTG210_DMATFNR);
++}
++
++static void fotg210_set_configuration(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_DAR);
++
++	value |= DAR_AFT_CONF;
++	iowrite32(value, fotg210->reg + FOTG210_DAR);
++}
++
++static void fotg210_set_dev_addr(struct fotg210_udc *fotg210, u32 addr)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_DAR);
++
++	value |= (addr & 0x7F);
++	iowrite32(value, fotg210->reg + FOTG210_DAR);
++}
++
++static void fotg210_set_cxstall(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_DCFESR);
++
++	value |= DCFESR_CX_STL;
++	iowrite32(value, fotg210->reg + FOTG210_DCFESR);
++}
++
++static void fotg210_request_error(struct fotg210_udc *fotg210)
++{
++	fotg210_set_cxstall(fotg210);
++	pr_err("request error!!\n");
++}
++
++static void fotg210_set_address(struct fotg210_udc *fotg210,
++				struct usb_ctrlrequest *ctrl)
++{
++	if (le16_to_cpu(ctrl->wValue) >= 0x0100) {
++		fotg210_request_error(fotg210);
++	} else {
++		fotg210_set_dev_addr(fotg210, le16_to_cpu(ctrl->wValue));
++		fotg210_set_cxdone(fotg210);
++	}
++}
++
++static void fotg210_set_feature(struct fotg210_udc *fotg210,
++				struct usb_ctrlrequest *ctrl)
++{
++	switch (ctrl->bRequestType & USB_RECIP_MASK) {
++	case USB_RECIP_DEVICE:
++		fotg210_set_cxdone(fotg210);
++		break;
++	case USB_RECIP_INTERFACE:
++		fotg210_set_cxdone(fotg210);
++		break;
++	case USB_RECIP_ENDPOINT: {
++		u8 epnum;
++		epnum = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
++		if (epnum)
++			fotg210_set_epnstall(fotg210->ep[epnum]);
++		else
++			fotg210_set_cxstall(fotg210);
++		fotg210_set_cxdone(fotg210);
++		}
++		break;
++	default:
++		fotg210_request_error(fotg210);
++		break;
++	}
++}
++
++static void fotg210_clear_feature(struct fotg210_udc *fotg210,
++				struct usb_ctrlrequest *ctrl)
++{
++	struct fotg210_ep *ep =
++		fotg210->ep[ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK];
++
++	switch (ctrl->bRequestType & USB_RECIP_MASK) {
++	case USB_RECIP_DEVICE:
++		fotg210_set_cxdone(fotg210);
++		break;
++	case USB_RECIP_INTERFACE:
++		fotg210_set_cxdone(fotg210);
++		break;
++	case USB_RECIP_ENDPOINT:
++		if (ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK) {
++			if (ep->wedged) {
++				fotg210_set_cxdone(fotg210);
++				break;
++			}
++			if (ep->stall)
++				fotg210_set_halt_and_wedge(&ep->ep, 0, 0);
++		}
++		fotg210_set_cxdone(fotg210);
++		break;
++	default:
++		fotg210_request_error(fotg210);
++		break;
++	}
++}
++
++static int fotg210_is_epnstall(struct fotg210_ep *ep)
++{
++	struct fotg210_udc *fotg210 = ep->fotg210;
++	u32 value;
++	void __iomem *reg;
++
++	reg = (ep->dir_in) ?
++		fotg210->reg + FOTG210_INEPMPSR(ep->epnum) :
++		fotg210->reg + FOTG210_OUTEPMPSR(ep->epnum);
++	value = ioread32(reg);
++	return value & INOUTEPMPSR_STL_EP ? 1 : 0;
++}
++
++/* For EP0 requests triggered by this driver (currently GET_STATUS response) */
++static void fotg210_ep0_complete(struct usb_ep *_ep, struct usb_request *req)
++{
++	struct fotg210_ep *ep;
++	struct fotg210_udc *fotg210;
++
++	ep = container_of(_ep, struct fotg210_ep, ep);
++	fotg210 = ep->fotg210;
++
++	if (req->status || req->actual != req->length) {
++		dev_warn(&fotg210->gadget.dev, "EP0 request failed: %d\n", req->status);
++	}
++}
++
++static void fotg210_get_status(struct fotg210_udc *fotg210,
++				struct usb_ctrlrequest *ctrl)
++{
++	u8 epnum;
++
++	switch (ctrl->bRequestType & USB_RECIP_MASK) {
++	case USB_RECIP_DEVICE:
++		fotg210->ep0_data = cpu_to_le16(1 << USB_DEVICE_SELF_POWERED);
++		break;
++	case USB_RECIP_INTERFACE:
++		fotg210->ep0_data = cpu_to_le16(0);
++		break;
++	case USB_RECIP_ENDPOINT:
++		epnum = ctrl->wIndex & USB_ENDPOINT_NUMBER_MASK;
++		if (epnum)
++			fotg210->ep0_data =
++				cpu_to_le16(fotg210_is_epnstall(fotg210->ep[epnum])
++					    << USB_ENDPOINT_HALT);
++		else
++			fotg210_request_error(fotg210);
++		break;
++
++	default:
++		fotg210_request_error(fotg210);
++		return;		/* exit */
++	}
++
++	fotg210->ep0_req->buf = &fotg210->ep0_data;
++	fotg210->ep0_req->length = 2;
++
++	spin_unlock(&fotg210->lock);
++	fotg210_ep_queue(fotg210->gadget.ep0, fotg210->ep0_req, GFP_ATOMIC);
++	spin_lock(&fotg210->lock);
++}
++
++static int fotg210_setup_packet(struct fotg210_udc *fotg210,
++				struct usb_ctrlrequest *ctrl)
++{
++	u8 *p = (u8 *)ctrl;
++	u8 ret = 0;
++
++	fotg210_rdsetupp(fotg210, p);
++
++	fotg210->ep[0]->dir_in = ctrl->bRequestType & USB_DIR_IN;
++
++	if (fotg210->gadget.speed == USB_SPEED_UNKNOWN) {
++		u32 value = ioread32(fotg210->reg + FOTG210_DMCR);
++		fotg210->gadget.speed = value & DMCR_HS_EN ?
++				USB_SPEED_HIGH : USB_SPEED_FULL;
++	}
++
++	/* check request */
++	if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
++		switch (ctrl->bRequest) {
++		case USB_REQ_GET_STATUS:
++			fotg210_get_status(fotg210, ctrl);
++			break;
++		case USB_REQ_CLEAR_FEATURE:
++			fotg210_clear_feature(fotg210, ctrl);
++			break;
++		case USB_REQ_SET_FEATURE:
++			fotg210_set_feature(fotg210, ctrl);
++			break;
++		case USB_REQ_SET_ADDRESS:
++			fotg210_set_address(fotg210, ctrl);
++			break;
++		case USB_REQ_SET_CONFIGURATION:
++			fotg210_set_configuration(fotg210);
++			ret = 1;
++			break;
++		default:
++			ret = 1;
++			break;
++		}
++	} else {
++		ret = 1;
++	}
++
++	return ret;
++}
++
++static void fotg210_ep0out(struct fotg210_udc *fotg210)
++{
++	struct fotg210_ep *ep = fotg210->ep[0];
++
++	if (!list_empty(&ep->queue) && !ep->dir_in) {
++		struct fotg210_request *req;
++
++		req = list_first_entry(&ep->queue,
++			struct fotg210_request, queue);
++
++		if (req->req.length)
++			fotg210_start_dma(ep, req);
++
++		if ((req->req.length - req->req.actual) < ep->ep.maxpacket)
++			fotg210_done(ep, req, 0);
++	} else {
++		pr_err("%s : empty queue\n", __func__);
++	}
++}
++
++static void fotg210_ep0in(struct fotg210_udc *fotg210)
++{
++	struct fotg210_ep *ep = fotg210->ep[0];
++
++	if ((!list_empty(&ep->queue)) && (ep->dir_in)) {
++		struct fotg210_request *req;
++
++		req = list_entry(ep->queue.next,
++				struct fotg210_request, queue);
++
++		if (req->req.length)
++			fotg210_start_dma(ep, req);
++
++		if (req->req.actual == req->req.length)
++			fotg210_done(ep, req, 0);
++	} else {
++		fotg210_set_cxdone(fotg210);
++	}
++}
++
++static void fotg210_clear_comabt_int(struct fotg210_udc *fotg210)
++{
++	u32 value = ioread32(fotg210->reg + FOTG210_DISGR0);
++
++	value &= ~DISGR0_CX_COMABT_INT;
++	iowrite32(value, fotg210->reg + FOTG210_DISGR0);
++}
++
++static void fotg210_in_fifo_handler(struct fotg210_ep *ep)
++{
++	struct fotg210_request *req = list_entry(ep->queue.next,
++					struct fotg210_request, queue);
++
++	if (req->req.length)
++		fotg210_start_dma(ep, req);
++	fotg210_done(ep, req, 0);
++}
++
++static void fotg210_out_fifo_handler(struct fotg210_ep *ep)
++{
++	struct fotg210_request *req = list_entry(ep->queue.next,
++						 struct fotg210_request, queue);
++	int disgr1 = ioread32(ep->fotg210->reg + FOTG210_DISGR1);
++
++	fotg210_start_dma(ep, req);
++
++	/* Complete the request when it's full or a short packet arrived.
++	 * Like other drivers, short_not_ok isn't handled.
++	 */
++
++	if (req->req.length == req->req.actual ||
++	    (disgr1 & DISGR1_SPK_INT(ep->epnum - 1)))
++		fotg210_done(ep, req, 0);
++}
++
++static irqreturn_t fotg210_irq(int irq, void *_fotg210)
++{
++	struct fotg210_udc *fotg210 = _fotg210;
++	u32 int_grp = ioread32(fotg210->reg + FOTG210_DIGR);
++	u32 int_msk = ioread32(fotg210->reg + FOTG210_DMIGR);
++
++	int_grp &= ~int_msk;
++
++	spin_lock(&fotg210->lock);
++
++	if (int_grp & DIGR_INT_G2) {
++		void __iomem *reg = fotg210->reg + FOTG210_DISGR2;
++		u32 int_grp2 = ioread32(reg);
++		u32 int_msk2 = ioread32(fotg210->reg + FOTG210_DMISGR2);
++		u32 value;
++
++		int_grp2 &= ~int_msk2;
++
++		if (int_grp2 & DISGR2_USBRST_INT) {
++			usb_gadget_udc_reset(&fotg210->gadget,
++					     fotg210->driver);
++			value = ioread32(reg);
++			value &= ~DISGR2_USBRST_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 udc reset\n");
++		}
++		if (int_grp2 & DISGR2_SUSP_INT) {
++			value = ioread32(reg);
++			value &= ~DISGR2_SUSP_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 udc suspend\n");
++		}
++		if (int_grp2 & DISGR2_RESM_INT) {
++			value = ioread32(reg);
++			value &= ~DISGR2_RESM_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 udc resume\n");
++		}
++		if (int_grp2 & DISGR2_ISO_SEQ_ERR_INT) {
++			value = ioread32(reg);
++			value &= ~DISGR2_ISO_SEQ_ERR_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 iso sequence error\n");
++		}
++		if (int_grp2 & DISGR2_ISO_SEQ_ABORT_INT) {
++			value = ioread32(reg);
++			value &= ~DISGR2_ISO_SEQ_ABORT_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 iso sequence abort\n");
++		}
++		if (int_grp2 & DISGR2_TX0BYTE_INT) {
++			fotg210_clear_tx0byte(fotg210);
++			value = ioread32(reg);
++			value &= ~DISGR2_TX0BYTE_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 transferred 0 byte\n");
++		}
++		if (int_grp2 & DISGR2_RX0BYTE_INT) {
++			fotg210_clear_rx0byte(fotg210);
++			value = ioread32(reg);
++			value &= ~DISGR2_RX0BYTE_INT;
++			iowrite32(value, reg);
++			pr_info("fotg210 received 0 byte\n");
++		}
++		if (int_grp2 & DISGR2_DMA_ERROR) {
++			value = ioread32(reg);
++			value &= ~DISGR2_DMA_ERROR;
++			iowrite32(value, reg);
++		}
++	}
++
++	if (int_grp & DIGR_INT_G0) {
++		void __iomem *reg = fotg210->reg + FOTG210_DISGR0;
++		u32 int_grp0 = ioread32(reg);
++		u32 int_msk0 = ioread32(fotg210->reg + FOTG210_DMISGR0);
++		struct usb_ctrlrequest ctrl;
++
++		int_grp0 &= ~int_msk0;
++
++		/* the highest priority in this source register */
++		if (int_grp0 & DISGR0_CX_COMABT_INT) {
++			fotg210_clear_comabt_int(fotg210);
++			pr_info("fotg210 CX command abort\n");
++		}
++
++		if (int_grp0 & DISGR0_CX_SETUP_INT) {
++			if (fotg210_setup_packet(fotg210, &ctrl)) {
++				spin_unlock(&fotg210->lock);
++				if (fotg210->driver->setup(&fotg210->gadget,
++							   &ctrl) < 0)
++					fotg210_set_cxstall(fotg210);
++				spin_lock(&fotg210->lock);
++			}
++		}
++		if (int_grp0 & DISGR0_CX_COMEND_INT)
++			pr_info("fotg210 cmd end\n");
++
++		if (int_grp0 & DISGR0_CX_IN_INT)
++			fotg210_ep0in(fotg210);
++
++		if (int_grp0 & DISGR0_CX_OUT_INT)
++			fotg210_ep0out(fotg210);
++
++		if (int_grp0 & DISGR0_CX_COMFAIL_INT) {
++			fotg210_set_cxstall(fotg210);
++			pr_info("fotg210 ep0 fail\n");
++		}
++	}
++
++	if (int_grp & DIGR_INT_G1) {
++		void __iomem *reg = fotg210->reg + FOTG210_DISGR1;
++		u32 int_grp1 = ioread32(reg);
++		u32 int_msk1 = ioread32(fotg210->reg + FOTG210_DMISGR1);
++		int fifo;
++
++		int_grp1 &= ~int_msk1;
++
++		for (fifo = 0; fifo < FOTG210_MAX_FIFO_NUM; fifo++) {
++			if (int_grp1 & DISGR1_IN_INT(fifo))
++				fotg210_in_fifo_handler(fotg210->ep[fifo + 1]);
++
++			if ((int_grp1 & DISGR1_OUT_INT(fifo)) ||
++			    (int_grp1 & DISGR1_SPK_INT(fifo)))
++				fotg210_out_fifo_handler(fotg210->ep[fifo + 1]);
++		}
++	}
++
++	spin_unlock(&fotg210->lock);
++
++	return IRQ_HANDLED;
++}
++
++static void fotg210_disable_unplug(struct fotg210_udc *fotg210)
++{
++	u32 reg = ioread32(fotg210->reg + FOTG210_PHYTMSR);
++
++	reg &= ~PHYTMSR_UNPLUG;
++	iowrite32(reg, fotg210->reg + FOTG210_PHYTMSR);
++}
++
++static int fotg210_udc_start(struct usb_gadget *g,
++		struct usb_gadget_driver *driver)
++{
++	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
++	u32 value;
++
++	/* hook up the driver */
++	fotg210->driver = driver;
++
++	/* enable device global interrupt */
++	value = ioread32(fotg210->reg + FOTG210_DMCR);
++	value |= DMCR_GLINT_EN;
++	iowrite32(value, fotg210->reg + FOTG210_DMCR);
++
++	return 0;
++}
++
++static void fotg210_init(struct fotg210_udc *fotg210)
++{
++	u32 value;
++
++	/* disable global interrupt and set int polarity to active high */
++	iowrite32(GMIR_MHC_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
++		  fotg210->reg + FOTG210_GMIR);
++
++	/* disable device global interrupt */
++	value = ioread32(fotg210->reg + FOTG210_DMCR);
++	value &= ~DMCR_GLINT_EN;
++	iowrite32(value, fotg210->reg + FOTG210_DMCR);
++
++	/* enable only grp2 irqs we handle */
++	iowrite32(~(DISGR2_DMA_ERROR | DISGR2_RX0BYTE_INT | DISGR2_TX0BYTE_INT
++		    | DISGR2_ISO_SEQ_ABORT_INT | DISGR2_ISO_SEQ_ERR_INT
++		    | DISGR2_RESM_INT | DISGR2_SUSP_INT | DISGR2_USBRST_INT),
++		  fotg210->reg + FOTG210_DMISGR2);
++
++	/* disable all fifo interrupt */
++	iowrite32(~(u32)0, fotg210->reg + FOTG210_DMISGR1);
++
++	/* disable cmd end */
++	value = ioread32(fotg210->reg + FOTG210_DMISGR0);
++	value |= DMISGR0_MCX_COMEND;
++	iowrite32(value, fotg210->reg + FOTG210_DMISGR0);
++}
++
++static int fotg210_udc_stop(struct usb_gadget *g)
++{
++	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
++	unsigned long	flags;
++
++	spin_lock_irqsave(&fotg210->lock, flags);
++
++	fotg210_init(fotg210);
++	fotg210->driver = NULL;
++
++	spin_unlock_irqrestore(&fotg210->lock, flags);
++
++	return 0;
++}
++
++static const struct usb_gadget_ops fotg210_gadget_ops = {
++	.udc_start		= fotg210_udc_start,
++	.udc_stop		= fotg210_udc_stop,
++};
++
++static int fotg210_udc_remove(struct platform_device *pdev)
++{
++	struct fotg210_udc *fotg210 = platform_get_drvdata(pdev);
++	int i;
++
++	usb_del_gadget_udc(&fotg210->gadget);
++	iounmap(fotg210->reg);
++	free_irq(platform_get_irq(pdev, 0), fotg210);
++
++	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
++	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
++		kfree(fotg210->ep[i]);
++	kfree(fotg210);
++
++	return 0;
++}
++
++static int fotg210_udc_probe(struct platform_device *pdev)
++{
++	struct resource *res, *ires;
++	struct fotg210_udc *fotg210 = NULL;
++	struct fotg210_ep *_ep[FOTG210_MAX_NUM_EP];
++	int ret = 0;
++	int i;
++
++	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++	if (!res) {
++		pr_err("platform_get_resource error.\n");
++		return -ENODEV;
++	}
++
++	ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
++	if (!ires) {
++		pr_err("platform_get_resource IORESOURCE_IRQ error.\n");
++		return -ENODEV;
++	}
++
++	ret = -ENOMEM;
++
++	/* initialize udc */
++	fotg210 = kzalloc(sizeof(struct fotg210_udc), GFP_KERNEL);
++	if (fotg210 == NULL)
++		goto err;
++
++	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
++		_ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
++		if (_ep[i] == NULL)
++			goto err_alloc;
++		fotg210->ep[i] = _ep[i];
++	}
++
++	fotg210->reg = ioremap(res->start, resource_size(res));
++	if (fotg210->reg == NULL) {
++		pr_err("ioremap error.\n");
++		goto err_alloc;
++	}
++
++	spin_lock_init(&fotg210->lock);
++
++	platform_set_drvdata(pdev, fotg210);
++
++	fotg210->gadget.ops = &fotg210_gadget_ops;
++
++	fotg210->gadget.max_speed = USB_SPEED_HIGH;
++	fotg210->gadget.dev.parent = &pdev->dev;
++	fotg210->gadget.dev.dma_mask = pdev->dev.dma_mask;
++	fotg210->gadget.name = udc_name;
++
++	INIT_LIST_HEAD(&fotg210->gadget.ep_list);
++
++	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
++		struct fotg210_ep *ep = fotg210->ep[i];
++
++		if (i) {
++			INIT_LIST_HEAD(&fotg210->ep[i]->ep.ep_list);
++			list_add_tail(&fotg210->ep[i]->ep.ep_list,
++				      &fotg210->gadget.ep_list);
++		}
++		ep->fotg210 = fotg210;
++		INIT_LIST_HEAD(&ep->queue);
++		ep->ep.name = fotg210_ep_name[i];
++		ep->ep.ops = &fotg210_ep_ops;
++		usb_ep_set_maxpacket_limit(&ep->ep, (unsigned short) ~0);
++
++		if (i == 0) {
++			ep->ep.caps.type_control = true;
++		} else {
++			ep->ep.caps.type_iso = true;
++			ep->ep.caps.type_bulk = true;
++			ep->ep.caps.type_int = true;
++		}
++
++		ep->ep.caps.dir_in = true;
++		ep->ep.caps.dir_out = true;
++	}
++	usb_ep_set_maxpacket_limit(&fotg210->ep[0]->ep, 0x40);
++	fotg210->gadget.ep0 = &fotg210->ep[0]->ep;
++	INIT_LIST_HEAD(&fotg210->gadget.ep0->ep_list);
++
++	fotg210->ep0_req = fotg210_ep_alloc_request(&fotg210->ep[0]->ep,
++				GFP_KERNEL);
++	if (fotg210->ep0_req == NULL)
++		goto err_map;
++
++	fotg210->ep0_req->complete = fotg210_ep0_complete;
++
++	fotg210_init(fotg210);
++
++	fotg210_disable_unplug(fotg210);
++
++	ret = request_irq(ires->start, fotg210_irq, IRQF_SHARED,
++			  udc_name, fotg210);
++	if (ret < 0) {
++		pr_err("request_irq error (%d)\n", ret);
++		goto err_req;
++	}
++
++	ret = usb_add_gadget_udc(&pdev->dev, &fotg210->gadget);
++	if (ret)
++		goto err_add_udc;
++
++	dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION);
++
++	return 0;
++
++err_add_udc:
++	free_irq(ires->start, fotg210);
++
++err_req:
++	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
++
++err_map:
++	iounmap(fotg210->reg);
++
++err_alloc:
++	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
++		kfree(fotg210->ep[i]);
++	kfree(fotg210);
++
++err:
++	return ret;
++}
++
++static struct platform_driver fotg210_driver = {
++	.driver		= {
++		.name =	udc_name,
++	},
++	.probe		= fotg210_udc_probe,
++	.remove		= fotg210_udc_remove,
++};
++
++module_platform_driver(fotg210_driver);
++
++MODULE_AUTHOR("Yuan-Hsin Chen, Feng-Hsin Chiang <john453 at faraday-tech.com>");
++MODULE_LICENSE("GPL");
++MODULE_DESCRIPTION(DRIVER_DESC);
+--- a/drivers/usb/gadget/udc/Kconfig
++++ b/drivers/usb/gadget/udc/Kconfig
+@@ -108,17 +108,6 @@ config USB_FUSB300
+ 	help
+ 	   Faraday usb device controller FUSB300 driver
+ 
+-config USB_FOTG210_UDC
+-	depends on HAS_DMA
+-	tristate "Faraday FOTG210 USB Peripheral Controller"
+-	help
+-	   Faraday USB2.0 OTG controller which can be configured as
+-	   high speed or full speed USB device. This driver supppors
+-	   Bulk Transfer so far.
+-
+-	   Say "y" to link the driver statically, or "m" to build a
+-	   dynamically linked module called "fotg210_udc".
+-
+ config USB_GR_UDC
+ 	tristate "Aeroflex Gaisler GRUSBDC USB Peripheral Controller Driver"
+ 	depends on HAS_DMA
+--- a/drivers/usb/gadget/udc/Makefile
++++ b/drivers/usb/gadget/udc/Makefile
+@@ -34,7 +34,6 @@ obj-$(CONFIG_USB_EG20T)		+= pch_udc.o
+ obj-$(CONFIG_USB_MV_UDC)	+= mv_udc.o
+ mv_udc-y			:= mv_udc_core.o
+ obj-$(CONFIG_USB_FUSB300)	+= fusb300_udc.o
+-obj-$(CONFIG_USB_FOTG210_UDC)	+= fotg210-udc.o
+ obj-$(CONFIG_USB_MV_U3D)	+= mv_u3d_core.o
+ obj-$(CONFIG_USB_GR_UDC)	+= gr_udc.o
+ obj-$(CONFIG_USB_GADGET_XILINX)	+= udc-xilinx.o
+--- a/drivers/usb/host/Kconfig
++++ b/drivers/usb/host/Kconfig
+@@ -389,17 +389,6 @@ config USB_ISP1362_HCD
+ 	  To compile this driver as a module, choose M here: the
+ 	  module will be called isp1362-hcd.
+ 
+-config USB_FOTG210_HCD
+-	tristate "FOTG210 HCD support"
+-	depends on USB && HAS_DMA && HAS_IOMEM
+-	help
+-	  Faraday FOTG210 is an OTG controller which can be configured as
+-	  an USB2.0 host. It is designed to meet USB2.0 EHCI specification
+-	  with minor modification.
+-
+-	  To compile this driver as a module, choose M here: the
+-	  module will be called fotg210-hcd.
+-
+ config USB_MAX3421_HCD
+ 	tristate "MAX3421 HCD (USB-over-SPI) support"
+ 	depends on USB && SPI
+--- a/drivers/usb/host/Makefile
++++ b/drivers/usb/host/Makefile
+@@ -84,6 +84,5 @@ obj-$(CONFIG_USB_EHCI_FSL)	+= ehci-fsl.o
+ obj-$(CONFIG_USB_EHCI_MV)	+= ehci-mv.o
+ obj-$(CONFIG_USB_HCD_BCMA)	+= bcma-hcd.o
+ obj-$(CONFIG_USB_HCD_SSB)	+= ssb-hcd.o
+-obj-$(CONFIG_USB_FOTG210_HCD)	+= fotg210-hcd.o
+ obj-$(CONFIG_USB_MAX3421_HCD)	+= max3421-hcd.o
+ obj-$(CONFIG_USB_XEN_HCD)	+= xen-hcd.o
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210-hcd.h
+@@ -0,0 +1,688 @@
++/* SPDX-License-Identifier: GPL-2.0 */
++#ifndef __LINUX_FOTG210_H
++#define __LINUX_FOTG210_H
++
++#include <linux/usb/ehci-dbgp.h>
++
++/* definitions used for the EHCI driver */
++
++/*
++ * __hc32 and __hc16 are "Host Controller" types, they may be equivalent to
++ * __leXX (normally) or __beXX (given FOTG210_BIG_ENDIAN_DESC), depending on
++ * the host controller implementation.
++ *
++ * To facilitate the strongest possible byte-order checking from "sparse"
++ * and so on, we use __leXX unless that's not practical.
++ */
++#define __hc32	__le32
++#define __hc16	__le16
++
++/* statistics can be kept for tuning/monitoring */
++struct fotg210_stats {
++	/* irq usage */
++	unsigned long		normal;
++	unsigned long		error;
++	unsigned long		iaa;
++	unsigned long		lost_iaa;
++
++	/* termination of urbs from core */
++	unsigned long		complete;
++	unsigned long		unlink;
++};
++
++/* fotg210_hcd->lock guards shared data against other CPUs:
++ *   fotg210_hcd:	async, unlink, periodic (and shadow), ...
++ *   usb_host_endpoint: hcpriv
++ *   fotg210_qh:	qh_next, qtd_list
++ *   fotg210_qtd:	qtd_list
++ *
++ * Also, hold this lock when talking to HC registers or
++ * when updating hw_* fields in shared qh/qtd/... structures.
++ */
++
++#define	FOTG210_MAX_ROOT_PORTS	1		/* see HCS_N_PORTS */
++
++/*
++ * fotg210_rh_state values of FOTG210_RH_RUNNING or above mean that the
++ * controller may be doing DMA.  Lower values mean there's no DMA.
++ */
++enum fotg210_rh_state {
++	FOTG210_RH_HALTED,
++	FOTG210_RH_SUSPENDED,
++	FOTG210_RH_RUNNING,
++	FOTG210_RH_STOPPING
++};
++
++/*
++ * Timer events, ordered by increasing delay length.
++ * Always update event_delays_ns[] and event_handlers[] (defined in
++ * ehci-timer.c) in parallel with this list.
++ */
++enum fotg210_hrtimer_event {
++	FOTG210_HRTIMER_POLL_ASS,	/* Poll for async schedule off */
++	FOTG210_HRTIMER_POLL_PSS,	/* Poll for periodic schedule off */
++	FOTG210_HRTIMER_POLL_DEAD,	/* Wait for dead controller to stop */
++	FOTG210_HRTIMER_UNLINK_INTR,	/* Wait for interrupt QH unlink */
++	FOTG210_HRTIMER_FREE_ITDS,	/* Wait for unused iTDs and siTDs */
++	FOTG210_HRTIMER_ASYNC_UNLINKS,	/* Unlink empty async QHs */
++	FOTG210_HRTIMER_IAA_WATCHDOG,	/* Handle lost IAA interrupts */
++	FOTG210_HRTIMER_DISABLE_PERIODIC, /* Wait to disable periodic sched */
++	FOTG210_HRTIMER_DISABLE_ASYNC,	/* Wait to disable async sched */
++	FOTG210_HRTIMER_IO_WATCHDOG,	/* Check for missing IRQs */
++	FOTG210_HRTIMER_NUM_EVENTS	/* Must come last */
++};
++#define FOTG210_HRTIMER_NO_EVENT	99
++
++struct fotg210_hcd {			/* one per controller */
++	/* timing support */
++	enum fotg210_hrtimer_event	next_hrtimer_event;
++	unsigned		enabled_hrtimer_events;
++	ktime_t			hr_timeouts[FOTG210_HRTIMER_NUM_EVENTS];
++	struct hrtimer		hrtimer;
++
++	int			PSS_poll_count;
++	int			ASS_poll_count;
++	int			died_poll_count;
++
++	/* glue to PCI and HCD framework */
++	struct fotg210_caps __iomem *caps;
++	struct fotg210_regs __iomem *regs;
++	struct ehci_dbg_port __iomem *debug;
++
++	__u32			hcs_params;	/* cached register copy */
++	spinlock_t		lock;
++	enum fotg210_rh_state	rh_state;
++
++	/* general schedule support */
++	bool			scanning:1;
++	bool			need_rescan:1;
++	bool			intr_unlinking:1;
++	bool			async_unlinking:1;
++	bool			shutdown:1;
++	struct fotg210_qh		*qh_scan_next;
++
++	/* async schedule support */
++	struct fotg210_qh		*async;
++	struct fotg210_qh		*dummy;		/* For AMD quirk use */
++	struct fotg210_qh		*async_unlink;
++	struct fotg210_qh		*async_unlink_last;
++	struct fotg210_qh		*async_iaa;
++	unsigned		async_unlink_cycle;
++	unsigned		async_count;	/* async activity count */
++
++	/* periodic schedule support */
++#define	DEFAULT_I_TDPS		1024		/* some HCs can do less */
++	unsigned		periodic_size;
++	__hc32			*periodic;	/* hw periodic table */
++	dma_addr_t		periodic_dma;
++	struct list_head	intr_qh_list;
++	unsigned		i_thresh;	/* uframes HC might cache */
++
++	union fotg210_shadow	*pshadow;	/* mirror hw periodic table */
++	struct fotg210_qh		*intr_unlink;
++	struct fotg210_qh		*intr_unlink_last;
++	unsigned		intr_unlink_cycle;
++	unsigned		now_frame;	/* frame from HC hardware */
++	unsigned		next_frame;	/* scan periodic, start here */
++	unsigned		intr_count;	/* intr activity count */
++	unsigned		isoc_count;	/* isoc activity count */
++	unsigned		periodic_count;	/* periodic activity count */
++	/* max periodic time per uframe */
++	unsigned		uframe_periodic_max;
++
++
++	/* list of itds completed while now_frame was still active */
++	struct list_head	cached_itd_list;
++	struct fotg210_itd	*last_itd_to_free;
++
++	/* per root hub port */
++	unsigned long		reset_done[FOTG210_MAX_ROOT_PORTS];
++
++	/* bit vectors (one bit per port)
++	 * which ports were already suspended at the start of a bus suspend
++	 */
++	unsigned long		bus_suspended;
++
++	/* which ports are edicated to the companion controller */
++	unsigned long		companion_ports;
++
++	/* which ports are owned by the companion during a bus suspend */
++	unsigned long		owned_ports;
++
++	/* which ports have the change-suspend feature turned on */
++	unsigned long		port_c_suspend;
++
++	/* which ports are suspended */
++	unsigned long		suspended_ports;
++
++	/* which ports have started to resume */
++	unsigned long		resuming_ports;
++
++	/* per-HC memory pools (could be per-bus, but ...) */
++	struct dma_pool		*qh_pool;	/* qh per active urb */
++	struct dma_pool		*qtd_pool;	/* one or more per qh */
++	struct dma_pool		*itd_pool;	/* itd per iso urb */
++
++	unsigned		random_frame;
++	unsigned long		next_statechange;
++	ktime_t			last_periodic_enable;
++	u32			command;
++
++	/* SILICON QUIRKS */
++	unsigned		need_io_watchdog:1;
++	unsigned		fs_i_thresh:1;	/* Intel iso scheduling */
++
++	u8			sbrn;		/* packed release number */
++
++	/* irq statistics */
++#ifdef FOTG210_STATS
++	struct fotg210_stats	stats;
++#	define INCR(x) ((x)++)
++#else
++#	define INCR(x) do {} while (0)
++#endif
++
++	/* silicon clock */
++	struct clk		*pclk;
++};
++
++/* convert between an HCD pointer and the corresponding FOTG210_HCD */
++static inline struct fotg210_hcd *hcd_to_fotg210(struct usb_hcd *hcd)
++{
++	return (struct fotg210_hcd *)(hcd->hcd_priv);
++}
++static inline struct usb_hcd *fotg210_to_hcd(struct fotg210_hcd *fotg210)
++{
++	return container_of((void *) fotg210, struct usb_hcd, hcd_priv);
++}
++
++/*-------------------------------------------------------------------------*/
++
++/* EHCI register interface, corresponds to EHCI Revision 0.95 specification */
++
++/* Section 2.2 Host Controller Capability Registers */
++struct fotg210_caps {
++	/* these fields are specified as 8 and 16 bit registers,
++	 * but some hosts can't perform 8 or 16 bit PCI accesses.
++	 * some hosts treat caplength and hciversion as parts of a 32-bit
++	 * register, others treat them as two separate registers, this
++	 * affects the memory map for big endian controllers.
++	 */
++	u32		hc_capbase;
++#define HC_LENGTH(fotg210, p)	(0x00ff&((p) >> /* bits 7:0 / offset 00h */ \
++				(fotg210_big_endian_capbase(fotg210) ? 24 : 0)))
++#define HC_VERSION(fotg210, p)	(0xffff&((p) >> /* bits 31:16 / offset 02h */ \
++				(fotg210_big_endian_capbase(fotg210) ? 0 : 16)))
++	u32		hcs_params;     /* HCSPARAMS - offset 0x4 */
++#define HCS_N_PORTS(p)		(((p)>>0)&0xf)	/* bits 3:0, ports on HC */
++
++	u32		hcc_params;	/* HCCPARAMS - offset 0x8 */
++#define HCC_CANPARK(p)		((p)&(1 << 2))  /* true: can park on async qh */
++#define HCC_PGM_FRAMELISTLEN(p) ((p)&(1 << 1))  /* true: periodic_size changes*/
++	u8		portroute[8];	 /* nibbles for routing - offset 0xC */
++};
++
++
++/* Section 2.3 Host Controller Operational Registers */
++struct fotg210_regs {
++
++	/* USBCMD: offset 0x00 */
++	u32		command;
++
++/* EHCI 1.1 addendum */
++/* 23:16 is r/w intr rate, in microframes; default "8" == 1/msec */
++#define CMD_PARK	(1<<11)		/* enable "park" on async qh */
++#define CMD_PARK_CNT(c)	(((c)>>8)&3)	/* how many transfers to park for */
++#define CMD_IAAD	(1<<6)		/* "doorbell" interrupt async advance */
++#define CMD_ASE		(1<<5)		/* async schedule enable */
++#define CMD_PSE		(1<<4)		/* periodic schedule enable */
++/* 3:2 is periodic frame list size */
++#define CMD_RESET	(1<<1)		/* reset HC not bus */
++#define CMD_RUN		(1<<0)		/* start/stop HC */
++
++	/* USBSTS: offset 0x04 */
++	u32		status;
++#define STS_ASS		(1<<15)		/* Async Schedule Status */
++#define STS_PSS		(1<<14)		/* Periodic Schedule Status */
++#define STS_RECL	(1<<13)		/* Reclamation */
++#define STS_HALT	(1<<12)		/* Not running (any reason) */
++/* some bits reserved */
++	/* these STS_* flags are also intr_enable bits (USBINTR) */
++#define STS_IAA		(1<<5)		/* Interrupted on async advance */
++#define STS_FATAL	(1<<4)		/* such as some PCI access errors */
++#define STS_FLR		(1<<3)		/* frame list rolled over */
++#define STS_PCD		(1<<2)		/* port change detect */
++#define STS_ERR		(1<<1)		/* "error" completion (overflow, ...) */
++#define STS_INT		(1<<0)		/* "normal" completion (short, ...) */
++
++	/* USBINTR: offset 0x08 */
++	u32		intr_enable;
++
++	/* FRINDEX: offset 0x0C */
++	u32		frame_index;	/* current microframe number */
++	/* CTRLDSSEGMENT: offset 0x10 */
++	u32		segment;	/* address bits 63:32 if needed */
++	/* PERIODICLISTBASE: offset 0x14 */
++	u32		frame_list;	/* points to periodic list */
++	/* ASYNCLISTADDR: offset 0x18 */
++	u32		async_next;	/* address of next async queue head */
++
++	u32	reserved1;
++	/* PORTSC: offset 0x20 */
++	u32	port_status;
++/* 31:23 reserved */
++#define PORT_USB11(x) (((x)&(3<<10)) == (1<<10))	/* USB 1.1 device */
++#define PORT_RESET	(1<<8)		/* reset port */
++#define PORT_SUSPEND	(1<<7)		/* suspend port */
++#define PORT_RESUME	(1<<6)		/* resume it */
++#define PORT_PEC	(1<<3)		/* port enable change */
++#define PORT_PE		(1<<2)		/* port enable */
++#define PORT_CSC	(1<<1)		/* connect status change */
++#define PORT_CONNECT	(1<<0)		/* device connected */
++#define PORT_RWC_BITS   (PORT_CSC | PORT_PEC)
++	u32     reserved2[19];
++
++	/* OTGCSR: offet 0x70 */
++	u32     otgcsr;
++#define OTGCSR_HOST_SPD_TYP     (3 << 22)
++#define OTGCSR_A_BUS_DROP	(1 << 5)
++#define OTGCSR_A_BUS_REQ	(1 << 4)
++
++	/* OTGISR: offset 0x74 */
++	u32     otgisr;
++#define OTGISR_OVC	(1 << 10)
++
++	u32     reserved3[15];
++
++	/* GMIR: offset 0xB4 */
++	u32     gmir;
++#define GMIR_INT_POLARITY	(1 << 3) /*Active High*/
++#define GMIR_MHC_INT		(1 << 2)
++#define GMIR_MOTG_INT		(1 << 1)
++#define GMIR_MDEV_INT	(1 << 0)
++};
++
++/*-------------------------------------------------------------------------*/
++
++#define	QTD_NEXT(fotg210, dma)	cpu_to_hc32(fotg210, (u32)dma)
++
++/*
++ * EHCI Specification 0.95 Section 3.5
++ * QTD: describe data transfer components (buffer, direction, ...)
++ * See Fig 3-6 "Queue Element Transfer Descriptor Block Diagram".
++ *
++ * These are associated only with "QH" (Queue Head) structures,
++ * used with control, bulk, and interrupt transfers.
++ */
++struct fotg210_qtd {
++	/* first part defined by EHCI spec */
++	__hc32			hw_next;	/* see EHCI 3.5.1 */
++	__hc32			hw_alt_next;    /* see EHCI 3.5.2 */
++	__hc32			hw_token;	/* see EHCI 3.5.3 */
++#define	QTD_TOGGLE	(1 << 31)	/* data toggle */
++#define	QTD_LENGTH(tok)	(((tok)>>16) & 0x7fff)
++#define	QTD_IOC		(1 << 15)	/* interrupt on complete */
++#define	QTD_CERR(tok)	(((tok)>>10) & 0x3)
++#define	QTD_PID(tok)	(((tok)>>8) & 0x3)
++#define	QTD_STS_ACTIVE	(1 << 7)	/* HC may execute this */
++#define	QTD_STS_HALT	(1 << 6)	/* halted on error */
++#define	QTD_STS_DBE	(1 << 5)	/* data buffer error (in HC) */
++#define	QTD_STS_BABBLE	(1 << 4)	/* device was babbling (qtd halted) */
++#define	QTD_STS_XACT	(1 << 3)	/* device gave illegal response */
++#define	QTD_STS_MMF	(1 << 2)	/* incomplete split transaction */
++#define	QTD_STS_STS	(1 << 1)	/* split transaction state */
++#define	QTD_STS_PING	(1 << 0)	/* issue PING? */
++
++#define ACTIVE_BIT(fotg210)	cpu_to_hc32(fotg210, QTD_STS_ACTIVE)
++#define HALT_BIT(fotg210)		cpu_to_hc32(fotg210, QTD_STS_HALT)
++#define STATUS_BIT(fotg210)	cpu_to_hc32(fotg210, QTD_STS_STS)
++
++	__hc32			hw_buf[5];	/* see EHCI 3.5.4 */
++	__hc32			hw_buf_hi[5];	/* Appendix B */
++
++	/* the rest is HCD-private */
++	dma_addr_t		qtd_dma;		/* qtd address */
++	struct list_head	qtd_list;		/* sw qtd list */
++	struct urb		*urb;			/* qtd's urb */
++	size_t			length;			/* length of buffer */
++} __aligned(32);
++
++/* mask NakCnt+T in qh->hw_alt_next */
++#define QTD_MASK(fotg210)	cpu_to_hc32(fotg210, ~0x1f)
++
++#define IS_SHORT_READ(token) (QTD_LENGTH(token) != 0 && QTD_PID(token) == 1)
++
++/*-------------------------------------------------------------------------*/
++
++/* type tag from {qh,itd,fstn}->hw_next */
++#define Q_NEXT_TYPE(fotg210, dma)	((dma) & cpu_to_hc32(fotg210, 3 << 1))
++
++/*
++ * Now the following defines are not converted using the
++ * cpu_to_le32() macro anymore, since we have to support
++ * "dynamic" switching between be and le support, so that the driver
++ * can be used on one system with SoC EHCI controller using big-endian
++ * descriptors as well as a normal little-endian PCI EHCI controller.
++ */
++/* values for that type tag */
++#define Q_TYPE_ITD	(0 << 1)
++#define Q_TYPE_QH	(1 << 1)
++#define Q_TYPE_SITD	(2 << 1)
++#define Q_TYPE_FSTN	(3 << 1)
++
++/* next async queue entry, or pointer to interrupt/periodic QH */
++#define QH_NEXT(fotg210, dma) \
++	(cpu_to_hc32(fotg210, (((u32)dma)&~0x01f)|Q_TYPE_QH))
++
++/* for periodic/async schedules and qtd lists, mark end of list */
++#define FOTG210_LIST_END(fotg210) \
++	cpu_to_hc32(fotg210, 1) /* "null pointer" to hw */
++
++/*
++ * Entries in periodic shadow table are pointers to one of four kinds
++ * of data structure.  That's dictated by the hardware; a type tag is
++ * encoded in the low bits of the hardware's periodic schedule.  Use
++ * Q_NEXT_TYPE to get the tag.
++ *
++ * For entries in the async schedule, the type tag always says "qh".
++ */
++union fotg210_shadow {
++	struct fotg210_qh	*qh;		/* Q_TYPE_QH */
++	struct fotg210_itd	*itd;		/* Q_TYPE_ITD */
++	struct fotg210_fstn	*fstn;		/* Q_TYPE_FSTN */
++	__hc32			*hw_next;	/* (all types) */
++	void			*ptr;
++};
++
++/*-------------------------------------------------------------------------*/
++
++/*
++ * EHCI Specification 0.95 Section 3.6
++ * QH: describes control/bulk/interrupt endpoints
++ * See Fig 3-7 "Queue Head Structure Layout".
++ *
++ * These appear in both the async and (for interrupt) periodic schedules.
++ */
++
++/* first part defined by EHCI spec */
++struct fotg210_qh_hw {
++	__hc32			hw_next;	/* see EHCI 3.6.1 */
++	__hc32			hw_info1;	/* see EHCI 3.6.2 */
++#define	QH_CONTROL_EP	(1 << 27)	/* FS/LS control endpoint */
++#define	QH_HEAD		(1 << 15)	/* Head of async reclamation list */
++#define	QH_TOGGLE_CTL	(1 << 14)	/* Data toggle control */
++#define	QH_HIGH_SPEED	(2 << 12)	/* Endpoint speed */
++#define	QH_LOW_SPEED	(1 << 12)
++#define	QH_FULL_SPEED	(0 << 12)
++#define	QH_INACTIVATE	(1 << 7)	/* Inactivate on next transaction */
++	__hc32			hw_info2;	/* see EHCI 3.6.2 */
++#define	QH_SMASK	0x000000ff
++#define	QH_CMASK	0x0000ff00
++#define	QH_HUBADDR	0x007f0000
++#define	QH_HUBPORT	0x3f800000
++#define	QH_MULT		0xc0000000
++	__hc32			hw_current;	/* qtd list - see EHCI 3.6.4 */
++
++	/* qtd overlay (hardware parts of a struct fotg210_qtd) */
++	__hc32			hw_qtd_next;
++	__hc32			hw_alt_next;
++	__hc32			hw_token;
++	__hc32			hw_buf[5];
++	__hc32			hw_buf_hi[5];
++} __aligned(32);
++
++struct fotg210_qh {
++	struct fotg210_qh_hw	*hw;		/* Must come first */
++	/* the rest is HCD-private */
++	dma_addr_t		qh_dma;		/* address of qh */
++	union fotg210_shadow	qh_next;	/* ptr to qh; or periodic */
++	struct list_head	qtd_list;	/* sw qtd list */
++	struct list_head	intr_node;	/* list of intr QHs */
++	struct fotg210_qtd	*dummy;
++	struct fotg210_qh	*unlink_next;	/* next on unlink list */
++
++	unsigned		unlink_cycle;
++
++	u8			needs_rescan;	/* Dequeue during giveback */
++	u8			qh_state;
++#define	QH_STATE_LINKED		1		/* HC sees this */
++#define	QH_STATE_UNLINK		2		/* HC may still see this */
++#define	QH_STATE_IDLE		3		/* HC doesn't see this */
++#define	QH_STATE_UNLINK_WAIT	4		/* LINKED and on unlink q */
++#define	QH_STATE_COMPLETING	5		/* don't touch token.HALT */
++
++	u8			xacterrs;	/* XactErr retry counter */
++#define	QH_XACTERR_MAX		32		/* XactErr retry limit */
++
++	/* periodic schedule info */
++	u8			usecs;		/* intr bandwidth */
++	u8			gap_uf;		/* uframes split/csplit gap */
++	u8			c_usecs;	/* ... split completion bw */
++	u16			tt_usecs;	/* tt downstream bandwidth */
++	unsigned short		period;		/* polling interval */
++	unsigned short		start;		/* where polling starts */
++#define NO_FRAME ((unsigned short)~0)			/* pick new start */
++
++	struct usb_device	*dev;		/* access to TT */
++	unsigned		is_out:1;	/* bulk or intr OUT */
++	unsigned		clearing_tt:1;	/* Clear-TT-Buf in progress */
++};
++
++/*-------------------------------------------------------------------------*/
++
++/* description of one iso transaction (up to 3 KB data if highspeed) */
++struct fotg210_iso_packet {
++	/* These will be copied to iTD when scheduling */
++	u64			bufp;		/* itd->hw_bufp{,_hi}[pg] |= */
++	__hc32			transaction;	/* itd->hw_transaction[i] |= */
++	u8			cross;		/* buf crosses pages */
++	/* for full speed OUT splits */
++	u32			buf1;
++};
++
++/* temporary schedule data for packets from iso urbs (both speeds)
++ * each packet is one logical usb transaction to the device (not TT),
++ * beginning at stream->next_uframe
++ */
++struct fotg210_iso_sched {
++	struct list_head	td_list;
++	unsigned		span;
++	struct fotg210_iso_packet	packet[];
++};
++
++/*
++ * fotg210_iso_stream - groups all (s)itds for this endpoint.
++ * acts like a qh would, if EHCI had them for ISO.
++ */
++struct fotg210_iso_stream {
++	/* first field matches fotg210_hq, but is NULL */
++	struct fotg210_qh_hw	*hw;
++
++	u8			bEndpointAddress;
++	u8			highspeed;
++	struct list_head	td_list;	/* queued itds */
++	struct list_head	free_list;	/* list of unused itds */
++	struct usb_device	*udev;
++	struct usb_host_endpoint *ep;
++
++	/* output of (re)scheduling */
++	int			next_uframe;
++	__hc32			splits;
++
++	/* the rest is derived from the endpoint descriptor,
++	 * trusting urb->interval == f(epdesc->bInterval) and
++	 * including the extra info for hw_bufp[0..2]
++	 */
++	u8			usecs, c_usecs;
++	u16			interval;
++	u16			tt_usecs;
++	u16			maxp;
++	u16			raw_mask;
++	unsigned		bandwidth;
++
++	/* This is used to initialize iTD's hw_bufp fields */
++	__hc32			buf0;
++	__hc32			buf1;
++	__hc32			buf2;
++
++	/* this is used to initialize sITD's tt info */
++	__hc32			address;
++};
++
++/*-------------------------------------------------------------------------*/
++
++/*
++ * EHCI Specification 0.95 Section 3.3
++ * Fig 3-4 "Isochronous Transaction Descriptor (iTD)"
++ *
++ * Schedule records for high speed iso xfers
++ */
++struct fotg210_itd {
++	/* first part defined by EHCI spec */
++	__hc32			hw_next;	/* see EHCI 3.3.1 */
++	__hc32			hw_transaction[8]; /* see EHCI 3.3.2 */
++#define FOTG210_ISOC_ACTIVE	(1<<31)	/* activate transfer this slot */
++#define FOTG210_ISOC_BUF_ERR	(1<<30)	/* Data buffer error */
++#define FOTG210_ISOC_BABBLE	(1<<29)	/* babble detected */
++#define FOTG210_ISOC_XACTERR	(1<<28)	/* XactErr - transaction error */
++#define	FOTG210_ITD_LENGTH(tok)	(((tok)>>16) & 0x0fff)
++#define	FOTG210_ITD_IOC		(1 << 15)	/* interrupt on complete */
++
++#define ITD_ACTIVE(fotg210)	cpu_to_hc32(fotg210, FOTG210_ISOC_ACTIVE)
++
++	__hc32			hw_bufp[7];	/* see EHCI 3.3.3 */
++	__hc32			hw_bufp_hi[7];	/* Appendix B */
++
++	/* the rest is HCD-private */
++	dma_addr_t		itd_dma;	/* for this itd */
++	union fotg210_shadow	itd_next;	/* ptr to periodic q entry */
++
++	struct urb		*urb;
++	struct fotg210_iso_stream	*stream;	/* endpoint's queue */
++	struct list_head	itd_list;	/* list of stream's itds */
++
++	/* any/all hw_transactions here may be used by that urb */
++	unsigned		frame;		/* where scheduled */
++	unsigned		pg;
++	unsigned		index[8];	/* in urb->iso_frame_desc */
++} __aligned(32);
++
++/*-------------------------------------------------------------------------*/
++
++/*
++ * EHCI Specification 0.96 Section 3.7
++ * Periodic Frame Span Traversal Node (FSTN)
++ *
++ * Manages split interrupt transactions (using TT) that span frame boundaries
++ * into uframes 0/1; see 4.12.2.2.  In those uframes, a "save place" FSTN
++ * makes the HC jump (back) to a QH to scan for fs/ls QH completions until
++ * it hits a "restore" FSTN; then it returns to finish other uframe 0/1 work.
++ */
++struct fotg210_fstn {
++	__hc32			hw_next;	/* any periodic q entry */
++	__hc32			hw_prev;	/* qh or FOTG210_LIST_END */
++
++	/* the rest is HCD-private */
++	dma_addr_t		fstn_dma;
++	union fotg210_shadow	fstn_next;	/* ptr to periodic q entry */
++} __aligned(32);
++
++/*-------------------------------------------------------------------------*/
++
++/* Prepare the PORTSC wakeup flags during controller suspend/resume */
++
++#define fotg210_prepare_ports_for_controller_suspend(fotg210, do_wakeup) \
++		fotg210_adjust_port_wakeup_flags(fotg210, true, do_wakeup)
++
++#define fotg210_prepare_ports_for_controller_resume(fotg210)		\
++		fotg210_adjust_port_wakeup_flags(fotg210, false, false)
++
++/*-------------------------------------------------------------------------*/
++
++/*
++ * Some EHCI controllers have a Transaction Translator built into the
++ * root hub. This is a non-standard feature.  Each controller will need
++ * to add code to the following inline functions, and call them as
++ * needed (mostly in root hub code).
++ */
++
++static inline unsigned int
++fotg210_get_speed(struct fotg210_hcd *fotg210, unsigned int portsc)
++{
++	return (readl(&fotg210->regs->otgcsr)
++		& OTGCSR_HOST_SPD_TYP) >> 22;
++}
++
++/* Returns the speed of a device attached to a port on the root hub. */
++static inline unsigned int
++fotg210_port_speed(struct fotg210_hcd *fotg210, unsigned int portsc)
++{
++	switch (fotg210_get_speed(fotg210, portsc)) {
++	case 0:
++		return 0;
++	case 1:
++		return USB_PORT_STAT_LOW_SPEED;
++	case 2:
++	default:
++		return USB_PORT_STAT_HIGH_SPEED;
++	}
++}
++
++/*-------------------------------------------------------------------------*/
++
++#define	fotg210_has_fsl_portno_bug(e)		(0)
++
++/*
++ * While most USB host controllers implement their registers in
++ * little-endian format, a minority (celleb companion chip) implement
++ * them in big endian format.
++ *
++ * This attempts to support either format at compile time without a
++ * runtime penalty, or both formats with the additional overhead
++ * of checking a flag bit.
++ *
++ */
++
++#define fotg210_big_endian_mmio(e)	0
++#define fotg210_big_endian_capbase(e)	0
++
++static inline unsigned int fotg210_readl(const struct fotg210_hcd *fotg210,
++		__u32 __iomem *regs)
++{
++	return readl(regs);
++}
++
++static inline void fotg210_writel(const struct fotg210_hcd *fotg210,
++		const unsigned int val, __u32 __iomem *regs)
++{
++	writel(val, regs);
++}
++
++/* cpu to fotg210 */
++static inline __hc32 cpu_to_hc32(const struct fotg210_hcd *fotg210, const u32 x)
++{
++	return cpu_to_le32(x);
++}
++
++/* fotg210 to cpu */
++static inline u32 hc32_to_cpu(const struct fotg210_hcd *fotg210, const __hc32 x)
++{
++	return le32_to_cpu(x);
++}
++
++static inline u32 hc32_to_cpup(const struct fotg210_hcd *fotg210,
++			       const __hc32 *x)
++{
++	return le32_to_cpup(x);
++}
++
++/*-------------------------------------------------------------------------*/
++
++static inline unsigned fotg210_read_frame_index(struct fotg210_hcd *fotg210)
++{
++	return fotg210_readl(fotg210, &fotg210->regs->frame_index);
++}
++
++/*-------------------------------------------------------------------------*/
++
++#endif /* __LINUX_FOTG210_H */
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -0,0 +1,249 @@
++// SPDX-License-Identifier: GPL-2.0+
++/*
++ * Faraday FOTG210 USB OTG controller
++ *
++ * Copyright (C) 2013 Faraday Technology Corporation
++ * Author: Yuan-Hsin Chen <yhchen at faraday-tech.com>
++ */
++
++#include <linux/kernel.h>
++
++#define FOTG210_MAX_NUM_EP	5 /* ep0...ep4 */
++#define FOTG210_MAX_FIFO_NUM	4 /* fifo0...fifo4 */
++
++/* Global Mask of HC/OTG/DEV interrupt Register(0xC4) */
++#define FOTG210_GMIR		0xC4
++#define GMIR_INT_POLARITY	0x8 /*Active High*/
++#define GMIR_MHC_INT		0x4
++#define GMIR_MOTG_INT		0x2
++#define GMIR_MDEV_INT		0x1
++
++/*  Device Main Control Register(0x100) */
++#define FOTG210_DMCR		0x100
++#define DMCR_HS_EN		(1 << 6)
++#define DMCR_CHIP_EN		(1 << 5)
++#define DMCR_SFRST		(1 << 4)
++#define DMCR_GOSUSP		(1 << 3)
++#define DMCR_GLINT_EN		(1 << 2)
++#define DMCR_HALF_SPEED		(1 << 1)
++#define DMCR_CAP_RMWAKUP	(1 << 0)
++
++/* Device Address Register(0x104) */
++#define FOTG210_DAR		0x104
++#define DAR_AFT_CONF		(1 << 7)
++
++/* Device Test Register(0x108) */
++#define FOTG210_DTR		0x108
++#define DTR_TST_CLRFF		(1 << 0)
++
++/* PHY Test Mode Selector register(0x114) */
++#define FOTG210_PHYTMSR		0x114
++#define PHYTMSR_TST_PKT		(1 << 4)
++#define PHYTMSR_TST_SE0NAK	(1 << 3)
++#define PHYTMSR_TST_KSTA	(1 << 2)
++#define PHYTMSR_TST_JSTA	(1 << 1)
++#define PHYTMSR_UNPLUG		(1 << 0)
++
++/* Cx configuration and FIFO Empty Status register(0x120) */
++#define FOTG210_DCFESR		0x120
++#define DCFESR_FIFO_EMPTY(fifo)	(1 << 8 << (fifo))
++#define DCFESR_CX_EMP		(1 << 5)
++#define DCFESR_CX_CLR		(1 << 3)
++#define DCFESR_CX_STL		(1 << 2)
++#define DCFESR_TST_PKDONE	(1 << 1)
++#define DCFESR_CX_DONE		(1 << 0)
++
++/* Device IDLE Counter Register(0x124) */
++#define FOTG210_DICR		0x124
++
++/* Device Mask of Interrupt Group Register (0x130) */
++#define FOTG210_DMIGR		0x130
++#define DMIGR_MINT_G0		(1 << 0)
++
++/* Device Mask of Interrupt Source Group 0(0x134) */
++#define FOTG210_DMISGR0		0x134
++#define DMISGR0_MCX_COMEND	(1 << 3)
++#define DMISGR0_MCX_OUT_INT	(1 << 2)
++#define DMISGR0_MCX_IN_INT	(1 << 1)
++#define DMISGR0_MCX_SETUP_INT	(1 << 0)
++
++/* Device Mask of Interrupt Source Group 1 Register(0x138)*/
++#define FOTG210_DMISGR1		0x138
++#define DMISGR1_MF3_IN_INT	(1 << 19)
++#define DMISGR1_MF2_IN_INT	(1 << 18)
++#define DMISGR1_MF1_IN_INT	(1 << 17)
++#define DMISGR1_MF0_IN_INT	(1 << 16)
++#define DMISGR1_MF_IN_INT(fifo)	(1 << (16 + (fifo)))
++#define DMISGR1_MF3_SPK_INT	(1 << 7)
++#define DMISGR1_MF3_OUT_INT	(1 << 6)
++#define DMISGR1_MF2_SPK_INT	(1 << 5)
++#define DMISGR1_MF2_OUT_INT	(1 << 4)
++#define DMISGR1_MF1_SPK_INT	(1 << 3)
++#define DMISGR1_MF1_OUT_INT	(1 << 2)
++#define DMISGR1_MF0_SPK_INT	(1 << 1)
++#define DMISGR1_MF0_OUT_INT	(1 << 0)
++#define DMISGR1_MF_OUTSPK_INT(fifo)	(0x3 << (fifo) * 2)
++
++/* Device Mask of Interrupt Source Group 2 Register (0x13C) */
++#define FOTG210_DMISGR2		0x13C
++#define DMISGR2_MDMA_ERROR	(1 << 8)
++#define DMISGR2_MDMA_CMPLT	(1 << 7)
++
++/* Device Interrupt group Register (0x140) */
++#define FOTG210_DIGR		0x140
++#define DIGR_INT_G2		(1 << 2)
++#define DIGR_INT_G1		(1 << 1)
++#define DIGR_INT_G0		(1 << 0)
++
++/* Device Interrupt Source Group 0 Register (0x144) */
++#define FOTG210_DISGR0		0x144
++#define DISGR0_CX_COMABT_INT	(1 << 5)
++#define DISGR0_CX_COMFAIL_INT	(1 << 4)
++#define DISGR0_CX_COMEND_INT	(1 << 3)
++#define DISGR0_CX_OUT_INT	(1 << 2)
++#define DISGR0_CX_IN_INT	(1 << 1)
++#define DISGR0_CX_SETUP_INT	(1 << 0)
++
++/* Device Interrupt Source Group 1 Register (0x148) */
++#define FOTG210_DISGR1		0x148
++#define DISGR1_OUT_INT(fifo)	(1 << ((fifo) * 2))
++#define DISGR1_SPK_INT(fifo)	(1 << 1 << ((fifo) * 2))
++#define DISGR1_IN_INT(fifo)	(1 << 16 << (fifo))
++
++/* Device Interrupt Source Group 2 Register (0x14C) */
++#define FOTG210_DISGR2		0x14C
++#define DISGR2_DMA_ERROR	(1 << 8)
++#define DISGR2_DMA_CMPLT	(1 << 7)
++#define DISGR2_RX0BYTE_INT	(1 << 6)
++#define DISGR2_TX0BYTE_INT	(1 << 5)
++#define DISGR2_ISO_SEQ_ABORT_INT	(1 << 4)
++#define DISGR2_ISO_SEQ_ERR_INT	(1 << 3)
++#define DISGR2_RESM_INT		(1 << 2)
++#define DISGR2_SUSP_INT		(1 << 1)
++#define DISGR2_USBRST_INT	(1 << 0)
++
++/* Device Receive Zero-Length Data Packet Register (0x150)*/
++#define FOTG210_RX0BYTE		0x150
++#define RX0BYTE_EP8		(1 << 7)
++#define RX0BYTE_EP7		(1 << 6)
++#define RX0BYTE_EP6		(1 << 5)
++#define RX0BYTE_EP5		(1 << 4)
++#define RX0BYTE_EP4		(1 << 3)
++#define RX0BYTE_EP3		(1 << 2)
++#define RX0BYTE_EP2		(1 << 1)
++#define RX0BYTE_EP1		(1 << 0)
++
++/* Device Transfer Zero-Length Data Packet Register (0x154)*/
++#define FOTG210_TX0BYTE		0x154
++#define TX0BYTE_EP8		(1 << 7)
++#define TX0BYTE_EP7		(1 << 6)
++#define TX0BYTE_EP6		(1 << 5)
++#define TX0BYTE_EP5		(1 << 4)
++#define TX0BYTE_EP4		(1 << 3)
++#define TX0BYTE_EP3		(1 << 2)
++#define TX0BYTE_EP2		(1 << 1)
++#define TX0BYTE_EP1		(1 << 0)
++
++/* Device IN Endpoint x MaxPacketSize Register(0x160+4*(x-1)) */
++#define FOTG210_INEPMPSR(ep)	(0x160 + 4 * ((ep) - 1))
++#define INOUTEPMPSR_MPS(mps)	((mps) & 0x2FF)
++#define INOUTEPMPSR_STL_EP	(1 << 11)
++#define INOUTEPMPSR_RESET_TSEQ	(1 << 12)
++
++/* Device OUT Endpoint x MaxPacketSize Register(0x180+4*(x-1)) */
++#define FOTG210_OUTEPMPSR(ep)	(0x180 + 4 * ((ep) - 1))
++
++/* Device Endpoint 1~4 Map Register (0x1A0) */
++#define FOTG210_EPMAP		0x1A0
++#define EPMAP_FIFONO(ep, dir)		\
++	((((ep) - 1) << ((ep) - 1) * 8) << ((dir) ? 0 : 4))
++#define EPMAP_FIFONOMSK(ep, dir)	\
++	((3 << ((ep) - 1) * 8) << ((dir) ? 0 : 4))
++
++/* Device FIFO Map Register (0x1A8) */
++#define FOTG210_FIFOMAP		0x1A8
++#define FIFOMAP_DIROUT(fifo)	(0x0 << 4 << (fifo) * 8)
++#define FIFOMAP_DIRIN(fifo)	(0x1 << 4 << (fifo) * 8)
++#define FIFOMAP_BIDIR(fifo)	(0x2 << 4 << (fifo) * 8)
++#define FIFOMAP_NA(fifo)	(0x3 << 4 << (fifo) * 8)
++#define FIFOMAP_EPNO(ep)	((ep) << ((ep) - 1) * 8)
++#define FIFOMAP_EPNOMSK(ep)	(0xF << ((ep) - 1) * 8)
++
++/* Device FIFO Confuguration Register (0x1AC) */
++#define FOTG210_FIFOCF		0x1AC
++#define FIFOCF_TYPE(type, fifo)	((type) << (fifo) * 8)
++#define FIFOCF_BLK_SIN(fifo)	(0x0 << (fifo) * 8 << 2)
++#define FIFOCF_BLK_DUB(fifo)	(0x1 << (fifo) * 8 << 2)
++#define FIFOCF_BLK_TRI(fifo)	(0x2 << (fifo) * 8 << 2)
++#define FIFOCF_BLKSZ_512(fifo)	(0x0 << (fifo) * 8 << 4)
++#define FIFOCF_BLKSZ_1024(fifo)	(0x1 << (fifo) * 8 << 4)
++#define FIFOCF_FIFO_EN(fifo)	(0x1 << (fifo) * 8 << 5)
++
++/* Device FIFO n Instruction and Byte Count Register (0x1B0+4*n) */
++#define FOTG210_FIBCR(fifo)	(0x1B0 + (fifo) * 4)
++#define FIBCR_BCFX		0x7FF
++#define FIBCR_FFRST		(1 << 12)
++
++/* Device DMA Target FIFO Number Register (0x1C0) */
++#define FOTG210_DMATFNR		0x1C0
++#define DMATFNR_ACC_CXF		(1 << 4)
++#define DMATFNR_ACC_F3		(1 << 3)
++#define DMATFNR_ACC_F2		(1 << 2)
++#define DMATFNR_ACC_F1		(1 << 1)
++#define DMATFNR_ACC_F0		(1 << 0)
++#define DMATFNR_ACC_FN(fifo)	(1 << (fifo))
++#define DMATFNR_DISDMA		0
++
++/* Device DMA Controller Parameter setting 1 Register (0x1C8) */
++#define FOTG210_DMACPSR1	0x1C8
++#define DMACPSR1_DMA_LEN(len)	(((len) & 0xFFFF) << 8)
++#define DMACPSR1_DMA_ABORT	(1 << 3)
++#define DMACPSR1_DMA_TYPE(dir_in)	(((dir_in) ? 1 : 0) << 1)
++#define DMACPSR1_DMA_START	(1 << 0)
++
++/* Device DMA Controller Parameter setting 2 Register (0x1CC) */
++#define FOTG210_DMACPSR2	0x1CC
++
++/* Device DMA Controller Parameter setting 3 Register (0x1CC) */
++#define FOTG210_CXPORT		0x1D0
++
++struct fotg210_request {
++	struct usb_request	req;
++	struct list_head	queue;
++};
++
++struct fotg210_ep {
++	struct usb_ep		ep;
++	struct fotg210_udc	*fotg210;
++
++	struct list_head	queue;
++	unsigned		stall:1;
++	unsigned		wedged:1;
++	unsigned		use_dma:1;
++
++	unsigned char		epnum;
++	unsigned char		type;
++	unsigned char		dir_in;
++	unsigned int		maxp;
++	const struct usb_endpoint_descriptor	*desc;
++};
++
++struct fotg210_udc {
++	spinlock_t		lock; /* protect the struct */
++	void __iomem		*reg;
++
++	unsigned long		irq_trigger;
++
++	struct usb_gadget		gadget;
++	struct usb_gadget_driver	*driver;
++
++	struct fotg210_ep	*ep[FOTG210_MAX_NUM_EP];
++
++	struct usb_request	*ep0_req;	/* for internal request */
++	__le16			ep0_data;
++	u8			ep0_dir;	/* 0/0x80  out/in */
++
++	u8			reenum;		/* if re-enumeration */
++};
++
++#define gadget_to_fotg210(g)	container_of((g), struct fotg210_udc, gadget)
+--- a/drivers/usb/gadget/udc/fotg210.h
++++ /dev/null
+@@ -1,249 +0,0 @@
+-// SPDX-License-Identifier: GPL-2.0+
+-/*
+- * Faraday FOTG210 USB OTG controller
+- *
+- * Copyright (C) 2013 Faraday Technology Corporation
+- * Author: Yuan-Hsin Chen <yhchen at faraday-tech.com>
+- */
+-
+-#include <linux/kernel.h>
+-
+-#define FOTG210_MAX_NUM_EP	5 /* ep0...ep4 */
+-#define FOTG210_MAX_FIFO_NUM	4 /* fifo0...fifo4 */
+-
+-/* Global Mask of HC/OTG/DEV interrupt Register(0xC4) */
+-#define FOTG210_GMIR		0xC4
+-#define GMIR_INT_POLARITY	0x8 /*Active High*/
+-#define GMIR_MHC_INT		0x4
+-#define GMIR_MOTG_INT		0x2
+-#define GMIR_MDEV_INT		0x1
+-
+-/*  Device Main Control Register(0x100) */
+-#define FOTG210_DMCR		0x100
+-#define DMCR_HS_EN		(1 << 6)
+-#define DMCR_CHIP_EN		(1 << 5)
+-#define DMCR_SFRST		(1 << 4)
+-#define DMCR_GOSUSP		(1 << 3)
+-#define DMCR_GLINT_EN		(1 << 2)
+-#define DMCR_HALF_SPEED		(1 << 1)
+-#define DMCR_CAP_RMWAKUP	(1 << 0)
+-
+-/* Device Address Register(0x104) */
+-#define FOTG210_DAR		0x104
+-#define DAR_AFT_CONF		(1 << 7)
+-
+-/* Device Test Register(0x108) */
+-#define FOTG210_DTR		0x108
+-#define DTR_TST_CLRFF		(1 << 0)
+-
+-/* PHY Test Mode Selector register(0x114) */
+-#define FOTG210_PHYTMSR		0x114
+-#define PHYTMSR_TST_PKT		(1 << 4)
+-#define PHYTMSR_TST_SE0NAK	(1 << 3)
+-#define PHYTMSR_TST_KSTA	(1 << 2)
+-#define PHYTMSR_TST_JSTA	(1 << 1)
+-#define PHYTMSR_UNPLUG		(1 << 0)
+-
+-/* Cx configuration and FIFO Empty Status register(0x120) */
+-#define FOTG210_DCFESR		0x120
+-#define DCFESR_FIFO_EMPTY(fifo)	(1 << 8 << (fifo))
+-#define DCFESR_CX_EMP		(1 << 5)
+-#define DCFESR_CX_CLR		(1 << 3)
+-#define DCFESR_CX_STL		(1 << 2)
+-#define DCFESR_TST_PKDONE	(1 << 1)
+-#define DCFESR_CX_DONE		(1 << 0)
+-
+-/* Device IDLE Counter Register(0x124) */
+-#define FOTG210_DICR		0x124
+-
+-/* Device Mask of Interrupt Group Register (0x130) */
+-#define FOTG210_DMIGR		0x130
+-#define DMIGR_MINT_G0		(1 << 0)
+-
+-/* Device Mask of Interrupt Source Group 0(0x134) */
+-#define FOTG210_DMISGR0		0x134
+-#define DMISGR0_MCX_COMEND	(1 << 3)
+-#define DMISGR0_MCX_OUT_INT	(1 << 2)
+-#define DMISGR0_MCX_IN_INT	(1 << 1)
+-#define DMISGR0_MCX_SETUP_INT	(1 << 0)
+-
+-/* Device Mask of Interrupt Source Group 1 Register(0x138)*/
+-#define FOTG210_DMISGR1		0x138
+-#define DMISGR1_MF3_IN_INT	(1 << 19)
+-#define DMISGR1_MF2_IN_INT	(1 << 18)
+-#define DMISGR1_MF1_IN_INT	(1 << 17)
+-#define DMISGR1_MF0_IN_INT	(1 << 16)
+-#define DMISGR1_MF_IN_INT(fifo)	(1 << (16 + (fifo)))
+-#define DMISGR1_MF3_SPK_INT	(1 << 7)
+-#define DMISGR1_MF3_OUT_INT	(1 << 6)
+-#define DMISGR1_MF2_SPK_INT	(1 << 5)
+-#define DMISGR1_MF2_OUT_INT	(1 << 4)
+-#define DMISGR1_MF1_SPK_INT	(1 << 3)
+-#define DMISGR1_MF1_OUT_INT	(1 << 2)
+-#define DMISGR1_MF0_SPK_INT	(1 << 1)
+-#define DMISGR1_MF0_OUT_INT	(1 << 0)
+-#define DMISGR1_MF_OUTSPK_INT(fifo)	(0x3 << (fifo) * 2)
+-
+-/* Device Mask of Interrupt Source Group 2 Register (0x13C) */
+-#define FOTG210_DMISGR2		0x13C
+-#define DMISGR2_MDMA_ERROR	(1 << 8)
+-#define DMISGR2_MDMA_CMPLT	(1 << 7)
+-
+-/* Device Interrupt group Register (0x140) */
+-#define FOTG210_DIGR		0x140
+-#define DIGR_INT_G2		(1 << 2)
+-#define DIGR_INT_G1		(1 << 1)
+-#define DIGR_INT_G0		(1 << 0)
+-
+-/* Device Interrupt Source Group 0 Register (0x144) */
+-#define FOTG210_DISGR0		0x144
+-#define DISGR0_CX_COMABT_INT	(1 << 5)
+-#define DISGR0_CX_COMFAIL_INT	(1 << 4)
+-#define DISGR0_CX_COMEND_INT	(1 << 3)
+-#define DISGR0_CX_OUT_INT	(1 << 2)
+-#define DISGR0_CX_IN_INT	(1 << 1)
+-#define DISGR0_CX_SETUP_INT	(1 << 0)
+-
+-/* Device Interrupt Source Group 1 Register (0x148) */
+-#define FOTG210_DISGR1		0x148
+-#define DISGR1_OUT_INT(fifo)	(1 << ((fifo) * 2))
+-#define DISGR1_SPK_INT(fifo)	(1 << 1 << ((fifo) * 2))
+-#define DISGR1_IN_INT(fifo)	(1 << 16 << (fifo))
+-
+-/* Device Interrupt Source Group 2 Register (0x14C) */
+-#define FOTG210_DISGR2		0x14C
+-#define DISGR2_DMA_ERROR	(1 << 8)
+-#define DISGR2_DMA_CMPLT	(1 << 7)
+-#define DISGR2_RX0BYTE_INT	(1 << 6)
+-#define DISGR2_TX0BYTE_INT	(1 << 5)
+-#define DISGR2_ISO_SEQ_ABORT_INT	(1 << 4)
+-#define DISGR2_ISO_SEQ_ERR_INT	(1 << 3)
+-#define DISGR2_RESM_INT		(1 << 2)
+-#define DISGR2_SUSP_INT		(1 << 1)
+-#define DISGR2_USBRST_INT	(1 << 0)
+-
+-/* Device Receive Zero-Length Data Packet Register (0x150)*/
+-#define FOTG210_RX0BYTE		0x150
+-#define RX0BYTE_EP8		(1 << 7)
+-#define RX0BYTE_EP7		(1 << 6)
+-#define RX0BYTE_EP6		(1 << 5)
+-#define RX0BYTE_EP5		(1 << 4)
+-#define RX0BYTE_EP4		(1 << 3)
+-#define RX0BYTE_EP3		(1 << 2)
+-#define RX0BYTE_EP2		(1 << 1)
+-#define RX0BYTE_EP1		(1 << 0)
+-
+-/* Device Transfer Zero-Length Data Packet Register (0x154)*/
+-#define FOTG210_TX0BYTE		0x154
+-#define TX0BYTE_EP8		(1 << 7)
+-#define TX0BYTE_EP7		(1 << 6)
+-#define TX0BYTE_EP6		(1 << 5)
+-#define TX0BYTE_EP5		(1 << 4)
+-#define TX0BYTE_EP4		(1 << 3)
+-#define TX0BYTE_EP3		(1 << 2)
+-#define TX0BYTE_EP2		(1 << 1)
+-#define TX0BYTE_EP1		(1 << 0)
+-
+-/* Device IN Endpoint x MaxPacketSize Register(0x160+4*(x-1)) */
+-#define FOTG210_INEPMPSR(ep)	(0x160 + 4 * ((ep) - 1))
+-#define INOUTEPMPSR_MPS(mps)	((mps) & 0x2FF)
+-#define INOUTEPMPSR_STL_EP	(1 << 11)
+-#define INOUTEPMPSR_RESET_TSEQ	(1 << 12)
+-
+-/* Device OUT Endpoint x MaxPacketSize Register(0x180+4*(x-1)) */
+-#define FOTG210_OUTEPMPSR(ep)	(0x180 + 4 * ((ep) - 1))
+-
+-/* Device Endpoint 1~4 Map Register (0x1A0) */
+-#define FOTG210_EPMAP		0x1A0
+-#define EPMAP_FIFONO(ep, dir)		\
+-	((((ep) - 1) << ((ep) - 1) * 8) << ((dir) ? 0 : 4))
+-#define EPMAP_FIFONOMSK(ep, dir)	\
+-	((3 << ((ep) - 1) * 8) << ((dir) ? 0 : 4))
+-
+-/* Device FIFO Map Register (0x1A8) */
+-#define FOTG210_FIFOMAP		0x1A8
+-#define FIFOMAP_DIROUT(fifo)	(0x0 << 4 << (fifo) * 8)
+-#define FIFOMAP_DIRIN(fifo)	(0x1 << 4 << (fifo) * 8)
+-#define FIFOMAP_BIDIR(fifo)	(0x2 << 4 << (fifo) * 8)
+-#define FIFOMAP_NA(fifo)	(0x3 << 4 << (fifo) * 8)
+-#define FIFOMAP_EPNO(ep)	((ep) << ((ep) - 1) * 8)
+-#define FIFOMAP_EPNOMSK(ep)	(0xF << ((ep) - 1) * 8)
+-
+-/* Device FIFO Confuguration Register (0x1AC) */
+-#define FOTG210_FIFOCF		0x1AC
+-#define FIFOCF_TYPE(type, fifo)	((type) << (fifo) * 8)
+-#define FIFOCF_BLK_SIN(fifo)	(0x0 << (fifo) * 8 << 2)
+-#define FIFOCF_BLK_DUB(fifo)	(0x1 << (fifo) * 8 << 2)
+-#define FIFOCF_BLK_TRI(fifo)	(0x2 << (fifo) * 8 << 2)
+-#define FIFOCF_BLKSZ_512(fifo)	(0x0 << (fifo) * 8 << 4)
+-#define FIFOCF_BLKSZ_1024(fifo)	(0x1 << (fifo) * 8 << 4)
+-#define FIFOCF_FIFO_EN(fifo)	(0x1 << (fifo) * 8 << 5)
+-
+-/* Device FIFO n Instruction and Byte Count Register (0x1B0+4*n) */
+-#define FOTG210_FIBCR(fifo)	(0x1B0 + (fifo) * 4)
+-#define FIBCR_BCFX		0x7FF
+-#define FIBCR_FFRST		(1 << 12)
+-
+-/* Device DMA Target FIFO Number Register (0x1C0) */
+-#define FOTG210_DMATFNR		0x1C0
+-#define DMATFNR_ACC_CXF		(1 << 4)
+-#define DMATFNR_ACC_F3		(1 << 3)
+-#define DMATFNR_ACC_F2		(1 << 2)
+-#define DMATFNR_ACC_F1		(1 << 1)
+-#define DMATFNR_ACC_F0		(1 << 0)
+-#define DMATFNR_ACC_FN(fifo)	(1 << (fifo))
+-#define DMATFNR_DISDMA		0
+-
+-/* Device DMA Controller Parameter setting 1 Register (0x1C8) */
+-#define FOTG210_DMACPSR1	0x1C8
+-#define DMACPSR1_DMA_LEN(len)	(((len) & 0xFFFF) << 8)
+-#define DMACPSR1_DMA_ABORT	(1 << 3)
+-#define DMACPSR1_DMA_TYPE(dir_in)	(((dir_in) ? 1 : 0) << 1)
+-#define DMACPSR1_DMA_START	(1 << 0)
+-
+-/* Device DMA Controller Parameter setting 2 Register (0x1CC) */
+-#define FOTG210_DMACPSR2	0x1CC
+-
+-/* Device DMA Controller Parameter setting 3 Register (0x1CC) */
+-#define FOTG210_CXPORT		0x1D0
+-
+-struct fotg210_request {
+-	struct usb_request	req;
+-	struct list_head	queue;
+-};
+-
+-struct fotg210_ep {
+-	struct usb_ep		ep;
+-	struct fotg210_udc	*fotg210;
+-
+-	struct list_head	queue;
+-	unsigned		stall:1;
+-	unsigned		wedged:1;
+-	unsigned		use_dma:1;
+-
+-	unsigned char		epnum;
+-	unsigned char		type;
+-	unsigned char		dir_in;
+-	unsigned int		maxp;
+-	const struct usb_endpoint_descriptor	*desc;
+-};
+-
+-struct fotg210_udc {
+-	spinlock_t		lock; /* protect the struct */
+-	void __iomem		*reg;
+-
+-	unsigned long		irq_trigger;
+-
+-	struct usb_gadget		gadget;
+-	struct usb_gadget_driver	*driver;
+-
+-	struct fotg210_ep	*ep[FOTG210_MAX_NUM_EP];
+-
+-	struct usb_request	*ep0_req;	/* for internal request */
+-	__le16			ep0_data;
+-	u8			ep0_dir;	/* 0/0x80  out/in */
+-
+-	u8			reenum;		/* if re-enumeration */
+-};
+-
+-#define gadget_to_fotg210(g)	container_of((g), struct fotg210_udc, gadget)
+--- a/drivers/usb/host/fotg210.h
++++ /dev/null
+@@ -1,688 +0,0 @@
+-/* SPDX-License-Identifier: GPL-2.0 */
+-#ifndef __LINUX_FOTG210_H
+-#define __LINUX_FOTG210_H
+-
+-#include <linux/usb/ehci-dbgp.h>
+-
+-/* definitions used for the EHCI driver */
+-
+-/*
+- * __hc32 and __hc16 are "Host Controller" types, they may be equivalent to
+- * __leXX (normally) or __beXX (given FOTG210_BIG_ENDIAN_DESC), depending on
+- * the host controller implementation.
+- *
+- * To facilitate the strongest possible byte-order checking from "sparse"
+- * and so on, we use __leXX unless that's not practical.
+- */
+-#define __hc32	__le32
+-#define __hc16	__le16
+-
+-/* statistics can be kept for tuning/monitoring */
+-struct fotg210_stats {
+-	/* irq usage */
+-	unsigned long		normal;
+-	unsigned long		error;
+-	unsigned long		iaa;
+-	unsigned long		lost_iaa;
+-
+-	/* termination of urbs from core */
+-	unsigned long		complete;
+-	unsigned long		unlink;
+-};
+-
+-/* fotg210_hcd->lock guards shared data against other CPUs:
+- *   fotg210_hcd:	async, unlink, periodic (and shadow), ...
+- *   usb_host_endpoint: hcpriv
+- *   fotg210_qh:	qh_next, qtd_list
+- *   fotg210_qtd:	qtd_list
+- *
+- * Also, hold this lock when talking to HC registers or
+- * when updating hw_* fields in shared qh/qtd/... structures.
+- */
+-
+-#define	FOTG210_MAX_ROOT_PORTS	1		/* see HCS_N_PORTS */
+-
+-/*
+- * fotg210_rh_state values of FOTG210_RH_RUNNING or above mean that the
+- * controller may be doing DMA.  Lower values mean there's no DMA.
+- */
+-enum fotg210_rh_state {
+-	FOTG210_RH_HALTED,
+-	FOTG210_RH_SUSPENDED,
+-	FOTG210_RH_RUNNING,
+-	FOTG210_RH_STOPPING
+-};
+-
+-/*
+- * Timer events, ordered by increasing delay length.
+- * Always update event_delays_ns[] and event_handlers[] (defined in
+- * ehci-timer.c) in parallel with this list.
+- */
+-enum fotg210_hrtimer_event {
+-	FOTG210_HRTIMER_POLL_ASS,	/* Poll for async schedule off */
+-	FOTG210_HRTIMER_POLL_PSS,	/* Poll for periodic schedule off */
+-	FOTG210_HRTIMER_POLL_DEAD,	/* Wait for dead controller to stop */
+-	FOTG210_HRTIMER_UNLINK_INTR,	/* Wait for interrupt QH unlink */
+-	FOTG210_HRTIMER_FREE_ITDS,	/* Wait for unused iTDs and siTDs */
+-	FOTG210_HRTIMER_ASYNC_UNLINKS,	/* Unlink empty async QHs */
+-	FOTG210_HRTIMER_IAA_WATCHDOG,	/* Handle lost IAA interrupts */
+-	FOTG210_HRTIMER_DISABLE_PERIODIC, /* Wait to disable periodic sched */
+-	FOTG210_HRTIMER_DISABLE_ASYNC,	/* Wait to disable async sched */
+-	FOTG210_HRTIMER_IO_WATCHDOG,	/* Check for missing IRQs */
+-	FOTG210_HRTIMER_NUM_EVENTS	/* Must come last */
+-};
+-#define FOTG210_HRTIMER_NO_EVENT	99
+-
+-struct fotg210_hcd {			/* one per controller */
+-	/* timing support */
+-	enum fotg210_hrtimer_event	next_hrtimer_event;
+-	unsigned		enabled_hrtimer_events;
+-	ktime_t			hr_timeouts[FOTG210_HRTIMER_NUM_EVENTS];
+-	struct hrtimer		hrtimer;
+-
+-	int			PSS_poll_count;
+-	int			ASS_poll_count;
+-	int			died_poll_count;
+-
+-	/* glue to PCI and HCD framework */
+-	struct fotg210_caps __iomem *caps;
+-	struct fotg210_regs __iomem *regs;
+-	struct ehci_dbg_port __iomem *debug;
+-
+-	__u32			hcs_params;	/* cached register copy */
+-	spinlock_t		lock;
+-	enum fotg210_rh_state	rh_state;
+-
+-	/* general schedule support */
+-	bool			scanning:1;
+-	bool			need_rescan:1;
+-	bool			intr_unlinking:1;
+-	bool			async_unlinking:1;
+-	bool			shutdown:1;
+-	struct fotg210_qh		*qh_scan_next;
+-
+-	/* async schedule support */
+-	struct fotg210_qh		*async;
+-	struct fotg210_qh		*dummy;		/* For AMD quirk use */
+-	struct fotg210_qh		*async_unlink;
+-	struct fotg210_qh		*async_unlink_last;
+-	struct fotg210_qh		*async_iaa;
+-	unsigned		async_unlink_cycle;
+-	unsigned		async_count;	/* async activity count */
+-
+-	/* periodic schedule support */
+-#define	DEFAULT_I_TDPS		1024		/* some HCs can do less */
+-	unsigned		periodic_size;
+-	__hc32			*periodic;	/* hw periodic table */
+-	dma_addr_t		periodic_dma;
+-	struct list_head	intr_qh_list;
+-	unsigned		i_thresh;	/* uframes HC might cache */
+-
+-	union fotg210_shadow	*pshadow;	/* mirror hw periodic table */
+-	struct fotg210_qh		*intr_unlink;
+-	struct fotg210_qh		*intr_unlink_last;
+-	unsigned		intr_unlink_cycle;
+-	unsigned		now_frame;	/* frame from HC hardware */
+-	unsigned		next_frame;	/* scan periodic, start here */
+-	unsigned		intr_count;	/* intr activity count */
+-	unsigned		isoc_count;	/* isoc activity count */
+-	unsigned		periodic_count;	/* periodic activity count */
+-	/* max periodic time per uframe */
+-	unsigned		uframe_periodic_max;
+-
+-
+-	/* list of itds completed while now_frame was still active */
+-	struct list_head	cached_itd_list;
+-	struct fotg210_itd	*last_itd_to_free;
+-
+-	/* per root hub port */
+-	unsigned long		reset_done[FOTG210_MAX_ROOT_PORTS];
+-
+-	/* bit vectors (one bit per port)
+-	 * which ports were already suspended at the start of a bus suspend
+-	 */
+-	unsigned long		bus_suspended;
+-
+-	/* which ports are edicated to the companion controller */
+-	unsigned long		companion_ports;
+-
+-	/* which ports are owned by the companion during a bus suspend */
+-	unsigned long		owned_ports;
+-
+-	/* which ports have the change-suspend feature turned on */
+-	unsigned long		port_c_suspend;
+-
+-	/* which ports are suspended */
+-	unsigned long		suspended_ports;
+-
+-	/* which ports have started to resume */
+-	unsigned long		resuming_ports;
+-
+-	/* per-HC memory pools (could be per-bus, but ...) */
+-	struct dma_pool		*qh_pool;	/* qh per active urb */
+-	struct dma_pool		*qtd_pool;	/* one or more per qh */
+-	struct dma_pool		*itd_pool;	/* itd per iso urb */
+-
+-	unsigned		random_frame;
+-	unsigned long		next_statechange;
+-	ktime_t			last_periodic_enable;
+-	u32			command;
+-
+-	/* SILICON QUIRKS */
+-	unsigned		need_io_watchdog:1;
+-	unsigned		fs_i_thresh:1;	/* Intel iso scheduling */
+-
+-	u8			sbrn;		/* packed release number */
+-
+-	/* irq statistics */
+-#ifdef FOTG210_STATS
+-	struct fotg210_stats	stats;
+-#	define INCR(x) ((x)++)
+-#else
+-#	define INCR(x) do {} while (0)
+-#endif
+-
+-	/* silicon clock */
+-	struct clk		*pclk;
+-};
+-
+-/* convert between an HCD pointer and the corresponding FOTG210_HCD */
+-static inline struct fotg210_hcd *hcd_to_fotg210(struct usb_hcd *hcd)
+-{
+-	return (struct fotg210_hcd *)(hcd->hcd_priv);
+-}
+-static inline struct usb_hcd *fotg210_to_hcd(struct fotg210_hcd *fotg210)
+-{
+-	return container_of((void *) fotg210, struct usb_hcd, hcd_priv);
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/* EHCI register interface, corresponds to EHCI Revision 0.95 specification */
+-
+-/* Section 2.2 Host Controller Capability Registers */
+-struct fotg210_caps {
+-	/* these fields are specified as 8 and 16 bit registers,
+-	 * but some hosts can't perform 8 or 16 bit PCI accesses.
+-	 * some hosts treat caplength and hciversion as parts of a 32-bit
+-	 * register, others treat them as two separate registers, this
+-	 * affects the memory map for big endian controllers.
+-	 */
+-	u32		hc_capbase;
+-#define HC_LENGTH(fotg210, p)	(0x00ff&((p) >> /* bits 7:0 / offset 00h */ \
+-				(fotg210_big_endian_capbase(fotg210) ? 24 : 0)))
+-#define HC_VERSION(fotg210, p)	(0xffff&((p) >> /* bits 31:16 / offset 02h */ \
+-				(fotg210_big_endian_capbase(fotg210) ? 0 : 16)))
+-	u32		hcs_params;     /* HCSPARAMS - offset 0x4 */
+-#define HCS_N_PORTS(p)		(((p)>>0)&0xf)	/* bits 3:0, ports on HC */
+-
+-	u32		hcc_params;	/* HCCPARAMS - offset 0x8 */
+-#define HCC_CANPARK(p)		((p)&(1 << 2))  /* true: can park on async qh */
+-#define HCC_PGM_FRAMELISTLEN(p) ((p)&(1 << 1))  /* true: periodic_size changes*/
+-	u8		portroute[8];	 /* nibbles for routing - offset 0xC */
+-};
+-
+-
+-/* Section 2.3 Host Controller Operational Registers */
+-struct fotg210_regs {
+-
+-	/* USBCMD: offset 0x00 */
+-	u32		command;
+-
+-/* EHCI 1.1 addendum */
+-/* 23:16 is r/w intr rate, in microframes; default "8" == 1/msec */
+-#define CMD_PARK	(1<<11)		/* enable "park" on async qh */
+-#define CMD_PARK_CNT(c)	(((c)>>8)&3)	/* how many transfers to park for */
+-#define CMD_IAAD	(1<<6)		/* "doorbell" interrupt async advance */
+-#define CMD_ASE		(1<<5)		/* async schedule enable */
+-#define CMD_PSE		(1<<4)		/* periodic schedule enable */
+-/* 3:2 is periodic frame list size */
+-#define CMD_RESET	(1<<1)		/* reset HC not bus */
+-#define CMD_RUN		(1<<0)		/* start/stop HC */
+-
+-	/* USBSTS: offset 0x04 */
+-	u32		status;
+-#define STS_ASS		(1<<15)		/* Async Schedule Status */
+-#define STS_PSS		(1<<14)		/* Periodic Schedule Status */
+-#define STS_RECL	(1<<13)		/* Reclamation */
+-#define STS_HALT	(1<<12)		/* Not running (any reason) */
+-/* some bits reserved */
+-	/* these STS_* flags are also intr_enable bits (USBINTR) */
+-#define STS_IAA		(1<<5)		/* Interrupted on async advance */
+-#define STS_FATAL	(1<<4)		/* such as some PCI access errors */
+-#define STS_FLR		(1<<3)		/* frame list rolled over */
+-#define STS_PCD		(1<<2)		/* port change detect */
+-#define STS_ERR		(1<<1)		/* "error" completion (overflow, ...) */
+-#define STS_INT		(1<<0)		/* "normal" completion (short, ...) */
+-
+-	/* USBINTR: offset 0x08 */
+-	u32		intr_enable;
+-
+-	/* FRINDEX: offset 0x0C */
+-	u32		frame_index;	/* current microframe number */
+-	/* CTRLDSSEGMENT: offset 0x10 */
+-	u32		segment;	/* address bits 63:32 if needed */
+-	/* PERIODICLISTBASE: offset 0x14 */
+-	u32		frame_list;	/* points to periodic list */
+-	/* ASYNCLISTADDR: offset 0x18 */
+-	u32		async_next;	/* address of next async queue head */
+-
+-	u32	reserved1;
+-	/* PORTSC: offset 0x20 */
+-	u32	port_status;
+-/* 31:23 reserved */
+-#define PORT_USB11(x) (((x)&(3<<10)) == (1<<10))	/* USB 1.1 device */
+-#define PORT_RESET	(1<<8)		/* reset port */
+-#define PORT_SUSPEND	(1<<7)		/* suspend port */
+-#define PORT_RESUME	(1<<6)		/* resume it */
+-#define PORT_PEC	(1<<3)		/* port enable change */
+-#define PORT_PE		(1<<2)		/* port enable */
+-#define PORT_CSC	(1<<1)		/* connect status change */
+-#define PORT_CONNECT	(1<<0)		/* device connected */
+-#define PORT_RWC_BITS   (PORT_CSC | PORT_PEC)
+-	u32     reserved2[19];
+-
+-	/* OTGCSR: offet 0x70 */
+-	u32     otgcsr;
+-#define OTGCSR_HOST_SPD_TYP     (3 << 22)
+-#define OTGCSR_A_BUS_DROP	(1 << 5)
+-#define OTGCSR_A_BUS_REQ	(1 << 4)
+-
+-	/* OTGISR: offset 0x74 */
+-	u32     otgisr;
+-#define OTGISR_OVC	(1 << 10)
+-
+-	u32     reserved3[15];
+-
+-	/* GMIR: offset 0xB4 */
+-	u32     gmir;
+-#define GMIR_INT_POLARITY	(1 << 3) /*Active High*/
+-#define GMIR_MHC_INT		(1 << 2)
+-#define GMIR_MOTG_INT		(1 << 1)
+-#define GMIR_MDEV_INT	(1 << 0)
+-};
+-
+-/*-------------------------------------------------------------------------*/
+-
+-#define	QTD_NEXT(fotg210, dma)	cpu_to_hc32(fotg210, (u32)dma)
+-
+-/*
+- * EHCI Specification 0.95 Section 3.5
+- * QTD: describe data transfer components (buffer, direction, ...)
+- * See Fig 3-6 "Queue Element Transfer Descriptor Block Diagram".
+- *
+- * These are associated only with "QH" (Queue Head) structures,
+- * used with control, bulk, and interrupt transfers.
+- */
+-struct fotg210_qtd {
+-	/* first part defined by EHCI spec */
+-	__hc32			hw_next;	/* see EHCI 3.5.1 */
+-	__hc32			hw_alt_next;    /* see EHCI 3.5.2 */
+-	__hc32			hw_token;	/* see EHCI 3.5.3 */
+-#define	QTD_TOGGLE	(1 << 31)	/* data toggle */
+-#define	QTD_LENGTH(tok)	(((tok)>>16) & 0x7fff)
+-#define	QTD_IOC		(1 << 15)	/* interrupt on complete */
+-#define	QTD_CERR(tok)	(((tok)>>10) & 0x3)
+-#define	QTD_PID(tok)	(((tok)>>8) & 0x3)
+-#define	QTD_STS_ACTIVE	(1 << 7)	/* HC may execute this */
+-#define	QTD_STS_HALT	(1 << 6)	/* halted on error */
+-#define	QTD_STS_DBE	(1 << 5)	/* data buffer error (in HC) */
+-#define	QTD_STS_BABBLE	(1 << 4)	/* device was babbling (qtd halted) */
+-#define	QTD_STS_XACT	(1 << 3)	/* device gave illegal response */
+-#define	QTD_STS_MMF	(1 << 2)	/* incomplete split transaction */
+-#define	QTD_STS_STS	(1 << 1)	/* split transaction state */
+-#define	QTD_STS_PING	(1 << 0)	/* issue PING? */
+-
+-#define ACTIVE_BIT(fotg210)	cpu_to_hc32(fotg210, QTD_STS_ACTIVE)
+-#define HALT_BIT(fotg210)		cpu_to_hc32(fotg210, QTD_STS_HALT)
+-#define STATUS_BIT(fotg210)	cpu_to_hc32(fotg210, QTD_STS_STS)
+-
+-	__hc32			hw_buf[5];	/* see EHCI 3.5.4 */
+-	__hc32			hw_buf_hi[5];	/* Appendix B */
+-
+-	/* the rest is HCD-private */
+-	dma_addr_t		qtd_dma;		/* qtd address */
+-	struct list_head	qtd_list;		/* sw qtd list */
+-	struct urb		*urb;			/* qtd's urb */
+-	size_t			length;			/* length of buffer */
+-} __aligned(32);
+-
+-/* mask NakCnt+T in qh->hw_alt_next */
+-#define QTD_MASK(fotg210)	cpu_to_hc32(fotg210, ~0x1f)
+-
+-#define IS_SHORT_READ(token) (QTD_LENGTH(token) != 0 && QTD_PID(token) == 1)
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/* type tag from {qh,itd,fstn}->hw_next */
+-#define Q_NEXT_TYPE(fotg210, dma)	((dma) & cpu_to_hc32(fotg210, 3 << 1))
+-
+-/*
+- * Now the following defines are not converted using the
+- * cpu_to_le32() macro anymore, since we have to support
+- * "dynamic" switching between be and le support, so that the driver
+- * can be used on one system with SoC EHCI controller using big-endian
+- * descriptors as well as a normal little-endian PCI EHCI controller.
+- */
+-/* values for that type tag */
+-#define Q_TYPE_ITD	(0 << 1)
+-#define Q_TYPE_QH	(1 << 1)
+-#define Q_TYPE_SITD	(2 << 1)
+-#define Q_TYPE_FSTN	(3 << 1)
+-
+-/* next async queue entry, or pointer to interrupt/periodic QH */
+-#define QH_NEXT(fotg210, dma) \
+-	(cpu_to_hc32(fotg210, (((u32)dma)&~0x01f)|Q_TYPE_QH))
+-
+-/* for periodic/async schedules and qtd lists, mark end of list */
+-#define FOTG210_LIST_END(fotg210) \
+-	cpu_to_hc32(fotg210, 1) /* "null pointer" to hw */
+-
+-/*
+- * Entries in periodic shadow table are pointers to one of four kinds
+- * of data structure.  That's dictated by the hardware; a type tag is
+- * encoded in the low bits of the hardware's periodic schedule.  Use
+- * Q_NEXT_TYPE to get the tag.
+- *
+- * For entries in the async schedule, the type tag always says "qh".
+- */
+-union fotg210_shadow {
+-	struct fotg210_qh	*qh;		/* Q_TYPE_QH */
+-	struct fotg210_itd	*itd;		/* Q_TYPE_ITD */
+-	struct fotg210_fstn	*fstn;		/* Q_TYPE_FSTN */
+-	__hc32			*hw_next;	/* (all types) */
+-	void			*ptr;
+-};
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/*
+- * EHCI Specification 0.95 Section 3.6
+- * QH: describes control/bulk/interrupt endpoints
+- * See Fig 3-7 "Queue Head Structure Layout".
+- *
+- * These appear in both the async and (for interrupt) periodic schedules.
+- */
+-
+-/* first part defined by EHCI spec */
+-struct fotg210_qh_hw {
+-	__hc32			hw_next;	/* see EHCI 3.6.1 */
+-	__hc32			hw_info1;	/* see EHCI 3.6.2 */
+-#define	QH_CONTROL_EP	(1 << 27)	/* FS/LS control endpoint */
+-#define	QH_HEAD		(1 << 15)	/* Head of async reclamation list */
+-#define	QH_TOGGLE_CTL	(1 << 14)	/* Data toggle control */
+-#define	QH_HIGH_SPEED	(2 << 12)	/* Endpoint speed */
+-#define	QH_LOW_SPEED	(1 << 12)
+-#define	QH_FULL_SPEED	(0 << 12)
+-#define	QH_INACTIVATE	(1 << 7)	/* Inactivate on next transaction */
+-	__hc32			hw_info2;	/* see EHCI 3.6.2 */
+-#define	QH_SMASK	0x000000ff
+-#define	QH_CMASK	0x0000ff00
+-#define	QH_HUBADDR	0x007f0000
+-#define	QH_HUBPORT	0x3f800000
+-#define	QH_MULT		0xc0000000
+-	__hc32			hw_current;	/* qtd list - see EHCI 3.6.4 */
+-
+-	/* qtd overlay (hardware parts of a struct fotg210_qtd) */
+-	__hc32			hw_qtd_next;
+-	__hc32			hw_alt_next;
+-	__hc32			hw_token;
+-	__hc32			hw_buf[5];
+-	__hc32			hw_buf_hi[5];
+-} __aligned(32);
+-
+-struct fotg210_qh {
+-	struct fotg210_qh_hw	*hw;		/* Must come first */
+-	/* the rest is HCD-private */
+-	dma_addr_t		qh_dma;		/* address of qh */
+-	union fotg210_shadow	qh_next;	/* ptr to qh; or periodic */
+-	struct list_head	qtd_list;	/* sw qtd list */
+-	struct list_head	intr_node;	/* list of intr QHs */
+-	struct fotg210_qtd	*dummy;
+-	struct fotg210_qh	*unlink_next;	/* next on unlink list */
+-
+-	unsigned		unlink_cycle;
+-
+-	u8			needs_rescan;	/* Dequeue during giveback */
+-	u8			qh_state;
+-#define	QH_STATE_LINKED		1		/* HC sees this */
+-#define	QH_STATE_UNLINK		2		/* HC may still see this */
+-#define	QH_STATE_IDLE		3		/* HC doesn't see this */
+-#define	QH_STATE_UNLINK_WAIT	4		/* LINKED and on unlink q */
+-#define	QH_STATE_COMPLETING	5		/* don't touch token.HALT */
+-
+-	u8			xacterrs;	/* XactErr retry counter */
+-#define	QH_XACTERR_MAX		32		/* XactErr retry limit */
+-
+-	/* periodic schedule info */
+-	u8			usecs;		/* intr bandwidth */
+-	u8			gap_uf;		/* uframes split/csplit gap */
+-	u8			c_usecs;	/* ... split completion bw */
+-	u16			tt_usecs;	/* tt downstream bandwidth */
+-	unsigned short		period;		/* polling interval */
+-	unsigned short		start;		/* where polling starts */
+-#define NO_FRAME ((unsigned short)~0)			/* pick new start */
+-
+-	struct usb_device	*dev;		/* access to TT */
+-	unsigned		is_out:1;	/* bulk or intr OUT */
+-	unsigned		clearing_tt:1;	/* Clear-TT-Buf in progress */
+-};
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/* description of one iso transaction (up to 3 KB data if highspeed) */
+-struct fotg210_iso_packet {
+-	/* These will be copied to iTD when scheduling */
+-	u64			bufp;		/* itd->hw_bufp{,_hi}[pg] |= */
+-	__hc32			transaction;	/* itd->hw_transaction[i] |= */
+-	u8			cross;		/* buf crosses pages */
+-	/* for full speed OUT splits */
+-	u32			buf1;
+-};
+-
+-/* temporary schedule data for packets from iso urbs (both speeds)
+- * each packet is one logical usb transaction to the device (not TT),
+- * beginning at stream->next_uframe
+- */
+-struct fotg210_iso_sched {
+-	struct list_head	td_list;
+-	unsigned		span;
+-	struct fotg210_iso_packet	packet[];
+-};
+-
+-/*
+- * fotg210_iso_stream - groups all (s)itds for this endpoint.
+- * acts like a qh would, if EHCI had them for ISO.
+- */
+-struct fotg210_iso_stream {
+-	/* first field matches fotg210_hq, but is NULL */
+-	struct fotg210_qh_hw	*hw;
+-
+-	u8			bEndpointAddress;
+-	u8			highspeed;
+-	struct list_head	td_list;	/* queued itds */
+-	struct list_head	free_list;	/* list of unused itds */
+-	struct usb_device	*udev;
+-	struct usb_host_endpoint *ep;
+-
+-	/* output of (re)scheduling */
+-	int			next_uframe;
+-	__hc32			splits;
+-
+-	/* the rest is derived from the endpoint descriptor,
+-	 * trusting urb->interval == f(epdesc->bInterval) and
+-	 * including the extra info for hw_bufp[0..2]
+-	 */
+-	u8			usecs, c_usecs;
+-	u16			interval;
+-	u16			tt_usecs;
+-	u16			maxp;
+-	u16			raw_mask;
+-	unsigned		bandwidth;
+-
+-	/* This is used to initialize iTD's hw_bufp fields */
+-	__hc32			buf0;
+-	__hc32			buf1;
+-	__hc32			buf2;
+-
+-	/* this is used to initialize sITD's tt info */
+-	__hc32			address;
+-};
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/*
+- * EHCI Specification 0.95 Section 3.3
+- * Fig 3-4 "Isochronous Transaction Descriptor (iTD)"
+- *
+- * Schedule records for high speed iso xfers
+- */
+-struct fotg210_itd {
+-	/* first part defined by EHCI spec */
+-	__hc32			hw_next;	/* see EHCI 3.3.1 */
+-	__hc32			hw_transaction[8]; /* see EHCI 3.3.2 */
+-#define FOTG210_ISOC_ACTIVE	(1<<31)	/* activate transfer this slot */
+-#define FOTG210_ISOC_BUF_ERR	(1<<30)	/* Data buffer error */
+-#define FOTG210_ISOC_BABBLE	(1<<29)	/* babble detected */
+-#define FOTG210_ISOC_XACTERR	(1<<28)	/* XactErr - transaction error */
+-#define	FOTG210_ITD_LENGTH(tok)	(((tok)>>16) & 0x0fff)
+-#define	FOTG210_ITD_IOC		(1 << 15)	/* interrupt on complete */
+-
+-#define ITD_ACTIVE(fotg210)	cpu_to_hc32(fotg210, FOTG210_ISOC_ACTIVE)
+-
+-	__hc32			hw_bufp[7];	/* see EHCI 3.3.3 */
+-	__hc32			hw_bufp_hi[7];	/* Appendix B */
+-
+-	/* the rest is HCD-private */
+-	dma_addr_t		itd_dma;	/* for this itd */
+-	union fotg210_shadow	itd_next;	/* ptr to periodic q entry */
+-
+-	struct urb		*urb;
+-	struct fotg210_iso_stream	*stream;	/* endpoint's queue */
+-	struct list_head	itd_list;	/* list of stream's itds */
+-
+-	/* any/all hw_transactions here may be used by that urb */
+-	unsigned		frame;		/* where scheduled */
+-	unsigned		pg;
+-	unsigned		index[8];	/* in urb->iso_frame_desc */
+-} __aligned(32);
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/*
+- * EHCI Specification 0.96 Section 3.7
+- * Periodic Frame Span Traversal Node (FSTN)
+- *
+- * Manages split interrupt transactions (using TT) that span frame boundaries
+- * into uframes 0/1; see 4.12.2.2.  In those uframes, a "save place" FSTN
+- * makes the HC jump (back) to a QH to scan for fs/ls QH completions until
+- * it hits a "restore" FSTN; then it returns to finish other uframe 0/1 work.
+- */
+-struct fotg210_fstn {
+-	__hc32			hw_next;	/* any periodic q entry */
+-	__hc32			hw_prev;	/* qh or FOTG210_LIST_END */
+-
+-	/* the rest is HCD-private */
+-	dma_addr_t		fstn_dma;
+-	union fotg210_shadow	fstn_next;	/* ptr to periodic q entry */
+-} __aligned(32);
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/* Prepare the PORTSC wakeup flags during controller suspend/resume */
+-
+-#define fotg210_prepare_ports_for_controller_suspend(fotg210, do_wakeup) \
+-		fotg210_adjust_port_wakeup_flags(fotg210, true, do_wakeup)
+-
+-#define fotg210_prepare_ports_for_controller_resume(fotg210)		\
+-		fotg210_adjust_port_wakeup_flags(fotg210, false, false)
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/*
+- * Some EHCI controllers have a Transaction Translator built into the
+- * root hub. This is a non-standard feature.  Each controller will need
+- * to add code to the following inline functions, and call them as
+- * needed (mostly in root hub code).
+- */
+-
+-static inline unsigned int
+-fotg210_get_speed(struct fotg210_hcd *fotg210, unsigned int portsc)
+-{
+-	return (readl(&fotg210->regs->otgcsr)
+-		& OTGCSR_HOST_SPD_TYP) >> 22;
+-}
+-
+-/* Returns the speed of a device attached to a port on the root hub. */
+-static inline unsigned int
+-fotg210_port_speed(struct fotg210_hcd *fotg210, unsigned int portsc)
+-{
+-	switch (fotg210_get_speed(fotg210, portsc)) {
+-	case 0:
+-		return 0;
+-	case 1:
+-		return USB_PORT_STAT_LOW_SPEED;
+-	case 2:
+-	default:
+-		return USB_PORT_STAT_HIGH_SPEED;
+-	}
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-#define	fotg210_has_fsl_portno_bug(e)		(0)
+-
+-/*
+- * While most USB host controllers implement their registers in
+- * little-endian format, a minority (celleb companion chip) implement
+- * them in big endian format.
+- *
+- * This attempts to support either format at compile time without a
+- * runtime penalty, or both formats with the additional overhead
+- * of checking a flag bit.
+- *
+- */
+-
+-#define fotg210_big_endian_mmio(e)	0
+-#define fotg210_big_endian_capbase(e)	0
+-
+-static inline unsigned int fotg210_readl(const struct fotg210_hcd *fotg210,
+-		__u32 __iomem *regs)
+-{
+-	return readl(regs);
+-}
+-
+-static inline void fotg210_writel(const struct fotg210_hcd *fotg210,
+-		const unsigned int val, __u32 __iomem *regs)
+-{
+-	writel(val, regs);
+-}
+-
+-/* cpu to fotg210 */
+-static inline __hc32 cpu_to_hc32(const struct fotg210_hcd *fotg210, const u32 x)
+-{
+-	return cpu_to_le32(x);
+-}
+-
+-/* fotg210 to cpu */
+-static inline u32 hc32_to_cpu(const struct fotg210_hcd *fotg210, const __hc32 x)
+-{
+-	return le32_to_cpu(x);
+-}
+-
+-static inline u32 hc32_to_cpup(const struct fotg210_hcd *fotg210,
+-			       const __hc32 *x)
+-{
+-	return le32_to_cpup(x);
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-static inline unsigned fotg210_read_frame_index(struct fotg210_hcd *fotg210)
+-{
+-	return fotg210_readl(fotg210, &fotg210->regs->frame_index);
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-#endif /* __LINUX_FOTG210_H */
diff --git a/target/linux/gemini/patches-6.1/0003-usb-fotg210-Compile-into-one-module.patch b/target/linux/gemini/patches-6.1/0003-usb-fotg210-Compile-into-one-module.patch
new file mode 100644
index 000000000000..7a48245b5a53
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0003-usb-fotg210-Compile-into-one-module.patch
@@ -0,0 +1,342 @@
+From 0dbc77a99267a5efef0603a4b49ac02ece6a3f23 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 23 Oct 2022 16:47:07 +0200
+Subject: [PATCH 03/29] usb: fotg210: Compile into one module
+
+It is since ages perfectly possible to compile both of these
+modules into the same kernel, which makes no sense since it
+is one piece of hardware.
+
+Compile one module named "fotg210.ko" for both HCD and UDC
+drivers by collecting the init calls into a fotg210-core.c
+file and start to centralize things handling one and the same
+piece of hardware.
+
+Stub out the initcalls if one or the other part of the driver
+was not selected.
+
+Tested by compiling one or the other or both of the drivers
+into the kernel and as modules.
+
+Cc: Fabian Vogt <fabian at ritter-vogt.de>
+Cc: Yuan-Hsin Chen <yhchen at faraday-tech.com>
+Cc: Felipe Balbi <balbi at kernel.org>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221023144708.3596563-2-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/Kconfig        |  4 +-
+ drivers/usb/fotg210/Makefile       | 11 ++++-
+ drivers/usb/fotg210/fotg210-core.c | 79 ++++++++++++++++++++++++++++++
+ drivers/usb/fotg210/fotg210-hcd.c  | 49 +++---------------
+ drivers/usb/fotg210/fotg210-udc.c  | 19 ++-----
+ drivers/usb/fotg210/fotg210.h      | 42 ++++++++++++++++
+ 6 files changed, 142 insertions(+), 62 deletions(-)
+ create mode 100644 drivers/usb/fotg210/fotg210-core.c
+ create mode 100644 drivers/usb/fotg210/fotg210.h
+
+--- a/drivers/usb/fotg210/Kconfig
++++ b/drivers/usb/fotg210/Kconfig
+@@ -12,7 +12,7 @@ config USB_FOTG210
+ if USB_FOTG210
+ 
+ config USB_FOTG210_HCD
+-	tristate "Faraday FOTG210 USB Host Controller support"
++	bool "Faraday FOTG210 USB Host Controller support"
+ 	depends on USB
+ 	help
+ 	  Faraday FOTG210 is an OTG controller which can be configured as
+@@ -24,7 +24,7 @@ config USB_FOTG210_HCD
+ 
+ config USB_FOTG210_UDC
+ 	depends on USB_GADGET
+-	tristate "Faraday FOTG210 USB Peripheral Controller support"
++	bool "Faraday FOTG210 USB Peripheral Controller support"
+ 	help
+ 	   Faraday USB2.0 OTG controller which can be configured as
+ 	   high speed or full speed USB device. This driver suppports
+--- a/drivers/usb/fotg210/Makefile
++++ b/drivers/usb/fotg210/Makefile
+@@ -1,3 +1,10 @@
+ # SPDX-License-Identifier: GPL-2.0
+-obj-$(CONFIG_USB_FOTG210_HCD)	+= fotg210-hcd.o
+-obj-$(CONFIG_USB_FOTG210_UDC)	+= fotg210-udc.o
++
++# This setup links the different object files into one single
++# module so we don't have to EXPORT() a lot of internal symbols
++# or create unnecessary submodules.
++fotg210-objs-y				+= fotg210-core.o
++fotg210-objs-$(CONFIG_USB_FOTG210_HCD)	+= fotg210-hcd.o
++fotg210-objs-$(CONFIG_USB_FOTG210_UDC)	+= fotg210-udc.o
++fotg210-objs				:= $(fotg210-objs-y)
++obj-$(CONFIG_USB_FOTG210)		+= fotg210.o
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -0,0 +1,79 @@
++// SPDX-License-Identifier: GPL-2.0+
++/*
++ * Central probing code for the FOTG210 dual role driver
++ * We register one driver for the hardware and then we decide
++ * whether to proceed with probing the host or the peripheral
++ * driver.
++ */
++#include <linux/device.h>
++#include <linux/module.h>
++#include <linux/of.h>
++#include <linux/platform_device.h>
++#include <linux/usb.h>
++
++#include "fotg210.h"
++
++static int fotg210_probe(struct platform_device *pdev)
++{
++	int ret;
++
++	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD)) {
++		ret = fotg210_hcd_probe(pdev);
++		if (ret)
++			return ret;
++	}
++	if (IS_ENABLED(CONFIG_USB_FOTG210_UDC))
++		ret = fotg210_udc_probe(pdev);
++
++	return ret;
++}
++
++static int fotg210_remove(struct platform_device *pdev)
++{
++	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD))
++		fotg210_hcd_remove(pdev);
++	if (IS_ENABLED(CONFIG_USB_FOTG210_UDC))
++		fotg210_udc_remove(pdev);
++
++	return 0;
++}
++
++#ifdef CONFIG_OF
++static const struct of_device_id fotg210_of_match[] = {
++	{ .compatible = "faraday,fotg210" },
++	{},
++};
++MODULE_DEVICE_TABLE(of, fotg210_of_match);
++#endif
++
++static struct platform_driver fotg210_driver = {
++	.driver = {
++		.name   = "fotg210",
++		.of_match_table = of_match_ptr(fotg210_of_match),
++	},
++	.probe  = fotg210_probe,
++	.remove = fotg210_remove,
++};
++
++static int __init fotg210_init(void)
++{
++	if (usb_disabled())
++		return -ENODEV;
++
++	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD))
++		fotg210_hcd_init();
++	return platform_driver_register(&fotg210_driver);
++}
++module_init(fotg210_init);
++
++static void __exit fotg210_cleanup(void)
++{
++	platform_driver_unregister(&fotg210_driver);
++	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD))
++		fotg210_hcd_cleanup();
++}
++module_exit(fotg210_cleanup);
++
++MODULE_AUTHOR("Yuan-Hsin Chen, Feng-Hsin Chiang");
++MODULE_LICENSE("GPL");
++MODULE_DESCRIPTION("FOTG210 Dual Role Controller Driver");
+--- a/drivers/usb/fotg210/fotg210-hcd.c
++++ b/drivers/usb/fotg210/fotg210-hcd.c
+@@ -39,8 +39,8 @@
+ #include <asm/irq.h>
+ #include <asm/unaligned.h>
+ 
+-#define DRIVER_AUTHOR "Yuan-Hsin Chen"
+-#define DRIVER_DESC "FOTG210 Host Controller (EHCI) Driver"
++#include "fotg210.h"
++
+ static const char hcd_name[] = "fotg210_hcd";
+ 
+ #undef FOTG210_URB_TRACE
+@@ -5490,9 +5490,6 @@ static int fotg210_get_frame(struct usb_
+  * functions  and in order to facilitate role switching we cannot
+  * give the fotg210 driver exclusive access to those.
+  */
+-MODULE_DESCRIPTION(DRIVER_DESC);
+-MODULE_AUTHOR(DRIVER_AUTHOR);
+-MODULE_LICENSE("GPL");
+ 
+ static const struct hc_driver fotg210_fotg210_hc_driver = {
+ 	.description		= hcd_name,
+@@ -5560,7 +5557,7 @@ static void fotg210_init(struct fotg210_
+  * then invokes the start() method for the HCD associated with it
+  * through the hotplug entry's driver_data.
+  */
+-static int fotg210_hcd_probe(struct platform_device *pdev)
++int fotg210_hcd_probe(struct platform_device *pdev)
+ {
+ 	struct device *dev = &pdev->dev;
+ 	struct usb_hcd *hcd;
+@@ -5652,7 +5649,7 @@ fail_create_hcd:
+  * @dev: USB Host Controller being removed
+  *
+  */
+-static int fotg210_hcd_remove(struct platform_device *pdev)
++int fotg210_hcd_remove(struct platform_device *pdev)
+ {
+ 	struct usb_hcd *hcd = platform_get_drvdata(pdev);
+ 	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+@@ -5668,27 +5665,8 @@ static int fotg210_hcd_remove(struct pla
+ 	return 0;
+ }
+ 
+-#ifdef CONFIG_OF
+-static const struct of_device_id fotg210_of_match[] = {
+-	{ .compatible = "faraday,fotg210" },
+-	{},
+-};
+-MODULE_DEVICE_TABLE(of, fotg210_of_match);
+-#endif
+-
+-static struct platform_driver fotg210_hcd_driver = {
+-	.driver = {
+-		.name   = "fotg210-hcd",
+-		.of_match_table = of_match_ptr(fotg210_of_match),
+-	},
+-	.probe  = fotg210_hcd_probe,
+-	.remove = fotg210_hcd_remove,
+-};
+-
+-static int __init fotg210_hcd_init(void)
++int __init fotg210_hcd_init(void)
+ {
+-	int retval = 0;
+-
+ 	if (usb_disabled())
+ 		return -ENODEV;
+ 
+@@ -5704,24 +5682,11 @@ static int __init fotg210_hcd_init(void)
+ 
+ 	fotg210_debug_root = debugfs_create_dir("fotg210", usb_debug_root);
+ 
+-	retval = platform_driver_register(&fotg210_hcd_driver);
+-	if (retval < 0)
+-		goto clean;
+-	return retval;
+-
+-clean:
+-	debugfs_remove(fotg210_debug_root);
+-	fotg210_debug_root = NULL;
+-
+-	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
+-	return retval;
++	return 0;
+ }
+-module_init(fotg210_hcd_init);
+ 
+-static void __exit fotg210_hcd_cleanup(void)
++void __exit fotg210_hcd_cleanup(void)
+ {
+-	platform_driver_unregister(&fotg210_hcd_driver);
+ 	debugfs_remove(fotg210_debug_root);
+ 	clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded);
+ }
+-module_exit(fotg210_hcd_cleanup);
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -16,6 +16,7 @@
+ #include <linux/usb/ch9.h>
+ #include <linux/usb/gadget.h>
+ 
++#include "fotg210.h"
+ #include "fotg210-udc.h"
+ 
+ #define	DRIVER_DESC	"FOTG210 USB Device Controller Driver"
+@@ -1081,7 +1082,7 @@ static const struct usb_gadget_ops fotg2
+ 	.udc_stop		= fotg210_udc_stop,
+ };
+ 
+-static int fotg210_udc_remove(struct platform_device *pdev)
++int fotg210_udc_remove(struct platform_device *pdev)
+ {
+ 	struct fotg210_udc *fotg210 = platform_get_drvdata(pdev);
+ 	int i;
+@@ -1098,7 +1099,7 @@ static int fotg210_udc_remove(struct pla
+ 	return 0;
+ }
+ 
+-static int fotg210_udc_probe(struct platform_device *pdev)
++int fotg210_udc_probe(struct platform_device *pdev)
+ {
+ 	struct resource *res, *ires;
+ 	struct fotg210_udc *fotg210 = NULL;
+@@ -1223,17 +1224,3 @@ err_alloc:
+ err:
+ 	return ret;
+ }
+-
+-static struct platform_driver fotg210_driver = {
+-	.driver		= {
+-		.name =	udc_name,
+-	},
+-	.probe		= fotg210_udc_probe,
+-	.remove		= fotg210_udc_remove,
+-};
+-
+-module_platform_driver(fotg210_driver);
+-
+-MODULE_AUTHOR("Yuan-Hsin Chen, Feng-Hsin Chiang <john453 at faraday-tech.com>");
+-MODULE_LICENSE("GPL");
+-MODULE_DESCRIPTION(DRIVER_DESC);
+--- /dev/null
++++ b/drivers/usb/fotg210/fotg210.h
+@@ -0,0 +1,42 @@
++/* SPDX-License-Identifier: GPL-2.0 */
++#ifndef __FOTG210_H
++#define __FOTG210_H
++
++#ifdef CONFIG_USB_FOTG210_HCD
++int fotg210_hcd_probe(struct platform_device *pdev);
++int fotg210_hcd_remove(struct platform_device *pdev);
++int fotg210_hcd_init(void);
++void fotg210_hcd_cleanup(void);
++#else
++static inline int fotg210_hcd_probe(struct platform_device *pdev)
++{
++	return 0;
++}
++static inline int fotg210_hcd_remove(struct platform_device *pdev)
++{
++	return 0;
++}
++static inline int fotg210_hcd_init(void)
++{
++	return 0;
++}
++static inline void fotg210_hcd_cleanup(void)
++{
++}
++#endif
++
++#ifdef CONFIG_USB_FOTG210_UDC
++int fotg210_udc_probe(struct platform_device *pdev);
++int fotg210_udc_remove(struct platform_device *pdev);
++#else
++static inline int fotg210_udc_probe(struct platform_device *pdev)
++{
++	return 0;
++}
++static inline int fotg210_udc_remove(struct platform_device *pdev)
++{
++	return 0;
++}
++#endif
++
++#endif /* __FOTG210_H */
diff --git a/target/linux/gemini/patches-6.1/0004-usb-fotg210-Select-subdriver-by-mode.patch b/target/linux/gemini/patches-6.1/0004-usb-fotg210-Select-subdriver-by-mode.patch
new file mode 100644
index 000000000000..c617ebd82177
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0004-usb-fotg210-Select-subdriver-by-mode.patch
@@ -0,0 +1,71 @@
+From 7c0b661926097e935f2711857596fc2277b2304a Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 23 Oct 2022 16:47:08 +0200
+Subject: [PATCH 04/29] usb: fotg210: Select subdriver by mode
+
+Check which mode the hardware is in, and selecte the peripheral
+driver if the hardware is in explicit peripheral mode, otherwise
+select host mode.
+
+This should solve the immediate problem that both subdrivers
+can get probed.
+
+Cc: Fabian Vogt <fabian at ritter-vogt.de>
+Cc: Yuan-Hsin Chen <yhchen at faraday-tech.com>
+Cc: Felipe Balbi <balbi at kernel.org>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221023144708.3596563-3-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 25 ++++++++++++++++---------
+ 1 file changed, 16 insertions(+), 9 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -10,30 +10,37 @@
+ #include <linux/of.h>
+ #include <linux/platform_device.h>
+ #include <linux/usb.h>
++#include <linux/usb/otg.h>
+ 
+ #include "fotg210.h"
+ 
+ static int fotg210_probe(struct platform_device *pdev)
+ {
++	struct device *dev = &pdev->dev;
++	enum usb_dr_mode mode;
+ 	int ret;
+ 
+-	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD)) {
+-		ret = fotg210_hcd_probe(pdev);
+-		if (ret)
+-			return ret;
+-	}
+-	if (IS_ENABLED(CONFIG_USB_FOTG210_UDC))
++	mode = usb_get_dr_mode(dev);
++
++	if (mode == USB_DR_MODE_PERIPHERAL)
+ 		ret = fotg210_udc_probe(pdev);
++	else
++		ret = fotg210_hcd_probe(pdev);
+ 
+ 	return ret;
+ }
+ 
+ static int fotg210_remove(struct platform_device *pdev)
+ {
+-	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD))
+-		fotg210_hcd_remove(pdev);
+-	if (IS_ENABLED(CONFIG_USB_FOTG210_UDC))
++	struct device *dev = &pdev->dev;
++	enum usb_dr_mode mode;
++
++	mode = usb_get_dr_mode(dev);
++
++	if (mode == USB_DR_MODE_PERIPHERAL)
+ 		fotg210_udc_remove(pdev);
++	else
++		fotg210_hcd_remove(pdev);
+ 
+ 	return 0;
+ }
diff --git a/target/linux/gemini/patches-6.1/0005-usb-fotg2-add-Gemini-specific-handling.patch b/target/linux/gemini/patches-6.1/0005-usb-fotg2-add-Gemini-specific-handling.patch
new file mode 100644
index 000000000000..bfce914e6646
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0005-usb-fotg2-add-Gemini-specific-handling.patch
@@ -0,0 +1,139 @@
+From f7f6c8aca91093e2f886ec97910b1a7d9a69bf9b Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 9 Nov 2022 21:05:54 +0100
+Subject: [PATCH 05/29] usb: fotg2: add Gemini-specific handling
+
+The Cortina Systems Gemini has bolted on a PHY inside the
+silicon that can be handled by six bits in a MISC register in
+the system controller.
+
+If we are running on Gemini, look up a syscon regmap through
+a phandle and enable VBUS and optionally the Mini-B connector.
+
+If the device is flagged as "wakeup-source" using the standard
+DT bindings, we also enable this in the global controller for
+respective port.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221109200554.1957185-1-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/Kconfig        |  1 +
+ drivers/usb/fotg210/fotg210-core.c | 80 ++++++++++++++++++++++++++++++
+ 2 files changed, 81 insertions(+)
+
+--- a/drivers/usb/fotg210/Kconfig
++++ b/drivers/usb/fotg210/Kconfig
+@@ -5,6 +5,7 @@ config USB_FOTG210
+ 	depends on USB || USB_GADGET
+ 	depends on HAS_DMA && HAS_IOMEM
+ 	default ARCH_GEMINI
++	select MFD_SYSCON
+ 	help
+ 	  Faraday FOTG210 is a dual-mode USB controller that can act
+ 	  in both host controller and peripheral controller mode.
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -5,15 +5,86 @@
+  * whether to proceed with probing the host or the peripheral
+  * driver.
+  */
++#include <linux/bitops.h>
+ #include <linux/device.h>
++#include <linux/mfd/syscon.h>
+ #include <linux/module.h>
+ #include <linux/of.h>
+ #include <linux/platform_device.h>
++#include <linux/regmap.h>
+ #include <linux/usb.h>
+ #include <linux/usb/otg.h>
+ 
+ #include "fotg210.h"
+ 
++/*
++ * Gemini-specific initialization function, only executed on the
++ * Gemini SoC using the global misc control register.
++ *
++ * The gemini USB blocks are connected to either Mini-A (host mode) or
++ * Mini-B (peripheral mode) plugs. There is no role switch support on the
++ * Gemini SoC, just either-or.
++ */
++#define GEMINI_GLOBAL_MISC_CTRL		0x30
++#define GEMINI_MISC_USB0_WAKEUP		BIT(14)
++#define GEMINI_MISC_USB1_WAKEUP		BIT(15)
++#define GEMINI_MISC_USB0_VBUS_ON	BIT(22)
++#define GEMINI_MISC_USB1_VBUS_ON	BIT(23)
++#define GEMINI_MISC_USB0_MINI_B		BIT(29)
++#define GEMINI_MISC_USB1_MINI_B		BIT(30)
++
++static int fotg210_gemini_init(struct device *dev, struct resource *res,
++			       enum usb_dr_mode mode)
++{
++	struct device_node *np = dev->of_node;
++	struct regmap *map;
++	bool wakeup;
++	u32 mask, val;
++	int ret;
++
++	map = syscon_regmap_lookup_by_phandle(np, "syscon");
++	if (IS_ERR(map)) {
++		dev_err(dev, "no syscon\n");
++		return PTR_ERR(map);
++	}
++	wakeup = of_property_read_bool(np, "wakeup-source");
++
++	/*
++	 * Figure out if this is USB0 or USB1 by simply checking the
++	 * physical base address.
++	 */
++	mask = 0;
++	if (res->start == 0x69000000) {
++		mask = GEMINI_MISC_USB1_VBUS_ON | GEMINI_MISC_USB1_MINI_B |
++			GEMINI_MISC_USB1_WAKEUP;
++		if (mode == USB_DR_MODE_HOST)
++			val = GEMINI_MISC_USB1_VBUS_ON;
++		else
++			val = GEMINI_MISC_USB1_MINI_B;
++		if (wakeup)
++			val |= GEMINI_MISC_USB1_WAKEUP;
++	} else {
++		mask = GEMINI_MISC_USB0_VBUS_ON | GEMINI_MISC_USB0_MINI_B |
++			GEMINI_MISC_USB0_WAKEUP;
++		if (mode == USB_DR_MODE_HOST)
++			val = GEMINI_MISC_USB0_VBUS_ON;
++		else
++			val = GEMINI_MISC_USB0_MINI_B;
++		if (wakeup)
++			val |= GEMINI_MISC_USB0_WAKEUP;
++	}
++
++	ret = regmap_update_bits(map, GEMINI_GLOBAL_MISC_CTRL, mask, val);
++	if (ret) {
++		dev_err(dev, "failed to initialize Gemini PHY\n");
++		return ret;
++	}
++
++	dev_info(dev, "initialized Gemini PHY in %s mode\n",
++		 (mode == USB_DR_MODE_HOST) ? "host" : "gadget");
++	return 0;
++}
++
+ static int fotg210_probe(struct platform_device *pdev)
+ {
+ 	struct device *dev = &pdev->dev;
+@@ -22,6 +93,15 @@ static int fotg210_probe(struct platform
+ 
+ 	mode = usb_get_dr_mode(dev);
+ 
++	if (of_device_is_compatible(dev->of_node, "cortina,gemini-usb")) {
++		struct resource *res;
++
++		res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++		ret = fotg210_gemini_init(dev, res, mode);
++		if (ret)
++			return ret;
++	}
++
+ 	if (mode == USB_DR_MODE_PERIPHERAL)
+ 		ret = fotg210_udc_probe(pdev);
+ 	else
diff --git a/target/linux/gemini/patches-6.1/0006-usb-fotg210-Fix-Kconfig-for-USB-host-modules.patch b/target/linux/gemini/patches-6.1/0006-usb-fotg210-Fix-Kconfig-for-USB-host-modules.patch
new file mode 100644
index 000000000000..76d4d8fbc104
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0006-usb-fotg210-Fix-Kconfig-for-USB-host-modules.patch
@@ -0,0 +1,54 @@
+From 6e002d41889bc52213a26ff91338d340505e0336 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Fri, 11 Nov 2022 15:48:21 +0100
+Subject: [PATCH 06/29] usb: fotg210: Fix Kconfig for USB host modules
+
+The kernel robot reports a link failure when activating the
+FOTG210 host subdriver with =y on a system where the USB host
+core is a module (CONFIG_USB=m).
+
+This is a bit of special case, so mimic the Kconfig incantations
+from DWC3: let the subdrivers for host or peripheral depend
+on the host or gadget support being =y or the same as the
+FOTG210 core itself.
+
+This should ensure that either:
+
+- The host (CONFIG_USB) or gadget (CONFIG_GADGET) is compiled
+  in and then the FOTG210 can be either module or compiled
+  in.
+
+- The host or gadget is modular, and then the FOTG210 module
+  must be a module too, or we cannot resolve the symbols
+  at link time.
+
+Reported-by: kernel test robot <lkp at intel.com>
+Link: https://lore.kernel.org/linux-usb/202211112132.0BUPGKCd-lkp@intel.com/
+Cc: Arnd Bergmann <arnd at arndb.de>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221111144821.113665-1-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/Kconfig | 4 ++--
+ 1 file changed, 2 insertions(+), 2 deletions(-)
+
+--- a/drivers/usb/fotg210/Kconfig
++++ b/drivers/usb/fotg210/Kconfig
+@@ -14,7 +14,7 @@ if USB_FOTG210
+ 
+ config USB_FOTG210_HCD
+ 	bool "Faraday FOTG210 USB Host Controller support"
+-	depends on USB
++	depends on USB=y || USB=USB_FOTG210
+ 	help
+ 	  Faraday FOTG210 is an OTG controller which can be configured as
+ 	  an USB2.0 host. It is designed to meet USB2.0 EHCI specification
+@@ -24,7 +24,7 @@ config USB_FOTG210_HCD
+ 	  module will be called fotg210-hcd.
+ 
+ config USB_FOTG210_UDC
+-	depends on USB_GADGET
++	depends on USB_GADGET=y || USB_GADGET=USB_FOTG210
+ 	bool "Faraday FOTG210 USB Peripheral Controller support"
+ 	help
+ 	   Faraday USB2.0 OTG controller which can be configured as
diff --git a/target/linux/gemini/patches-6.1/0007-usb-USB_FOTG210-should-depend-on-ARCH_GEMINI.patch b/target/linux/gemini/patches-6.1/0007-usb-USB_FOTG210-should-depend-on-ARCH_GEMINI.patch
new file mode 100644
index 000000000000..26f6ea342ca9
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0007-usb-USB_FOTG210-should-depend-on-ARCH_GEMINI.patch
@@ -0,0 +1,29 @@
+From 466b10510add46afd21ca19505b29d35ad853370 Mon Sep 17 00:00:00 2001
+From: Geert Uytterhoeven <geert+renesas at glider.be>
+Date: Mon, 21 Nov 2022 16:22:19 +0100
+Subject: [PATCH 07/29] usb: USB_FOTG210 should depend on ARCH_GEMINI
+
+The Faraday Technology FOTG210 USB2 Dual Role Controller is only present
+on Cortina Systems Gemini SoCs.  Hence add a dependency on ARCH_GEMINI,
+to prevent asking the user about its drivers when configuring a kernel
+without Cortina Systems Gemini SoC support.
+
+Fixes: 1dd33a9f1b95ab59 ("usb: fotg210: Collect pieces of dual mode controller")
+Signed-off-by: Geert Uytterhoeven <geert+renesas at glider.be>
+Reviewed-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/a989b3b798ecaf3b45f35160e30e605636d66a77.1669044086.git.geert+renesas@glider.be
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/Kconfig | 1 +
+ 1 file changed, 1 insertion(+)
+
+--- a/drivers/usb/fotg210/Kconfig
++++ b/drivers/usb/fotg210/Kconfig
+@@ -4,6 +4,7 @@ config USB_FOTG210
+ 	tristate "Faraday FOTG210 USB2 Dual Role controller"
+ 	depends on USB || USB_GADGET
+ 	depends on HAS_DMA && HAS_IOMEM
++	depends on ARCH_GEMINI || COMPILE_TEST
+ 	default ARCH_GEMINI
+ 	select MFD_SYSCON
+ 	help
diff --git a/target/linux/gemini/patches-6.1/0008-fotg210-udc-Use-dev-pointer-in-probe-and-dev_message.patch b/target/linux/gemini/patches-6.1/0008-fotg210-udc-Use-dev-pointer-in-probe-and-dev_message.patch
new file mode 100644
index 000000000000..c74e96c016e3
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0008-fotg210-udc-Use-dev-pointer-in-probe-and-dev_message.patch
@@ -0,0 +1,64 @@
+From 27cd321a365fecac857e41ad1681062994142e4a Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 14 Nov 2022 12:51:58 +0100
+Subject: [PATCH 08/29] fotg210-udc: Use dev pointer in probe and dev_messages
+
+Add a local struct device *dev pointer and use dev_err()
+etc to report status.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221114115201.302887-1-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 13 +++++++------
+ 1 file changed, 7 insertions(+), 6 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1104,6 +1104,7 @@ int fotg210_udc_probe(struct platform_de
+ 	struct resource *res, *ires;
+ 	struct fotg210_udc *fotg210 = NULL;
+ 	struct fotg210_ep *_ep[FOTG210_MAX_NUM_EP];
++	struct device *dev = &pdev->dev;
+ 	int ret = 0;
+ 	int i;
+ 
+@@ -1135,7 +1136,7 @@ int fotg210_udc_probe(struct platform_de
+ 
+ 	fotg210->reg = ioremap(res->start, resource_size(res));
+ 	if (fotg210->reg == NULL) {
+-		pr_err("ioremap error.\n");
++		dev_err(dev, "ioremap error\n");
+ 		goto err_alloc;
+ 	}
+ 
+@@ -1146,8 +1147,8 @@ int fotg210_udc_probe(struct platform_de
+ 	fotg210->gadget.ops = &fotg210_gadget_ops;
+ 
+ 	fotg210->gadget.max_speed = USB_SPEED_HIGH;
+-	fotg210->gadget.dev.parent = &pdev->dev;
+-	fotg210->gadget.dev.dma_mask = pdev->dev.dma_mask;
++	fotg210->gadget.dev.parent = dev;
++	fotg210->gadget.dev.dma_mask = dev->dma_mask;
+ 	fotg210->gadget.name = udc_name;
+ 
+ 	INIT_LIST_HEAD(&fotg210->gadget.ep_list);
+@@ -1195,15 +1196,15 @@ int fotg210_udc_probe(struct platform_de
+ 	ret = request_irq(ires->start, fotg210_irq, IRQF_SHARED,
+ 			  udc_name, fotg210);
+ 	if (ret < 0) {
+-		pr_err("request_irq error (%d)\n", ret);
++		dev_err(dev, "request_irq error (%d)\n", ret);
+ 		goto err_req;
+ 	}
+ 
+-	ret = usb_add_gadget_udc(&pdev->dev, &fotg210->gadget);
++	ret = usb_add_gadget_udc(dev, &fotg210->gadget);
+ 	if (ret)
+ 		goto err_add_udc;
+ 
+-	dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION);
++	dev_info(dev, "version %s\n", DRIVER_VERSION);
+ 
+ 	return 0;
+ 
diff --git a/target/linux/gemini/patches-6.1/0009-fotg210-udc-Support-optional-external-PHY.patch b/target/linux/gemini/patches-6.1/0009-fotg210-udc-Support-optional-external-PHY.patch
new file mode 100644
index 000000000000..8287af158798
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0009-fotg210-udc-Support-optional-external-PHY.patch
@@ -0,0 +1,162 @@
+From 03e4b585ac947e2d422bedf03179bbfec3aca3cf Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 14 Nov 2022 12:51:59 +0100
+Subject: [PATCH 09/29] fotg210-udc: Support optional external PHY
+
+This adds support for an optional external PHY to the FOTG210
+UDC driver.
+
+Tested with the GPIO VBUS PHY driver on the Gemini SoC.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221114115201.302887-2-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 72 +++++++++++++++++++++++++++++++
+ drivers/usb/fotg210/fotg210-udc.h |  2 +
+ 2 files changed, 74 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -15,6 +15,8 @@
+ #include <linux/platform_device.h>
+ #include <linux/usb/ch9.h>
+ #include <linux/usb/gadget.h>
++#include <linux/usb/otg.h>
++#include <linux/usb/phy.h>
+ 
+ #include "fotg210.h"
+ #include "fotg210-udc.h"
+@@ -1022,10 +1024,18 @@ static int fotg210_udc_start(struct usb_
+ {
+ 	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
+ 	u32 value;
++	int ret;
+ 
+ 	/* hook up the driver */
+ 	fotg210->driver = driver;
+ 
++	if (!IS_ERR_OR_NULL(fotg210->phy)) {
++		ret = otg_set_peripheral(fotg210->phy->otg,
++					 &fotg210->gadget);
++		if (ret)
++			dev_err(fotg210->dev, "can't bind to phy\n");
++	}
++
+ 	/* enable device global interrupt */
+ 	value = ioread32(fotg210->reg + FOTG210_DMCR);
+ 	value |= DMCR_GLINT_EN;
+@@ -1067,6 +1077,9 @@ static int fotg210_udc_stop(struct usb_g
+ 	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
+ 	unsigned long	flags;
+ 
++	if (!IS_ERR_OR_NULL(fotg210->phy))
++		return otg_set_peripheral(fotg210->phy->otg, NULL);
++
+ 	spin_lock_irqsave(&fotg210->lock, flags);
+ 
+ 	fotg210_init(fotg210);
+@@ -1082,12 +1095,50 @@ static const struct usb_gadget_ops fotg2
+ 	.udc_stop		= fotg210_udc_stop,
+ };
+ 
++/**
++ * fotg210_phy_event - Called by phy upon VBus event
++ * @nb: notifier block
++ * @action: phy action, is vbus connect or disconnect
++ * @data: the usb_gadget structure in fotg210
++ *
++ * Called by the USB Phy when a cable connect or disconnect is sensed.
++ *
++ * Returns NOTIFY_OK or NOTIFY_DONE
++ */
++static int fotg210_phy_event(struct notifier_block *nb, unsigned long action,
++			     void *data)
++{
++	struct usb_gadget *gadget = data;
++
++	if (!gadget)
++		return NOTIFY_DONE;
++
++	switch (action) {
++	case USB_EVENT_VBUS:
++		usb_gadget_vbus_connect(gadget);
++		return NOTIFY_OK;
++	case USB_EVENT_NONE:
++		usb_gadget_vbus_disconnect(gadget);
++		return NOTIFY_OK;
++	default:
++		return NOTIFY_DONE;
++	}
++}
++
++static struct notifier_block fotg210_phy_notifier = {
++	.notifier_call = fotg210_phy_event,
++};
++
+ int fotg210_udc_remove(struct platform_device *pdev)
+ {
+ 	struct fotg210_udc *fotg210 = platform_get_drvdata(pdev);
+ 	int i;
+ 
+ 	usb_del_gadget_udc(&fotg210->gadget);
++	if (!IS_ERR_OR_NULL(fotg210->phy)) {
++		usb_unregister_notifier(fotg210->phy, &fotg210_phy_notifier);
++		usb_put_phy(fotg210->phy);
++	}
+ 	iounmap(fotg210->reg);
+ 	free_irq(platform_get_irq(pdev, 0), fotg210);
+ 
+@@ -1127,6 +1178,22 @@ int fotg210_udc_probe(struct platform_de
+ 	if (fotg210 == NULL)
+ 		goto err;
+ 
++	fotg210->dev = dev;
++
++	fotg210->phy = devm_usb_get_phy_by_phandle(dev->parent, "usb-phy", 0);
++	if (IS_ERR(fotg210->phy)) {
++		ret = PTR_ERR(fotg210->phy);
++		if (ret == -EPROBE_DEFER)
++			goto err;
++		dev_info(dev, "no PHY found\n");
++		fotg210->phy = NULL;
++	} else {
++		ret = usb_phy_init(fotg210->phy);
++		if (ret)
++			goto err;
++		dev_info(dev, "found and initialized PHY\n");
++	}
++
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
+ 		_ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
+ 		if (_ep[i] == NULL)
+@@ -1200,6 +1267,9 @@ int fotg210_udc_probe(struct platform_de
+ 		goto err_req;
+ 	}
+ 
++	if (!IS_ERR_OR_NULL(fotg210->phy))
++		usb_register_notifier(fotg210->phy, &fotg210_phy_notifier);
++
+ 	ret = usb_add_gadget_udc(dev, &fotg210->gadget);
+ 	if (ret)
+ 		goto err_add_udc;
+@@ -1209,6 +1279,8 @@ int fotg210_udc_probe(struct platform_de
+ 	return 0;
+ 
+ err_add_udc:
++	if (!IS_ERR_OR_NULL(fotg210->phy))
++		usb_unregister_notifier(fotg210->phy, &fotg210_phy_notifier);
+ 	free_irq(ires->start, fotg210);
+ 
+ err_req:
+--- a/drivers/usb/fotg210/fotg210-udc.h
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -234,6 +234,8 @@ struct fotg210_udc {
+ 
+ 	unsigned long		irq_trigger;
+ 
++	struct device			*dev;
++	struct usb_phy			*phy;
+ 	struct usb_gadget		gadget;
+ 	struct usb_gadget_driver	*driver;
+ 
diff --git a/target/linux/gemini/patches-6.1/0010-fotg210-udc-Handle-PCLK.patch b/target/linux/gemini/patches-6.1/0010-fotg210-udc-Handle-PCLK.patch
new file mode 100644
index 000000000000..54718aaeac92
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0010-fotg210-udc-Handle-PCLK.patch
@@ -0,0 +1,94 @@
+From 772ea3ec2b9363b45ef9a4768ea205f758c3debc Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 14 Nov 2022 12:52:00 +0100
+Subject: [PATCH 10/29] fotg210-udc: Handle PCLK
+
+This adds optional handling of the peripheral clock PCLK.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221114115201.302887-3-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 30 ++++++++++++++++++++++++++++--
+ drivers/usb/fotg210/fotg210-udc.h |  1 +
+ 2 files changed, 29 insertions(+), 2 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -15,6 +15,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/usb/ch9.h>
+ #include <linux/usb/gadget.h>
++#include <linux/clk.h>
+ #include <linux/usb/otg.h>
+ #include <linux/usb/phy.h>
+ 
+@@ -1145,6 +1146,10 @@ int fotg210_udc_remove(struct platform_d
+ 	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+ 		kfree(fotg210->ep[i]);
++
++	if (!IS_ERR(fotg210->pclk))
++		clk_disable_unprepare(fotg210->pclk);
++
+ 	kfree(fotg210);
+ 
+ 	return 0;
+@@ -1180,17 +1185,34 @@ int fotg210_udc_probe(struct platform_de
+ 
+ 	fotg210->dev = dev;
+ 
++	/* It's OK not to supply this clock */
++	fotg210->pclk = devm_clk_get(dev, "PCLK");
++	if (!IS_ERR(fotg210->pclk)) {
++		ret = clk_prepare_enable(fotg210->pclk);
++		if (ret) {
++			dev_err(dev, "failed to enable PCLK\n");
++			return ret;
++		}
++	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
++		/*
++		 * Percolate deferrals, for anything else,
++		 * just live without the clocking.
++		 */
++		ret = -EPROBE_DEFER;
++		goto err;
++	}
++
+ 	fotg210->phy = devm_usb_get_phy_by_phandle(dev->parent, "usb-phy", 0);
+ 	if (IS_ERR(fotg210->phy)) {
+ 		ret = PTR_ERR(fotg210->phy);
+ 		if (ret == -EPROBE_DEFER)
+-			goto err;
++			goto err_pclk;
+ 		dev_info(dev, "no PHY found\n");
+ 		fotg210->phy = NULL;
+ 	} else {
+ 		ret = usb_phy_init(fotg210->phy);
+ 		if (ret)
+-			goto err;
++			goto err_pclk;
+ 		dev_info(dev, "found and initialized PHY\n");
+ 	}
+ 
+@@ -1292,6 +1314,10 @@ err_map:
+ err_alloc:
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+ 		kfree(fotg210->ep[i]);
++err_pclk:
++	if (!IS_ERR(fotg210->pclk))
++		clk_disable_unprepare(fotg210->pclk);
++
+ 	kfree(fotg210);
+ 
+ err:
+--- a/drivers/usb/fotg210/fotg210-udc.h
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -231,6 +231,7 @@ struct fotg210_ep {
+ struct fotg210_udc {
+ 	spinlock_t		lock; /* protect the struct */
+ 	void __iomem		*reg;
++	struct clk		*pclk;
+ 
+ 	unsigned long		irq_trigger;
+ 
diff --git a/target/linux/gemini/patches-6.1/0011-fotg210-udc-Get-IRQ-using-platform_get_irq.patch b/target/linux/gemini/patches-6.1/0011-fotg210-udc-Get-IRQ-using-platform_get_irq.patch
new file mode 100644
index 000000000000..4b0697a69ab6
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0011-fotg210-udc-Get-IRQ-using-platform_get_irq.patch
@@ -0,0 +1,72 @@
+From eda686d41e298a9d16708d2ec8d12d8e682dd7ca Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 14 Nov 2022 12:52:01 +0100
+Subject: [PATCH 11/29] fotg210-udc: Get IRQ using platform_get_irq()
+
+The platform_get_irq() is necessary to use to get dynamic
+IRQ resolution when instantiating the device from the
+device tree. IRQs are not passed as resources in that
+case.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221114115201.302887-4-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 15 ++++++++-------
+ 1 file changed, 8 insertions(+), 7 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1157,10 +1157,11 @@ int fotg210_udc_remove(struct platform_d
+ 
+ int fotg210_udc_probe(struct platform_device *pdev)
+ {
+-	struct resource *res, *ires;
++	struct resource *res;
+ 	struct fotg210_udc *fotg210 = NULL;
+ 	struct fotg210_ep *_ep[FOTG210_MAX_NUM_EP];
+ 	struct device *dev = &pdev->dev;
++	int irq;
+ 	int ret = 0;
+ 	int i;
+ 
+@@ -1170,9 +1171,9 @@ int fotg210_udc_probe(struct platform_de
+ 		return -ENODEV;
+ 	}
+ 
+-	ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
+-	if (!ires) {
+-		pr_err("platform_get_resource IORESOURCE_IRQ error.\n");
++	irq = platform_get_irq(pdev, 0);
++	if (irq < 0) {
++		pr_err("could not get irq\n");
+ 		return -ENODEV;
+ 	}
+ 
+@@ -1202,7 +1203,7 @@ int fotg210_udc_probe(struct platform_de
+ 		goto err;
+ 	}
+ 
+-	fotg210->phy = devm_usb_get_phy_by_phandle(dev->parent, "usb-phy", 0);
++	fotg210->phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0);
+ 	if (IS_ERR(fotg210->phy)) {
+ 		ret = PTR_ERR(fotg210->phy);
+ 		if (ret == -EPROBE_DEFER)
+@@ -1282,7 +1283,7 @@ int fotg210_udc_probe(struct platform_de
+ 
+ 	fotg210_disable_unplug(fotg210);
+ 
+-	ret = request_irq(ires->start, fotg210_irq, IRQF_SHARED,
++	ret = request_irq(irq, fotg210_irq, IRQF_SHARED,
+ 			  udc_name, fotg210);
+ 	if (ret < 0) {
+ 		dev_err(dev, "request_irq error (%d)\n", ret);
+@@ -1303,7 +1304,7 @@ int fotg210_udc_probe(struct platform_de
+ err_add_udc:
+ 	if (!IS_ERR_OR_NULL(fotg210->phy))
+ 		usb_unregister_notifier(fotg210->phy, &fotg210_phy_notifier);
+-	free_irq(ires->start, fotg210);
++	free_irq(irq, fotg210);
+ 
+ err_req:
+ 	fotg210_ep_free_request(&fotg210->ep[0]->ep, fotg210->ep0_req);
diff --git a/target/linux/gemini/patches-6.1/0012-usb-fotg210-udc-Remove-a-useless-assignment.patch b/target/linux/gemini/patches-6.1/0012-usb-fotg210-udc-Remove-a-useless-assignment.patch
new file mode 100644
index 000000000000..07fd67dd32b7
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0012-usb-fotg210-udc-Remove-a-useless-assignment.patch
@@ -0,0 +1,42 @@
+From 7889a2f0256c55e0184dffd0001d0782f9e4cb83 Mon Sep 17 00:00:00 2001
+From: Christophe JAILLET <christophe.jaillet at wanadoo.fr>
+Date: Mon, 14 Nov 2022 21:38:04 +0100
+Subject: [PATCH 12/29] usb: fotg210-udc: Remove a useless assignment
+
+There is no need to use an intermediate array for these memory allocations,
+so, axe it.
+
+While at it, turn a '== NULL' into a shorter '!' when testing memory
+allocation failure.
+
+Signed-off-by: Christophe JAILLET <christophe.jaillet at wanadoo.fr>
+Reviewed-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/deab9696fc4000499470e7ccbca7c36fca17bd4e.1668458274.git.christophe.jaillet@wanadoo.fr
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 6 ++----
+ 1 file changed, 2 insertions(+), 4 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1159,7 +1159,6 @@ int fotg210_udc_probe(struct platform_de
+ {
+ 	struct resource *res;
+ 	struct fotg210_udc *fotg210 = NULL;
+-	struct fotg210_ep *_ep[FOTG210_MAX_NUM_EP];
+ 	struct device *dev = &pdev->dev;
+ 	int irq;
+ 	int ret = 0;
+@@ -1218,10 +1217,9 @@ int fotg210_udc_probe(struct platform_de
+ 	}
+ 
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
+-		_ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
+-		if (_ep[i] == NULL)
++		fotg210->ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
++		if (!fotg210->ep[i])
+ 			goto err_alloc;
+-		fotg210->ep[i] = _ep[i];
+ 	}
+ 
+ 	fotg210->reg = ioremap(res->start, resource_size(res));
diff --git a/target/linux/gemini/patches-6.1/0013-usb-fotg210-udc-fix-potential-memory-leak-in-fotg210.patch b/target/linux/gemini/patches-6.1/0013-usb-fotg210-udc-fix-potential-memory-leak-in-fotg210.patch
new file mode 100644
index 000000000000..b53b338140e0
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0013-usb-fotg210-udc-fix-potential-memory-leak-in-fotg210.patch
@@ -0,0 +1,61 @@
+From 7b95ade85ac18eec63e81ac58a482b3e88361ffd Mon Sep 17 00:00:00 2001
+From: Yi Yang <yiyang13 at huawei.com>
+Date: Fri, 2 Dec 2022 09:21:26 +0800
+Subject: [PATCH 13/29] usb: fotg210-udc: fix potential memory leak in
+ fotg210_udc_probe()
+MIME-Version: 1.0
+Content-Type: text/plain; charset=UTF-8
+Content-Transfer-Encoding: 8bit
+
+In fotg210_udc_probe(), if devm_clk_get() or clk_prepare_enable()
+fails, 'fotg210' will not be freed, which will lead to a memory leak.
+Fix it by moving kfree() to a proper location.
+
+In addition,we can use "return -ENOMEM" instead of "goto err"
+to simplify the code.
+
+Fixes: 718a38d092ec ("fotg210-udc: Handle PCLK")
+Reviewed-by: Andrzej Pietrasiewicz <andrzej.p at collabora.com>
+Reviewed-by: Linus Walleij <linus.walleij at linaro.org>
+Signed-off-by: Yi Yang <yiyang13 at huawei.com>
+Link: https://lore.kernel.org/r/20221202012126.246953-1-yiyang13@huawei.com
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 9 +++------
+ 1 file changed, 3 insertions(+), 6 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1176,12 +1176,10 @@ int fotg210_udc_probe(struct platform_de
+ 		return -ENODEV;
+ 	}
+ 
+-	ret = -ENOMEM;
+-
+ 	/* initialize udc */
+ 	fotg210 = kzalloc(sizeof(struct fotg210_udc), GFP_KERNEL);
+ 	if (fotg210 == NULL)
+-		goto err;
++		return -ENOMEM;
+ 
+ 	fotg210->dev = dev;
+ 
+@@ -1191,7 +1189,7 @@ int fotg210_udc_probe(struct platform_de
+ 		ret = clk_prepare_enable(fotg210->pclk);
+ 		if (ret) {
+ 			dev_err(dev, "failed to enable PCLK\n");
+-			return ret;
++			goto err;
+ 		}
+ 	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
+ 		/*
+@@ -1317,8 +1315,7 @@ err_pclk:
+ 	if (!IS_ERR(fotg210->pclk))
+ 		clk_disable_unprepare(fotg210->pclk);
+ 
+-	kfree(fotg210);
+-
+ err:
++	kfree(fotg210);
+ 	return ret;
+ }
diff --git a/target/linux/gemini/patches-6.1/0014-usb-fotg210-fix-OTG-only-build.patch b/target/linux/gemini/patches-6.1/0014-usb-fotg210-fix-OTG-only-build.patch
new file mode 100644
index 000000000000..895ed5503b15
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0014-usb-fotg210-fix-OTG-only-build.patch
@@ -0,0 +1,42 @@
+From d8eed400495029ba551704ff0fae1dad87332291 Mon Sep 17 00:00:00 2001
+From: Arnd Bergmann <arnd at arndb.de>
+Date: Thu, 15 Dec 2022 17:57:20 +0100
+Subject: [PATCH 14/29] usb: fotg210: fix OTG-only build
+
+The fotg210 module combines the HCD and OTG drivers, which then
+fails to build when only the USB gadget support is enabled
+in the kernel but host support is not:
+
+aarch64-linux-ld: drivers/usb/fotg210/fotg210-core.o: in function `fotg210_init':
+fotg210-core.c:(.init.text+0xc): undefined reference to `usb_disabled'
+
+Move the check for usb_disabled() after the check for the HCD module,
+and let the OTG driver still be probed in this configuration.
+
+A nicer approach might be to have the common portion built as a
+library module, with the two platform other files registering
+their own platform_driver instances separately.
+
+Fixes: ddacd6ef44ca ("usb: fotg210: Fix Kconfig for USB host modules")
+Reviewed-by: Linus Walleij <linus.walleij at linaro.org>
+Signed-off-by: Arnd Bergmann <arnd at arndb.de>
+Link: https://lore.kernel.org/r/20221215165728.2062984-1-arnd@kernel.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 5 +----
+ 1 file changed, 1 insertion(+), 4 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -144,10 +144,7 @@ static struct platform_driver fotg210_dr
+ 
+ static int __init fotg210_init(void)
+ {
+-	if (usb_disabled())
+-		return -ENODEV;
+-
+-	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD))
++	if (IS_ENABLED(CONFIG_USB_FOTG210_HCD) && !usb_disabled())
+ 		fotg210_hcd_init();
+ 	return platform_driver_register(&fotg210_driver);
+ }
diff --git a/target/linux/gemini/patches-6.1/0015-usb-fotg210-udc-fix-error-return-code-in-fotg210_udc.patch b/target/linux/gemini/patches-6.1/0015-usb-fotg210-udc-fix-error-return-code-in-fotg210_udc.patch
new file mode 100644
index 000000000000..49a0fc341c79
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0015-usb-fotg210-udc-fix-error-return-code-in-fotg210_udc.patch
@@ -0,0 +1,31 @@
+From eaaa85d907fe27852dd960b2bc5d7bcf11bc3ebd Mon Sep 17 00:00:00 2001
+From: Yang Yingliang <yangyingliang at huawei.com>
+Date: Fri, 30 Dec 2022 14:54:27 +0800
+Subject: [PATCH 15/29] usb: fotg210-udc: fix error return code in
+ fotg210_udc_probe()
+
+After commit  5f217ccd520f ("fotg210-udc: Support optional external PHY"),
+the error code is re-assigned to 0 in fotg210_udc_probe(), if allocate or
+map memory fails after the assignment, it can't return an error code. Set
+the error code to -ENOMEM to fix this problem.
+
+Fixes: 5f217ccd520f ("fotg210-udc: Support optional external PHY")
+Signed-off-by: Yang Yingliang <yangyingliang at huawei.com>
+Reviewed-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20221230065427.944586-1-yangyingliang@huawei.com
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 2 ++
+ 1 file changed, 2 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1214,6 +1214,8 @@ int fotg210_udc_probe(struct platform_de
+ 		dev_info(dev, "found and initialized PHY\n");
+ 	}
+ 
++	ret = -ENOMEM;
++
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++) {
+ 		fotg210->ep[i] = kzalloc(sizeof(struct fotg210_ep), GFP_KERNEL);
+ 		if (!fotg210->ep[i])
diff --git a/target/linux/gemini/patches-6.1/0016-usb-fotg210-List-different-variants.patch b/target/linux/gemini/patches-6.1/0016-usb-fotg210-List-different-variants.patch
new file mode 100644
index 000000000000..57cbe623452c
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0016-usb-fotg210-List-different-variants.patch
@@ -0,0 +1,28 @@
+From 407577548b2fcd41cc72ee05df1f05a430ed30a0 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:16 +0100
+Subject: [PATCH 16/29] usb: fotg210: List different variants
+
+There are at least two variants of the FOTG: FOTG200 and
+FOTG210. Handle them in this driver and let's add
+more quirks as we go along.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-2-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 2 ++
+ 1 file changed, 2 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -127,7 +127,9 @@ static int fotg210_remove(struct platfor
+ 
+ #ifdef CONFIG_OF
+ static const struct of_device_id fotg210_of_match[] = {
++	{ .compatible = "faraday,fotg200" },
+ 	{ .compatible = "faraday,fotg210" },
++	/* TODO: can we also handle FUSB220? */
+ 	{},
+ };
+ MODULE_DEVICE_TABLE(of, fotg210_of_match);
diff --git a/target/linux/gemini/patches-6.1/0017-usb-fotg210-Acquire-memory-resource-in-core.patch b/target/linux/gemini/patches-6.1/0017-usb-fotg210-Acquire-memory-resource-in-core.patch
new file mode 100644
index 000000000000..15588ccc0dac
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0017-usb-fotg210-Acquire-memory-resource-in-core.patch
@@ -0,0 +1,253 @@
+From fa735ad1afeb5791d5562617b9bbed74574d3e81 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:17 +0100
+Subject: [PATCH 17/29] usb: fotg210: Acquire memory resource in core
+
+The subdrivers are obtaining and mapping the memory resource
+separately. Create a common state container for the shared
+resources and start populating this by acquiring the IO
+memory resource and remap it and pass this to the subdrivers
+for host and peripheral.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-3-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 29 ++++++++++++++++++++++-------
+ drivers/usb/fotg210/fotg210-hcd.c  | 15 +++++----------
+ drivers/usb/fotg210/fotg210-hcd.h  |  1 +
+ drivers/usb/fotg210/fotg210-udc.c  | 16 +++-------------
+ drivers/usb/fotg210/fotg210-udc.h  |  1 +
+ drivers/usb/fotg210/fotg210.h      | 24 ++++++++++++++++++++----
+ 6 files changed, 52 insertions(+), 34 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -33,9 +33,10 @@
+ #define GEMINI_MISC_USB0_MINI_B		BIT(29)
+ #define GEMINI_MISC_USB1_MINI_B		BIT(30)
+ 
+-static int fotg210_gemini_init(struct device *dev, struct resource *res,
++static int fotg210_gemini_init(struct fotg210 *fotg, struct resource *res,
+ 			       enum usb_dr_mode mode)
+ {
++	struct device *dev = fotg->dev;
+ 	struct device_node *np = dev->of_node;
+ 	struct regmap *map;
+ 	bool wakeup;
+@@ -47,6 +48,7 @@ static int fotg210_gemini_init(struct de
+ 		dev_err(dev, "no syscon\n");
+ 		return PTR_ERR(map);
+ 	}
++	fotg->map = map;
+ 	wakeup = of_property_read_bool(np, "wakeup-source");
+ 
+ 	/*
+@@ -55,6 +57,7 @@ static int fotg210_gemini_init(struct de
+ 	 */
+ 	mask = 0;
+ 	if (res->start == 0x69000000) {
++		fotg->port = GEMINI_PORT_1;
+ 		mask = GEMINI_MISC_USB1_VBUS_ON | GEMINI_MISC_USB1_MINI_B |
+ 			GEMINI_MISC_USB1_WAKEUP;
+ 		if (mode == USB_DR_MODE_HOST)
+@@ -64,6 +67,7 @@ static int fotg210_gemini_init(struct de
+ 		if (wakeup)
+ 			val |= GEMINI_MISC_USB1_WAKEUP;
+ 	} else {
++		fotg->port = GEMINI_PORT_0;
+ 		mask = GEMINI_MISC_USB0_VBUS_ON | GEMINI_MISC_USB0_MINI_B |
+ 			GEMINI_MISC_USB0_WAKEUP;
+ 		if (mode == USB_DR_MODE_HOST)
+@@ -89,23 +93,34 @@ static int fotg210_probe(struct platform
+ {
+ 	struct device *dev = &pdev->dev;
+ 	enum usb_dr_mode mode;
++	struct fotg210 *fotg;
+ 	int ret;
+ 
++	fotg = devm_kzalloc(dev, sizeof(*fotg), GFP_KERNEL);
++	if (!fotg)
++		return -ENOMEM;
++	fotg->dev = dev;
++
++	fotg->res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++	if (!fotg->res)
++		return -ENODEV;
++
++	fotg->base = devm_ioremap_resource(dev, fotg->res);
++	if (!fotg->base)
++		return -ENOMEM;
++
+ 	mode = usb_get_dr_mode(dev);
+ 
+ 	if (of_device_is_compatible(dev->of_node, "cortina,gemini-usb")) {
+-		struct resource *res;
+-
+-		res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-		ret = fotg210_gemini_init(dev, res, mode);
++		ret = fotg210_gemini_init(fotg, fotg->res, mode);
+ 		if (ret)
+ 			return ret;
+ 	}
+ 
+ 	if (mode == USB_DR_MODE_PERIPHERAL)
+-		ret = fotg210_udc_probe(pdev);
++		ret = fotg210_udc_probe(pdev, fotg);
+ 	else
+-		ret = fotg210_hcd_probe(pdev);
++		ret = fotg210_hcd_probe(pdev, fotg);
+ 
+ 	return ret;
+ }
+--- a/drivers/usb/fotg210/fotg210-hcd.c
++++ b/drivers/usb/fotg210/fotg210-hcd.c
+@@ -5557,11 +5557,10 @@ static void fotg210_init(struct fotg210_
+  * then invokes the start() method for the HCD associated with it
+  * through the hotplug entry's driver_data.
+  */
+-int fotg210_hcd_probe(struct platform_device *pdev)
++int fotg210_hcd_probe(struct platform_device *pdev, struct fotg210 *fotg)
+ {
+ 	struct device *dev = &pdev->dev;
+ 	struct usb_hcd *hcd;
+-	struct resource *res;
+ 	int irq;
+ 	int retval;
+ 	struct fotg210_hcd *fotg210;
+@@ -5585,18 +5584,14 @@ int fotg210_hcd_probe(struct platform_de
+ 
+ 	hcd->has_tt = 1;
+ 
+-	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
+-	if (IS_ERR(hcd->regs)) {
+-		retval = PTR_ERR(hcd->regs);
+-		goto failed_put_hcd;
+-	}
++	hcd->regs = fotg->base;
+ 
+-	hcd->rsrc_start = res->start;
+-	hcd->rsrc_len = resource_size(res);
++	hcd->rsrc_start = fotg->res->start;
++	hcd->rsrc_len = resource_size(fotg->res);
+ 
+ 	fotg210 = hcd_to_fotg210(hcd);
+ 
++	fotg210->fotg = fotg;
+ 	fotg210->caps = hcd->regs;
+ 
+ 	/* It's OK not to supply this clock */
+--- a/drivers/usb/fotg210/fotg210-hcd.h
++++ b/drivers/usb/fotg210/fotg210-hcd.h
+@@ -182,6 +182,7 @@ struct fotg210_hcd {			/* one per contro
+ #	define INCR(x) do {} while (0)
+ #endif
+ 
++	struct fotg210		*fotg;		/* Overarching FOTG210 device */
+ 	/* silicon clock */
+ 	struct clk		*pclk;
+ };
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1155,21 +1155,14 @@ int fotg210_udc_remove(struct platform_d
+ 	return 0;
+ }
+ 
+-int fotg210_udc_probe(struct platform_device *pdev)
++int fotg210_udc_probe(struct platform_device *pdev, struct fotg210 *fotg)
+ {
+-	struct resource *res;
+ 	struct fotg210_udc *fotg210 = NULL;
+ 	struct device *dev = &pdev->dev;
+ 	int irq;
+ 	int ret = 0;
+ 	int i;
+ 
+-	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-	if (!res) {
+-		pr_err("platform_get_resource error.\n");
+-		return -ENODEV;
+-	}
+-
+ 	irq = platform_get_irq(pdev, 0);
+ 	if (irq < 0) {
+ 		pr_err("could not get irq\n");
+@@ -1182,6 +1175,7 @@ int fotg210_udc_probe(struct platform_de
+ 		return -ENOMEM;
+ 
+ 	fotg210->dev = dev;
++	fotg210->fotg = fotg;
+ 
+ 	/* It's OK not to supply this clock */
+ 	fotg210->pclk = devm_clk_get(dev, "PCLK");
+@@ -1222,11 +1216,7 @@ int fotg210_udc_probe(struct platform_de
+ 			goto err_alloc;
+ 	}
+ 
+-	fotg210->reg = ioremap(res->start, resource_size(res));
+-	if (fotg210->reg == NULL) {
+-		dev_err(dev, "ioremap error\n");
+-		goto err_alloc;
+-	}
++	fotg210->reg = fotg->base;
+ 
+ 	spin_lock_init(&fotg210->lock);
+ 
+--- a/drivers/usb/fotg210/fotg210-udc.h
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -236,6 +236,7 @@ struct fotg210_udc {
+ 	unsigned long		irq_trigger;
+ 
+ 	struct device			*dev;
++	struct fotg210			*fotg;
+ 	struct usb_phy			*phy;
+ 	struct usb_gadget		gadget;
+ 	struct usb_gadget_driver	*driver;
+--- a/drivers/usb/fotg210/fotg210.h
++++ b/drivers/usb/fotg210/fotg210.h
+@@ -2,13 +2,28 @@
+ #ifndef __FOTG210_H
+ #define __FOTG210_H
+ 
++enum gemini_port {
++	GEMINI_PORT_NONE = 0,
++	GEMINI_PORT_0,
++	GEMINI_PORT_1,
++};
++
++struct fotg210 {
++	struct device *dev;
++	struct resource *res;
++	void __iomem *base;
++	struct regmap *map;
++	enum gemini_port port;
++};
++
+ #ifdef CONFIG_USB_FOTG210_HCD
+-int fotg210_hcd_probe(struct platform_device *pdev);
++int fotg210_hcd_probe(struct platform_device *pdev, struct fotg210 *fotg);
+ int fotg210_hcd_remove(struct platform_device *pdev);
+ int fotg210_hcd_init(void);
+ void fotg210_hcd_cleanup(void);
+ #else
+-static inline int fotg210_hcd_probe(struct platform_device *pdev)
++static inline int fotg210_hcd_probe(struct platform_device *pdev,
++				    struct fotg210 *fotg)
+ {
+ 	return 0;
+ }
+@@ -26,10 +41,11 @@ static inline void fotg210_hcd_cleanup(v
+ #endif
+ 
+ #ifdef CONFIG_USB_FOTG210_UDC
+-int fotg210_udc_probe(struct platform_device *pdev);
++int fotg210_udc_probe(struct platform_device *pdev, struct fotg210 *fotg);
+ int fotg210_udc_remove(struct platform_device *pdev);
+ #else
+-static inline int fotg210_udc_probe(struct platform_device *pdev)
++static inline int fotg210_udc_probe(struct platform_device *pdev,
++				    struct fotg210 *fotg)
+ {
+ 	return 0;
+ }
diff --git a/target/linux/gemini/patches-6.1/0018-usb-fotg210-Move-clock-handling-to-core.patch b/target/linux/gemini/patches-6.1/0018-usb-fotg210-Move-clock-handling-to-core.patch
new file mode 100644
index 000000000000..d236a71b4983
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0018-usb-fotg210-Move-clock-handling-to-core.patch
@@ -0,0 +1,203 @@
+From fb8e1e8dbc47e7aff7624b47adaa0a84d2983802 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:18 +0100
+Subject: [PATCH 18/29] usb: fotg210: Move clock handling to core
+
+Grab the optional silicon block clock, prepare and enable it in
+the core before proceeding to prepare the host or peripheral
+driver. This saves duplicate code and also uses the simple
+devm_clk_get_optional_enabled() to do everything we really
+want to do.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-4-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c |  5 +++++
+ drivers/usb/fotg210/fotg210-hcd.c  | 33 ++----------------------------
+ drivers/usb/fotg210/fotg210-udc.c  | 30 +++------------------------
+ drivers/usb/fotg210/fotg210-udc.h  |  1 -
+ drivers/usb/fotg210/fotg210.h      |  1 +
+ 5 files changed, 11 insertions(+), 59 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -6,6 +6,7 @@
+  * driver.
+  */
+ #include <linux/bitops.h>
++#include <linux/clk.h>
+ #include <linux/device.h>
+ #include <linux/mfd/syscon.h>
+ #include <linux/module.h>
+@@ -109,6 +110,10 @@ static int fotg210_probe(struct platform
+ 	if (!fotg->base)
+ 		return -ENOMEM;
+ 
++	fotg->pclk = devm_clk_get_optional_enabled(dev, "PCLK");
++	if (IS_ERR(fotg->pclk))
++		return PTR_ERR(fotg->pclk);
++
+ 	mode = usb_get_dr_mode(dev);
+ 
+ 	if (of_device_is_compatible(dev->of_node, "cortina,gemini-usb")) {
+--- a/drivers/usb/fotg210/fotg210-hcd.c
++++ b/drivers/usb/fotg210/fotg210-hcd.c
+@@ -33,7 +33,6 @@
+ #include <linux/platform_device.h>
+ #include <linux/io.h>
+ #include <linux/iopoll.h>
+-#include <linux/clk.h>
+ 
+ #include <asm/byteorder.h>
+ #include <asm/irq.h>
+@@ -5594,44 +5593,22 @@ int fotg210_hcd_probe(struct platform_de
+ 	fotg210->fotg = fotg;
+ 	fotg210->caps = hcd->regs;
+ 
+-	/* It's OK not to supply this clock */
+-	fotg210->pclk = clk_get(dev, "PCLK");
+-	if (!IS_ERR(fotg210->pclk)) {
+-		retval = clk_prepare_enable(fotg210->pclk);
+-		if (retval) {
+-			dev_err(dev, "failed to enable PCLK\n");
+-			goto failed_put_hcd;
+-		}
+-	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
+-		/*
+-		 * Percolate deferrals, for anything else,
+-		 * just live without the clocking.
+-		 */
+-		retval = PTR_ERR(fotg210->pclk);
+-		goto failed_dis_clk;
+-	}
+-
+ 	retval = fotg210_setup(hcd);
+ 	if (retval)
+-		goto failed_dis_clk;
++		goto failed_put_hcd;
+ 
+ 	fotg210_init(fotg210);
+ 
+ 	retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
+ 	if (retval) {
+ 		dev_err(dev, "failed to add hcd with err %d\n", retval);
+-		goto failed_dis_clk;
++		goto failed_put_hcd;
+ 	}
+ 	device_wakeup_enable(hcd->self.controller);
+ 	platform_set_drvdata(pdev, hcd);
+ 
+ 	return retval;
+ 
+-failed_dis_clk:
+-	if (!IS_ERR(fotg210->pclk)) {
+-		clk_disable_unprepare(fotg210->pclk);
+-		clk_put(fotg210->pclk);
+-	}
+ failed_put_hcd:
+ 	usb_put_hcd(hcd);
+ fail_create_hcd:
+@@ -5647,12 +5624,6 @@ fail_create_hcd:
+ int fotg210_hcd_remove(struct platform_device *pdev)
+ {
+ 	struct usb_hcd *hcd = platform_get_drvdata(pdev);
+-	struct fotg210_hcd *fotg210 = hcd_to_fotg210(hcd);
+-
+-	if (!IS_ERR(fotg210->pclk)) {
+-		clk_disable_unprepare(fotg210->pclk);
+-		clk_put(fotg210->pclk);
+-	}
+ 
+ 	usb_remove_hcd(hcd);
+ 	usb_put_hcd(hcd);
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -15,7 +15,6 @@
+ #include <linux/platform_device.h>
+ #include <linux/usb/ch9.h>
+ #include <linux/usb/gadget.h>
+-#include <linux/clk.h>
+ #include <linux/usb/otg.h>
+ #include <linux/usb/phy.h>
+ 
+@@ -1147,9 +1146,6 @@ int fotg210_udc_remove(struct platform_d
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+ 		kfree(fotg210->ep[i]);
+ 
+-	if (!IS_ERR(fotg210->pclk))
+-		clk_disable_unprepare(fotg210->pclk);
+-
+ 	kfree(fotg210);
+ 
+ 	return 0;
+@@ -1177,34 +1173,17 @@ int fotg210_udc_probe(struct platform_de
+ 	fotg210->dev = dev;
+ 	fotg210->fotg = fotg;
+ 
+-	/* It's OK not to supply this clock */
+-	fotg210->pclk = devm_clk_get(dev, "PCLK");
+-	if (!IS_ERR(fotg210->pclk)) {
+-		ret = clk_prepare_enable(fotg210->pclk);
+-		if (ret) {
+-			dev_err(dev, "failed to enable PCLK\n");
+-			goto err;
+-		}
+-	} else if (PTR_ERR(fotg210->pclk) == -EPROBE_DEFER) {
+-		/*
+-		 * Percolate deferrals, for anything else,
+-		 * just live without the clocking.
+-		 */
+-		ret = -EPROBE_DEFER;
+-		goto err;
+-	}
+-
+ 	fotg210->phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0);
+ 	if (IS_ERR(fotg210->phy)) {
+ 		ret = PTR_ERR(fotg210->phy);
+ 		if (ret == -EPROBE_DEFER)
+-			goto err_pclk;
++			goto err_free;
+ 		dev_info(dev, "no PHY found\n");
+ 		fotg210->phy = NULL;
+ 	} else {
+ 		ret = usb_phy_init(fotg210->phy);
+ 		if (ret)
+-			goto err_pclk;
++			goto err_free;
+ 		dev_info(dev, "found and initialized PHY\n");
+ 	}
+ 
+@@ -1303,11 +1282,8 @@ err_map:
+ err_alloc:
+ 	for (i = 0; i < FOTG210_MAX_NUM_EP; i++)
+ 		kfree(fotg210->ep[i]);
+-err_pclk:
+-	if (!IS_ERR(fotg210->pclk))
+-		clk_disable_unprepare(fotg210->pclk);
+ 
+-err:
++err_free:
+ 	kfree(fotg210);
+ 	return ret;
+ }
+--- a/drivers/usb/fotg210/fotg210-udc.h
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -231,7 +231,6 @@ struct fotg210_ep {
+ struct fotg210_udc {
+ 	spinlock_t		lock; /* protect the struct */
+ 	void __iomem		*reg;
+-	struct clk		*pclk;
+ 
+ 	unsigned long		irq_trigger;
+ 
+--- a/drivers/usb/fotg210/fotg210.h
++++ b/drivers/usb/fotg210/fotg210.h
+@@ -12,6 +12,7 @@ struct fotg210 {
+ 	struct device *dev;
+ 	struct resource *res;
+ 	void __iomem *base;
++	struct clk *pclk;
+ 	struct regmap *map;
+ 	enum gemini_port port;
+ };
diff --git a/target/linux/gemini/patches-6.1/0019-usb-fotg210-Check-role-register-in-core.patch b/target/linux/gemini/patches-6.1/0019-usb-fotg210-Check-role-register-in-core.patch
new file mode 100644
index 000000000000..c7fc310720e0
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0019-usb-fotg210-Check-role-register-in-core.patch
@@ -0,0 +1,57 @@
+From b1b07abb598211de3ce7f52abdf8dcb24384341e Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:19 +0100
+Subject: [PATCH 19/29] usb: fotg210: Check role register in core
+
+Read the role register and check that we are in host/peripheral
+mode and issue warnings if we're not in the right role when
+probing respective driver.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-5-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 16 ++++++++++++++--
+ 1 file changed, 14 insertions(+), 2 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -18,6 +18,11 @@
+ 
+ #include "fotg210.h"
+ 
++/* Role Register 0x80 */
++#define FOTG210_RR			0x80
++#define FOTG210_RR_ID			BIT(21) /* 1 = B-device, 0 = A-device */
++#define FOTG210_RR_CROLE		BIT(20) /* 1 = device, 0 = host */
++
+ /*
+  * Gemini-specific initialization function, only executed on the
+  * Gemini SoC using the global misc control register.
+@@ -95,6 +100,7 @@ static int fotg210_probe(struct platform
+ 	struct device *dev = &pdev->dev;
+ 	enum usb_dr_mode mode;
+ 	struct fotg210 *fotg;
++	u32 val;
+ 	int ret;
+ 
+ 	fotg = devm_kzalloc(dev, sizeof(*fotg), GFP_KERNEL);
+@@ -122,10 +128,16 @@ static int fotg210_probe(struct platform
+ 			return ret;
+ 	}
+ 
+-	if (mode == USB_DR_MODE_PERIPHERAL)
++	val = readl(fotg->base + FOTG210_RR);
++	if (mode == USB_DR_MODE_PERIPHERAL) {
++		if (!(val & FOTG210_RR_CROLE))
++			dev_err(dev, "block not in device role\n");
+ 		ret = fotg210_udc_probe(pdev, fotg);
+-	else
++	} else {
++		if (val & FOTG210_RR_CROLE)
++			dev_err(dev, "block not in host role\n");
+ 		ret = fotg210_hcd_probe(pdev, fotg);
++	}
+ 
+ 	return ret;
+ }
diff --git a/target/linux/gemini/patches-6.1/0020-usb-fotg210-udc-Assign-of_node-and-speed-on-start.patch b/target/linux/gemini/patches-6.1/0020-usb-fotg210-udc-Assign-of_node-and-speed-on-start.patch
new file mode 100644
index 000000000000..e949b97a6235
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0020-usb-fotg210-udc-Assign-of_node-and-speed-on-start.patch
@@ -0,0 +1,37 @@
+From d7c2b0b6da75b86cf5ddbcd51a74d74e19bbf178 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:20 +0100
+Subject: [PATCH 20/29] usb: fotg210-udc: Assign of_node and speed on start
+
+Follow the example set by other drivers to assign of_node
+and speed to the driver when binding, also print bound
+info akin to other UDC drivers.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-6-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 5 +++++
+ 1 file changed, 5 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1028,6 +1028,10 @@ static int fotg210_udc_start(struct usb_
+ 
+ 	/* hook up the driver */
+ 	fotg210->driver = driver;
++	fotg210->gadget.dev.of_node = fotg210->dev->of_node;
++	fotg210->gadget.speed = USB_SPEED_UNKNOWN;
++
++	dev_info(fotg210->dev, "bound driver %s\n", driver->driver.name);
+ 
+ 	if (!IS_ERR_OR_NULL(fotg210->phy)) {
+ 		ret = otg_set_peripheral(fotg210->phy->otg,
+@@ -1084,6 +1088,7 @@ static int fotg210_udc_stop(struct usb_g
+ 
+ 	fotg210_init(fotg210);
+ 	fotg210->driver = NULL;
++	fotg210->gadget.speed = USB_SPEED_UNKNOWN;
+ 
+ 	spin_unlock_irqrestore(&fotg210->lock, flags);
+ 
diff --git a/target/linux/gemini/patches-6.1/0021-usb-fotg210-udc-Implement-VBUS-session.patch b/target/linux/gemini/patches-6.1/0021-usb-fotg210-udc-Implement-VBUS-session.patch
new file mode 100644
index 000000000000..e94a5d8af660
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0021-usb-fotg210-udc-Implement-VBUS-session.patch
@@ -0,0 +1,101 @@
+From 2fbbfb2c556944945639b17b13fcb1e05272b646 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Wed, 18 Jan 2023 08:09:21 +0100
+Subject: [PATCH 21/29] usb: fotg210-udc: Implement VBUS session
+
+Implement VBUS session handling for FOTG210. This is
+mainly used by the UDC driver which needs to call down to
+the FOTG210 core and enable/disable VBUS, as this needs to be
+handled outside of the HCD and UDC drivers, by platform
+specific glue code.
+
+The Gemini has a special bit in a system register to turn
+VBUS on and off so we implement this in the FOTG210 core.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230103-gemini-fotg210-usb-v2-7-100388af9810@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-core.c | 29 +++++++++++++++++++++++++++++
+ drivers/usb/fotg210/fotg210-udc.c  | 17 +++++++++++++++++
+ drivers/usb/fotg210/fotg210.h      |  2 ++
+ 3 files changed, 48 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-core.c
++++ b/drivers/usb/fotg210/fotg210-core.c
+@@ -95,6 +95,35 @@ static int fotg210_gemini_init(struct fo
+ 	return 0;
+ }
+ 
++/**
++ * fotg210_vbus() - Called by gadget driver to enable/disable VBUS
++ * @enable: true to enable VBUS, false to disable VBUS
++ */
++void fotg210_vbus(struct fotg210 *fotg, bool enable)
++{
++	u32 mask;
++	u32 val;
++	int ret;
++
++	switch (fotg->port) {
++	case GEMINI_PORT_0:
++		mask = GEMINI_MISC_USB0_VBUS_ON;
++		val = enable ? GEMINI_MISC_USB0_VBUS_ON : 0;
++		break;
++	case GEMINI_PORT_1:
++		mask = GEMINI_MISC_USB1_VBUS_ON;
++		val = enable ? GEMINI_MISC_USB1_VBUS_ON : 0;
++		break;
++	default:
++		return;
++	}
++	ret = regmap_update_bits(fotg->map, GEMINI_GLOBAL_MISC_CTRL, mask, val);
++	if (ret)
++		dev_err(fotg->dev, "failed to %s VBUS\n",
++			enable ? "enable" : "disable");
++	dev_info(fotg->dev, "%s: %s VBUS\n", __func__, enable ? "enable" : "disable");
++}
++
+ static int fotg210_probe(struct platform_device *pdev)
+ {
+ 	struct device *dev = &pdev->dev;
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -1095,9 +1095,26 @@ static int fotg210_udc_stop(struct usb_g
+ 	return 0;
+ }
+ 
++/**
++ * fotg210_vbus_session - Called by external transceiver to enable/disable udc
++ * @_gadget: usb gadget
++ * @is_active: 0 if should disable UDC VBUS, 1 if should enable
++ *
++ * Returns 0
++ */
++static int fotg210_vbus_session(struct usb_gadget *g, int is_active)
++{
++	struct fotg210_udc *fotg210 = gadget_to_fotg210(g);
++
++	/* Call down to core integration layer to drive or disable VBUS */
++	fotg210_vbus(fotg210->fotg, is_active);
++	return 0;
++}
++
+ static const struct usb_gadget_ops fotg210_gadget_ops = {
+ 	.udc_start		= fotg210_udc_start,
+ 	.udc_stop		= fotg210_udc_stop,
++	.vbus_session		= fotg210_vbus_session,
+ };
+ 
+ /**
+--- a/drivers/usb/fotg210/fotg210.h
++++ b/drivers/usb/fotg210/fotg210.h
+@@ -17,6 +17,8 @@ struct fotg210 {
+ 	enum gemini_port port;
+ };
+ 
++void fotg210_vbus(struct fotg210 *fotg, bool enable);
++
+ #ifdef CONFIG_USB_FOTG210_HCD
+ int fotg210_hcd_probe(struct platform_device *pdev, struct fotg210 *fotg);
+ int fotg210_hcd_remove(struct platform_device *pdev);
diff --git a/target/linux/gemini/patches-6.1/0022-fotg210-udc-Introduce-and-use-a-fotg210_ack_int-func.patch b/target/linux/gemini/patches-6.1/0022-fotg210-udc-Introduce-and-use-a-fotg210_ack_int-func.patch
new file mode 100644
index 000000000000..025e97e1b72a
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0022-fotg210-udc-Introduce-and-use-a-fotg210_ack_int-func.patch
@@ -0,0 +1,137 @@
+From f011d1eab23f4c063c5441c0d5a22898adf9145c Mon Sep 17 00:00:00 2001
+From: Fabian Vogt <fabian at ritter-vogt.de>
+Date: Mon, 23 Jan 2023 08:35:07 +0100
+Subject: [PATCH 22/29] fotg210-udc: Introduce and use a fotg210_ack_int
+ function
+
+This is in preparation of support for devices where interrupts are acked
+differently.
+
+Signed-off-by: Fabian Vogt <fabian at ritter-vogt.de>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230123073508.2350402-3-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 54 +++++++++++--------------------
+ 1 file changed, 18 insertions(+), 36 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -28,6 +28,14 @@ static const char udc_name[] = "fotg210_
+ static const char * const fotg210_ep_name[] = {
+ 	"ep0", "ep1", "ep2", "ep3", "ep4"};
+ 
++static void fotg210_ack_int(struct fotg210_udc *fotg210, u32 offset, u32 mask)
++{
++	u32 value = ioread32(fotg210->reg + offset);
++
++	value &= ~mask;
++	iowrite32(value, fotg210->reg + offset);
++}
++
+ static void fotg210_disable_fifo_int(struct fotg210_ep *ep)
+ {
+ 	u32 value = ioread32(ep->fotg210->reg + FOTG210_DMISGR1);
+@@ -303,8 +311,7 @@ static void fotg210_wait_dma_done(struct
+ 			goto dma_reset;
+ 	} while (!(value & DISGR2_DMA_CMPLT));
+ 
+-	value &= ~DISGR2_DMA_CMPLT;
+-	iowrite32(value, ep->fotg210->reg + FOTG210_DISGR2);
++	fotg210_ack_int(ep->fotg210, FOTG210_DISGR2, DISGR2_DMA_CMPLT);
+ 	return;
+ 
+ dma_reset:
+@@ -844,14 +851,6 @@ static void fotg210_ep0in(struct fotg210
+ 	}
+ }
+ 
+-static void fotg210_clear_comabt_int(struct fotg210_udc *fotg210)
+-{
+-	u32 value = ioread32(fotg210->reg + FOTG210_DISGR0);
+-
+-	value &= ~DISGR0_CX_COMABT_INT;
+-	iowrite32(value, fotg210->reg + FOTG210_DISGR0);
+-}
+-
+ static void fotg210_in_fifo_handler(struct fotg210_ep *ep)
+ {
+ 	struct fotg210_request *req = list_entry(ep->queue.next,
+@@ -893,60 +892,43 @@ static irqreturn_t fotg210_irq(int irq,
+ 		void __iomem *reg = fotg210->reg + FOTG210_DISGR2;
+ 		u32 int_grp2 = ioread32(reg);
+ 		u32 int_msk2 = ioread32(fotg210->reg + FOTG210_DMISGR2);
+-		u32 value;
+ 
+ 		int_grp2 &= ~int_msk2;
+ 
+ 		if (int_grp2 & DISGR2_USBRST_INT) {
+ 			usb_gadget_udc_reset(&fotg210->gadget,
+ 					     fotg210->driver);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_USBRST_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_USBRST_INT);
+ 			pr_info("fotg210 udc reset\n");
+ 		}
+ 		if (int_grp2 & DISGR2_SUSP_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_SUSP_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_SUSP_INT);
+ 			pr_info("fotg210 udc suspend\n");
+ 		}
+ 		if (int_grp2 & DISGR2_RESM_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_RESM_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_RESM_INT);
+ 			pr_info("fotg210 udc resume\n");
+ 		}
+ 		if (int_grp2 & DISGR2_ISO_SEQ_ERR_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_ISO_SEQ_ERR_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_ISO_SEQ_ERR_INT);
+ 			pr_info("fotg210 iso sequence error\n");
+ 		}
+ 		if (int_grp2 & DISGR2_ISO_SEQ_ABORT_INT) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_ISO_SEQ_ABORT_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_ISO_SEQ_ABORT_INT);
+ 			pr_info("fotg210 iso sequence abort\n");
+ 		}
+ 		if (int_grp2 & DISGR2_TX0BYTE_INT) {
+ 			fotg210_clear_tx0byte(fotg210);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_TX0BYTE_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_TX0BYTE_INT);
+ 			pr_info("fotg210 transferred 0 byte\n");
+ 		}
+ 		if (int_grp2 & DISGR2_RX0BYTE_INT) {
+ 			fotg210_clear_rx0byte(fotg210);
+-			value = ioread32(reg);
+-			value &= ~DISGR2_RX0BYTE_INT;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_RX0BYTE_INT);
+ 			pr_info("fotg210 received 0 byte\n");
+ 		}
+ 		if (int_grp2 & DISGR2_DMA_ERROR) {
+-			value = ioread32(reg);
+-			value &= ~DISGR2_DMA_ERROR;
+-			iowrite32(value, reg);
++			fotg210_ack_int(fotg210, FOTG210_DISGR2, DISGR2_DMA_ERROR);
+ 		}
+ 	}
+ 
+@@ -960,7 +942,7 @@ static irqreturn_t fotg210_irq(int irq,
+ 
+ 		/* the highest priority in this source register */
+ 		if (int_grp0 & DISGR0_CX_COMABT_INT) {
+-			fotg210_clear_comabt_int(fotg210);
++			fotg210_ack_int(fotg210, FOTG210_DISGR0, DISGR0_CX_COMABT_INT);
+ 			pr_info("fotg210 CX command abort\n");
+ 		}
+ 
diff --git a/target/linux/gemini/patches-6.1/0023-fotg210-udc-Improve-device-initialization.patch b/target/linux/gemini/patches-6.1/0023-fotg210-udc-Improve-device-initialization.patch
new file mode 100644
index 000000000000..248ec855b449
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0023-fotg210-udc-Improve-device-initialization.patch
@@ -0,0 +1,66 @@
+From 367747c7813cecf19b46ef7134691f903ab76dc9 Mon Sep 17 00:00:00 2001
+From: Fabian Vogt <fabian at ritter-vogt.de>
+Date: Mon, 23 Jan 2023 08:35:08 +0100
+Subject: [PATCH 23/29] fotg210-udc: Improve device initialization
+
+Reset the device explicitly to get into a known state and also set the chip
+enable bit. Additionally, mask interrupts which aren't handled.
+
+Signed-off-by: Fabian Vogt <fabian at ritter-vogt.de>
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230123073508.2350402-4-linus.walleij@linaro.org
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-udc.c | 15 +++++++++++++++
+ drivers/usb/fotg210/fotg210-udc.h |  2 ++
+ 2 files changed, 17 insertions(+)
+
+--- a/drivers/usb/fotg210/fotg210-udc.c
++++ b/drivers/usb/fotg210/fotg210-udc.c
+@@ -7,6 +7,7 @@
+  * Author : Yuan-Hsin Chen <yhchen at faraday-tech.com>
+  */
+ 
++#include <linux/delay.h>
+ #include <linux/dma-mapping.h>
+ #include <linux/err.h>
+ #include <linux/interrupt.h>
+@@ -1022,6 +1023,11 @@ static int fotg210_udc_start(struct usb_
+ 			dev_err(fotg210->dev, "can't bind to phy\n");
+ 	}
+ 
++	/* chip enable */
++	value = ioread32(fotg210->reg + FOTG210_DMCR);
++	value |= DMCR_CHIP_EN;
++	iowrite32(value, fotg210->reg + FOTG210_DMCR);
++
+ 	/* enable device global interrupt */
+ 	value = ioread32(fotg210->reg + FOTG210_DMCR);
+ 	value |= DMCR_GLINT_EN;
+@@ -1038,6 +1044,15 @@ static void fotg210_init(struct fotg210_
+ 	iowrite32(GMIR_MHC_INT | GMIR_MOTG_INT | GMIR_INT_POLARITY,
+ 		  fotg210->reg + FOTG210_GMIR);
+ 
++	/* mask interrupts for groups other than 0-2 */
++	iowrite32(~(DMIGR_MINT_G0 | DMIGR_MINT_G1 | DMIGR_MINT_G2),
++		  fotg210->reg + FOTG210_DMIGR);
++
++	/* udc software reset */
++	iowrite32(DMCR_SFRST, fotg210->reg + FOTG210_DMCR);
++	/* Better wait a bit, but without a datasheet, no idea how long. */
++	usleep_range(100, 200);
++
+ 	/* disable device global interrupt */
+ 	value = ioread32(fotg210->reg + FOTG210_DMCR);
+ 	value &= ~DMCR_GLINT_EN;
+--- a/drivers/usb/fotg210/fotg210-udc.h
++++ b/drivers/usb/fotg210/fotg210-udc.h
+@@ -58,6 +58,8 @@
+ 
+ /* Device Mask of Interrupt Group Register (0x130) */
+ #define FOTG210_DMIGR		0x130
++#define DMIGR_MINT_G2		(1 << 2)
++#define DMIGR_MINT_G1		(1 << 1)
+ #define DMIGR_MINT_G0		(1 << 0)
+ 
+ /* Device Mask of Interrupt Source Group 0(0x134) */
diff --git a/target/linux/gemini/patches-6.1/0024-usb-fotg210-hcd-use-sysfs_emit-to-instead-of-scnprin.patch b/target/linux/gemini/patches-6.1/0024-usb-fotg210-hcd-use-sysfs_emit-to-instead-of-scnprin.patch
new file mode 100644
index 000000000000..6e6ad816d51a
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0024-usb-fotg210-hcd-use-sysfs_emit-to-instead-of-scnprin.patch
@@ -0,0 +1,35 @@
+From 482830a70408a5d30af264b3d6706f818c78b2b2 Mon Sep 17 00:00:00 2001
+From: Andy Shevchenko <andriy.shevchenko at linux.intel.com>
+Date: Fri, 20 Jan 2023 17:44:33 +0200
+Subject: [PATCH 24/29] usb: fotg210-hcd: use sysfs_emit() to instead of
+ scnprintf()
+
+Follow the advice of the Documentation/filesystems/sysfs.rst and show()
+should only use sysfs_emit() or sysfs_emit_at() when formatting the
+value to be returned to user space.
+
+Signed-off-by: Andy Shevchenko <andriy.shevchenko at linux.intel.com>
+Link: https://lore.kernel.org/r/20230120154437.22025-1-andriy.shevchenko@linux.intel.com
+Signed-off-by: Greg Kroah-Hartman <gregkh at linuxfoundation.org>
+---
+ drivers/usb/fotg210/fotg210-hcd.c | 5 +----
+ 1 file changed, 1 insertion(+), 4 deletions(-)
+
+--- a/drivers/usb/fotg210/fotg210-hcd.c
++++ b/drivers/usb/fotg210/fotg210-hcd.c
+@@ -4686,14 +4686,11 @@ static ssize_t uframe_periodic_max_show(
+ 		struct device_attribute *attr, char *buf)
+ {
+ 	struct fotg210_hcd *fotg210;
+-	int n;
+ 
+ 	fotg210 = hcd_to_fotg210(bus_to_hcd(dev_get_drvdata(dev)));
+-	n = scnprintf(buf, PAGE_SIZE, "%d\n", fotg210->uframe_periodic_max);
+-	return n;
++	return sysfs_emit(buf, "%d\n", fotg210->uframe_periodic_max);
+ }
+ 
+-
+ static ssize_t uframe_periodic_max_store(struct device *dev,
+ 		struct device_attribute *attr, const char *buf, size_t count)
+ {
diff --git a/target/linux/gemini/patches-6.1/0025-ARM-dts-gemini-Push-down-flash-address-size-cells.patch b/target/linux/gemini/patches-6.1/0025-ARM-dts-gemini-Push-down-flash-address-size-cells.patch
new file mode 100644
index 000000000000..98fa9e4f7a9c
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0025-ARM-dts-gemini-Push-down-flash-address-size-cells.patch
@@ -0,0 +1,68 @@
+From 6b84aa39a063eec883d410a9893cec70fce56163 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 4 Dec 2022 20:02:28 +0100
+Subject: [PATCH 25/29] ARM: dts: gemini: Push down flash address/size cells
+
+The platforms not defining any OF partions complain like
+this:
+
+../arch/arm/boot/dts/gemini.dtsi:19.25-28.5: Warning
+ (avoid_unnecessary_addr_size): /soc/flash at 30000000: unnecessary
+ #address-cells/#size-cells without "ranges" or child "reg" property
+
+Get rid of this by only defining the address-cells and
+size-cells where it is actually used by OF partitions.
+
+Link: https://lore.kernel.org/r/20221204190230.3345590-1-linus.walleij@linaro.org
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+---
+ arch/arm/boot/dts/gemini-dlink-dns-313.dts | 2 ++
+ arch/arm/boot/dts/gemini-wbd111.dts        | 2 ++
+ arch/arm/boot/dts/gemini-wbd222.dts        | 2 ++
+ arch/arm/boot/dts/gemini.dtsi              | 2 --
+ 4 files changed, 6 insertions(+), 2 deletions(-)
+
+--- a/arch/arm/boot/dts/gemini-dlink-dns-313.dts
++++ b/arch/arm/boot/dts/gemini-dlink-dns-313.dts
+@@ -164,6 +164,8 @@
+ 			compatible = "cortina,gemini-flash", "jedec-flash";
+ 			status = "okay";
+ 			reg = <0x30000000 0x00080000>;
++			#address-cells = <1>;
++			#size-cells = <1>;
+ 
+ 			/*
+ 			 * This "RedBoot" is the Storlink derivative.
+--- a/arch/arm/boot/dts/gemini-wbd111.dts
++++ b/arch/arm/boot/dts/gemini-wbd111.dts
+@@ -86,6 +86,8 @@
+ 			status = "okay";
+ 			/* 8MB of flash */
+ 			reg = <0x30000000 0x00800000>;
++			#address-cells = <1>;
++			#size-cells = <1>;
+ 
+ 			partition at 0 {
+ 				label = "RedBoot";
+--- a/arch/arm/boot/dts/gemini-wbd222.dts
++++ b/arch/arm/boot/dts/gemini-wbd222.dts
+@@ -90,6 +90,8 @@
+ 			status = "okay";
+ 			/* 8MB of flash */
+ 			reg = <0x30000000 0x00800000>;
++			#address-cells = <1>;
++			#size-cells = <1>;
+ 
+ 			partition at 0 {
+ 				label = "RedBoot";
+--- a/arch/arm/boot/dts/gemini.dtsi
++++ b/arch/arm/boot/dts/gemini.dtsi
+@@ -22,8 +22,6 @@
+ 			pinctrl-names = "default";
+ 			pinctrl-0 = <&pflash_default_pins>;
+ 			bank-width = <2>;
+-			#address-cells = <1>;
+-			#size-cells = <1>;
+ 			status = "disabled";
+ 		};
+ 
diff --git a/target/linux/gemini/patches-6.1/0026-ARM-dts-gemini-wbd111-Use-RedBoot-partion-parser.patch b/target/linux/gemini/patches-6.1/0026-ARM-dts-gemini-wbd111-Use-RedBoot-partion-parser.patch
new file mode 100644
index 000000000000..6c0c48bbe03d
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0026-ARM-dts-gemini-wbd111-Use-RedBoot-partion-parser.patch
@@ -0,0 +1,57 @@
+From 0e733f5af628210f372585e431504a7024e7b571 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 4 Dec 2022 20:02:29 +0100
+Subject: [PATCH 26/29] ARM: dts: gemini: wbd111: Use RedBoot partion parser
+
+This is clearly a RedBoot partitioned device with 0x20000
+sized erase blocks.
+
+Link: https://lore.kernel.org/r/20221204190230.3345590-2-linus.walleij@linaro.org
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+---
+ arch/arm/boot/dts/gemini-wbd111.dts | 33 ++++-------------------------
+ 1 file changed, 4 insertions(+), 29 deletions(-)
+
+--- a/arch/arm/boot/dts/gemini-wbd111.dts
++++ b/arch/arm/boot/dts/gemini-wbd111.dts
+@@ -86,36 +86,11 @@
+ 			status = "okay";
+ 			/* 8MB of flash */
+ 			reg = <0x30000000 0x00800000>;
+-			#address-cells = <1>;
+-			#size-cells = <1>;
+ 
+-			partition at 0 {
+-				label = "RedBoot";
+-				reg = <0x00000000 0x00020000>;
+-				read-only;
+-			};
+-			partition at 20000 {
+-				label = "kernel";
+-				reg = <0x00020000 0x00100000>;
+-			};
+-			partition at 120000 {
+-				label = "rootfs";
+-				reg = <0x00120000 0x006a0000>;
+-			};
+-			partition at 7c0000 {
+-				label = "VCTL";
+-				reg = <0x007c0000 0x00010000>;
+-				read-only;
+-			};
+-			partition at 7d0000 {
+-				label = "cfg";
+-				reg = <0x007d0000 0x00010000>;
+-				read-only;
+-			};
+-			partition at 7e0000 {
+-				label = "FIS";
+-				reg = <0x007e0000 0x00010000>;
+-				read-only;
++			partitions {
++				compatible = "redboot-fis";
++				/* Eraseblock at 0x7e0000 */
++				fis-index-block = <0x3f>;
+ 			};
+ 		};
+ 
diff --git a/target/linux/gemini/patches-6.1/0027-ARM-dts-gemini-wbd222-Use-RedBoot-partion-parser.patch b/target/linux/gemini/patches-6.1/0027-ARM-dts-gemini-wbd222-Use-RedBoot-partion-parser.patch
new file mode 100644
index 000000000000..10bc7315b372
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0027-ARM-dts-gemini-wbd222-Use-RedBoot-partion-parser.patch
@@ -0,0 +1,57 @@
+From 8558e2e1110a5daa4ac9e1c5b5c15e1651a8fb94 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Sun, 4 Dec 2022 20:02:30 +0100
+Subject: [PATCH 27/29] ARM: dts: gemini: wbd222: Use RedBoot partion parser
+
+This is clearly a RedBoot partitioned device with 0x20000
+sized erase blocks.
+
+Link: https://lore.kernel.org/r/20221204190230.3345590-3-linus.walleij@linaro.org
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+---
+ arch/arm/boot/dts/gemini-wbd222.dts | 33 ++++-------------------------
+ 1 file changed, 4 insertions(+), 29 deletions(-)
+
+--- a/arch/arm/boot/dts/gemini-wbd222.dts
++++ b/arch/arm/boot/dts/gemini-wbd222.dts
+@@ -90,36 +90,11 @@
+ 			status = "okay";
+ 			/* 8MB of flash */
+ 			reg = <0x30000000 0x00800000>;
+-			#address-cells = <1>;
+-			#size-cells = <1>;
+ 
+-			partition at 0 {
+-				label = "RedBoot";
+-				reg = <0x00000000 0x00020000>;
+-				read-only;
+-			};
+-			partition at 20000 {
+-				label = "kernel";
+-				reg = <0x00020000 0x00100000>;
+-			};
+-			partition at 120000 {
+-				label = "rootfs";
+-				reg = <0x00120000 0x006a0000>;
+-			};
+-			partition at 7c0000 {
+-				label = "VCTL";
+-				reg = <0x007c0000 0x00010000>;
+-				read-only;
+-			};
+-			partition at 7d0000 {
+-				label = "cfg";
+-				reg = <0x007d0000 0x00010000>;
+-				read-only;
+-			};
+-			partition at 7e0000 {
+-				label = "FIS";
+-				reg = <0x007e0000 0x00010000>;
+-				read-only;
++			partitions {
++				compatible = "redboot-fis";
++				/* Eraseblock at 0x7e0000 */
++				fis-index-block = <0x3f>;
+ 			};
+ 		};
+ 
diff --git a/target/linux/gemini/patches-6.1/0028-ARM-dts-gemini-Fix-USB-block-version.patch b/target/linux/gemini/patches-6.1/0028-ARM-dts-gemini-Fix-USB-block-version.patch
new file mode 100644
index 000000000000..9192397d0484
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0028-ARM-dts-gemini-Fix-USB-block-version.patch
@@ -0,0 +1,34 @@
+From d5c01ce4a1016507c69682894cf6b66301abca3d Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 23 Jan 2023 08:39:15 +0100
+Subject: [PATCH 28/29] ARM: dts: gemini: Fix USB block version
+
+The FOTG version in the Gemini is the FOTG200, fix this
+up.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230123073916.2350839-1-linus.walleij@linaro.org
+---
+ arch/arm/boot/dts/gemini.dtsi | 4 ++--
+ 1 file changed, 2 insertions(+), 2 deletions(-)
+
+--- a/arch/arm/boot/dts/gemini.dtsi
++++ b/arch/arm/boot/dts/gemini.dtsi
+@@ -439,7 +439,7 @@
+ 		};
+ 
+ 		usb0: usb at 68000000 {
+-			compatible = "cortina,gemini-usb", "faraday,fotg210";
++			compatible = "cortina,gemini-usb", "faraday,fotg200";
+ 			reg = <0x68000000 0x1000>;
+ 			interrupts = <10 IRQ_TYPE_LEVEL_HIGH>;
+ 			resets = <&syscon GEMINI_RESET_USB0>;
+@@ -460,7 +460,7 @@
+ 		};
+ 
+ 		usb1: usb at 69000000 {
+-			compatible = "cortina,gemini-usb", "faraday,fotg210";
++			compatible = "cortina,gemini-usb", "faraday,fotg200";
+ 			reg = <0x69000000 0x1000>;
+ 			interrupts = <11 IRQ_TYPE_LEVEL_HIGH>;
+ 			resets = <&syscon GEMINI_RESET_USB1>;
diff --git a/target/linux/gemini/patches-6.1/0029-ARM-dts-gemini-Enable-DNS313-FOTG210-as-periph.patch b/target/linux/gemini/patches-6.1/0029-ARM-dts-gemini-Enable-DNS313-FOTG210-as-periph.patch
new file mode 100644
index 000000000000..3ce4cb9c2042
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/0029-ARM-dts-gemini-Enable-DNS313-FOTG210-as-periph.patch
@@ -0,0 +1,58 @@
+From 296184694ae7a4e388603c95499e98d30b21cc09 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 23 Jan 2023 08:39:16 +0100
+Subject: [PATCH 29/29] ARM: dts: gemini: Enable DNS313 FOTG210 as periph
+
+Add the GPIO-based VBUS phy, and enable the FOTG210
+USB1 block for use as peripheral.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+Link: https://lore.kernel.org/r/20230123073916.2350839-2-linus.walleij@linaro.org
+---
+ arch/arm/boot/dts/gemini-dlink-dns-313.dts | 17 +++++++++++++++++
+ arch/arm/boot/dts/gemini.dtsi              |  2 ++
+ 2 files changed, 19 insertions(+)
+
+--- a/arch/arm/boot/dts/gemini-dlink-dns-313.dts
++++ b/arch/arm/boot/dts/gemini-dlink-dns-313.dts
+@@ -80,6 +80,15 @@
+ 		#cooling-cells = <2>;
+ 	};
+ 
++	/*
++	 * This is the type B USB connector on the device,
++	 * a GPIO-controlled USB VBUS detect
++	 */
++	usb1_phy: phy {
++		compatible = "gpio-usb-b-connector", "usb-b-connector";
++		#phy-cells = <0>;
++		vbus-gpios = <&gpio0 18 GPIO_ACTIVE_LOW>;
++	};
+ 
+ 	/* Global Mixed-Mode Technology G751 mounted on GPIO I2C */
+ 	i2c {
+@@ -302,5 +311,13 @@
+ 		ide at 63000000 {
+ 			status = "okay";
+ 		};
++
++		usb at 69000000 {
++			status = "okay";
++			dr_mode = "peripheral";
++			usb-phy = <&usb1_phy>;
++			pinctrl-names = "default";
++			pinctrl-0 = <&usb_default_pins>;
++		};
+ 	};
+ };
+--- a/arch/arm/boot/dts/gemini.dtsi
++++ b/arch/arm/boot/dts/gemini.dtsi
+@@ -455,6 +455,8 @@
+ 			 */
+ 			pinctrl-names = "default";
+ 			pinctrl-0 = <&usb_default_pins>;
++			/* Default to host mode */
++			dr_mode = "host";
+ 			syscon = <&syscon>;
+ 			status = "disabled";
+ 		};
diff --git a/target/linux/gemini/patches-6.1/300-ARM-dts-Augment-DIR-685-partition-table-for-OpenWrt.patch b/target/linux/gemini/patches-6.1/300-ARM-dts-Augment-DIR-685-partition-table-for-OpenWrt.patch
new file mode 100644
index 000000000000..78a163afd87b
--- /dev/null
+++ b/target/linux/gemini/patches-6.1/300-ARM-dts-Augment-DIR-685-partition-table-for-OpenWrt.patch
@@ -0,0 +1,37 @@
+From 36ee838bf83c01cff7cb47c7b07be278d2950ac0 Mon Sep 17 00:00:00 2001
+From: Linus Walleij <linus.walleij at linaro.org>
+Date: Mon, 11 Mar 2019 15:44:29 +0100
+Subject: [PATCH 2/2] ARM: dts: Augment DIR-685 partition table for OpenWrt
+
+Rename the firmware partition so that the firmware MTD
+splitter will do its job, drop the rootfs arguments as
+the MTD splitter will set this up automatically.
+
+Signed-off-by: Linus Walleij <linus.walleij at linaro.org>
+---
+ arch/arm/boot/dts/gemini-dlink-dir-685.dts | 6 +++---
+ 1 file changed, 3 insertions(+), 3 deletions(-)
+
+--- a/arch/arm/boot/dts/gemini-dlink-dir-685.dts
++++ b/arch/arm/boot/dts/gemini-dlink-dir-685.dts
+@@ -20,7 +20,7 @@
+ 	};
+ 
+ 	chosen {
+-		bootargs = "console=ttyS0,19200n8 root=/dev/sda1 rw rootwait consoleblank=300";
++		bootargs = "console=ttyS0,19200n8 consoleblank=300";
+ 		stdout-path = "uart0:19200n8";
+ 	};
+ 
+@@ -317,9 +317,9 @@
+ 				 * this is called "upgrade" on the vendor system.
+ 				 */
+ 				partition at 40000 {
+-					label = "upgrade";
++					compatible = "wrg";
++					label = "firmware";
+ 					reg = <0x00040000 0x01f40000>;
+-					read-only;
+ 				};
+ 				/* RGDB, Residental Gateway Database? */
+ 				partition at 1f80000 {
-- 
2.34.1




More information about the openwrt-devel mailing list