[RESEND PATCH V2 2/2] usb: phy: phy-brcm-usb: Add Broadcom STB USB phy driver

From: Al Cooper
Date: Wed Jun 08 2016 - 19:45:29 EST


Add a new USB Phy driver for Broadcom STB SoCs. This driver
supports all Broadcom STB ARM SoCs. This driver in combination
with the generic ohci, ehci and xhci platform drivers will enable
USB1.1, USB2.0 and USB3.0 support. This Phy driver also supports
the Broadcom UDC gadget driver.

Signed-off-by: Al Cooper <alcooperx@xxxxxxxxx>
---
.../bindings/phy/brcm,brcmstb-usb-phy.txt | 39 +
MAINTAINERS | 7 +
drivers/phy/Kconfig | 10 +
drivers/phy/Makefile | 2 +
drivers/phy/phy-brcm-usb-init.c | 792 +++++++++++++++++++++
drivers/phy/phy-brcm-usb-init.h | 49 ++
drivers/phy/phy-brcm-usb.c | 206 ++++++
7 files changed, 1105 insertions(+)
create mode 100644 Documentation/devicetree/bindings/phy/brcm,brcmstb-usb-phy.txt
create mode 100644 drivers/phy/phy-brcm-usb-init.c
create mode 100644 drivers/phy/phy-brcm-usb-init.h
create mode 100644 drivers/phy/phy-brcm-usb.c

diff --git a/Documentation/devicetree/bindings/phy/brcm,brcmstb-usb-phy.txt b/Documentation/devicetree/bindings/phy/brcm,brcmstb-usb-phy.txt
new file mode 100644
index 0000000..34fa9dd
--- /dev/null
+++ b/Documentation/devicetree/bindings/phy/brcm,brcmstb-usb-phy.txt
@@ -0,0 +1,39 @@
+Broadcom STB USB PHY
+
+Required properties:
+ - compatible: brcm,brcmstb-usb-phy
+ - reg: two offset and length pairs. The second pair specifies the
+ USB 3.0 related registers and is only required for PHYs
+ that support USB 3.0
+ - #phy-cells: Shall be 1 as it expects one argument for setting
+ the type of the PHY. Possible values are 0 (1.1 and 2.0),
+ 1 (3.0)
+
+
+Optional Properties:
+- clocks : phandle + clock specifier for the phy clocks
+- clock-names: string, clock name
+- ipp: Invert Port Power
+- ioc: Invert Over Current detection
+- has_xhci: Contains an optional 3.0 PHY
+- device: PHY Device mode. Possible values are: 0 (Host), 1 (Device)
+ or 2 (DRD)
+
+
+
+Example:
+
+usbphy_0: usb-phy@f0470200 {
+ reg = <0xf0470200 0xb8>,
+ <0xf0471940 0x6c0>;
+ #address-cells = <1>;
+ #size-cells = <1>;
+ compatible = "brcm,brcmstb-usb-phy";
+ ioc = <1>;
+ ipp = <1>;
+ #phy-cells = <1>;
+ ranges;
+ has_xhci;
+ clocks = <&sw_usb20>;
+ clock-names = "sw_usb";
+};
diff --git a/MAINTAINERS b/MAINTAINERS
index ed1229e..4d529e7 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -2631,6 +2631,13 @@ S: Maintained
F: drivers/bcma/
F: include/linux/bcma/

+BROADCOM STB USB PHY DRIVER
+M: Al Cooper <alcooperx@xxxxxxxxx>
+L: linux-usb@xxxxxxxxxxxxxxx
+L: bcm-kernel-feedback-list@xxxxxxxxxxxx
+S: Supported
+F: drivers/phy/phy-brcm-usb*
+
BROADCOM SYSTEMPORT ETHERNET DRIVER
M: Florian Fainelli <f.fainelli@xxxxxxxxx>
L: netdev@xxxxxxxxxxxxxxx
diff --git a/drivers/phy/Kconfig b/drivers/phy/Kconfig
index b869b98..61a0244 100644
--- a/drivers/phy/Kconfig
+++ b/drivers/phy/Kconfig
@@ -432,6 +432,16 @@ config PHY_CYGNUS_PCIE
Enable this to support the Broadcom Cygnus PCIe PHY.
If unsure, say N.

+config BRCM_USB_PHY
+ tristate "Broadcom USB PHY driver"
+ depends on OF && USB && ARCH_BRCMSTB
+ select GENERIC_PHY
+ default y
+ help
+ Enable this to support the Broadcom USB PHY on
+ Broadcom STB SoCs.
+ If unsure, say Y.
+
source "drivers/phy/tegra/Kconfig"

