86 lines
2.8 KiB
Diff
86 lines
2.8 KiB
Diff
From 13a1b2e927893cbb046a1ec5a55ec3516873a3f6 Mon Sep 17 00:00:00 2001
|
|
From: Chunfeng Yun <chunfeng.yun@mediatek.com>
|
|
Date: Fri, 13 Oct 2017 16:26:36 +0800
|
|
Subject: [PATCH 129/224] usb: xhci-mtk: support option to disable usb3 ports
|
|
|
|
Add support to disable specific usb3 ports, it's useful when
|
|
usb3 phy is shared with PCIe or SATA, because we should disable
|
|
the corresponding usb3 port if the phy is used by PCIe or SATA.
|
|
Sometimes it's helpful to analyse and solve problems.
|
|
|
|
Signed-off-by: Chunfeng Yun <chunfeng.yun@mediatek.com>
|
|
Acked-by: Mathias Nyman <mathias.nyman@linux.intel.com>
|
|
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
|
|
---
|
|
drivers/usb/host/xhci-mtk.c | 18 +++++++++++++++---
|
|
drivers/usb/host/xhci-mtk.h | 1 +
|
|
2 files changed, 16 insertions(+), 3 deletions(-)
|
|
|
|
--- a/drivers/usb/host/xhci-mtk.c
|
|
+++ b/drivers/usb/host/xhci-mtk.c
|
|
@@ -92,6 +92,7 @@ static int xhci_mtk_host_enable(struct x
|
|
{
|
|
struct mu3c_ippc_regs __iomem *ippc = mtk->ippc_regs;
|
|
u32 value, check_val;
|
|
+ int u3_ports_disabed = 0;
|
|
int ret;
|
|
int i;
|
|
|
|
@@ -103,8 +104,13 @@ static int xhci_mtk_host_enable(struct x
|
|
value &= ~CTRL1_IP_HOST_PDN;
|
|
writel(value, &ippc->ip_pw_ctr1);
|
|
|
|
- /* power on and enable all u3 ports */
|
|
+ /* power on and enable u3 ports except skipped ones */
|
|
for (i = 0; i < mtk->num_u3_ports; i++) {
|
|
+ if ((0x1 << i) & mtk->u3p_dis_msk) {
|
|
+ u3_ports_disabed++;
|
|
+ continue;
|
|
+ }
|
|
+
|
|
value = readl(&ippc->u3_ctrl_p[i]);
|
|
value &= ~(CTRL_U3_PORT_PDN | CTRL_U3_PORT_DIS);
|
|
value |= CTRL_U3_PORT_HOST_SEL;
|
|
@@ -126,7 +132,7 @@ static int xhci_mtk_host_enable(struct x
|
|
check_val = STS1_SYSPLL_STABLE | STS1_REF_RST |
|
|
STS1_SYS125_RST | STS1_XHCI_RST;
|
|
|
|
- if (mtk->num_u3_ports)
|
|
+ if (mtk->num_u3_ports > u3_ports_disabed)
|
|
check_val |= STS1_U3_MAC_RST;
|
|
|
|
ret = readl_poll_timeout(&ippc->ip_pw_sts1, value,
|
|
@@ -149,8 +155,11 @@ static int xhci_mtk_host_disable(struct
|
|
if (!mtk->has_ippc)
|
|
return 0;
|
|
|
|
- /* power down all u3 ports */
|
|
+ /* power down u3 ports except skipped ones */
|
|
for (i = 0; i < mtk->num_u3_ports; i++) {
|
|
+ if ((0x1 << i) & mtk->u3p_dis_msk)
|
|
+ continue;
|
|
+
|
|
value = readl(&ippc->u3_ctrl_p[i]);
|
|
value |= CTRL_U3_PORT_PDN;
|
|
writel(value, &ippc->u3_ctrl_p[i]);
|
|
@@ -573,6 +582,9 @@ static int xhci_mtk_probe(struct platfor
|
|
}
|
|
|
|
mtk->lpm_support = of_property_read_bool(node, "usb3-lpm-capable");
|
|
+ /* optional property, ignore the error if it does not exist */
|
|
+ of_property_read_u32(node, "mediatek,u3p-dis-msk",
|
|
+ &mtk->u3p_dis_msk);
|
|
|
|
ret = usb_wakeup_of_property_parse(mtk, node);
|
|
if (ret)
|
|
--- a/drivers/usb/host/xhci-mtk.h
|
|
+++ b/drivers/usb/host/xhci-mtk.h
|
|
@@ -121,6 +121,7 @@ struct xhci_hcd_mtk {
|
|
bool has_ippc;
|
|
int num_u2_ports;
|
|
int num_u3_ports;
|
|
+ int u3p_dis_msk;
|
|
struct regulator *vusb33;
|
|
struct regulator *vbus;
|
|
struct clk *sys_clk; /* sys and mac clock */
|