1 files changed, 125 insertions, 0 deletions
diff --git a/src/soc/mediatek/common/tracker.c b/src/soc/mediatek/common/tracker.c
new file mode 100644
index 0000000000..6d4e6b2f05
--- /dev/null
+++ b/src/soc/mediatek/common/tracker.c
@@ -0,0 +1,125 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#include <stdio.h>
+#include <console/console.h>
+#include <device/mmio.h>
+#include <soc/addressmap.h>
+#include <soc/tracker_common.h>
+
+static struct tracker {
+	uintptr_t base_addr;
+	u32 timeout;
+	u32 entry;
+	u32 offset[2];
+	const char *str;
+} tracker_data[TRACKER_NUM] = {
+	[TRACKER_SYSTRACKER] = {
+		.base_addr = DBG_TRACKER_BASE,
+		.timeout = BUS_DBG_CON_TIMEOUT,
+		.entry = SYS_TRACK_ENTRY,
+		.offset[0] = AR_TRACK_OFFSET,
+		.offset[1] = AW_TRACK_OFFSET,
+		.str = "systracker",
+	},
+	[TRACKER_INFRATRACKER] = {
+		.base_addr = INFRA_TRACKER_BASE,
+		.timeout = BUSTRACKER_TIMEOUT,
+		.entry = INFRA_ENTRY_NUM,
+		.offset[0] = AR_TRACK_OFFSET,
+		.offset[1] = AW_TRACK_OFFSET,
+		.str = "infra_tracker",
+	},
+	[TRACKER_PERISYSTRACKER] = {
+		.base_addr = PERI_TRACKER_BASE,
+		.timeout = BUSTRACKER_TIMEOUT,
+		.entry = PERI_ENTRY_NUM,
+		.offset[0] = AR_TRACK_OFFSET,
+		.offset[1] = AW_TRACK_OFFSET,
+		.str = "peri_tracker",
+	},
+};
+
+static void setup_init(void)
+{
+	u32 val;
+	/*
+	 * Set infra/peri tracker timeout.
+	 * timeout = clock_in_mhz * 1000 / 16 * timeout_in_ms
+	 *
+	 * timeout: 200ms
+	 * infra tracker clock: 156MHz
+	 * peri tracker clock: 78MHz
+	 */
+	val = 156 * 1000 / 16 * 200;
+	write32((void *)(INFRA_TRACKER_BASE + BUS_DBG_TIMER_CON0), val);
+	write32((void *)(INFRA_TRACKER_BASE + BUS_DBG_TIMER_CON1), val);
+
+	val = 78 * 1000 / 16 * 200;
+	write32((void *)(PERI_TRACKER_BASE + BUS_DBG_TIMER_CON0), val);
+	write32((void *)(PERI_TRACKER_BASE + BUS_DBG_TIMER_CON1), val);
+
+	/* Enable infra/peri tracer because tracker and tracer share the same enable bit. */
+	write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_1), 1 << BUS_TRACE_EN);
+	write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_2), 1 << BUS_TRACE_EN);
+
+	/*
+	 * Enable infra/peri tracker.
+	 * bit[0] - BUS_DBG_EN
+	 * bit[1] - TIMEOUT_EN
+	 * bit[2] - SLV_ERR_EN
+	 * bit[13] - HALT_ON_TIMEOUT_EN
+	 * bit[14] - BUS_OT_WEN_CTRL
+	 */
+	val = BIT(0) | BIT(1) | BIT(2) | BIT(13) | BIT(14);
+	write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_AO_1), val);
+	write32((void *)(BUS_TRACE_MONITOR_BASE + BUS_TRACE_CON_AO_2), val);
+
+}
+
+static void tracker_dump_data(void)
+{
+	int i, j, k;
+	int size;
+	uintptr_t reg;
+	struct tracker *tra;
+
+	for (j = 0; j < TRACKER_NUM; j++) {
+		tra = &tracker_data[j];
+
+		if (!(read32((void *)(tra->base_addr)) & tra->timeout))
+			continue;
+
+		printk(BIOS_INFO, "**Dump %s debug register start**\n", tra->str);
+		for (k = 0; k < 2; k++) {
+			/*
+			 * for systracker:
+			 * offset[0] dump from offset 0x100 ~ 0x2F8.
+			 * offset[1] dump from offset 0x300 ~ 0x4FC
+			 *
+			 * for infra tracker:
+			 * offset[0] dump from offset 0x100 ~ 0x1F8
+			 * offset[1] dump from offset 0x300 ~ 0x3FC
+			 *
+			 * for perisys tracker:
+			 * offset[0] dump from offset 0x100 ~ 0x2F8
+			 * offset[1] dump from offset 0x300 ~ 0x4FC
+			 */
+			size = 2 * tra->entry;
+			for (i = 0; i < size; i++) {
+				reg = tra->base_addr + tra->offset[k] + i * 4;
+				printk(BIOS_INFO, "%#lx:%#x,", reg, read32((void *)reg));
+
+				if (i % 4 == 3 || i == size - 1)
+					printk(BIOS_INFO, "\n");
+			}
+		}
+
+		printk(BIOS_INFO, "**Dump %s debug register end**\n", tra->str);
+	}
+}
+
+void bustracker_init(void)
+{
+	tracker_dump_data();
+	setup_init();
+}