Using musb-new structure for mt85xx gadget driver.
Add gadget driver dts for mt8518 SoCs.

Signed-off-by: mingming lee <mingming....@mediatek.com>
---
 arch/arm/dts/mt8518.dtsi      |  13 ++
 drivers/usb/musb-new/Kconfig  |  11 +-
 drivers/usb/musb-new/Makefile |   1 +
 drivers/usb/musb-new/mt85xx.c | 417 ++++++++++++++++++++++++++++++++++
 4 files changed, 441 insertions(+), 1 deletion(-)
 create mode 100644 drivers/usb/musb-new/mt85xx.c

diff --git a/arch/arm/dts/mt8518.dtsi b/arch/arm/dts/mt8518.dtsi
index c2d17fda4a..56da91a9fe 100644
--- a/arch/arm/dts/mt8518.dtsi
+++ b/arch/arm/dts/mt8518.dtsi
@@ -74,6 +74,19 @@
                };
        };
 
+       usb0: usb@11100000 {
+               compatible = "mediatek,mt8518-musb";
+               reg = <0x11100000 0x1000>;
+               reg-names = "control";
+               clocks = <&topckgen CLK_TOP_USB20_48M>,
+                        <&topckgen CLK_TOP_USBIF>,
+                        <&topckgen CLK_TOP_USB>;
+               clock-names = "usbpll", "usbmcu", "usb";
+               interrupts = <GIC_SPI 72 IRQ_TYPE_LEVEL_LOW>;
+               interrupt-names = "mc";
+               status = "okay";
+       };
+
        mmc0: mmc@11120000 {
                compatible = "mediatek,mt8516-mmc";
                reg = <0x11120000 0x1000>;
diff --git a/drivers/usb/musb-new/Kconfig b/drivers/usb/musb-new/Kconfig
index 79ad14ef66..6cf8a2b60b 100644
--- a/drivers/usb/musb-new/Kconfig
+++ b/drivers/usb/musb-new/Kconfig
@@ -47,6 +47,15 @@ config USB_MUSB_DSPS
        bool "TI DSPS platforms"
 
 if USB_MUSB_HOST || USB_MUSB_GADGET
+config USB_MUSB_MT85XX
+       bool "Enable Mediatek MT85XX DRC USB controller"
+       depends on DM_USB && ARCH_MEDIATEK
+       default n
+       help
+         Say y to enable Mediatek MT85XX USB DRC controller support
+         if it is available on your Mediatek MUSB IP based platform.
+         DMA controllers are ignored. This driver follow musb-new
+         driver and usb gadget framework.
 
 config USB_MUSB_PIC32
        bool "Enable Microchip PIC32 DRC USB controller"
@@ -76,7 +85,7 @@ endif
 
 config USB_MUSB_PIO_ONLY
        bool "Disable DMA (always use PIO)"
-       default y if USB_MUSB_AM35X || USB_MUSB_PIC32 || USB_MUSB_OMAP2PLUS || 
USB_MUSB_DSPS || USB_MUSB_SUNXI
+       default y if USB_MUSB_AM35X || USB_MUSB_PIC32 || USB_MUSB_OMAP2PLUS || 
USB_MUSB_DSPS || USB_MUSB_SUNXI || USB_MUSB_MT85XX
        help
          All data is copied between memory and FIFO by the CPU.
          DMA controllers are ignored.
diff --git a/drivers/usb/musb-new/Makefile b/drivers/usb/musb-new/Makefile
index ec7852ce94..6355eb12dd 100644
--- a/drivers/usb/musb-new/Makefile
+++ b/drivers/usb/musb-new/Makefile
@@ -8,6 +8,7 @@ obj-$(CONFIG_USB_MUSB_HOST) += musb_host.o musb_core.o 
musb_uboot.o
 obj-$(CONFIG_USB_MUSB_DSPS) += musb_dsps.o
 obj-$(CONFIG_USB_MUSB_DA8XX)   += da8xx.o
 obj-$(CONFIG_USB_MUSB_AM35X) += am35x.o
+obj-$(CONFIG_USB_MUSB_MT85XX) += mt85xx.o
 obj-$(CONFIG_USB_MUSB_OMAP2PLUS) += omap2430.o
 obj-$(CONFIG_USB_MUSB_PIC32) += pic32.o
 obj-$(CONFIG_USB_MUSB_SUNXI) += sunxi.o
diff --git a/drivers/usb/musb-new/mt85xx.c b/drivers/usb/musb-new/mt85xx.c
new file mode 100644
index 0000000000..131fd7dd79
--- /dev/null
+++ b/drivers/usb/musb-new/mt85xx.c
@@ -0,0 +1,417 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Mediatek "glue layer"
+ *
+ * Copyright (C) 2019-2021 by Mediatek
+ * Based on the AllWinner SUNXI "glue layer" code.
+ * Copyright (C) 2015 Hans de Goede <hdego...@redhat.com>
+ * Copyright (C) 2013 Jussi Kivilinna <jussi.kivili...@iki.fi>
+ *
+ * This file is part of the Inventra Controller Driver for Linux.
+ */
+#include <common.h>
+#include <clk.h>
+#include <dm.h>
+#include <dm/lists.h>
+#include <dm/root.h>
+#include <linux/usb/musb.h>
+#include <usb.h>
+#include "linux-compat.h"
+#include "musb_core.h"
+#include "musb_uboot.h"
+
+#define DBG_I(fmt, ...) \
+       pr_info(fmt, ##__VA_ARGS__)
+
+struct mtk_musb_config {
+       struct musb_hdrc_config *config;
+};
+
+struct mtk_musb_glue {
+       struct musb_host_data mdata;
+       struct clk usbpllclk;
+       struct clk usbmcuclk;
+       struct clk usbclk;
+       struct mtk_musb_config *cfg;
+       struct device dev;
+};
+
+#define to_mtk_musb_glue(d)    container_of(d, struct mtk_musb_glue, dev)
+
+/******************************************************************************
+ * phy settings
+ 
******************************************************************************/
+#define USB20_PHY_BASE                 0x11110800
+#define USBPHY_READ8(offset)    \
+       readb((void *)(USB20_PHY_BASE + (offset)))
+#define USBPHY_WRITE8(offset, value)   \
+       writeb(value, (void *)(USB20_PHY_BASE + (offset)))
+#define USBPHY_SET8(offset, mask)      \
+       USBPHY_WRITE8(offset, (USBPHY_READ8(offset)) | (mask))
+#define USBPHY_CLR8(offset, mask)      \
+       USBPHY_WRITE8(offset, (USBPHY_READ8(offset)) & (~(mask)))
+
+static void mt_usb_phy_poweron(void)
+{
+       /*
+        * switch to USB function.
+        * (system register, force ip into usb mode).
+        */
+       USBPHY_CLR8(0x6b, 0x04);
+       USBPHY_CLR8(0x6e, 0x01);
+       USBPHY_CLR8(0x21, 0x03);
+
+       /* RG_USB20_BC11_SW_EN = 1'b0 */
+       USBPHY_SET8(0x22, 0x04);
+       USBPHY_CLR8(0x1a, 0x80);
+
+       /* RG_USB20_DP_100K_EN = 1'b0 */
+       /* RG_USB20_DP_100K_EN = 1'b0 */
+       USBPHY_CLR8(0x22, 0x03);
+
+       /*OTG enable*/
+       USBPHY_SET8(0x20, 0x10);
+       /* release force suspendm */
+       USBPHY_CLR8(0x6a, 0x04);
+
+       mdelay(800);
+
+       /* force enter device mode */
+       USBPHY_CLR8(0x6c, 0x10);
+       USBPHY_SET8(0x6c, 0x2E);
+       USBPHY_SET8(0x6d, 0x3E);
+}
+
+static void mt_usb_phy_savecurrent(void)
+{
+       /*
+        * switch to USB function.
+        * (system register, force ip into usb mode).
+        */
+       USBPHY_CLR8(0x6b, 0x04);
+       USBPHY_CLR8(0x6e, 0x01);
+       USBPHY_CLR8(0x21, 0x03);
+
+       /* release force suspendm */
+       USBPHY_CLR8(0x6a, 0x04);
+       USBPHY_SET8(0x68, 0x04);
+       /* RG_DPPULLDOWN./RG_DMPULLDOWN. */
+       USBPHY_SET8(0x68, 0xc0);
+       /* RG_XCVRSEL[1:0] = 2'b01 */
+       USBPHY_CLR8(0x68, 0x30);
+       USBPHY_SET8(0x68, 0x10);
+       /* RG_TERMSEL = 1'b1 */
+       USBPHY_SET8(0x68, 0x04);
+       /* RG_DATAIN[3:0] = 4'b0000 */
+       USBPHY_CLR8(0x69, 0x3c);
+
+       /*
+        * force_dp_pulldown, force_dm_pulldown,
+        * force_xcversel, force_termsel.
+        */
+       USBPHY_SET8(0x6a, 0xba);
+
+       /* RG_USB20_BC11_SW_EN = 1'b0 */
+       USBPHY_CLR8(0x1a, 0x80);
+       /* RG_USB20_OTG_VBUSSCMP_EN = 1'b0 */
+       USBPHY_CLR8(0x1a, 0x10);
+
+       mdelay(800);
+
+       USBPHY_CLR8(0x6a, 0x04);
+       /* rg_usb20_pll_stable = 1 */
+       //USBPHY_SET8(0x63, 0x02);
+
+       mdelay(1);
+
+       /* force suspendm = 1 */
+       //USBPHY_SET8(0x6a, 0x04);
+}
+
+static void mt_usb_phy_recover(void)
+{
+       /* clean PUPD_BIST_EN */
+       /* PUPD_BIST_EN = 1'b0 */
+       /* PMIC will use it to detect charger type */
+       USBPHY_CLR8(0x1d, 0x10);
+
+       /* force_uart_en = 1'b0 */
+       USBPHY_CLR8(0x6b, 0x04);
+       /* RG_UART_EN = 1'b0 */
+       USBPHY_CLR8(0x6e, 0x01);
+       /* force_uart_en = 1'b0 */
+       USBPHY_CLR8(0x6a, 0x04);
+
+       USBPHY_CLR8(0x21, 0x03);
+       USBPHY_CLR8(0x68, 0xf4);
+
+       /* RG_DATAIN[3:0] = 4'b0000 */
+       USBPHY_CLR8(0x69, 0x3c);
+
+       USBPHY_CLR8(0x6a, 0xba);
+
+       /* RG_USB20_BC11_SW_EN = 1'b0 */
+       USBPHY_CLR8(0x1a, 0x80);
+       /* RG_USB20_OTG_VBUSSCMP_EN = 1'b1 */
+       USBPHY_SET8(0x1a, 0x10);
+
+       //HQA adjustment
+       USBPHY_CLR8(0x18, 0x08);
+       USBPHY_SET8(0x18, 0x06);
+       mdelay(800);
+
+       /* force enter device mode */
+       //USBPHY_CLR8(0x6c, 0x10);
+       //USBPHY_SET8(0x6c, 0x2E);
+       //USBPHY_SET8(0x6d, 0x3E);
+
+       /* enable VRT internal R architecture */
+       /* RG_USB20_INTR_EN = 1'b1 */
+       USBPHY_SET8(0x00, 0x20);
+}
+
+/******************************************************************************
+ * MUSB Glue code
+ 
******************************************************************************/
+
+static irqreturn_t mtk_musb_interrupt(int irq, void *__hci)
+{
+       struct musb             *musb = __hci;
+       irqreturn_t             retval = IRQ_NONE;
+
+       /* read and flush interrupts */
+       musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
+//     last_int_usb = musb->int_usb;
+       if (musb->int_usb)
+               musb_writeb(musb->mregs, MUSB_INTRUSB, musb->int_usb);
+       musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
+       if (musb->int_tx)
+               musb_writew(musb->mregs, MUSB_INTRTX, musb->int_tx);
+       musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);
+       if (musb->int_rx)
+               musb_writew(musb->mregs, MUSB_INTRRX, musb->int_rx);
+
+       if (musb->int_usb || musb->int_tx || musb->int_rx)
+               retval |= musb_interrupt(musb);
+
+       return retval;
+}
+
+/* musb_core does not call enable / disable in a balanced manner <sigh> */
+static bool enabled;
+
+static int mtk_musb_enable(struct musb *musb)
+{
+       struct mtk_musb_glue *glue = to_mtk_musb_glue(musb->controller);
+
+       DBG_I("%s():\n", __func__);
+
+       musb_ep_select(musb->mregs, 0);
+       musb_writeb(musb->mregs, MUSB_FADDR, 0);
+
+       if (enabled)
+               return 0;
+
+       mt_usb_phy_recover();
+
+       enabled = true;
+
+       return 0;
+}
+
+static void mtk_musb_disable(struct musb *musb)
+{
+       struct mtk_musb_glue *glue = to_mtk_musb_glue(musb->controller);
+       int ret;
+
+       DBG_I("%s():\n", __func__);
+
+       if (!enabled)
+               return;
+
+       mt_usb_phy_savecurrent();
+
+       enabled = false;
+}
+
+static int mtk_musb_init(struct musb *musb)
+{
+       struct mtk_musb_glue *glue = to_mtk_musb_glue(musb->controller);
+       int ret;
+
+       DBG_I("%s():\n", __func__);
+
+       ret = clk_enable(&glue->usbpllclk);
+       if (ret) {
+               dev_err(dev, "failed to enable usbpll clock\n");
+               return ret;
+       }
+       ret = clk_enable(&glue->usbmcuclk);
+       if (ret) {
+               dev_err(dev, "failed to enable usbmcu clock\n");
+               return ret;
+       }
+       ret = clk_enable(&glue->usbclk);
+       if (ret) {
+               dev_err(dev, "failed to enable usb clock\n");
+               return ret;
+       }
+
+       musb->isr = mtk_musb_interrupt;
+
+       return 0;
+}
+
+static int mtk_musb_exit(struct musb *musb)
+{
+       struct mtk_musb_glue *glue = to_mtk_musb_glue(musb->controller);
+
+       clk_disable(&glue->usbclk);
+       clk_disable(&glue->usbmcuclk);
+       clk_disable(&glue->usbpllclk);
+
+       return 0;
+}
+
+static const struct musb_platform_ops mtk_musb_ops = {
+       .init           = mtk_musb_init,
+       .exit           = mtk_musb_exit,
+       .enable         = mtk_musb_enable,
+       .disable        = mtk_musb_disable,
+};
+
+/* MTK OTG supports up to 7 endpoints */
+#define MTK_MUSB_MAX_EP_NUM            8
+#define MTK_MUSB_RAM_BITS              16
+
+static struct musb_fifo_cfg mtk_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),
+       MUSB_EP_FIFO_SINGLE(6, FIFO_TX, 512),
+       MUSB_EP_FIFO_SINGLE(6, FIFO_RX, 512),
+       MUSB_EP_FIFO_SINGLE(7, FIFO_TX, 512),
+       MUSB_EP_FIFO_SINGLE(7, FIFO_RX, 512),
+};
+
+static struct musb_hdrc_config musb_config = {
+       .fifo_cfg       = mtk_musb_mode_cfg,
+       .fifo_cfg_size  = ARRAY_SIZE(mtk_musb_mode_cfg),
+       .multipoint     = true,
+       .dyn_fifo       = true,
+       .num_eps        = MTK_MUSB_MAX_EP_NUM,
+       .ram_bits       = MTK_MUSB_RAM_BITS,
+};
+
+static int musb_usb_probe(struct udevice *dev)
+{
+       struct mtk_musb_glue *glue = dev_get_priv(dev);
+       struct musb_host_data *host = &glue->mdata;
+       struct musb_hdrc_platform_data pdata;
+       void *base = dev_read_addr_ptr(dev);
+       int ret;
+
+       DBG_I("%s():\n", __func__);
+
+#ifdef CONFIG_USB_MUSB_HOST
+       struct usb_bus_priv *priv = dev_get_uclass_priv(dev);
+#endif
+
+       if (!base)
+               return -EINVAL;
+
+       glue->cfg = (struct mtk_musb_config *)dev_get_driver_data(dev);
+       if (!glue->cfg)
+               return -EINVAL;
+
+       ret = clk_get_by_name(dev, "usbpll", &glue->usbpllclk);
+       if (ret) {
+               dev_err(dev, "failed to get usbpll clock\n");
+               return ret;
+       }
+       ret = clk_get_by_name(dev, "usbmcu", &glue->usbmcuclk);
+       if (ret) {
+               dev_err(dev, "failed to get usbmcu clock\n");
+               return ret;
+       }
+       ret = clk_get_by_name(dev, "usb", &glue->usbclk);
+       if (ret) {
+               dev_err(dev, "failed to get usb clock\n");
+               return ret;
+       }
+
+       memset(&pdata, 0, sizeof(pdata));
+       pdata.power = (u8)400;
+       pdata.platform_ops = &mtk_musb_ops;
+       pdata.config = glue->cfg->config;
+
+#ifdef CONFIG_USB_MUSB_HOST
+       priv->desc_before_addr = true;
+
+       pdata.mode = MUSB_HOST;
+       host->host = musb_init_controller(&pdata, &glue->dev, base);
+       if (!host->host)
+               return -EIO;
+
+       ret = musb_lowlevel_init(host);
+       if (!ret)
+               printf("MTK MUSB OTG (Host)\n");
+#else
+       pdata.mode = MUSB_PERIPHERAL;
+       host->host = musb_register(&pdata, &glue->dev, base);
+       if (!host->host)
+               return -EIO;
+
+       printf("MTK MUSB OTG (Peripheral)\n");
+#endif
+
+       mt_usb_phy_poweron();
+
+       return ret;
+}
+
+static int musb_usb_remove(struct udevice *dev)
+{
+       struct mtk_musb_glue *glue = dev_get_priv(dev);
+       struct musb_host_data *host = &glue->mdata;
+
+       musb_stop(host->host);
+       free(host->host);
+       host->host = NULL;
+
+       return 0;
+}
+
+static const struct mtk_musb_config mt8518_cfg = {
+       .config = &musb_config,
+};
+
+static const struct udevice_id mtk_musb_ids[] = {
+       { .compatible = "mediatek,mt8518-musb",
+         .data = (ulong)&mt8518_cfg },
+       { }
+};
+
+U_BOOT_DRIVER(mtk_musb) = {
+       .name           = "mtk_musb",
+#ifdef CONFIG_USB_MUSB_HOST
+       .id             = UCLASS_USB,
+#else
+       .id             = UCLASS_USB_GADGET_GENERIC,
+#endif
+       .of_match       = mtk_musb_ids,
+       .probe          = musb_usb_probe,
+       .remove         = musb_usb_remove,
+#ifdef CONFIG_USB_MUSB_HOST
+       .ops            = &musb_usb_ops,
+#endif
+       .platdata_auto_alloc_size = sizeof(struct usb_platdata),
+       .priv_auto_alloc_size = sizeof(struct mtk_musb_glue),
+};
-- 
2.24.1

Reply via email to