+Kishon, On 05/27/2016 12:57 PM, Al Cooper wrote: > 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"); > -- Florian -- To unsubscribe from this list: send the line "unsubscribe linux-usb" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html