--- /dev/null
+/*
+ * Broadcom Northstar USB 3.0 PHY Driver
+ *
+ * Copyright (C) 2016 Rafał Miłecki <rafal@milecki.pl>
+ *
+ * All magic values used for initialization (and related comments) were obtained
+ * from Broadcom's SDK:
+ * Copyright (c) Broadcom Corp, 2012
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/bcma/bcma.h>
+#include <linux/delay.h>
+#include <linux/err.h>
+#include <linux/module.h>
+#include <linux/of_platform.h>
+#include <linux/platform_device.h>
+#include <linux/phy/phy.h>
+#include <linux/slab.h>
+
+#define BCM_NS_USB3_MII_MNG_TIMEOUT_US 1000    /* usecs */
+
+enum bcm_ns_family {
+       BCM_NS_UNKNOWN,
+       BCM_NS_AX,
+       BCM_NS_BX,
+};
+
+struct bcm_ns_usb3 {
+       struct device *dev;
+       enum bcm_ns_family family;
+       void __iomem *dmp;
+       void __iomem *ccb_mii;
+       struct phy *phy;
+};
+
+static const struct of_device_id bcm_ns_usb3_id_table[] = {
+       {
+               .compatible = "brcm,ns-ax-usb3-phy",
+               .data = (int *)BCM_NS_AX,
+       },
+       {
+               .compatible = "brcm,ns-bx-usb3-phy",
+               .data = (int *)BCM_NS_BX,
+       },
+       {},
+};
+MODULE_DEVICE_TABLE(of, bcm_ns_usb3_id_table);
+
+static int bcm_ns_usb3_wait_reg(struct bcm_ns_usb3 *usb3, void __iomem *addr,
+                               u32 mask, u32 value, unsigned long timeout)
+{
+       unsigned long deadline = jiffies + timeout;
+       u32 val;
+
+       do {
+               val = readl(addr);
+               if ((val & mask) == value)
+                       return 0;
+               cpu_relax();
+               udelay(10);
+       } while (!time_after_eq(jiffies, deadline));
+
+       dev_err(usb3->dev, "Timeout waiting for register %p\n", addr);
+
+       return -EBUSY;
+}
+
+static inline int bcm_ns_usb3_mii_mng_wait_idle(struct bcm_ns_usb3 *usb3)
+{
+       return bcm_ns_usb3_wait_reg(usb3, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL,
+                                   0x0100, 0x0000,
+                                   usecs_to_jiffies(BCM_NS_USB3_MII_MNG_TIMEOUT_US));
+}
+
+static int bcm_ns_usb3_mii_mng_write32(struct bcm_ns_usb3 *usb3, u32 value)
+{
+       int err;
+
+       err = bcm_ns_usb3_mii_mng_wait_idle(usb3);
+       if (err < 0) {
+               dev_err(usb3->dev, "Couldn't write 0x%08x value\n", value);
+               return err;
+       }
+
+       writel(value, usb3->ccb_mii + BCMA_CCB_MII_MNG_CMD_DATA);
+
+       return 0;
+}
+
+static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)
+{
+       int err;
+
+       /* Enable MDIO. Setting MDCDIV as 26  */
+       writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);
+
+       /* Wait for MDIO? */
+       udelay(2);
+
+       /* USB3 PLL Block */
+       err = bcm_ns_usb3_mii_mng_write32(usb3, 0x587e8000);
+       if (err < 0)
+               return err;
+
+       /* Assert Ana_Pllseq start */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x58061000);
+
+       /* Assert CML Divider ratio to 26 */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x582a6400);
+
+       /* Asserting PLL Reset */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x582ec000);
+
+       /* Deaaserting PLL Reset */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x582e8000);
+
+       /* Waiting MII Mgt interface idle */
+       bcm_ns_usb3_mii_mng_wait_idle(usb3);
+
+       /* Deasserting USB3 system reset */
+       writel(0, usb3->dmp + BCMA_RESET_CTL);
+
+       /* PLL frequency monitor enable */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x58069000);
+
+       /* PIPE Block */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x587e8060);
+
+       /* CMPMAX & CMPMINTH setting */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x580af30d);
+
+       /* DEGLITCH MIN & MAX setting */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x580e6302);
+
+       /* TXPMD block */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x587e8040);
+
+       /* Enabling SSC */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x58061003);
+
+       /* Waiting MII Mgt interface idle */
+       bcm_ns_usb3_mii_mng_wait_idle(usb3);
+
+       return 0;
+}
+
+static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)
+{
+       int err;
+
+       /* Enable MDIO. Setting MDCDIV as 26  */
+       writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);
+
+       /* Wait for MDIO? */
+       udelay(2);
+
+       /* PLL30 block */
+       err = bcm_ns_usb3_mii_mng_write32(usb3, 0x587e8000);
+       if (err < 0)
+               return err;
+
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x582a6400);
+
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x587e80e0);
+
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x580a009c);
+
+       /* Enable SSC */
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x587e8040);
+
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x580a21d3);
+
+       bcm_ns_usb3_mii_mng_write32(usb3, 0x58061003);
+
+       /* Waiting MII Mgt interface idle */
+       bcm_ns_usb3_mii_mng_wait_idle(usb3);
+
+       /* Deasserting USB3 system reset */
+       writel(0, usb3->dmp + BCMA_RESET_CTL);
+
+       return 0;
+}
+
+static int bcm_ns_usb3_phy_init(struct phy *phy)
+{
+       struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);
+       int err;
+
+       /* Perform USB3 system soft reset */
+       writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);
+
+       switch (usb3->family) {
+       case BCM_NS_AX:
+               err = bcm_ns_usb3_phy_init_ns_ax(usb3);
+               break;
+       case BCM_NS_BX:
+               err = bcm_ns_usb3_phy_init_ns_bx(usb3);
+               break;
+       default:
+               WARN_ON(1);
+               err = -ENOTSUPP;
+       }
+
+       return err;
+}
+
+static const struct phy_ops ops = {
+       .init           = bcm_ns_usb3_phy_init,
+       .owner          = THIS_MODULE,
+};
+
+static int bcm_ns_usb3_probe(struct platform_device *pdev)
+{
+       struct device *dev = &pdev->dev;
+       const struct of_device_id *of_id;
+       struct bcm_ns_usb3 *usb3;
+       struct resource *res;
+       struct phy_provider *phy_provider;
+
+       usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
+       if (!usb3)
+               return -ENOMEM;
+
+       usb3->dev = dev;
+
+       of_id = of_match_device(bcm_ns_usb3_id_table, dev);
+       if (!of_id)
+               return -EINVAL;
+       usb3->family = (enum bcm_ns_family)of_id->data;
+
+       res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dmp");
+       usb3->dmp = devm_ioremap_resource(dev, res);
+       if (IS_ERR(usb3->dmp)) {
+               dev_err(dev, "Failed to map DMP regs\n");
+               return PTR_ERR(usb3->dmp);
+       }
+
+       res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ccb-mii");
+       usb3->ccb_mii = devm_ioremap_resource(dev, res);
+       if (IS_ERR(usb3->ccb_mii)) {
+               dev_err(dev, "Failed to map ChipCommon B MII regs\n");
+               return PTR_ERR(usb3->ccb_mii);
+       }
+
+       usb3->phy = devm_phy_create(dev, NULL, &ops);
+       if (IS_ERR(usb3->phy)) {
+               dev_err(dev, "Failed to create PHY\n");
+               return PTR_ERR(usb3->phy);
+       }
+
+       phy_set_drvdata(usb3->phy, usb3);
+       platform_set_drvdata(pdev, usb3);
+
+       phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
+       if (!IS_ERR(phy_provider))
+               dev_info(dev, "Registered Broadcom Northstar USB 3.0 PHY driver\n");
+
+       return PTR_ERR_OR_ZERO(phy_provider);
+}
+
+static struct platform_driver bcm_ns_usb3_driver = {
+       .probe          = bcm_ns_usb3_probe,
+       .driver = {
+               .name = "bcm_ns_usb3",
+               .of_match_table = bcm_ns_usb3_id_table,
+       },
+};
+module_platform_driver(bcm_ns_usb3_driver);
+
+MODULE_LICENSE("GPL v2");