endmenu
diff --git a/drivers/phy/Makefile b/drivers/phy/Makefile
index 9c3e73c..babb0c7 100644
--- a/drivers/phy/Makefile
+++ b/drivers/phy/Makefile
@@ -9,6 +9,8 @@ obj-$(CONFIG_PHY_BERLIN_SATA) += phy-berlin-sata.o
obj-$(CONFIG_PHY_DM816X_USB) += phy-dm816x-usb.o
obj-$(CONFIG_ARMADA375_USBCLUSTER_PHY) += phy-armada375-usb2.o
obj-$(CONFIG_BCM_KONA_USB2_PHY) += phy-bcm-kona-usb2.o
+obj-$(CONFIG_BRCM_USB_PHY) += phy-brcm-usb.o
+obj-$(CONFIG_BRCM_USB_PHY) += phy-brcm-usb-init.o
obj-$(CONFIG_PHY_EXYNOS_DP_VIDEO) += phy-exynos-dp-video.o
obj-$(CONFIG_PHY_EXYNOS_MIPI_VIDEO) += phy-exynos-mipi-video.o
obj-$(CONFIG_PHY_LPC18XX_USB_OTG) += phy-lpc18xx-usb-otg.o
diff --git a/drivers/phy/phy-brcm-usb-init.c b/drivers/phy/phy-brcm-usb-init.c
new file mode 100644
index 0000000..f5d8c32
--- /dev/null
+++ b/drivers/phy/phy-brcm-usb-init.c
@@ -0,0 +1,792 @@
+/*
+ * Copyright (C) 2014-2016 Broadcom
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of the project nor the names of its contributors
+ * may be used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+/*
+ * This module is used by both the bootloader and Linux and
+ * contains USB initialization for power up and S3 resume.
+ */
+
+#include <linux/delay.h>
+#include <linux/io.h>
+
+#include <linux/soc/brcmstb/brcmstb.h>
+#include "phy-brcm-usb-init.h"
+
+/* Register definitions for the USB CTRL block */
+#define USB_CTRL_SETUP 0x00
+#define USB_CTRL_SETUP_IOC_MASK 0x00000010
+#define USB_CTRL_SETUP_IPP_MASK 0x00000020
+#define USB_CTRL_SETUP_BABO_MASK 0x00000001
+#define USB_CTRL_SETUP_FNHW_MASK 0x00000002
+#define USB_CTRL_SETUP_FNBO_MASK 0x00000004
+#define USB_CTRL_SETUP_WABO_MASK 0x00000008
+#define USB_CTRL_SETUP_scb1_en_MASK 0x00004000 /* option */
+#define USB_CTRL_SETUP_scb2_en_MASK 0x00008000 /* option */
+#define USB_CTRL_SETUP_ss_ehci64bit_en_MASK 0x00020000 /* option */
+#define USB_CTRL_SETUP_ss_ehci64bit_en_var_MASK 0x00010000 /* option */
+#define USB_CTRL_SETUP_strap_ipp_sel_MASK 0x02000000 /* option */
+#define USB_CTRL_SETUP_OC3_DISABLE_MASK 0xc0000000 /* option */
+#define USB_CTRL_PLL_CTL 0x04
+#define USB_CTRL_PLL_CTL_PLL_SUSPEND_EN_MASK 0x08000000
+#define USB_CTRL_PLL_CTL_PLL_RESETB_MASK 0x40000000
+#define USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK 0x80000000 /* option */
+#define USB_CTRL_EBRIDGE 0x0c
+#define USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK 0x00020000 /* option */
+#define USB_CTRL_MDIO 0x14
+#define USB_CTRL_MDIO2 0x18
+#define USB_CTRL_UTMI_CTL_1 0x2c
+#define USB_CTRL_UTMI_CTL_1_POWER_UP_FSM_EN_MASK 0x00000800
+#define USB_CTRL_UTMI_CTL_1_POWER_UP_FSM_EN_P1_MASK 0x08000000
+#define USB_CTRL_USB_PM 0x34
+#define USB_CTRL_USB_PM_bdc_soft_resetb_MASK 0x00800000 /* option */
+#define USB_CTRL_USB_PM_xhc_soft_resetb_MASK 0x00400000 /* option */
+#define USB_CTRL_USB_PM_xhc_soft_resetb_var_MASK 0x40000000 /* option */
+#define USB_CTRL_USB_PM_USB_PWRDN_MASK 0x80000000 /* option */
+#define USB_CTRL_USB30_CTL1 0x60
+#define USB_CTRL_USB30_CTL1_phy3_pll_seq_start_MASK 0x00000010
+#define USB_CTRL_USB30_CTL1_phy3_resetb_MASK 0x00010000
+#define USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK 0x00020000 /* option */
+#define USB_CTRL_USB30_CTL1_usb3_ioc_MASK 0x10000000 /* option */
+#define USB_CTRL_USB30_CTL1_usb3_ipp_MASK 0x20000000 /* option */
+#define USB_CTRL_USB30_PCTL 0x70
+#define USB_CTRL_USB30_PCTL_PHY3_SOFT_RESETB_MASK 0x00000002
+#define USB_CTRL_USB30_PCTL_PHY3_SOFT_RESETB_P1_MASK 0x00020000
+#define USB_CTRL_USB_DEVICE_CTL1 0x90
+#define USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK 0x00000003 /* option */
+
+/* Register definitions for the XHCI EC block */
+#define USB_XHCI_EC_IRAADR 0x658
+#define USB_XHCI_EC_IRADAT 0x65c
+
+enum brcm_family_type {
+ BRCM_FAMILY_DEFAULT,
+ BRCM_FAMILY_3390A0,
+ BRCM_FAMILY_7250B0,
+ BRCM_FAMILY_7271A0,
+ BRCM_FAMILY_7364A0,
+ BRCM_FAMILY_7366C0,
+ BRCM_FAMILY_74371A0,
+ BRCM_FAMILY_7439B0,
+ BRCM_FAMILY_7445D0,
+ BRCM_FAMILY_COUNT,
+};
+
+enum {
+ USB_CTRL_SETUP_scb1_en_SELECTOR,
+ USB_CTRL_SETUP_scb2_en_SELECTOR,
+ USB_CTRL_SETUP_ss_ehci64bit_en_SELECTOR,
+ USB_CTRL_SETUP_strap_ipp_sel_SELECTOR,
+ USB_CTRL_SETUP_OC3_DISABLE_SELECTOR,
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_SELECTOR,
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_SELECTOR,
+ USB_CTRL_USB_PM_bdc_soft_resetb_SELECTOR,
+ USB_CTRL_USB_PM_xhc_soft_resetb_SELECTOR,
+ USB_CTRL_USB_PM_USB_PWRDN_SELECTOR,
+ USB_CTRL_USB30_CTL1_xhc_soft_resetb_SELECTOR,
+ USB_CTRL_USB30_CTL1_usb3_ioc_SELECTOR,
+ USB_CTRL_USB30_CTL1_usb3_ipp_SELECTOR,
+ USB_CTRL_USB_DEVICE_CTL1_port_mode_SELECTOR,
+ USB_CTRL_SELECTOR_COUNT,
+};
+
+#define USB_CTRL_REG(base, reg) ((void *)base + USB_CTRL_##reg)
+#define USB_XHCI_EC_REG(base, reg) ((void *)base + USB_XHCI_EC_##reg)
+#define USB_CTRL_MASK(reg, field) \
+ USB_CTRL_##reg##_##field##_MASK
+#define USB_CTRL_MASK_FAMILY(reg, field) \
+ (usb_reg_bits_map[USB_CTRL_##reg##_##field##_SELECTOR])
+
+#define USB_CTRL_SET_FAMILY(base, reg, field) \
+ usb_ctrl_set_family(USB_CTRL_REG(base, reg), \
+ USB_CTRL_##reg##_##field##_SELECTOR)
+#define USB_CTRL_UNSET_FAMILY(base, reg, field) \
+ usb_ctrl_unset_family(USB_CTRL_REG(base, reg), \
+ USB_CTRL_##reg##_##field##_SELECTOR)
+#define USB_CTRL_SET(base, reg, field) \
+ usb_ctrl_set(USB_CTRL_REG(base, reg), \
+ USB_CTRL_##reg##_##field##_MASK)
+#define USB_CTRL_UNSET(base, reg, field) \
+ usb_ctrl_unset(USB_CTRL_REG(base, reg), \
+ USB_CTRL_##reg##_##field##_MASK)
+
+#define MDIO_USB2 0
+#define MDIO_USB3 (1 << 31)
+
+#define USB_CTRL_SETUP_CONDITIONAL_BITS ( \
+ USB_CTRL_MASK(SETUP, BABO) | \
+ USB_CTRL_MASK(SETUP, FNHW) | \
+ USB_CTRL_MASK(SETUP, FNBO) | \
+ USB_CTRL_MASK(SETUP, WABO) | \
+ USB_CTRL_MASK(SETUP, IOC) | \
+ USB_CTRL_MASK(SETUP, IPP))
+
+#ifdef __LITTLE_ENDIAN
+#define ENDIAN_SETTINGS ( \
+ USB_CTRL_MASK(SETUP, BABO) | \
+ USB_CTRL_MASK(SETUP, FNHW))
+#else
+#define ENDIAN_SETTINGS ( \
+ USB_CTRL_MASK(SETUP, FNHW) | \
+ USB_CTRL_MASK(SETUP, FNBO) | \
+ USB_CTRL_MASK(SETUP, WABO))
+#endif
+
+struct id_to_type {
+ uint32_t id;
+ int type;
+};
+
+static const struct id_to_type id_to_type_table[] = {
+ { 0x33900000, BRCM_FAMILY_3390A0 },
+ { 0x33900010, BRCM_FAMILY_3390A0 },
+ { 0x72500010, BRCM_FAMILY_7250B0 },
+ { 0x72710000, BRCM_FAMILY_7271A0 },
+ { 0x72680000, BRCM_FAMILY_7271A0 },
+ { 0x73640000, BRCM_FAMILY_7364A0 },
+ { 0x73640010, BRCM_FAMILY_7364A0 },
+ { 0x73660020, BRCM_FAMILY_7366C0 },
+ { 0x74371000, BRCM_FAMILY_74371A0 },
+ { 0x74390010, BRCM_FAMILY_7439B0 },
+ { 0x74450030, BRCM_FAMILY_7445D0 },
+ { 0x74450040, BRCM_FAMILY_7445D0 },
+};
+
+static const uint32_t *usb_reg_bits_map;
+static enum brcm_family_type my_family;
+
+static const uint32_t
+usb_reg_bits_map_table[BRCM_FAMILY_COUNT][USB_CTRL_SELECTOR_COUNT] = {
+ /* DEFAULT (default to latest chip, currently the 7271) */
+ [BRCM_FAMILY_DEFAULT] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_var_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ 0, /* USB_CTRL_SETUP_OC3_DISABLE_MASK */
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK,
+ 0, /* USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK */
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_USB_PWRDN_MASK */
+ USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK,
+ USB_CTRL_USB30_CTL1_usb3_ioc_MASK,
+ USB_CTRL_USB30_CTL1_usb3_ipp_MASK,
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+ /* 3390B0 */
+ [BRCM_FAMILY_3390A0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ USB_CTRL_SETUP_strap_ipp_sel_MASK,
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ 0, /* USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK */
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK,
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ USB_CTRL_USB_PM_xhc_soft_resetb_MASK,
+ USB_CTRL_USB_PM_USB_PWRDN_MASK,
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK,
+ },
+ /* 7250b0 */
+ [BRCM_FAMILY_7250B0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK,
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK,
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ USB_CTRL_USB_PM_xhc_soft_resetb_var_MASK,
+ 0, /* USB_CTRL_USB_PM_USB_PWRDN_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+ /* 7271a0 */
+ [BRCM_FAMILY_7271A0] = {
+ 0, /* USB_CTRL_SETUP_scb1_en_MASK */
+ 0, /* USB_CTRL_SETUP_scb2_en_MASK */
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ USB_CTRL_SETUP_strap_ipp_sel_MASK,
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ 0, /* USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK */
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK,
+ USB_CTRL_USB_PM_bdc_soft_resetb_MASK,
+ USB_CTRL_USB_PM_xhc_soft_resetb_MASK,
+ USB_CTRL_USB_PM_USB_PWRDN_MASK,
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK,
+ },
+ /* 7364a0 */
+ [BRCM_FAMILY_7364A0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK,
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK,
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ USB_CTRL_USB_PM_xhc_soft_resetb_var_MASK,
+ 0, /* USB_CTRL_USB_PM_USB_PWRDN_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+ /* 7366c0 */
+ [BRCM_FAMILY_7366C0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ 0, /* USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK */
+ USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK,
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ USB_CTRL_USB_PM_xhc_soft_resetb_var_MASK,
+ USB_CTRL_USB_PM_USB_PWRDN_MASK,
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+ /* 74371A0 */
+ [BRCM_FAMILY_74371A0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_var_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ 0, /* USB_CTRL_SETUP_OC3_DISABLE_MASK */
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK,
+ 0, /* USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK */
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_USB_PWRDN_MASK */
+ USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK,
+ USB_CTRL_USB30_CTL1_usb3_ioc_MASK,
+ USB_CTRL_USB30_CTL1_usb3_ipp_MASK,
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+ /* 7439B0 */
+ [BRCM_FAMILY_7439B0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_MASK,
+ USB_CTRL_SETUP_strap_ipp_sel_MASK,
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ 0, /* USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK */
+ 0, /* USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK */
+ USB_CTRL_USB_PM_bdc_soft_resetb_MASK,
+ USB_CTRL_USB_PM_xhc_soft_resetb_MASK,
+ USB_CTRL_USB_PM_USB_PWRDN_MASK,
+ 0, /* USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK,
+ },
+ /* 7445d0 */
+ [BRCM_FAMILY_7445D0] = {
+ USB_CTRL_SETUP_scb1_en_MASK,
+ USB_CTRL_SETUP_scb2_en_MASK,
+ USB_CTRL_SETUP_ss_ehci64bit_en_var_MASK,
+ 0, /* USB_CTRL_SETUP_strap_ipp_sel_MASK */
+ USB_CTRL_SETUP_OC3_DISABLE_MASK,
+ USB_CTRL_PLL_CTL_PLL_IDDQ_PWRDN_MASK,
+ 0, /* USB_CTRL_EBRIDGE_ESTOP_SCB_REQ_MASK */
+ 0, /* USB_CTRL_USB_PM_bdc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_xhc_soft_resetb_MASK */
+ 0, /* USB_CTRL_USB_PM_USB_PWRDN_MASK */
+ USB_CTRL_USB30_CTL1_xhc_soft_resetb_MASK,
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ioc_MASK */
+ 0, /* USB_CTRL_USB30_CTL1_usb3_ipp_MASK */
+ 0, /* USB_CTRL_USB_DEVICE_CTL1_port_mode_MASK */
+ },
+};
+
+static inline uint32_t brcmusb_readl(void __iomem *addr)
+{
+ /*
+ * MIPS endianness is configured by boot strap, which also reverses all
+ * bus endianness (i.e., big-endian CPU + big endian bus ==> native
+ * endian I/O).
+ *
+ * Other architectures (e.g., ARM) either do not support big endian, or
+ * else leave I/O in little endian mode.
+ */
+ if (IS_ENABLED(CONFIG_MIPS) && IS_ENABLED(__BIG_ENDIAN))
+ return __raw_readl(addr);
+ else
+ return readl_relaxed(addr);
+}
+
+static inline void brcmusb_writel(uint32_t val, void __iomem *addr)
+{
+ /* See brcmnand_readl() comments */
+ if (IS_ENABLED(CONFIG_MIPS) && IS_ENABLED(__BIG_ENDIAN))
+ __raw_writel(val, addr);
+ else
+ writel_relaxed(val, addr);
+}
+
+static inline void usb_ctrl_unset(void __iomem *reg, uint32_t mask)
+{
+ brcmusb_writel(brcmusb_readl(reg) & ~(mask), reg);
+};
+
+static inline void usb_ctrl_set(void __iomem *reg, uint32_t mask)
+{
+ brcmusb_writel(brcmusb_readl(reg) | (mask), reg);
+};
+
+static inline void usb_ctrl_unset_family(void __iomem *reg, uint32_t field)
+{
+ uint32_t mask;
+
+ mask = usb_reg_bits_map[field];
+ usb_ctrl_unset(reg, mask);
+};
+
+static inline void usb_ctrl_set_family(void __iomem *reg, uint32_t field)
+{
+ uint32_t mask;
+
+ mask = usb_reg_bits_map[field];
+ usb_ctrl_set(reg, mask);
+};
+
+
+static uint32_t usb_mdio_read(void __iomem *ctrl_base, uint32_t reg, int mode)
+{
+ uint32_t data;
+
+ data = (reg << 16) | mode;
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+ data |= (1 << 24);
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+ data &= ~(1 << 24);
+ udelay(10);
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+ udelay(10);
+
+ return brcmusb_readl(USB_CTRL_REG(ctrl_base, MDIO2)) & 0xffff;
+}
+
+static void usb_mdio_write(void __iomem *ctrl_base, uint32_t reg,
+ uint32_t val, int mode)
+{
+ uint32_t data;
+
+ data = (reg << 16) | val | mode;
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+ data |= (1 << 25);
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+ data &= ~(1 << 25);
+ udelay(10);
+ brcmusb_writel(data, USB_CTRL_REG(ctrl_base, MDIO));
+}
+
+
+static void usb_phy_ldo_fix(void __iomem *ctrl_base)
+{
+ /* first disable FSM but also leave it that way */
+ /* to allow normal suspend/resume */
+ USB_CTRL_UNSET(ctrl_base, UTMI_CTL_1, POWER_UP_FSM_EN);
+ USB_CTRL_UNSET(ctrl_base, UTMI_CTL_1, POWER_UP_FSM_EN_P1);
+
+ /* reset USB 2.0 PLL */
+ USB_CTRL_UNSET(ctrl_base, PLL_CTL, PLL_RESETB);
+ msleep(1);
+ USB_CTRL_SET(ctrl_base, PLL_CTL, PLL_RESETB);
+ msleep(10);
+
+}
+
+
+static void usb2_eye_fix(void __iomem *ctrl_base)
+{
+ /* Increase USB 2.0 TX level to meet spec requirement */
+ usb_mdio_write(ctrl_base, 0x1f, 0x80a0, MDIO_USB2);
+ usb_mdio_write(ctrl_base, 0x0a, 0xc6a0, MDIO_USB2);
+}
+
+
+static void usb3_pll_fix(void __iomem *ctrl_base)
+{
+ /* Set correct window for PLL lock detect */
+ usb_mdio_write(ctrl_base, 0x1f, 0x8000, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x07, 0x1503, MDIO_USB3);
+}
+
+
+static void usb3_enable_pipe_reset(void __iomem *ctrl_base)
+{
+ uint32_t val;
+
+ /* Re-enable USB 3.0 pipe reset */
+ usb_mdio_write(ctrl_base, 0x1f, 0x8000, MDIO_USB3);
+ val = usb_mdio_read(ctrl_base, 0x0f, MDIO_USB3) | 0x200;
+ usb_mdio_write(ctrl_base, 0x0f, val, MDIO_USB3);
+}
+
+
+static void usb3_enable_sigdet(void __iomem *ctrl_base)
+{
+ uint32_t val, ofs;
+ int ii;
+
+ ofs = 0;
+ for (ii = 0; ii < 2; ++ii) {
+ /* Set correct default for sigdet */
+ usb_mdio_write(ctrl_base, 0x1f, (0x8080 + ofs), MDIO_USB3);
+ val = usb_mdio_read(ctrl_base, 0x05, MDIO_USB3);
+ val = (val & ~0x800f) | 0x800d;
+ usb_mdio_write(ctrl_base, 0x05, val, MDIO_USB3);
+ ofs = 0x1000;
+ }
+}
+
+
+static void usb3_enable_skip_align(void __iomem *ctrl_base)
+{
+ uint32_t val, ofs;
+ int ii;
+
+ ofs = 0;
+ for (ii = 0; ii < 2; ++ii) {
+ /* Set correct default for SKIP align */
+ usb_mdio_write(ctrl_base, 0x1f, (0x8060 + ofs), MDIO_USB3);
+ val = usb_mdio_read(ctrl_base, 0x01, MDIO_USB3) | 0x200;
+ usb_mdio_write(ctrl_base, 0x01, val, MDIO_USB3);
+ ofs = 0x1000;
+ }
+}
+
+
+static void usb3_pll_54Mhz(void __iomem *ctrl_base)
+{
+ uint32_t ofs;
+ int ii;
+
+ if (my_family != BRCM_FAMILY_7271A0)
+ return;
+ /*
+ * On the 7271a0 and 7268a0, the reference clock for the
+ * 3.0 PLL has been changed from 50MHz to 54MHz so the
+ * PLL needs to be reprogramed. Later chips will have
+ * the PLL programmed correctly on power-up.
+ * See SWLINUX-4006.
+ */
+
+ /* set USB 3.0 PLL to accept 54Mhz reference clock */
+ USB_CTRL_UNSET(ctrl_base, USB30_CTL1, phy3_pll_seq_start);
+
+ usb_mdio_write(ctrl_base, 0x1f, 0x8000, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x10, 0x5784, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x11, 0x01d0, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x12, 0x1DE8, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x13, 0xAA80, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x14, 0x8826, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x15, 0x0044, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x16, 0x8000, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x17, 0x0851, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x18, 0x0000, MDIO_USB3);
+
+ /* both ports */
+ ofs = 0;
+ for (ii = 0; ii < 2; ++ii) {
+ usb_mdio_write(ctrl_base, 0x1f, (0x8040 + ofs), MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x03, 0x0090, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x04, 0x0134, MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x1f, (0x8020 + ofs), MDIO_USB3);
+ usb_mdio_write(ctrl_base, 0x01, 0x00e2, MDIO_USB3);
+ ofs = 0x1000;
+ }
+
+ /* restart PLL sequence */
+ USB_CTRL_SET(ctrl_base, USB30_CTL1, phy3_pll_seq_start);
+ msleep(1);
+}
+
+
+static void usb3_ssc_enable(void __iomem *ctrl_base)
+{
+ uint32_t val;
+
+ /* Enable USB 3.0 TX spread spectrum */
+ usb_mdio_write(ctrl_base, 0x1f, 0x8040, MDIO_USB3);
+ val = usb_mdio_read(ctrl_base, 0x01, MDIO_USB3) | 0xf;
+ usb_mdio_write(ctrl_base, 0x01, val, MDIO_USB3);
+
+ /* Currently, USB 3.0 SSC is enabled via port 0 MDIO registers,
+ * which should have been adequate. However, due to a bug in the
+ * USB 3.0 PHY, it must be enabled via both ports (HWUSB3DVT-26).
+ */
+ usb_mdio_write(ctrl_base, 0x1f, 0x9040, MDIO_USB3);
+ val = usb_mdio_read(ctrl_base, 0x01, MDIO_USB3) | 0xf;
+ usb_mdio_write(ctrl_base, 0x01, val, MDIO_USB3);
+}
+
+
+static void usb3_phy_workarounds(void __iomem *ctrl_base)
+{
+ usb3_pll_fix(ctrl_base);
+ usb3_pll_54Mhz(ctrl_base);
+ usb3_ssc_enable(ctrl_base);
+ usb3_enable_pipe_reset(ctrl_base);
+ usb3_enable_sigdet(ctrl_base);
+ usb3_enable_skip_align(ctrl_base);
+}
+
+
+static void memc_fix(struct brcm_usb_common_init_params *params)
+{
+ void __iomem *ctrl_base = params->ctrl_regs;
+ uint32_t prid;
+
+ if (my_family != BRCM_FAMILY_7445D0)
+ return;
+ /*
+ * This is a workaround for HW7445-1869 where a DMA write ends up
+ * doing a read pre-fetch after the end of the DMA buffer. This
+ * causes a problem when the DMA buffer is at the end of physical
+ * memory, causing the pre-fetch read to access non-existent memory,
+ * and the chip bondout has MEMC2 disabled. When the pre-fetch read
+ * tries to use the disabled MEMC2, it hangs the bus. The workaround
+ * is to disable MEMC2 access in the usb controller which avoids
+ * the hang.
+ */
+
+ prid = params->product_id & 0xfffff000;
+ switch (prid) {
+ case 0x72520000:
+ case 0x74480000:
+ case 0x74490000:
+ case 0x07252000:
+ case 0x07448000:
+ case 0x07449000:
+ USB_CTRL_UNSET_FAMILY(ctrl_base, SETUP, scb2_en);
+ }
+}
+
+static void usb3_otp_fix(struct brcm_usb_common_init_params *params)
+{
+ void __iomem *xhci_ec_base = params->xhci_ec_regs;
+ uint32_t val;
+
+ if ((params->family_id != 0x74371000) || (xhci_ec_base == 0))
+ return;
+ brcmusb_writel(0xa20c, USB_XHCI_EC_REG(xhci_ec_base, IRAADR));
+ val = brcmusb_readl(USB_XHCI_EC_REG(xhci_ec_base, IRADAT));
+
+ /* set cfg_pick_ss_lock */
+ val |= (1 << 27);
+ brcmusb_writel(val, USB_XHCI_EC_REG(xhci_ec_base, IRADAT));
+
+ /* Reset USB 3.0 PHY for workaround to take effect */
+ USB_CTRL_UNSET(params->ctrl_regs, USB30_CTL1, phy3_resetb);
+ USB_CTRL_SET(params->ctrl_regs, USB30_CTL1, phy3_resetb);
+}
+
+
+static void xhci_soft_reset(void __iomem *ctrl, int on_off)
+{
+ /* Assert reset */
+ if (on_off) {
+ if (USB_CTRL_MASK_FAMILY(USB_PM, xhc_soft_resetb))
+ USB_CTRL_UNSET_FAMILY(ctrl, USB_PM, xhc_soft_resetb);
+ else
+ USB_CTRL_UNSET_FAMILY(ctrl,
+ USB30_CTL1, xhc_soft_resetb);
+ }
+ /* De-assert reset */
+ else {
+ if (USB_CTRL_MASK_FAMILY(USB_PM, xhc_soft_resetb))
+ USB_CTRL_SET_FAMILY(ctrl, USB_PM, xhc_soft_resetb);
+ else
+ USB_CTRL_SET_FAMILY(ctrl, USB30_CTL1, xhc_soft_resetb);
+ }
+}
+
+static enum brcm_family_type get_family_type(
+ struct brcm_usb_common_init_params *params)
+{
+ unsigned int x;
+
+ for (x = 0;
+ x < (sizeof(id_to_type_table) / sizeof(struct id_to_type));
+ x++)
+ /* ignore the minor rev */
+ if ((params->family_id & 0xfffffff0) ==
+ id_to_type_table[x].id) {
+ return id_to_type_table[x].type;
+ }
+ return BRCM_FAMILY_DEFAULT;
+}
+
+void brcm_usb_common_init(struct brcm_usb_common_init_params *params)
+{
+ uint32_t reg;
+ void __iomem *ctrl = params->ctrl_regs;
+ int change_ipp = 0;
+
+ my_family = get_family_type(params);
+ usb_reg_bits_map = &usb_reg_bits_map_table[my_family][0];
+ xhci_soft_reset(ctrl, 1);
+
+ if (BRCM_ID(params->family_id) == 0x7366) {
+ /*
+ * The PHY3_SOFT_RESETB bits default to the wrong state.
+ */
+ USB_CTRL_SET(ctrl, USB30_PCTL, PHY3_SOFT_RESETB);
+ USB_CTRL_SET(ctrl, USB30_PCTL, PHY3_SOFT_RESETB_P1);
+ }
+ if (my_family == BRCM_FAMILY_7366C0)
+ /*
+ * Don't enable this so the memory controller doesn't read
+ * into memory holes. NOTE: This bit is low true on 7366C0.
+ */
+ USB_CTRL_SET_FAMILY(ctrl, EBRIDGE, ESTOP_SCB_REQ);
+
+ /* Take USB out of power down */
+ if (USB_CTRL_MASK_FAMILY(PLL_CTL, PLL_IDDQ_PWRDN)) {
+ USB_CTRL_UNSET_FAMILY(ctrl, PLL_CTL, PLL_IDDQ_PWRDN);
+ /* 1 millisecond - for USB clocks to settle down */
+ msleep(1);
+ }
+
+ /* 3390a0 & 7439b0 so far. */
+ if (USB_CTRL_MASK_FAMILY(USB_PM, USB_PWRDN)) {
+ USB_CTRL_UNSET_FAMILY(ctrl, USB_PM, USB_PWRDN);
+ /* 1 millisecond - for USB clocks to settle down */
+ msleep(1);
+ }
+
+ /* Starting with the 7445d0, there are no longer separate 3.0
+ * versions of IOC and IPP.
+ */
+ if (USB_CTRL_MASK_FAMILY(USB30_CTL1, usb3_ioc)) {
+ if (params->ioc)
+ USB_CTRL_SET_FAMILY(ctrl, USB30_CTL1, usb3_ioc);
+ if (params->ipp == 1)
+ USB_CTRL_SET_FAMILY(ctrl, USB30_CTL1, usb3_ipp);
+ }
+
+ if ((my_family != BRCM_FAMILY_74371A0) &&
+ (BRCM_ID(params->family_id) != 0x7364))
+ /*
+ * HW7439-637: 7439a0 and its derivatives do not have large
+ * enough descriptor storage for this.
+ */
+ USB_CTRL_SET_FAMILY(ctrl, SETUP, ss_ehci64bit_en);
+
+ /*
+ * Kick start USB3 PHY
+ * Make sure it's low to insure a rising edge.
+ */
+ USB_CTRL_UNSET(ctrl, USB30_CTL1, phy3_pll_seq_start);
+ USB_CTRL_SET(ctrl, USB30_CTL1, phy3_pll_seq_start);
+
+ /* Block auto PLL suspend by USB2 PHY */
+ USB_CTRL_SET(ctrl, PLL_CTL, PLL_SUSPEND_EN);
+
+ usb_phy_ldo_fix(ctrl);
+ usb2_eye_fix(ctrl);
+ if (params->has_xhci)
+ usb3_phy_workarounds(ctrl);
+
+ /* Setup the endian bits */
+ reg = brcmusb_readl(USB_CTRL_REG(ctrl, SETUP));
+ reg &= ~USB_CTRL_SETUP_CONDITIONAL_BITS;
+ reg |= ENDIAN_SETTINGS;
+
+ if (my_family == BRCM_FAMILY_7364A0)
+ /* Suppress overcurrent indication from USB30 ports for A0 */
+ reg |= USB_CTRL_MASK_FAMILY(SETUP, OC3_DISABLE);
+
+ if (USB_CTRL_MASK_FAMILY(SETUP, strap_ipp_sel))
+ if (params->ipp != 2)
+ /* override ipp strap pin (if it exits) */
+ reg &= ~(USB_CTRL_MASK_FAMILY(SETUP, strap_ipp_sel));
+
+ /*
+ * Make sure the the second and third memory controller
+ * interfaces are enabled.
+ */
+ if (USB_CTRL_MASK_FAMILY(SETUP, scb1_en))
+ reg |= USB_CTRL_MASK_FAMILY(SETUP, scb1_en);
+ if (USB_CTRL_MASK_FAMILY(SETUP, scb2_en))
+ reg |= USB_CTRL_MASK_FAMILY(SETUP, scb2_en);
+
+ /* Override the default OC and PP polarity */
+ if (params->ioc)
+ reg |= USB_CTRL_MASK(SETUP, IOC);
+ if ((params->ipp == 1) &&
+ ((reg & USB_CTRL_MASK(SETUP, IPP)) == 0)) {
+ change_ipp = 1;
+ reg |= USB_CTRL_MASK(SETUP, IPP);
+ }
+ brcmusb_writel(reg, USB_CTRL_REG(ctrl, SETUP));
+
+ /*
+ * If we're changing IPP, make sure power is off long enough
+ * to turn off any connected devices.
+ */
+ if (change_ipp)
+ msleep(50);
+ memc_fix(params);
+ if (params->has_xhci) {
+ xhci_soft_reset(ctrl, 0);
+ usb3_otp_fix(params);
+ }
+ if (USB_CTRL_MASK_FAMILY(USB_DEVICE_CTL1, port_mode)) {
+ reg = brcmusb_readl(USB_CTRL_REG(ctrl, USB_DEVICE_CTL1));
+ reg &= ~USB_CTRL_MASK_FAMILY(USB_DEVICE_CTL1, port_mode);
+ reg |= params->device_mode;
+ brcmusb_writel(reg, USB_CTRL_REG(ctrl, USB_DEVICE_CTL1));
+ }
+ if (USB_CTRL_MASK_FAMILY(USB_PM, bdc_soft_resetb)) {
+ switch (params->device_mode) {
+ case USB_CTLR_DEVICE_OFF:
+ USB_CTRL_UNSET_FAMILY(ctrl, USB_PM, bdc_soft_resetb);
+ break;
+ case USB_CTLR_DEVICE_ON:
+ case USB_CTLR_DEVICE_DUAL:
+ USB_CTRL_SET_FAMILY(ctrl, USB_PM, bdc_soft_resetb);
+ break;
+ }
+ }
+}
+
diff --git a/drivers/phy/phy-brcm-usb-init.h b/drivers/phy/phy-brcm-usb-init.h
new file mode 100644
index 0000000..e49918c
--- /dev/null
+++ b/drivers/phy/phy-brcm-usb-init.h
@@ -0,0 +1,49 @@
+/*
+ * Copyright (C) 2014-2016 Broadcom
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of the project nor the names of its contributors
+ * may be used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#ifndef _PHY_BRCM_USB_INIT_H
+#define _PHY_BRCM_USB_INIT_H
+
+#define USB_CTLR_DEVICE_OFF 0
+#define USB_CTLR_DEVICE_ON 1
+#define USB_CTLR_DEVICE_DUAL 2
+
+struct brcm_usb_common_init_params {
+ void __iomem *ctrl_regs;
+ void __iomem *xhci_ec_regs;
+ int ioc;
+ int ipp;
+ int has_xhci;
+ int device_mode;
+ uint32_t family_id;
+ uint32_t product_id;
+};
+
+void brcm_usb_common_init(struct brcm_usb_common_init_params *params);
+
+#endif /* _PHY_BRCM_USB_INIT_H */
diff --git a/drivers/phy/phy-brcm-usb.c b/drivers/phy/phy-brcm-usb.c
new file mode 100644
index 0000000..5edca1c
--- /dev/null
+++ b/drivers/phy/phy-brcm-usb.c
@@ -0,0 +1,206 @@
+/*
+ * phy-brcm-usb.c - Broadcom USB Phy Driver
+ *
+ * Copyright (C) 2015 Broadcom Corporation
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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/delay.h>
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/phy/phy.h>
+#include <linux/platform_device.h>
+#include <linux/interrupt.h>
+#include "phy-brcm-usb-init.h"
+#include <linux/soc/brcmstb/brcmstb.h>
+
+
+enum brcm_usb_phy_id {
+ BRCM_USB_PHY_2_0,
+ BRCM_USB_PHY_3_0,
+ BRCM_USB_PHY_ID_MAX
+};
+
+struct brcm_usb_phy_data {
+ struct brcm_usb_common_init_params ini;
+ void __iomem *ctrl_regs;
+ void __iomem *xhci_ec_regs;
+ int ioc;
+ int ipp;
+ int has_xhci;
+ int device_mode;
+ struct clk *usb_clk;
+ int num_phys;
+ struct brcm_usb_phy {
+ struct phy *phy;
+ unsigned int index;
+ } phys[BRCM_USB_PHY_ID_MAX];
+};
+
+#define to_brcm_usb_phy_data(phy) \
+ container_of((phy), struct brcm_usb_phy_data, phys[(phy)->index])
+
+static struct phy_ops brcm_usb_phy_ops = {
+ .owner = THIS_MODULE,
+};
+
+static struct phy *brcm_usb_phy_xlate(struct device *dev,
+ struct of_phandle_args *args)
+{
+ struct brcm_usb_phy_data *data = dev_get_drvdata(dev);
+
+ if (args->args[0] >= data->num_phys)
+ return ERR_PTR(-ENODEV);
+
+ return data->phys[args->args[0]].phy;
+}
+
+static int brcm_usb_phy_probe(struct platform_device *pdev)
+{
+ struct resource *res;
+ struct device *dev = &pdev->dev;
+ struct brcm_usb_phy_data *priv;
+ struct phy *gphy;
+ struct phy_provider *phy_provider;
+ struct device_node *dn = pdev->dev.of_node;
+ const u32 *prop;
+ int i;
+ int err;
+ const char *device_mode;
+ char err_msg_ioremap[] = "can't map register space\n";
+
+ priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
+ if (!priv)
+ return -ENOMEM;
+ platform_set_drvdata(pdev, priv);
+
+ priv->ini.family_id = brcmstb_get_family_id();
+ priv->ini.product_id = brcmstb_get_product_id();
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+ if (res == NULL) {
+ dev_err(&pdev->dev, "can't get USB_CTRL base address\n");
+ return -EINVAL;
+ }
+ priv->ini.ctrl_regs = devm_ioremap_resource(&pdev->dev, res);
+ if (IS_ERR(priv->ini.ctrl_regs)) {
+ dev_err(dev, err_msg_ioremap);
+ return -EINVAL;
+ }
+
+ /* The XHCI EC registers are optional */
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+ if (res != NULL) {
+ priv->ini.xhci_ec_regs =
+ devm_ioremap_resource(&pdev->dev, res);
+ if (IS_ERR(priv->ini.xhci_ec_regs)) {
+ dev_err(&pdev->dev, err_msg_ioremap);
+ return -EINVAL;
+ }
+ }
+
+ of_property_read_u32(dn, "ipp", &priv->ini.ipp);
+ of_property_read_u32(dn, "ioc", &priv->ini.ioc);
+
+ priv->ini.device_mode = USB_CTLR_DEVICE_OFF;
+ err = of_property_read_string(dn, "device", &device_mode);
+ if (err == 0) {
+ if (strcmp(device_mode, "on") == 0)
+ priv->ini.device_mode = USB_CTLR_DEVICE_ON;
+ if (strcmp(device_mode, "dual") == 0)
+ priv->ini.device_mode = USB_CTLR_DEVICE_DUAL;
+ }
+
+ prop = of_get_property(dn, "has_xhci", NULL);
+ if (prop) {
+ priv->ini.has_xhci = 1;
+ priv->num_phys = 2;
+ } else {
+ priv->num_phys = 1;
+ }
+
+ for (i = 0; i < priv->num_phys; i++) {
+ gphy = devm_phy_create(dev, NULL, &brcm_usb_phy_ops);
+ if (IS_ERR(gphy)) {
+ dev_err(dev, "failed to create PHY %d\n", i);
+ return PTR_ERR(gphy);
+ }
+ priv->phys[i].phy = gphy;
+ priv->phys[i].index = i;
+ phy_set_drvdata(gphy, &priv->phys[i]);
+ }
+ phy_provider = devm_of_phy_provider_register(dev,
+ brcm_usb_phy_xlate);
+ if (IS_ERR(phy_provider))
+ return PTR_ERR(phy_provider);
+
+ priv->usb_clk = of_clk_get_by_name(dn, "sw_usb");
+ if (IS_ERR(priv->usb_clk)) {
+ dev_err(&pdev->dev, "Clock not found in Device Tree\n");
+ priv->usb_clk = NULL;
+ }
+ err = clk_prepare_enable(priv->usb_clk);
+ if (err)
+ return err;
+
+ brcm_usb_common_init(&priv->ini);
+
+ return 0;
+}
+
+#ifdef CONFIG_PM_SLEEP
+static int brcm_usb_phy_suspend(struct device *dev)
+{
+ struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
+
+ clk_disable(priv->usb_clk);
+ return 0;
+}
+
+static int brcm_usb_phy_resume(struct device *dev)
+{
+ struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
+
+ clk_enable(priv->usb_clk);
+ brcm_usb_common_init(&priv->ini);
+ return 0;
+}
+#endif /* CONFIG_PM_SLEEP */
+
+static SIMPLE_DEV_PM_OPS(brcm_usb_phy_pm_ops, brcm_usb_phy_suspend,
+ brcm_usb_phy_resume);
+
+static const struct of_device_id brcm_usb_dt_ids[] = {
+ { .compatible = "brcm,brcmstb-usb-phy" },
+ { /* sentinel */ }
+};
+
+MODULE_DEVICE_TABLE(of, brcm_usb_dt_ids);
+
+static struct platform_driver brcm_usb_driver = {
+ .probe = brcm_usb_phy_probe,
+ .driver = {
+ .name = "brcmstb-usb-phy",
+ .owner = THIS_MODULE,
+ .pm = &brcm_usb_phy_pm_ops,
+ .of_match_table = brcm_usb_dt_ids,
+ },
+};
+
+module_platform_driver(brcm_usb_driver);
+
+MODULE_ALIAS("platform:brcmstb-usb-phy");
+MODULE_AUTHOR("Al Cooper <alcooperx@xxxxxxxxx>");
+MODULE_DESCRIPTION("BRCM USB PHY driver for STB systems");
+MODULE_LICENSE("GPL v2");
--
1.9.0.138.g2de3478