sunxi: add support for 4.1

Signed-off-by: Zoltan HERPAI <wigyori@uid0.hu>

SVN-Revision: 46571

1 files changed, 820 insertions, 0 deletions

diff --git a/target/linux/sunxi/patches-4.1/170-musb-add-driver.patch b/target/linux/sunxi/patches-4.1/170-musb-add-driver.patch
new file mode 100644
index 0000000000..5fc9e5aa66
--- /dev/null
+++ b/target/linux/sunxi/patches-4.1/170-musb-add-driver.patch
@@ -0,0 +1,820 @@
+From 744543c599c420bcddca08cd2e2713b82a008328 Mon Sep 17 00:00:00 2001
+From: Hans de Goede <hdegoede@redhat.com>
+Date: Wed, 8 Jul 2015 16:41:38 +0200
+Subject: [PATCH] usb: musb: sunxi: Add support for the Allwinner sunxi musb
+ controller
+
+This is based on initial code to get the Allwinner sunxi musb controller
+supported by Chen-Yu Tsai and Roman Byshko.
+
+This adds support for the Allwinner sunxi musb controller in both host only
+and otg mode. Peripheral only mode is not supported, as no boards use that.
+
+This has been tested on a cubietruck (A20 SoC) and an UTOO P66 tablet
+(A13 SoC) with a variety of devices in host mode and with the g_serial gadget
+driver in peripheral mode, plugging otg / host cables in/out a lot of times
+in all possible imaginable plug orders.
+
+Signed-off-by: Hans de Goede <hdegoede@redhat.com>
+Signed-off-by: Felipe Balbi <balbi@ti.com>
+---
+ .../bindings/usb/allwinner,sun4i-a10-musb.txt      |  27 +
+ drivers/usb/musb/Kconfig                           |  13 +-
+ drivers/usb/musb/Makefile                          |   1 +
+ drivers/usb/musb/sunxi.c                           | 703 +++++++++++++++++++++
+ 4 files changed, 743 insertions(+), 1 deletion(-)
+ create mode 100644 Documentation/devicetree/bindings/usb/allwinner,sun4i-a10-musb.txt
+ create mode 100644 drivers/usb/musb/sunxi.c
+
+diff --git a/Documentation/devicetree/bindings/usb/allwinner,sun4i-a10-musb.txt b/Documentation/devicetree/bindings/usb/allwinner,sun4i-a10-musb.txt
+new file mode 100644
+index 0000000..9254a6c
+--- /dev/null
++++ b/Documentation/devicetree/bindings/usb/allwinner,sun4i-a10-musb.txt
+@@ -0,0 +1,27 @@
++Allwinner sun4i A10 musb DRC/OTG controller
++-------------------------------------------
++
++Required properties:
++ - compatible      : "allwinner,sun4i-a10-musb"
++ - reg             : mmio address range of the musb controller
++ - clocks          : clock specifier for the musb controller ahb gate clock
++ - interrupts      : interrupt to which the musb controller is connected
++ - interrupt-names : must be "mc"
++ - phys            : phy specifier for the otg phy
++ - phy-names       : must be "usb"
++ - dr_mode         : Dual-Role mode must be "host" or "otg"
++ - extcon          : extcon specifier for the otg phy
++
++Example:
++
++	usb_otg: usb@01c13000 {
++		compatible = "allwinner,sun4i-a10-musb";
++		reg = <0x01c13000 0x0400>;
++		clocks = <&ahb_gates 0>;
++		interrupts = <38>;
++		interrupt-names = "mc";
++		phys = <&usbphy 0>;
++		phy-names = "usb";
++		extcon = <&usbphy 0>;
++		status = "disabled";
++	};
+diff --git a/drivers/usb/musb/Kconfig b/drivers/usb/musb/Kconfig
+index 39db8b6..37081ed 100644
+--- a/drivers/usb/musb/Kconfig
++++ b/drivers/usb/musb/Kconfig
+@@ -5,7 +5,7 @@
+ 
+ # (M)HDRC = (Multipoint) Highspeed Dual-Role Controller
+ config USB_MUSB_HDRC
+-	tristate 'Inventra Highspeed Dual Role Controller (TI, ADI, ...)'
++	tristate 'Inventra Highspeed Dual Role Controller (TI, ADI, AW, ...)'
+ 	depends on (USB || USB_GADGET)
+ 	help
+ 	  Say Y here if your system has a dual role high speed USB
+@@ -20,6 +20,8 @@ config USB_MUSB_HDRC
+ 	  Analog Devices parts using this IP include Blackfin BF54x,
+ 	  BF525 and BF527.
+ 
++	  Allwinner SoCs using this IP include A10, A13, A20, ...
++
+ 	  If you do not know what this is, please say N.
+ 
+ 	  To compile this driver as a module, choose M here; the
+@@ -60,6 +62,15 @@ endchoice
+ 
+ comment "Platform Glue Layer"
+ 
++config USB_MUSB_SUNXI
++	tristate "Allwinner (sunxi)"
++	depends on ARCH_SUNXI
++	depends on NOP_USB_XCEIV
++	depends on PHY_SUN4I_USB
++	depends on EXTCON
++	depends on GENERIC_PHY
++	select SUNXI_SRAM
++
+ config USB_MUSB_DAVINCI
+ 	tristate "DaVinci"
+ 	depends on ARCH_DAVINCI_DMx
+diff --git a/drivers/usb/musb/Makefile b/drivers/usb/musb/Makefile
+index ba49501..f95befe 100644
+--- a/drivers/usb/musb/Makefile
++++ b/drivers/usb/musb/Makefile
+@@ -20,6 +20,7 @@ obj-$(CONFIG_USB_MUSB_DA8XX)			+= da8xx.o
+ obj-$(CONFIG_USB_MUSB_BLACKFIN)			+= blackfin.o
+ obj-$(CONFIG_USB_MUSB_UX500)			+= ux500.o
+ obj-$(CONFIG_USB_MUSB_JZ4740)			+= jz4740.o
++obj-$(CONFIG_USB_MUSB_SUNXI)			+= sunxi.o
+ 
+ 
+ obj-$(CONFIG_USB_MUSB_AM335X_CHILD)		+= musb_am335x.o
+diff --git a/drivers/usb/musb/sunxi.c b/drivers/usb/musb/sunxi.c
+new file mode 100644
+index 0000000..00d7248
+--- /dev/null
++++ b/drivers/usb/musb/sunxi.c
+@@ -0,0 +1,703 @@
++/*
++ * Allwinner sun4i MUSB Glue Layer
++ *
++ * Copyright (C) 2015 Hans de Goede <hdegoede@redhat.com>
++ *
++ * Based on code from
++ * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
++ *
++ * This program is free software; you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License as published by
++ * the Free Software Foundation; either version 2 of the License, or
++ * (at your option) any later version.
++ *
++ * This program is distributed in the hope that it will be useful,
++ * but WITHOUT ANY WARRANTY; without even the implied warranty of
++ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk.h>
++#include <linux/err.h>
++#include <linux/extcon.h>
++#include <linux/io.h>
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/of.h>
++#include <linux/phy/phy-sun4i-usb.h>
++#include <linux/platform_device.h>
++#include <linux/soc/sunxi/sunxi_sram.h>
++#include <linux/usb/musb.h>
++#include <linux/usb/of.h>
++#include <linux/usb/usb_phy_generic.h>
++#include <linux/workqueue.h>
++#include "musb_core.h"
++
++/*
++ * Register offsets, note sunxi musb has a different layout then most
++ * musb implementations, we translate the layout in musb_readb & friends.
++ */
++#define SUNXI_MUSB_POWER			0x0040
++#define SUNXI_MUSB_DEVCTL			0x0041
++#define SUNXI_MUSB_INDEX			0x0042
++#define SUNXI_MUSB_VEND0			0x0043
++#define SUNXI_MUSB_INTRTX			0x0044
++#define SUNXI_MUSB_INTRRX			0x0046
++#define SUNXI_MUSB_INTRTXE			0x0048
++#define SUNXI_MUSB_INTRRXE			0x004a
++#define SUNXI_MUSB_INTRUSB			0x004c
++#define SUNXI_MUSB_INTRUSBE			0x0050
++#define SUNXI_MUSB_FRAME			0x0054
++#define SUNXI_MUSB_TXFIFOSZ			0x0090
++#define SUNXI_MUSB_TXFIFOADD			0x0092
++#define SUNXI_MUSB_RXFIFOSZ			0x0094
++#define SUNXI_MUSB_RXFIFOADD			0x0096
++#define SUNXI_MUSB_FADDR			0x0098
++#define SUNXI_MUSB_TXFUNCADDR			0x0098
++#define SUNXI_MUSB_TXHUBADDR			0x009a
++#define SUNXI_MUSB_TXHUBPORT			0x009b
++#define SUNXI_MUSB_RXFUNCADDR			0x009c
++#define SUNXI_MUSB_RXHUBADDR			0x009e
++#define SUNXI_MUSB_RXHUBPORT			0x009f
++#define SUNXI_MUSB_CONFIGDATA			0x00c0
++
++/* VEND0 bits */
++#define SUNXI_MUSB_VEND0_PIO_MODE		0
++
++/* flags */
++#define SUNXI_MUSB_FL_ENABLED			0
++#define SUNXI_MUSB_FL_HOSTMODE			1
++#define SUNXI_MUSB_FL_HOSTMODE_PEND		2
++#define SUNXI_MUSB_FL_VBUS_ON			3
++#define SUNXI_MUSB_FL_PHY_ON			4
++
++/* Our read/write methods need access and do not get passed in a musb ref :| */
++static struct musb *sunxi_musb;
++
++struct sunxi_glue {
++	struct device		*dev;
++	struct platform_device	*musb;
++	struct clk		*clk;
++	struct phy		*phy;
++	struct platform_device	*usb_phy;
++	struct usb_phy		*xceiv;
++	unsigned long		flags;
++	struct work_struct	work;
++	struct extcon_dev	*extcon;
++	struct notifier_block	host_nb;
++};
++
++/* phy_power_on / off may sleep, so we use a workqueue  */
++static void sunxi_musb_work(struct work_struct *work)
++{
++	struct sunxi_glue *glue = container_of(work, struct sunxi_glue, work);
++	bool vbus_on, phy_on;
++
++	if (!test_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags))
++		return;
++
++	if (test_and_clear_bit(SUNXI_MUSB_FL_HOSTMODE_PEND, &glue->flags)) {
++		struct musb *musb = platform_get_drvdata(glue->musb);
++		unsigned long flags;
++		u8 devctl;
++
++		spin_lock_irqsave(&musb->lock, flags);
++
++		devctl = readb(musb->mregs + SUNXI_MUSB_DEVCTL);
++		if (test_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags)) {
++			set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++			musb->xceiv->otg->default_a = 1;
++			musb->xceiv->otg->state = OTG_STATE_A_IDLE;
++			MUSB_HST_MODE(musb);
++			devctl |= MUSB_DEVCTL_SESSION;
++		} else {
++			clear_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++			musb->xceiv->otg->default_a = 0;
++			musb->xceiv->otg->state = OTG_STATE_B_IDLE;
++			MUSB_DEV_MODE(musb);
++			devctl &= ~MUSB_DEVCTL_SESSION;
++		}
++		writeb(devctl, musb->mregs + SUNXI_MUSB_DEVCTL);
++
++		spin_unlock_irqrestore(&musb->lock, flags);
++	}
++
++	vbus_on = test_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++	phy_on = test_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
++
++	if (phy_on != vbus_on) {
++		if (vbus_on) {
++			phy_power_on(glue->phy);
++			set_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
++		} else {
++			phy_power_off(glue->phy);
++			clear_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
++		}
++	}
++}
++
++static void sunxi_musb_set_vbus(struct musb *musb, int is_on)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	if (is_on)
++		set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++	else
++		clear_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++
++	schedule_work(&glue->work);
++}
++
++static void sunxi_musb_pre_root_reset_end(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	sun4i_usb_phy_set_squelch_detect(glue->phy, false);
++}
++
++static void sunxi_musb_post_root_reset_end(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	sun4i_usb_phy_set_squelch_detect(glue->phy, true);
++}
++
++static irqreturn_t sunxi_musb_interrupt(int irq, void *__hci)
++{
++	struct musb *musb = __hci;
++	unsigned long flags;
++
++	spin_lock_irqsave(&musb->lock, flags);
++
++	musb->int_usb = readb(musb->mregs + SUNXI_MUSB_INTRUSB);
++	if (musb->int_usb)
++		writeb(musb->int_usb, musb->mregs + SUNXI_MUSB_INTRUSB);
++
++	/*
++	 * sunxi musb often signals babble on low / full speed device
++	 * disconnect, without ever raising MUSB_INTR_DISCONNECT, since
++	 * normally babble never happens treat it as disconnect.
++	 */
++	if ((musb->int_usb & MUSB_INTR_BABBLE) && is_host_active(musb)) {
++		musb->int_usb &= ~MUSB_INTR_BABBLE;
++		musb->int_usb |= MUSB_INTR_DISCONNECT;
++	}
++
++	if ((musb->int_usb & MUSB_INTR_RESET) && !is_host_active(musb)) {
++		/* ep0 FADDR must be 0 when (re)entering peripheral mode */
++		musb_ep_select(musb->mregs, 0);
++		musb_writeb(musb->mregs, MUSB_FADDR, 0);
++	}
++
++	musb->int_tx = readw(musb->mregs + SUNXI_MUSB_INTRTX);
++	if (musb->int_tx)
++		writew(musb->int_tx, musb->mregs + SUNXI_MUSB_INTRTX);
++
++	musb->int_rx = readw(musb->mregs + SUNXI_MUSB_INTRRX);
++	if (musb->int_rx)
++		writew(musb->int_rx, musb->mregs + SUNXI_MUSB_INTRRX);
++
++	musb_interrupt(musb);
++
++	spin_unlock_irqrestore(&musb->lock, flags);
++
++	return IRQ_HANDLED;
++}
++
++static int sunxi_musb_host_notifier(struct notifier_block *nb,
++				    unsigned long event, void *ptr)
++{
++	struct sunxi_glue *glue = container_of(nb, struct sunxi_glue, host_nb);
++
++	if (event)
++		set_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags);
++	else
++		clear_bit(SUNXI_MUSB_FL_HOSTMODE, &glue->flags);
++
++	set_bit(SUNXI_MUSB_FL_HOSTMODE_PEND, &glue->flags);
++	schedule_work(&glue->work);
++
++	return NOTIFY_DONE;
++}
++
++static int sunxi_musb_init(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++	int ret;
++
++	sunxi_musb = musb;
++	musb->phy = glue->phy;
++	musb->xceiv = glue->xceiv;
++
++	ret = sunxi_sram_claim(musb->controller->parent);
++	if (ret)
++		return ret;
++
++	ret = clk_prepare_enable(glue->clk);
++	if (ret)
++		goto error_sram_release;
++
++	writeb(SUNXI_MUSB_VEND0_PIO_MODE, musb->mregs + SUNXI_MUSB_VEND0);
++
++	/* Register notifier before calling phy_init() */
++	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE) {
++		ret = extcon_register_notifier(glue->extcon, EXTCON_USB_HOST,
++					       &glue->host_nb);
++		if (ret)
++			goto error_clk_disable;
++	}
++
++	ret = phy_init(glue->phy);
++	if (ret)
++		goto error_unregister_notifier;
++
++	if (musb->port_mode == MUSB_PORT_MODE_HOST) {
++		ret = phy_power_on(glue->phy);
++		if (ret)
++			goto error_phy_exit;
++		set_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags);
++		/* Stop musb work from turning vbus off again */
++		set_bit(SUNXI_MUSB_FL_VBUS_ON, &glue->flags);
++	}
++
++	musb->isr = sunxi_musb_interrupt;
++
++	/* Stop the musb-core from doing runtime pm (not supported on sunxi) */
++	pm_runtime_get(musb->controller);
++
++	return 0;
++
++error_phy_exit:
++	phy_exit(glue->phy);
++error_unregister_notifier:
++	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
++		extcon_unregister_notifier(glue->extcon, EXTCON_USB_HOST,
++					   &glue->host_nb);
++error_clk_disable:
++	clk_disable_unprepare(glue->clk);
++error_sram_release:
++	sunxi_sram_release(musb->controller->parent);
++	return ret;
++}
++
++static int sunxi_musb_exit(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	pm_runtime_put(musb->controller);
++
++	cancel_work_sync(&glue->work);
++	if (test_bit(SUNXI_MUSB_FL_PHY_ON, &glue->flags))
++		phy_power_off(glue->phy);
++
++	phy_exit(glue->phy);
++
++	if (musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
++		extcon_unregister_notifier(glue->extcon, EXTCON_USB_HOST,
++					   &glue->host_nb);
++
++	clk_disable_unprepare(glue->clk);
++	sunxi_sram_release(musb->controller->parent);
++
++	return 0;
++}
++
++static void sunxi_musb_enable(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	/* musb_core does not call us in a balanced manner */
++	if (test_and_set_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags))
++		return;
++
++	schedule_work(&glue->work);
++}
++
++static void sunxi_musb_disable(struct musb *musb)
++{
++	struct sunxi_glue *glue = dev_get_drvdata(musb->controller->parent);
++
++	clear_bit(SUNXI_MUSB_FL_ENABLED, &glue->flags);
++}
++
++/*
++ * sunxi musb register layout
++ * 0x00 - 0x17	fifo regs, 1 long per fifo
++ * 0x40 - 0x57	generic control regs (power - frame)
++ * 0x80 - 0x8f	ep control regs (addressed through hw_ep->regs, indexed)
++ * 0x90 - 0x97	fifo control regs (indexed)
++ * 0x98 - 0x9f	multipoint / busctl regs (indexed)
++ * 0xc0		configdata reg
++ */
++
++static u32 sunxi_musb_fifo_offset(u8 epnum)
++{
++	return (epnum * 4);
++}
++
++static u32 sunxi_musb_ep_offset(u8 epnum, u16 offset)
++{
++	WARN_ONCE(offset != 0,
++		  "sunxi_musb_ep_offset called with non 0 offset\n");
++
++	return 0x80; /* indexed, so ignore epnum */
++}
++
++static u32 sunxi_musb_busctl_offset(u8 epnum, u16 offset)
++{
++	return SUNXI_MUSB_TXFUNCADDR + offset;
++}
++
++static u8 sunxi_musb_readb(const void __iomem *addr, unsigned offset)
++{
++	if (addr == sunxi_musb->mregs) {
++		/* generic control or fifo control reg access */
++		switch (offset) {
++		case MUSB_FADDR:
++			return readb(addr + SUNXI_MUSB_FADDR);
++		case MUSB_POWER:
++			return readb(addr + SUNXI_MUSB_POWER);
++		case MUSB_INTRUSB:
++			return readb(addr + SUNXI_MUSB_INTRUSB);
++		case MUSB_INTRUSBE:
++			return readb(addr + SUNXI_MUSB_INTRUSBE);
++		case MUSB_INDEX:
++			return readb(addr + SUNXI_MUSB_INDEX);
++		case MUSB_TESTMODE:
++			return 0; /* No testmode on sunxi */
++		case MUSB_DEVCTL:
++			return readb(addr + SUNXI_MUSB_DEVCTL);
++		case MUSB_TXFIFOSZ:
++			return readb(addr + SUNXI_MUSB_TXFIFOSZ);
++		case MUSB_RXFIFOSZ:
++			return readb(addr + SUNXI_MUSB_RXFIFOSZ);
++		case MUSB_CONFIGDATA + 0x10: /* See musb_read_configdata() */
++			return readb(addr + SUNXI_MUSB_CONFIGDATA);
++		/* Offset for these is fixed by sunxi_musb_busctl_offset() */
++		case SUNXI_MUSB_TXFUNCADDR:
++		case SUNXI_MUSB_TXHUBADDR:
++		case SUNXI_MUSB_TXHUBPORT:
++		case SUNXI_MUSB_RXFUNCADDR:
++		case SUNXI_MUSB_RXHUBADDR:
++		case SUNXI_MUSB_RXHUBPORT:
++			/* multipoint / busctl reg access */
++			return readb(addr + offset);
++		default:
++			dev_err(sunxi_musb->controller->parent,
++				"Error unknown readb offset %u\n", offset);
++			return 0;
++		}
++	} else if (addr == (sunxi_musb->mregs + 0x80)) {
++		/* ep control reg access */
++		/* sunxi has a 2 byte hole before the txtype register */
++		if (offset >= MUSB_TXTYPE)
++			offset += 2;
++		return readb(addr + offset);
++	}
++
++	dev_err(sunxi_musb->controller->parent,
++		"Error unknown readb at 0x%x bytes offset\n",
++		(int)(addr - sunxi_musb->mregs));
++	return 0;
++}
++
++static void sunxi_musb_writeb(void __iomem *addr, unsigned offset, u8 data)
++{
++	if (addr == sunxi_musb->mregs) {
++		/* generic control or fifo control reg access */
++		switch (offset) {
++		case MUSB_FADDR:
++			return writeb(data, addr + SUNXI_MUSB_FADDR);
++		case MUSB_POWER:
++			return writeb(data, addr + SUNXI_MUSB_POWER);
++		case MUSB_INTRUSB:
++			return writeb(data, addr + SUNXI_MUSB_INTRUSB);
++		case MUSB_INTRUSBE:
++			return writeb(data, addr + SUNXI_MUSB_INTRUSBE);
++		case MUSB_INDEX:
++			return writeb(data, addr + SUNXI_MUSB_INDEX);
++		case MUSB_TESTMODE:
++			if (data)
++				dev_warn(sunxi_musb->controller->parent,
++					"sunxi-musb does not have testmode\n");
++			return;
++		case MUSB_DEVCTL:
++			return writeb(data, addr + SUNXI_MUSB_DEVCTL);
++		case MUSB_TXFIFOSZ:
++			return writeb(data, addr + SUNXI_MUSB_TXFIFOSZ);
++		case MUSB_RXFIFOSZ:
++			return writeb(data, addr + SUNXI_MUSB_RXFIFOSZ);
++		/* Offset for these is fixed by sunxi_musb_busctl_offset() */
++		case SUNXI_MUSB_TXFUNCADDR:
++		case SUNXI_MUSB_TXHUBADDR:
++		case SUNXI_MUSB_TXHUBPORT:
++		case SUNXI_MUSB_RXFUNCADDR:
++		case SUNXI_MUSB_RXHUBADDR:
++		case SUNXI_MUSB_RXHUBPORT:
++			/* multipoint / busctl reg access */
++			return writeb(data, addr + offset);
++		default:
++			dev_err(sunxi_musb->controller->parent,
++				"Error unknown writeb offset %u\n", offset);
++			return;
++		}
++	} else if (addr == (sunxi_musb->mregs + 0x80)) {
++		/* ep control reg access */
++		if (offset >= MUSB_TXTYPE)
++			offset += 2;
++		return writeb(data, addr + offset);
++	}
++
++	dev_err(sunxi_musb->controller->parent,
++		"Error unknown writeb at 0x%x bytes offset\n",
++		(int)(addr - sunxi_musb->mregs));
++}
++
++static u16 sunxi_musb_readw(const void __iomem *addr, unsigned offset)
++{
++	if (addr == sunxi_musb->mregs) {
++		/* generic control or fifo control reg access */
++		switch (offset) {
++		case MUSB_INTRTX:
++			return readw(addr + SUNXI_MUSB_INTRTX);
++		case MUSB_INTRRX:
++			return readw(addr + SUNXI_MUSB_INTRRX);
++		case MUSB_INTRTXE:
++			return readw(addr + SUNXI_MUSB_INTRTXE);
++		case MUSB_INTRRXE:
++			return readw(addr + SUNXI_MUSB_INTRRXE);
++		case MUSB_FRAME:
++			return readw(addr + SUNXI_MUSB_FRAME);
++		case MUSB_TXFIFOADD:
++			return readw(addr + SUNXI_MUSB_TXFIFOADD);
++		case MUSB_RXFIFOADD:
++			return readw(addr + SUNXI_MUSB_RXFIFOADD);
++		case MUSB_HWVERS:
++			return 0; /* sunxi musb version is not known */
++		default:
++			dev_err(sunxi_musb->controller->parent,
++				"Error unknown readw offset %u\n", offset);
++			return 0;
++		}
++	} else if (addr == (sunxi_musb->mregs + 0x80)) {
++		/* ep control reg access */
++		return readw(addr + offset);
++	}
++
++	dev_err(sunxi_musb->controller->parent,
++		"Error unknown readw at 0x%x bytes offset\n",
++		(int)(addr - sunxi_musb->mregs));
++	return 0;
++}
++
++static void sunxi_musb_writew(void __iomem *addr, unsigned offset, u16 data)
++{
++	if (addr == sunxi_musb->mregs) {
++		/* generic control or fifo control reg access */
++		switch (offset) {
++		case MUSB_INTRTX:
++			return writew(data, addr + SUNXI_MUSB_INTRTX);
++		case MUSB_INTRRX:
++			return writew(data, addr + SUNXI_MUSB_INTRRX);
++		case MUSB_INTRTXE:
++			return writew(data, addr + SUNXI_MUSB_INTRTXE);
++		case MUSB_INTRRXE:
++			return writew(data, addr + SUNXI_MUSB_INTRRXE);
++		case MUSB_FRAME:
++			return writew(data, addr + SUNXI_MUSB_FRAME);
++		case MUSB_TXFIFOADD:
++			return writew(data, addr + SUNXI_MUSB_TXFIFOADD);
++		case MUSB_RXFIFOADD:
++			return writew(data, addr + SUNXI_MUSB_RXFIFOADD);
++		default:
++			dev_err(sunxi_musb->controller->parent,
++				"Error unknown writew offset %u\n", offset);
++			return;
++		}
++	} else if (addr == (sunxi_musb->mregs + 0x80)) {
++		/* ep control reg access */
++		return writew(data, addr + offset);
++	}
++
++	dev_err(sunxi_musb->controller->parent,
++		"Error unknown writew at 0x%x bytes offset\n",
++		(int)(addr - sunxi_musb->mregs));
++}
++
++static const struct musb_platform_ops sunxi_musb_ops = {
++	.quirks		= MUSB_INDEXED_EP,
++	.init		= sunxi_musb_init,
++	.exit		= sunxi_musb_exit,
++	.enable		= sunxi_musb_enable,
++	.disable	= sunxi_musb_disable,
++	.fifo_offset	= sunxi_musb_fifo_offset,
++	.ep_offset	= sunxi_musb_ep_offset,
++	.busctl_offset	= sunxi_musb_busctl_offset,
++	.readb		= sunxi_musb_readb,
++	.writeb		= sunxi_musb_writeb,
++	.readw		= sunxi_musb_readw,
++	.writew		= sunxi_musb_writew,
++	.set_vbus	= sunxi_musb_set_vbus,
++	.pre_root_reset_end = sunxi_musb_pre_root_reset_end,
++	.post_root_reset_end = sunxi_musb_post_root_reset_end,
++};
++
++/* Allwinner OTG supports up to 5 endpoints */
++#define SUNXI_MUSB_MAX_EP_NUM	6
++#define SUNXI_MUSB_RAM_BITS	11
++
++static struct musb_fifo_cfg sunxi_musb_mode_cfg[] = {
++	MUSB_EP_FIFO_SINGLE(1, FIFO_TX, 512),
++	MUSB_EP_FIFO_SINGLE(1, FIFO_RX, 512),
++	MUSB_EP_FIFO_SINGLE(2, FIFO_TX, 512),
++	MUSB_EP_FIFO_SINGLE(2, FIFO_RX, 512),
++	MUSB_EP_FIFO_SINGLE(3, FIFO_TX, 512),
++	MUSB_EP_FIFO_SINGLE(3, FIFO_RX, 512),
++	MUSB_EP_FIFO_SINGLE(4, FIFO_TX, 512),
++	MUSB_EP_FIFO_SINGLE(4, FIFO_RX, 512),
++	MUSB_EP_FIFO_SINGLE(5, FIFO_TX, 512),
++	MUSB_EP_FIFO_SINGLE(5, FIFO_RX, 512),
++};
++
++static struct musb_hdrc_config sunxi_musb_hdrc_config = {
++	.fifo_cfg       = sunxi_musb_mode_cfg,
++	.fifo_cfg_size  = ARRAY_SIZE(sunxi_musb_mode_cfg),
++	.multipoint	= true,
++	.dyn_fifo	= true,
++	.soft_con       = true,
++	.num_eps	= SUNXI_MUSB_MAX_EP_NUM,
++	.ram_bits	= SUNXI_MUSB_RAM_BITS,
++	.dma		= 0,
++};
++
++static int sunxi_musb_probe(struct platform_device *pdev)
++{
++	struct musb_hdrc_platform_data	pdata;
++	struct platform_device_info	pinfo;
++	struct sunxi_glue		*glue;
++	struct device_node		*np = pdev->dev.of_node;
++	int ret;
++
++	if (!np) {
++		dev_err(&pdev->dev, "Error no device tree node found\n");
++		return -EINVAL;
++	}
++
++	glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
++	if (!glue)
++		return -ENOMEM;
++
++	memset(&pdata, 0, sizeof(pdata));
++	switch (of_usb_get_dr_mode(np)) {
++#if defined CONFIG_USB_MUSB_DUAL_ROLE || defined CONFIG_USB_MUSB_HOST
++	case USB_DR_MODE_HOST:
++		pdata.mode = MUSB_PORT_MODE_HOST;
++		break;
++#endif
++#ifdef CONFIG_USB_MUSB_DUAL_ROLE
++	case USB_DR_MODE_OTG:
++		glue->extcon = extcon_get_edev_by_phandle(&pdev->dev, 0);
++		if (IS_ERR(glue->extcon)) {
++			if (PTR_ERR(glue->extcon) == -EPROBE_DEFER)
++				return -EPROBE_DEFER;
++			dev_err(&pdev->dev, "Invalid or missing extcon\n");
++			return PTR_ERR(glue->extcon);
++		}
++		pdata.mode = MUSB_PORT_MODE_DUAL_ROLE;
++		break;
++#endif
++	default:
++		dev_err(&pdev->dev, "Invalid or missing 'dr_mode' property\n");
++		return -EINVAL;
++	}
++	pdata.platform_ops	= &sunxi_musb_ops;
++	pdata.config		= &sunxi_musb_hdrc_config;
++
++	glue->dev = &pdev->dev;
++	INIT_WORK(&glue->work, sunxi_musb_work);
++	glue->host_nb.notifier_call = sunxi_musb_host_notifier;
++
++	glue->clk = devm_clk_get(&pdev->dev, NULL);
++	if (IS_ERR(glue->clk)) {
++		dev_err(&pdev->dev, "Error getting clock: %ld\n",
++			PTR_ERR(glue->clk));
++		return PTR_ERR(glue->clk);
++	}
++
++	glue->phy = devm_phy_get(&pdev->dev, "usb");
++	if (IS_ERR(glue->phy)) {
++		if (PTR_ERR(glue->phy) == -EPROBE_DEFER)
++			return -EPROBE_DEFER;
++		dev_err(&pdev->dev, "Error getting phy %ld\n",
++			PTR_ERR(glue->phy));
++		return PTR_ERR(glue->phy);
++	}
++
++	glue->usb_phy = usb_phy_generic_register();
++	if (IS_ERR(glue->usb_phy)) {
++		dev_err(&pdev->dev, "Error registering usb-phy %ld\n",
++			PTR_ERR(glue->usb_phy));
++		return PTR_ERR(glue->usb_phy);
++	}
++
++	glue->xceiv = devm_usb_get_phy(&pdev->dev, USB_PHY_TYPE_USB2);
++	if (IS_ERR(glue->xceiv)) {
++		ret = PTR_ERR(glue->xceiv);
++		dev_err(&pdev->dev, "Error getting usb-phy %d\n", ret);
++		goto err_unregister_usb_phy;
++	}
++
++	platform_set_drvdata(pdev, glue);
++
++	memset(&pinfo, 0, sizeof(pinfo));
++	pinfo.name	 = "musb-hdrc";
++	pinfo.id	= PLATFORM_DEVID_AUTO;
++	pinfo.parent	= &pdev->dev;
++	pinfo.res	= pdev->resource;
++	pinfo.num_res	= pdev->num_resources;
++	pinfo.data	= &pdata;
++	pinfo.size_data = sizeof(pdata);
++
++	glue->musb = platform_device_register_full(&pinfo);
++	if (IS_ERR(glue->musb)) {
++		ret = PTR_ERR(glue->musb);
++		dev_err(&pdev->dev, "Error registering musb dev: %d\n", ret);
++		goto err_unregister_usb_phy;
++	}
++
++	return 0;
++
++err_unregister_usb_phy:
++	usb_phy_generic_unregister(glue->usb_phy);
++	return ret;
++}
++
++static int sunxi_musb_remove(struct platform_device *pdev)
++{
++	struct sunxi_glue *glue = platform_get_drvdata(pdev);
++	struct platform_device *usb_phy = glue->usb_phy;
++
++	platform_device_unregister(glue->musb); /* Frees glue ! */
++	usb_phy_generic_unregister(usb_phy);
++
++	return 0;
++}
++
++static const struct of_device_id sunxi_musb_match[] = {
++	{ .compatible = "allwinner,sun4i-a10-musb", },
++	{}
++};
++
++static struct platform_driver sunxi_musb_driver = {
++	.probe = sunxi_musb_probe,
++	.remove = sunxi_musb_remove,
++	.driver = {
++		.name = "musb-sunxi",
++		.of_match_table = sunxi_musb_match,
++	},
++};
++module_platform_driver(sunxi_musb_driver);
++
++MODULE_DESCRIPTION("Allwinner sunxi MUSB Glue Layer");
++MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
++MODULE_LICENSE("GPL v2");