1 files changed, 271 insertions, 0 deletions
diff --git a/src/soc/intel/tigerlake/early_tcss.c b/src/soc/intel/tigerlake/early_tcss.c
new file mode 100644
index 0000000000..3944f61843
--- /dev/null
+++ b/src/soc/intel/tigerlake/early_tcss.c
@@ -0,0 +1,271 @@
+/* SPDX-License-Identifier: GPL-2.0-or-later */
+
+#include <console/console.h>
+#include <device/pci.h>
+#include <intelblocks/pmc_ipc.h>
+#include <soc/early_tcss.h>
+#include <soc/pci_devs.h>
+#include <stdlib.h>
+#include <inttypes.h>
+
+
+static uint32_t tcss_make_conn_cmd(int u, int u3, int u2, int ufp, int hsl,
+					int sbu, int acc)
+{
+	return TCSS_CD_FIELD(USAGE, u) |
+		TCSS_CD_FIELD(USB3, u3) |
+		TCSS_CD_FIELD(USB2, u2) |
+		TCSS_CD_FIELD(UFP, ufp) |
+		TCSS_CD_FIELD(HSL, hsl) |
+		TCSS_CD_FIELD(SBU, sbu) |
+		TCSS_CD_FIELD(ACC, acc);
+}
+
+static uint32_t tcss_make_alt_mode_cmd_buf_0(int u, int u3, int m)
+{
+	return TCSS_ALT_FIELD(USAGE, u) |
+		TCSS_ALT_FIELD(USB3, u3) |
+		TCSS_ALT_FIELD(MODE, m);
+
+}
+
+static uint32_t tcss_make_alt_mode_cmd_buf_1(int p, int c, int ufp, int dp)
+{
+	return TCSS_ALT_FIELD(POLARITY, p) |
+		TCSS_ALT_FIELD(CABLE, c) |
+		TCSS_ALT_FIELD(UFP, ufp) |
+		TCSS_ALT_FIELD(DP_MODE, dp);
+}
+
+static uint32_t tcss_make_safe_mode_cmd(int u, int u3)
+{
+	return TCSS_CD_FIELD(USAGE, u) |
+		TCSS_CD_FIELD(USB3, u3);
+}
+
+
+static uint32_t tcss_make_hpd_mode_cmd(int u, int u3, int hpd_lvl, int hpd_irq)
+{
+	return TCSS_HPD_FIELD(USAGE, u) |
+		TCSS_HPD_FIELD(USB3, u3) |
+		TCSS_HPD_FIELD(LVL, hpd_lvl) |
+		TCSS_HPD_FIELD(IRQ, hpd_irq);
+
+}
+
+static int send_pmc_req(int cmd_type, const struct pmc_ipc_buffer *req,
+			struct pmc_ipc_buffer *res, uint32_t size)
+{
+
+	uint32_t cmd_reg;
+	uint32_t res_reg;
+	int tries = 2;
+	int r;
+
+	cmd_reg = pmc_make_ipc_cmd(PMC_IPC_USBC_CMD_ID, PMC_IPC_USBC_SUBCMD_ID,
+				   size);
+
+	printk(BIOS_DEBUG, "Raw Buffer output 0 %08" PRIx32 "\n", req->buf[0]);
+	printk(BIOS_DEBUG, "Raw Buffer output 1 %08" PRIx32 "\n", req->buf[1]);
+
+	do {
+		r = pmc_send_ipc_cmd(cmd_reg, req, res);
+		if (r < 0) {
+			printk(BIOS_ERR, "pmc_send_ipc_cmd failed\n");
+			return -1;
+		}
+
+		res_reg = res->buf[0];
+		if (cmd_type == CONNECT_REQ) {
+			if (!TCSS_CONN_STATUS_HAS_FAILED(res_reg)) {
+				printk(BIOS_DEBUG, "pmc_send_ipc_cmd succeeded\n");
+				return 0;
+			}
+
+			if (TCSS_CONN_STATUS_IS_FATAL(res_reg)) {
+				printk(BIOS_ERR, "pmc_send_ipc_cmd status: fatal\n");
+				return -1;
+			}
+		} else {
+			if (!TCSS_STATUS_HAS_FAILED(res_reg)) {
+				printk(BIOS_DEBUG, "pmc_send_ipc_cmd succeeded\n");
+				return 0;
+			}
+
+			if (TCSS_STATUS_IS_FATAL(res_reg)) {
+				printk(BIOS_ERR, "pmc_send_ipc_cmd status: fatal\n");
+				return -1;
+			}
+		}
+	} while (--tries >= 0);
+
+	printk(BIOS_ERR, "pmc_send_ipc_cmd failed after retries\n");
+	return -1;
+}
+
+static int send_pmc_connect_request(int port, struct tcss_mux mux_data,
+					struct pmc_ipc_buffer *res)
+{
+	uint32_t cmd;
+	struct pmc_ipc_buffer req = { 0 };
+
+	cmd = tcss_make_conn_cmd(
+		PMC_IPC_TCSS_CONN_REQ_RES,
+		mux_data.usb3_port,
+		mux_data.usb2_port,
+		mux_data.ufp,
+		mux_data.polarity,
+		mux_data.polarity,
+		mux_data.acc);
+
+	req.buf[0] = cmd;
+
+	printk(BIOS_DEBUG, "port C%d CONN req: usage %d usb3 %d usb2 %d "
+	      "ufp %d ori_hsl %d ori_sbu %d dbg_acc %d\n",
+	      port,
+	      GET_TCSS_CD_FIELD(USAGE, cmd),
+	      GET_TCSS_CD_FIELD(USB3, cmd),
+	      GET_TCSS_CD_FIELD(USB2, cmd),
+	      GET_TCSS_CD_FIELD(UFP, cmd),
+	      GET_TCSS_CD_FIELD(HSL, cmd),
+	      GET_TCSS_CD_FIELD(SBU, cmd),
+	      GET_TCSS_CD_FIELD(ACC, cmd));
+
+	return send_pmc_req(CONNECT_REQ, &req, res, PMC_IPC_CONN_REQ_SIZE);
+}
+
+static int send_pmc_safe_mode_request(int port, struct tcss_mux mux_data,
+					struct pmc_ipc_buffer *res)
+{
+	uint32_t cmd;
+	struct pmc_ipc_buffer req = { 0 };
+
+	cmd = tcss_make_safe_mode_cmd(PMC_IPC_TCSS_SAFE_MODE_REQ_RES, mux_data.usb3_port);
+
+	req.buf[0] = cmd;
+
+	printk(BIOS_DEBUG, "port C%d SAFE req: usage %d usb3 %d\n",
+		port,
+		GET_TCSS_CD_FIELD(USAGE, cmd),
+		GET_TCSS_CD_FIELD(USB3, cmd));
+
+	return send_pmc_req(SAFE_REQ, &req, res, PMC_IPC_SAFE_REQ_SIZE);
+}
+
+static int send_pmc_dp_hpd_request(int port, struct tcss_mux mux_data)
+{
+	struct pmc_ipc_buffer *res = NULL;
+	struct pmc_ipc_buffer req = { 0 };
+	uint32_t cmd;
+
+	cmd = tcss_make_hpd_mode_cmd(
+		PMC_IPC_TCSS_HPD_REQ_RES,
+		mux_data.usb3_port,
+		mux_data.hpd_lvl,
+		mux_data.hpd_irq);
+
+	req.buf[0] = cmd;
+
+	return send_pmc_req(HPD_REQ, &req, res, PMC_IPC_HPD_REQ_SIZE);
+
+}
+
+static int send_pmc_dp_mode_request(int port, struct tcss_mux mux_data,
+					struct pmc_ipc_buffer *res)
+{
+	uint32_t cmd;
+	uint8_t dp_mode;
+	int ret;
+
+	struct pmc_ipc_buffer req = { 0 };
+
+	cmd = tcss_make_alt_mode_cmd_buf_0(
+		PMC_IPC_TCSS_ALTMODE_REQ_RES,
+		mux_data.usb3_port,
+		PMC_IPC_DP_MODE);
+
+	req.buf[0] = cmd;
+
+	printk(BIOS_DEBUG, "port C%d ALT_1 req: usage %d usb3 %d dp_mode %d\n",
+		port,
+		GET_TCSS_ALT_FIELD(USAGE, cmd),
+		GET_TCSS_ALT_FIELD(USB3, cmd),
+		GET_TCSS_ALT_FIELD(MODE, cmd));
+
+	switch (mux_data.dp_mode) {
+	case MODE_DP_PIN_A:
+		dp_mode = 1;
+		break;
+	case MODE_DP_PIN_B:
+		dp_mode = 2;
+		break;
+	case MODE_DP_PIN_C:
+		dp_mode = 3;
+		break;
+	case MODE_DP_PIN_D:
+		dp_mode = 4;
+		break;
+	case MODE_DP_PIN_E:
+		dp_mode = 5;
+		break;
+	case MODE_DP_PIN_F:
+		dp_mode = 6;
+		break;
+	default:
+		dp_mode = 0;
+		break;
+	}
+
+	cmd = tcss_make_alt_mode_cmd_buf_1(
+		mux_data.polarity,
+		mux_data.cable,
+		0, /* ufp is not supported in DP ALT Mode request */
+		dp_mode);
+
+	printk(BIOS_DEBUG, "port C%d ALT_2 req: polarity %d cable %d ufp %d "
+				"dp_mode %d\n",
+		port,
+		GET_TCSS_ALT_FIELD(POLARITY, cmd),
+		GET_TCSS_ALT_FIELD(CABLE, cmd),
+		GET_TCSS_ALT_FIELD(UFP, cmd),
+		GET_TCSS_ALT_FIELD(DP_MODE, cmd));
+
+	req.buf[1] = cmd;
+
+	ret = send_pmc_req(DP_REQ, &req, res, PMC_IPC_ALT_REQ_SIZE);
+	if (ret)
+		return ret;
+
+	send_pmc_dp_hpd_request(port, mux_data);
+	return 0;
+}
+
+void update_tcss_mux(int port, struct tcss_mux mux_data)
+{
+	struct pmc_ipc_buffer *rbuf = NULL;
+	int ret = 0;
+
+	/* check if mux has a DP device */
+	if (mux_data.dp) {
+		ret = send_pmc_connect_request(port, mux_data, rbuf);
+		if (ret) {
+			printk(BIOS_ERR, "Port %d connect request failed\n", port);
+			return;
+		}
+		ret = send_pmc_safe_mode_request(port, mux_data, rbuf);
+		if (ret) {
+			printk(BIOS_ERR, "Port %d safe mode request failed\n", port);
+			return;
+		}
+
+		ret = send_pmc_dp_mode_request(port, mux_data, rbuf);
+	}
+
+	if (ret)
+		printk(BIOS_ERR, "Port C%d mux set failed with error %d\n", port, ret);
+}
+
+__weak void mainboard_early_tcss_enable(void)
+{
+	/* to be overwritten by each mainboard that needs early tcss */
+}