Tristan Hsieh has uploaded this change for review. ( https://review.coreboot.org/28786
Change subject: mediatek: Refactor USB code among similar SoCs ......................................................................
mediatek: Refactor USB code among similar SoCs
Refactor USB code which will be reused among similar SoCs.
BUG=b:80501386 BRANCH=none TEST=Boots correctly on Elm
Change-Id: I06fefb4149a489be991e13ddf624082d11e31765 Signed-off-by: Tristan Shieh tristan.shieh@mediatek.com --- A src/soc/mediatek/common/include/soc/usb_common.h A src/soc/mediatek/common/usb.c M src/soc/mediatek/mt8173/Makefile.inc M src/soc/mediatek/mt8173/include/soc/usb.h M src/soc/mediatek/mt8173/usb.c 5 files changed, 351 insertions(+), 293 deletions(-)
git pull ssh://review.coreboot.org:29418/coreboot refs/changes/86/28786/1
diff --git a/src/soc/mediatek/common/include/soc/usb_common.h b/src/soc/mediatek/common/include/soc/usb_common.h new file mode 100644 index 0000000..8a36c6a --- /dev/null +++ b/src/soc/mediatek/common/include/soc/usb_common.h @@ -0,0 +1,172 @@ +/* + * This file is part of the coreboot project. + * + * Copyright 2018 MediaTek Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * 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. + */ + +#ifndef SOC_MEDIATEK_USB_COMMON_H +#define SOC_MEDIATEK_USB_COMMON_H + +#include <stddef.h> + +/* ip_pw_ctrl0 */ +#define CTRL0_IP_SW_RST (0x1 << 0) + +/* ip_pw_ctrl1 */ +#define CTRL1_IP_HOST_PDN (0x1 << 0) + +/* ip_pw_sts1 */ +#define STS1_U3_MAC_RST (0x1 << 16) +#define STS1_SYS125_RST (0x1 << 10) +#define STS1_REF_RST (0x1 << 8) +#define STS1_SYSPLL_STABLE (0x1 << 0) + +/* ip_pw_sts2 */ +#define STS2_U2_MAC_RST (0x1 << 0) + +/* ip_xhci_cap */ +#define CAP_U3_PORT_NUM(p) ((p) & 0xff) +#define CAP_U2_PORT_NUM(p) (((p) >> 8) & 0xff) + +/* u3_ctrl_p */ +#define CTRL_U3_PORT_HOST_SEL (0x1 << 2) +#define CTRL_U3_PORT_PDN (0x1 << 1) +#define CTRL_U3_PORT_DIS (0x1 << 0) + +/* u2_ctrl_p */ +#define CTRL_U2_PORT_HOST_SEL (0x1 << 2) +#define CTRL_U2_PORT_PDN (0x1 << 1) +#define CTRL_U2_PORT_DIS (0x1 << 0) + +struct ssusb_ippc_regs { + u32 ip_pw_ctr0; + u32 ip_pw_ctr1; + u32 ip_pw_ctr2; + u32 ip_pw_ctr3; + u32 ip_pw_sts1; + u32 ip_pw_sts2; + u32 reserved0[3]; + u32 ip_xhci_cap; + u32 reserved1[2]; + u64 u3_ctrl_p[4]; + u64 u2_ctrl_p[6]; +}; + +/* U2PHY_COM USBPHYACR5 */ +#define PA5_RG_U2_HSTX_SRCTRL (0x7 << 12) +#define PA5_RG_U2_HSTX_SRCTRL_VAL(x) ((0x7 & (x)) << 12) +#define PA5_RG_U2_HS_100U_U3_EN (0x1 << 11) + +/* U2PHY_COM USBPHYACR6 */ +#define PA6_RG_U2_ISO_EN (0x1 << 31) +#define PA6_RG_U2_BC11_SW_EN (0x1 << 23) +#define PA6_RG_U2_OTG_VBUSCMP_EN (0x1 << 20) +#define PA6_RG_U2_SQTH (0xf << 0) +#define PA6_RG_U2_SQTH_VAL(x) ((0xf & (x)) << 0) + +/* U2PHY_COM U2PHYACR4 */ +#define P2C_RG_USB20_GPIO_CTL (0x1 << 9) +#define P2C_USB20_GPIO_MODE (0x1 << 8) +#define P2C_U2_GPIO_CTR_MSK (P2C_RG_USB20_GPIO_CTL | P2C_USB20_GPIO_MODE) + +/* U2PHY_COM U2PHYDTM0 */ +#define P2C_FORCE_UART_EN (0x1 << 26) +#define P2C_FORCE_DATAIN (0x1 << 23) +#define P2C_FORCE_DM_PULLDOWN (0x1 << 21) +#define P2C_FORCE_DP_PULLDOWN (0x1 << 20) +#define P2C_FORCE_XCVRSEL (0x1 << 19) +#define P2C_FORCE_SUSPENDM (0x1 << 18) +#define P2C_FORCE_TERMSEL (0x1 << 17) +#define P2C_RG_DATAIN (0xf << 10) +#define P2C_RG_DATAIN_VAL(x) ((0xf & (x)) << 10) +#define P2C_RG_DMPULLDOWN (0x1 << 7) +#define P2C_RG_DPPULLDOWN (0x1 << 6) +#define P2C_RG_XCVRSEL (0x3 << 4) +#define P2C_RG_XCVRSEL_VAL(x) ((0x3 & (x)) << 4) +#define P2C_RG_SUSPENDM (0x1 << 3) +#define P2C_RG_TERMSEL (0x1 << 2) +#define P2C_DTM0_PART_MASK \ + (P2C_FORCE_DATAIN | P2C_FORCE_DM_PULLDOWN | \ + P2C_FORCE_DP_PULLDOWN | P2C_FORCE_XCVRSEL | \ + P2C_FORCE_TERMSEL | P2C_RG_DMPULLDOWN | \ + P2C_RG_TERMSEL) + +/* U2PHY_COM U2PHYDTM1 */ +#define P2C_RG_UART_EN (0x1 << 16) +#define P2C_RG_VBUSVALID (0x1 << 5) +#define P2C_RG_SESSEND (0x1 << 4) +#define P2C_RG_AVALID (0x1 << 2) + +/* U3PHYA PHYA_REG0 */ +#define P3A_RG_U3_VUSB10_ON (1 << 5) + +/* U3PHYA PHYA_REG6 */ +#define P3A_RG_TX_EIDLE_CM (0xf << 28) +#define P3A_RG_TX_EIDLE_CM_VAL(x) ((0xf & (x)) << 28) + +/* U3PHYA PHYA_REG9 */ +#define P3A_RG_RX_DAC_MUX (0x1f << 1) +#define P3A_RG_RX_DAC_MUX_VAL(x) ((0x1f & (x)) << 1) + +/* U3PHYA_DA REG0 */ +#define P3A_RG_XTAL_EXT_EN_U3 (0x3 << 10) +#define P3A_RG_XTAL_EXT_EN_U3_VAL(x) ((0x3 & (x)) << 10) + +/* U3PHYD CDR1 */ +#define P3D_RG_CDR_BIR_LTD1 (0x1f << 24) +#define P3D_RG_CDR_BIR_LTD1_VAL(x) ((0x1f & (x)) << 24) +#define P3D_RG_CDR_BIR_LTD0 (0x1f << 8) +#define P3D_RG_CDR_BIR_LTD0_VAL(x) ((0x1f & (x)) << 8) + +struct sif_u2_phy_com { + u32 reserved0[5]; + u32 usbphyacr5; + u32 usbphyacr6; + u32 u2phyacr3; + u32 u2phyacr4; + u32 reserved1[17]; + u32 u2phydtm0; + u32 u2phydtm1; + u32 reserved2[36]; /* 0x70 - 0xff */ +}; +check_member(sif_u2_phy_com, u2phydtm0, 0x68); + +struct sif_u3phyd { + u32 reserved0[23]; + u32 phyd_cdr1; + u32 reserved1[40]; +}; + +struct sif_u3phya { + u32 phya_reg0; + u32 reserved0[5]; + u32 phya_reg6; + u32 reserved1[2]; + u32 phya_reg9; + u32 reserved2[54]; +}; + +struct sif_u3phya_da { + u32 reg0; + u32 reserved[63]; +}; + +/* + * This is defined as weak no-ops that can be overridden by legacy SOCs. Some + * legacy SOCs need specific settings before init USB. And we expect future + * SOCs will not need it. + */ +void mtk_usb_prepare(void); + +void setup_usb_host(void); + +#endif diff --git a/src/soc/mediatek/common/usb.c b/src/soc/mediatek/common/usb.c new file mode 100644 index 0000000..ceeea19 --- /dev/null +++ b/src/soc/mediatek/common/usb.c @@ -0,0 +1,174 @@ +/* + * This file is part of the coreboot project. + * + * Copyright 2018 MediaTek Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * 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 <arch/io.h> +#include <compiler.h> +#include <console/console.h> +#include <delay.h> +#include <soc/addressmap.h> +#include <soc/usb.h> +#include <timer.h> + +#define USBTAG "[SSUSB] " +#define u3p_msg(fmt, arg...) printk(BIOS_INFO, USBTAG fmt, ##arg) +#define u3p_err(fmt, arg...) printk(BIOS_ERR, USBTAG fmt, ##arg) + +static struct ssusb_ippc_regs *ippc_regs = (void *)(SSUSB_IPPC_BASE); +static struct ssusb_sif_port *phy_ports = (void *)(SSUSB_SIF_BASE); + +static void phy_index_power_on(int index) +{ + struct ssusb_sif_port *phy = phy_ports + index; + + if (!index) { + /* Set RG_SSUSB_VUSB10_ON as 1 after VUSB10 ready */ + setbits_le32(&phy->u3phya.phya_reg0, P3A_RG_U3_VUSB10_ON); + /* power domain iso disable */ + clrbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_ISO_EN); + } + /* switch to USB function. (system register, force ip into usb mode) */ + clrbits_le32(&phy->u2phy.u2phydtm0, P2C_FORCE_UART_EN); + clrbits_le32(&phy->u2phy.u2phydtm1, P2C_RG_UART_EN); + if (!index) + clrbits_le32(&phy->u2phy.u2phyacr4, P2C_U2_GPIO_CTR_MSK); + + /* (force_suspendm=0) (let suspendm=1, enable usb 480MHz pll) */ + clrbits_le32(&phy->u2phy.u2phydtm0, P2C_FORCE_SUSPENDM | + P2C_RG_XCVRSEL | P2C_RG_DATAIN | P2C_DTM0_PART_MASK); + + /* DP/DM BC1.1 path Disable */ + clrbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_BC11_SW_EN); + /* improve Rx sensitivity */ + clrsetbits_le32(&phy->u2phy.usbphyacr6, + PA6_RG_U2_SQTH, PA6_RG_U2_SQTH_VAL(2)); + /* OTG Enable */ + setbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_OTG_VBUSCMP_EN); + + clrsetbits_le32(&phy->u3phya_da.reg0, + P3A_RG_XTAL_EXT_EN_U3, P3A_RG_XTAL_EXT_EN_U3_VAL(2)); + + clrsetbits_le32(&phy->u3phya.phya_reg9, + P3A_RG_RX_DAC_MUX, P3A_RG_RX_DAC_MUX_VAL(4)); + + if (!index) { + /* disable Change 100uA current from SSUSB */ + clrbits_le32(&phy->u2phy.usbphyacr5, PA5_RG_U2_HS_100U_U3_EN); + } + + clrsetbits_le32(&phy->u3phya.phya_reg6, + P3A_RG_TX_EIDLE_CM, P3A_RG_TX_EIDLE_CM_VAL(0xe)); + + clrsetbits_le32(&phy->u3phyd.phyd_cdr1, + P3D_RG_CDR_BIR_LTD0, P3D_RG_CDR_BIR_LTD0_VAL(0xc)); + clrsetbits_le32(&phy->u3phyd.phyd_cdr1, + P3D_RG_CDR_BIR_LTD1, P3D_RG_CDR_BIR_LTD1_VAL(0x3)); + + clrsetbits_le32(&phy->u2phy.u2phydtm1, + P2C_RG_SESSEND, P2C_RG_VBUSVALID | P2C_RG_AVALID); + + /* USB 2.0 slew rate calibration */ + clrsetbits_le32(&phy->u2phy.usbphyacr5, + PA5_RG_U2_HSTX_SRCTRL, PA5_RG_U2_HSTX_SRCTRL_VAL(4)); +} + +static void u3phy_power_on(void) +{ + for (size_t i = 0; i < USB_PORT_NUMBER; i++) + phy_index_power_on(i); +} + +static int check_ip_clk_status(void) +{ + int u3_port_num; + u32 check_bits; + u32 sts1, sts2; + struct stopwatch sw; + + u3_port_num = CAP_U3_PORT_NUM(read32(&ippc_regs->ip_xhci_cap)); + + check_bits = STS1_SYSPLL_STABLE | STS1_REF_RST | STS1_SYS125_RST; + check_bits |= (u3_port_num ? STS1_U3_MAC_RST : 0); + + stopwatch_init_usecs_expire(&sw, 50000); + + do { + if (stopwatch_expired(&sw)) { + u3p_err("usb clocks are not stable!!!\n"); + return -1; + } + + sts1 = read32(&ippc_regs->ip_pw_sts1) & check_bits; + sts2 = read32(&ippc_regs->ip_pw_sts2) & STS2_U2_MAC_RST; + } while ((sts1 != check_bits) || !sts2); + + return 0; +} + +static int u3phy_ports_enable(void) +{ + int i; + u32 value; + int u3_port_num; + int u2_port_num; + + value = read32(&ippc_regs->ip_xhci_cap); + u3_port_num = CAP_U3_PORT_NUM(value); + u2_port_num = CAP_U2_PORT_NUM(value); + u3p_msg("%s u2p:%d, u3p:%d\n", __func__, u2_port_num, u3_port_num); + + /* power on host ip */ + clrbits_le32(&ippc_regs->ip_pw_ctr1, CTRL1_IP_HOST_PDN); + + /* power on and enable all u3 ports */ + for (i = 0; i < u3_port_num; i++) { + clrsetbits_le32(&ippc_regs->u3_ctrl_p[i], + CTRL_U3_PORT_PDN | CTRL_U3_PORT_DIS, + CTRL_U3_PORT_HOST_SEL); + } + + /* power on and enable all u2 ports */ + for (i = 0; i < u2_port_num; i++) { + clrsetbits_le32(&ippc_regs->u2_ctrl_p[i], + CTRL_U2_PORT_PDN | CTRL_U2_PORT_DIS, + CTRL_U2_PORT_HOST_SEL); + } + return check_ip_clk_status(); +} + +static inline void ssusb_soft_reset(void) +{ + /* reset whole ip */ + setbits_le32(&ippc_regs->ip_pw_ctr0, CTRL0_IP_SW_RST); + clrbits_le32(&ippc_regs->ip_pw_ctr0, CTRL0_IP_SW_RST); +} + +__weak void mtk_usb_prepare(void) { /* do nothing */ } + +void setup_usb_host(void) +{ + int ret; + + u3p_msg("Setting up USB HOST controller...\n"); + + mtk_usb_prepare(); + ssusb_soft_reset(); + ret = u3phy_ports_enable(); + if (ret) { + u3p_err("%s fail to enable ports\n", __func__); + return; + } + u3phy_power_on(); + u3p_msg("phy power-on done.\n"); +} diff --git a/src/soc/mediatek/mt8173/Makefile.inc b/src/soc/mediatek/mt8173/Makefile.inc index 73048f4..e125e03 100644 --- a/src/soc/mediatek/mt8173/Makefile.inc +++ b/src/soc/mediatek/mt8173/Makefile.inc @@ -80,7 +80,7 @@ ramstage-y += ../common/pll.c pll.c ramstage-y += rtc.c
-ramstage-y += usb.c +ramstage-y += ../common/usb.c usb.c
ramstage-y += ddp.c ramstage-y += dsi.c diff --git a/src/soc/mediatek/mt8173/include/soc/usb.h b/src/soc/mediatek/mt8173/include/soc/usb.h index 646b077..8a6f61a 100644 --- a/src/soc/mediatek/mt8173/include/soc/usb.h +++ b/src/soc/mediatek/mt8173/include/soc/usb.h @@ -16,147 +16,7 @@ #ifndef SOC_MEDIATEK_MT8173_USB_H #define SOC_MEDIATEK_MT8173_USB_H
-/* ip_pw_ctrl0 */ -#define CTRL0_IP_SW_RST (0x1 << 0) - -/* ip_pw_ctrl1 */ -#define CTRL1_IP_HOST_PDN (0x1 << 0) - -/* ip_pw_sts1 */ -#define STS1_U3_MAC_RST (0x1 << 16) -#define STS1_SYS125_RST (0x1 << 10) -#define STS1_REF_RST (0x1 << 8) -#define STS1_SYSPLL_STABLE (0x1 << 0) - -/* ip_pw_sts2 */ -#define STS2_U2_MAC_RST (0x1 << 0) - -/* ip_xhci_cap */ -#define CAP_U3_PORT_NUM(p) ((p) & 0xff) -#define CAP_U2_PORT_NUM(p) (((p) >> 8) & 0xff) - -/* u3_ctrl_p */ -#define CTRL_U3_PORT_HOST_SEL (0x1 << 2) -#define CTRL_U3_PORT_PDN (0x1 << 1) -#define CTRL_U3_PORT_DIS (0x1 << 0) - -/* u2_ctrl_p */ -#define CTRL_U2_PORT_HOST_SEL (0x1 << 2) -#define CTRL_U2_PORT_PDN (0x1 << 1) -#define CTRL_U2_PORT_DIS (0x1 << 0) - -struct ssusb_ippc_regs { - u32 ip_pw_ctr0; - u32 ip_pw_ctr1; - u32 ip_pw_ctr2; - u32 ip_pw_ctr3; - u32 ip_pw_sts1; - u32 ip_pw_sts2; - u32 reserved0[3]; - u32 ip_xhci_cap; - u32 reserved1[2]; - u64 u3_ctrl_p[4]; - u64 u2_ctrl_p[6]; -}; - -/* U2PHY_COM USBPHYACR5 */ -#define PA5_RG_U2_HSTX_SRCTRL (0x7 << 12) -#define PA5_RG_U2_HSTX_SRCTRL_VAL(x) ((0x7 & (x)) << 12) -#define PA5_RG_U2_HS_100U_U3_EN (0x1 << 11) - -/* U2PHY_COM USBPHYACR6 */ -#define PA6_RG_U2_ISO_EN (0x1 << 31) -#define PA6_RG_U2_BC11_SW_EN (0x1 << 23) -#define PA6_RG_U2_OTG_VBUSCMP_EN (0x1 << 20) -#define PA6_RG_U2_SQTH (0xf << 0) -#define PA6_RG_U2_SQTH_VAL(x) ((0xf & (x)) << 0) - -/* U2PHY_COM U2PHYACR4 */ -#define P2C_RG_USB20_GPIO_CTL (0x1 << 9) -#define P2C_USB20_GPIO_MODE (0x1 << 8) -#define P2C_U2_GPIO_CTR_MSK (P2C_RG_USB20_GPIO_CTL | P2C_USB20_GPIO_MODE) - -/* U2PHY_COM U2PHYDTM0 */ -#define P2C_FORCE_UART_EN (0x1 << 26) -#define P2C_FORCE_DATAIN (0x1 << 23) -#define P2C_FORCE_DM_PULLDOWN (0x1 << 21) -#define P2C_FORCE_DP_PULLDOWN (0x1 << 20) -#define P2C_FORCE_XCVRSEL (0x1 << 19) -#define P2C_FORCE_SUSPENDM (0x1 << 18) -#define P2C_FORCE_TERMSEL (0x1 << 17) -#define P2C_RG_DATAIN (0xf << 10) -#define P2C_RG_DATAIN_VAL(x) ((0xf & (x)) << 10) -#define P2C_RG_DMPULLDOWN (0x1 << 7) -#define P2C_RG_DPPULLDOWN (0x1 << 6) -#define P2C_RG_XCVRSEL (0x3 << 4) -#define P2C_RG_XCVRSEL_VAL(x) ((0x3 & (x)) << 4) -#define P2C_RG_SUSPENDM (0x1 << 3) -#define P2C_RG_TERMSEL (0x1 << 2) -#define P2C_DTM0_PART_MASK \ - (P2C_FORCE_DATAIN | P2C_FORCE_DM_PULLDOWN | \ - P2C_FORCE_DP_PULLDOWN | P2C_FORCE_XCVRSEL | \ - P2C_FORCE_TERMSEL | P2C_RG_DMPULLDOWN | \ - P2C_RG_TERMSEL) - -/* U2PHY_COM U2PHYDTM1 */ -#define P2C_RG_UART_EN (0x1 << 16) -#define P2C_RG_VBUSVALID (0x1 << 5) -#define P2C_RG_SESSEND (0x1 << 4) -#define P2C_RG_AVALID (0x1 << 2) - -/* U3PHYA PHYA_REG0 */ -#define P3A_RG_U3_VUSB10_ON (1 << 5) - -/* U3PHYA PHYA_REG6 */ -#define P3A_RG_TX_EIDLE_CM (0xf << 28) -#define P3A_RG_TX_EIDLE_CM_VAL(x) ((0xf & (x)) << 28) - -/* U3PHYA PHYA_REG9 */ -#define P3A_RG_RX_DAC_MUX (0x1f << 1) -#define P3A_RG_RX_DAC_MUX_VAL(x) ((0x1f & (x)) << 1) - -/* U3PHYA_DA REG0 */ -#define P3A_RG_XTAL_EXT_EN_U3 (0x3 << 10) -#define P3A_RG_XTAL_EXT_EN_U3_VAL(x) ((0x3 & (x)) << 10) - -/* U3PHYD CDR1 */ -#define P3D_RG_CDR_BIR_LTD1 (0x1f << 24) -#define P3D_RG_CDR_BIR_LTD1_VAL(x) ((0x1f & (x)) << 24) -#define P3D_RG_CDR_BIR_LTD0 (0x1f << 8) -#define P3D_RG_CDR_BIR_LTD0_VAL(x) ((0x1f & (x)) << 8) - -struct sif_u2_phy_com { - u32 reserved0[5]; - u32 usbphyacr5; - u32 usbphyacr6; - u32 u2phyacr3; - u32 u2phyacr4; - u32 reserved1[17]; - u32 u2phydtm0; - u32 u2phydtm1; - u32 reserved2[36]; /* 0x70 - 0xff */ -}; -check_member(sif_u2_phy_com, u2phydtm0, 0x68); - -struct sif_u3phyd { - u32 reserved0[23]; - u32 phyd_cdr1; - u32 reserved1[40]; -}; - -struct sif_u3phya { - u32 phya_reg0; - u32 reserved0[5]; - u32 phya_reg6; - u32 reserved1[2]; - u32 phya_reg9; - u32 reserved2[54]; -}; - -struct sif_u3phya_da { - u32 reg0; - u32 reserved[63]; -}; +#include <soc/usb_common.h>
struct ssusb_sif_port { struct sif_u2_phy_com u2phy; @@ -170,9 +30,9 @@ check_member(ssusb_sif_port, u3phya, 0x300); check_member(ssusb_sif_port, u3phya_da, 0x400); check_member(ssusb_sif_port, reserved1, 0x500); -_Static_assert(sizeof(struct ssusb_sif_port) == 0x800, \ +_Static_assert(sizeof(struct ssusb_sif_port) == 0x800, "ssusb_sif_port size is wrong!");
-void setup_usb_host(void); +#define USB_PORT_NUMBER 2
#endif diff --git a/src/soc/mediatek/mt8173/usb.c b/src/soc/mediatek/mt8173/usb.c index 1dccfc9..a61a64b 100644 --- a/src/soc/mediatek/mt8173/usb.c +++ b/src/soc/mediatek/mt8173/usb.c @@ -13,158 +13,10 @@ * GNU General Public License for more details. */
-#include <arch/io.h> -#include <console/console.h> -#include <delay.h> -#include <soc/addressmap.h> #include <soc/pll.h> #include <soc/usb.h> -#include <timer.h>
-#define USBTAG "[SSUSB] " -#define u3p_msg(fmt, arg...) printk(BIOS_INFO, USBTAG fmt, ##arg) -#define u3p_err(fmt, arg...) printk(BIOS_ERR, USBTAG fmt, ##arg) - -static struct ssusb_ippc_regs *ippc_regs = (void *)(SSUSB_IPPC_BASE); -static struct ssusb_sif_port *phy_ports = (void *)(SSUSB_SIF_BASE); - -static void phy_index_power_on(int index) +void mtk_usb_prepare(void) { - struct ssusb_sif_port *phy = phy_ports + index; - - if (!index) { - /* Set RG_SSUSB_VUSB10_ON as 1 after VUSB10 ready */ - setbits_le32(&phy->u3phya.phya_reg0, P3A_RG_U3_VUSB10_ON); - /* power domain iso disable */ - clrbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_ISO_EN); - } - /* switch to USB function. (system register, force ip into usb mode) */ - clrbits_le32(&phy->u2phy.u2phydtm0, P2C_FORCE_UART_EN); - clrbits_le32(&phy->u2phy.u2phydtm1, P2C_RG_UART_EN); - if (!index) - clrbits_le32(&phy->u2phy.u2phyacr4, P2C_U2_GPIO_CTR_MSK); - - /* (force_suspendm=0) (let suspendm=1, enable usb 480MHz pll) */ - clrbits_le32(&phy->u2phy.u2phydtm0, P2C_FORCE_SUSPENDM | - P2C_RG_XCVRSEL | P2C_RG_DATAIN | P2C_DTM0_PART_MASK); - - /* DP/DM BC1.1 path Disable */ - clrbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_BC11_SW_EN); - /* improve Rx sensitivity */ - clrsetbits_le32(&phy->u2phy.usbphyacr6, - PA6_RG_U2_SQTH, PA6_RG_U2_SQTH_VAL(2)); - /* OTG Enable */ - setbits_le32(&phy->u2phy.usbphyacr6, PA6_RG_U2_OTG_VBUSCMP_EN); - - clrsetbits_le32(&phy->u3phya_da.reg0, - P3A_RG_XTAL_EXT_EN_U3, P3A_RG_XTAL_EXT_EN_U3_VAL(2)); - - clrsetbits_le32(&phy->u3phya.phya_reg9, - P3A_RG_RX_DAC_MUX, P3A_RG_RX_DAC_MUX_VAL(4)); - - if (!index) { - /* [mt8173]disable Change 100uA current from SSUSB */ - clrbits_le32(&phy->u2phy.usbphyacr5, PA5_RG_U2_HS_100U_U3_EN); - } - - clrsetbits_le32(&phy->u3phya.phya_reg6, - P3A_RG_TX_EIDLE_CM, P3A_RG_TX_EIDLE_CM_VAL(0xe)); - - clrsetbits_le32(&phy->u3phyd.phyd_cdr1, - P3D_RG_CDR_BIR_LTD0, P3D_RG_CDR_BIR_LTD0_VAL(0xc)); - clrsetbits_le32(&phy->u3phyd.phyd_cdr1, - P3D_RG_CDR_BIR_LTD1, P3D_RG_CDR_BIR_LTD1_VAL(0x3)); - - clrsetbits_le32(&phy->u2phy.u2phydtm1, - P2C_RG_SESSEND, P2C_RG_VBUSVALID | P2C_RG_AVALID); - - /* USB 2.0 slew rate calibration */ - clrsetbits_le32(&phy->u2phy.usbphyacr5, - PA5_RG_U2_HSTX_SRCTRL, PA5_RG_U2_HSTX_SRCTRL_VAL(4)); -} - -static void u3phy_power_on(void) -{ - phy_index_power_on(0); - phy_index_power_on(1); -} - -static int check_ip_clk_status(void) -{ - int u3_port_num; - u32 check_bits; - u32 sts1, sts2; - struct stopwatch sw; - - u3_port_num = CAP_U3_PORT_NUM(read32(&ippc_regs->ip_xhci_cap)); - - check_bits = STS1_SYSPLL_STABLE | STS1_REF_RST | STS1_SYS125_RST; - check_bits |= (u3_port_num ? STS1_U3_MAC_RST : 0); - - stopwatch_init_usecs_expire(&sw, 50000); - - do { - if (stopwatch_expired(&sw)) { - u3p_err("usb clocks are not stable!!!\n"); - return -1; - } - - sts1 = read32(&ippc_regs->ip_pw_sts1) & check_bits; - sts2 = read32(&ippc_regs->ip_pw_sts2) & STS2_U2_MAC_RST; - } while ((sts1 != check_bits) || !sts2); - - return 0; -} - -static int u3phy_ports_enable(void) -{ - int i; - u32 value; - int u3_port_num; - int u2_port_num; - - value = read32(&ippc_regs->ip_xhci_cap); - u3_port_num = CAP_U3_PORT_NUM(value); - u2_port_num = CAP_U2_PORT_NUM(value); - u3p_msg("%s u2p:%d, u3p:%d\n", __func__, u2_port_num, u3_port_num); - - /* power on host ip */ - clrbits_le32(&ippc_regs->ip_pw_ctr1, CTRL1_IP_HOST_PDN); - - /* power on and enable all u3 ports */ - for (i = 0; i < u3_port_num; i++) { - clrsetbits_le32(&ippc_regs->u3_ctrl_p[i], - CTRL_U3_PORT_PDN | CTRL_U3_PORT_DIS, CTRL_U3_PORT_HOST_SEL); - } - - /* power on and enable all u2 ports */ - for (i = 0; i < u2_port_num; i++) { - clrsetbits_le32(&ippc_regs->u2_ctrl_p[i], - CTRL_U2_PORT_PDN | CTRL_U2_PORT_DIS, CTRL_U2_PORT_HOST_SEL); - } - return check_ip_clk_status(); -} - -static inline void ssusb_soft_reset(void) -{ - /* reset whole ip */ - setbits_le32(&ippc_regs->ip_pw_ctr0, CTRL0_IP_SW_RST); - clrbits_le32(&ippc_regs->ip_pw_ctr0, CTRL0_IP_SW_RST); -} - -void setup_usb_host(void) -{ - int ret; - - u3p_msg("Setting up USB HOST controller...\n"); - mt_pll_enable_ssusb_clk(); - ssusb_soft_reset(); - ret = u3phy_ports_enable(); - if (ret) { - u3p_err("%s fail to enable ports\n", __func__); - return; - } - u3phy_power_on(); - u3p_msg("phy power-on done.\n"); }
-
Tristan Hsieh (Code Review)