Boot firmware on AMD's Yellow Carp and Pink Sardine allocates
very minimal buses for PCIe downstream ports. This results in
failure to extend the daisy chain.
Add quirk to reset the downstream port to help reset the topology
created by boot firmware.
Suggested-by: Mario Limonciello <mario.limonciello@xxxxxxx>
Signed-off-by: Sanath S <Sanath.S@xxxxxxx>
Cc: <stable@xxxxxxxxxxxxxxx>
---
drivers/thunderbolt/quirks.c | 14 ++++++++++++++
drivers/thunderbolt/switch.c | 28 ++++++++++++++++++++++++++++
drivers/thunderbolt/tb.h | 2 ++
drivers/thunderbolt/tb_regs.h | 1 +
4 files changed, 45 insertions(+)
diff --git a/drivers/thunderbolt/quirks.c b/drivers/thunderbolt/quirks.c
index e6bfa63b40ae..45e9d6c43e4a 100644
--- a/drivers/thunderbolt/quirks.c
+++ b/drivers/thunderbolt/quirks.c
@@ -27,6 +27,12 @@ static void quirk_clx_disable(struct tb_switch *sw)
tb_sw_dbg(sw, "disabling CL states\n");
}
+static void quirk_amd_downstream_port_reset(struct tb_switch *sw)
+{
+ sw->quirks |= QUIRK_DPR;
+ tb_sw_dbg(sw, "Resetting Down Stream Port\n");
+}
+
static void quirk_usb3_maximum_bandwidth(struct tb_switch *sw)
{
struct tb_port *port;
@@ -93,6 +99,14 @@ static const struct tb_quirk tb_quirks[] = {
{ 0x0438, 0x0209, 0x0000, 0x0000, quirk_clx_disable },
{ 0x0438, 0x020a, 0x0000, 0x0000, quirk_clx_disable },
{ 0x0438, 0x020b, 0x0000, 0x0000, quirk_clx_disable },
+ /*
+ * Reset Down Stream Ports on AMD USB4 Yellow Carp and
+ * Pink Sardine platforms.
+ */
+ { 0x0438, 0x0208, 0x0000, 0x0000, quirk_amd_downstream_port_reset },
+ { 0x0438, 0x0209, 0x0000, 0x0000, quirk_amd_downstream_port_reset },
+ { 0x0438, 0x020a, 0x0000, 0x0000, quirk_amd_downstream_port_reset },
+ { 0x0438, 0x020b, 0x0000, 0x0000, quirk_amd_downstream_port_reset },
};
/**
diff --git a/drivers/thunderbolt/switch.c b/drivers/thunderbolt/switch.c
index 1e15ffa79295..75780c6feea3 100644
--- a/drivers/thunderbolt/switch.c
+++ b/drivers/thunderbolt/switch.c
@@ -1547,6 +1547,23 @@ static void tb_dump_switch(const struct tb *tb, const struct tb_switch *sw)
regs->__unknown1, regs->__unknown4);
}
+static int tb_switch_reset_downstream_port(struct tb_switch *sw)
+{
+ struct tb_port *port;
+ uint32_t val = 0;
+ int ret;
+
+ tb_switch_for_each_port(sw, port) {
+ if (port->config.type == TB_TYPE_PORT) {
+ val = val | PORT_CS_19_DPR;
+ ret = tb_port_write(port, &val, TB_CFG_PORT,
+ port->cap_usb4 + PORT_CS_19, 1);
+ break;
+ }
+ }
+ return ret;
+}
+
/**
* tb_switch_reset() - reconfigure route, enable and send TB_CFG_PKG_RESET
* @sw: Switch to reset
@@ -3201,6 +3218,17 @@ int tb_switch_add(struct tb_switch *sw)
return ret;
}
+ /*
+ * PCIe resource allocated by boot firmware is not utilizing all the
+ * available buses, So perform reset of topology to avoid failure in
+ * extending daisy chain.
+ */
+ if (sw->quirks & QUIRK_DPR) {
+ ret = tb_switch_reset_downstream_port(sw);
+ if (ret)
+ return ret;
+ }
+
ret = tb_switch_port_hotplug_enable(sw);
if (ret)
return ret;
diff --git a/drivers/thunderbolt/tb.h b/drivers/thunderbolt/tb.h
index e299e53473ae..7a9ff53be67a 100644
--- a/drivers/thunderbolt/tb.h
+++ b/drivers/thunderbolt/tb.h
@@ -23,6 +23,8 @@
#define QUIRK_FORCE_POWER_LINK_CONTROLLER BIT(0)
/* Disable CLx if not supported */
#define QUIRK_NO_CLX BIT(1)
+/* Reset Down Stream Port */
+#define QUIRK_DPR BIT(2)
/**
* struct tb_nvm - Structure holding NVM information
diff --git a/drivers/thunderbolt/tb_regs.h b/drivers/thunderbolt/tb_regs.h
index 87e4795275fe..d49530bc0d53 100644
--- a/drivers/thunderbolt/tb_regs.h
+++ b/drivers/thunderbolt/tb_regs.h
@@ -389,6 +389,7 @@ struct tb_regs_port_header {
#define PORT_CS_18_CSA BIT(22)
#define PORT_CS_18_TIP BIT(24)
#define PORT_CS_19 0x13
+#define PORT_CS_19_DPR BIT(0)
#define PORT_CS_19_PC BIT(3)
#define PORT_CS_19_PID BIT(4)
#define PORT_CS_19_WOC BIT(16)
--
2.34.1
