t210: implement MBIST workaround

MBIST has left some registers in non-suggested states. This CL
restores CAR CE's, SLCG overrides & PLLD settings.

BUG=None
BRANCH=None
TEST=tested on Smaug, still boot to kernel

Change-Id: I1ddb19dd9fb6d8fb4d36e67eedeb847c6fd9f774
Signed-off-by: Patrick Georgi <pgeorgi@chromium.org>
Original-Commit-Id: 37a1c90c6deb351b2ae2caa03e5076553126744b
Original-Change-Id: I613b4ef622d64305d436cb8379a5170b0fe1c9af
Original-Signed-off-by: Yen Lin <yelin@nvidia.com>
Original-Reviewed-on: https://chromium-review.googlesource.com/282417
Original-Reviewed-by: Tom Warren <twarren@nvidia.com>
Original-Reviewed-by: Furquan Shaikh <furquan@chromium.org>
Reviewed-on: http://review.coreboot.org/11039
Tested-by: build bot (Jenkins)
Reviewed-by: Patrick Georgi <pgeorgi@google.com>

1 files changed, 104 insertions, 0 deletions

diff --git a/src/soc/nvidia/tegra210/bootblock.c b/src/soc/nvidia/tegra210/bootblock.c
index a6aa5847f7..0469320da4 100644
--- a/src/soc/nvidia/tegra210/bootblock.c
+++ b/src/soc/nvidia/tegra210/bootblock.c
@@ -22,6 +22,7 @@
 #include <arch/stages.h>
 #include <bootblock_common.h>
 #include <console/console.h>
+#include <delay.h>
 #include <program_loading.h>
 #include <soc/addressmap.h>
 #include <soc/clock.h>
@@ -58,11 +59,113 @@ void __attribute__((weak)) bootblock_mainboard_early_init(void)
 	/* Empty default implementation. */
 }
 
+/*
+ * Define operations for the workaround:
+ *   OP_SET : [reg] = val;
+ *   OP_OR  : [reg] |= val;
+ *   OP_AND : [reg] &= val;
+ *   OP_UDELAY : udelay(val);
+ */
+typedef enum {
+	OP_SET,
+	OP_OR,
+	OP_AND,
+	OP_UDELAY,	/* use val field as usec delay */
+} WAR_OP;
+
+struct workaround_op {
+	WAR_OP	op;
+	u32	reg;
+	u32	val;
+};
+
+/*
+ * An array defines the sequence to perform the workaround
+ */
+static struct workaround_op workaround_sequence[] = {
+	{OP_OR,  0x60006410, (1 << 15)},	/* CLK_SOURCE_SOR1: */
+	{OP_AND, 0x60006410, ~(1 << 14)},	/*   CLK_SEL1=1, CLK_SEL0=0 */
+	{OP_OR,  0x600060d0, 0x40800000},	/* PLLD_BASE */
+	{OP_SET, 0x600062ac, 0x40},		/* clear APE reset */
+	{OP_SET, 0x60006294, 0x40000},		/* clear VIC reset */
+	{OP_SET, 0x60006304, 0x18000000},	/* clear HOST1X & DISP1 reset */
+	{OP_UDELAY, 0, 2},
+	{OP_OR,  0x702d10a0, 0x400},		/* I2S0: I2S_CTRL.MASTER=1 */
+	{OP_AND, 0x702d1088, ~1},		/* I2S0: I2S_CG.SLCG_ENABLE=0 */
+	{OP_OR,  0x702d11a0, 0x400},		/* I2S1: I2S_CTRL.MASTER=1 */
+	{OP_AND, 0x702d1188, ~1},		/* I2S1: I2S_CG.SLCG_ENABLE=0 */
+	{OP_OR,  0x702d12a0, 0x400},		/* I2S2: I2S_CTRL.MASTER=1 */
+	{OP_AND, 0x702d1288, ~1},		/* I2S2: I2S_CG.SLCG_ENABLE=0 */
+	{OP_OR,  0x702d13a0, 0x400},		/* I2S3: I2S_CTRL.MASTER=1 */
+	{OP_AND, 0x702d1388, ~1},		/* I2S3: I2S_CG.SLCG_ENABLE=0 */
+	{OP_OR,  0x702d14a0, 0x400},		/* I2S4: I2S_CTRL.MASTER=1 */
+	{OP_AND, 0x702d1488, ~1},		/* I2S4: I2S_CG.SLCG_ENABLE=0 */
+	{OP_OR,  0x54200cf8, 4},		/* DC_COM_DSC_TOP_CTL[DSC_SLCG_OVERRIDE]=1 */
+	{OP_SET, 0x543400c8, 0xffffffff},	/* NV_PVIC_THI_SLCG_OVERRIDE_LOW_A = 0xFFFF_FFFF */
+	{OP_UDELAY, 0, 2},
+	{OP_SET, 0x600062a8, 0x40},		/* set APE reset */
+	{OP_SET, 0x60006300, 0x18000000},	/* set HOST1X & DISP1 reset */
+	{OP_SET, 0x60006290, 0x40000},		/* set VIC reset */
+	{OP_SET, 0x60006014, 0x020000c1},	/* CLK_ENB_H */
+	{OP_SET, 0x60006010, 0x80400130},	/* CLK_ENB_L */
+	{OP_SET, 0x60006018, 0x01f00200},	/* CLK_ENB_U */
+	{OP_SET, 0x60006360, 0x80400808},	/* CLK_ENB_V */
+	{OP_SET, 0x60006364, 0x402000fc},	/* CLK_ENB_W */
+	{OP_SET, 0x60006280, 0x23000780},	/* CLK_ENB_X */
+	{OP_SET, 0x60006298, 0x00000340},	/* CLK_ENB_Y */
+	{OP_SET, 0x600060f8, 0x00000000},	/* LVL2_CLK_GATE_OVRA */
+	{OP_SET, 0x600060fc, 0x00000000},	/* LVL2_CLK_GATE_OVRB */
+	{OP_SET, 0x600063a0, 0x00000000},	/* LVL2_CLK_GATE_OVRC */
+	{OP_SET, 0x600063a4, 0x01000000},	/* LVL2_CLK_GATE_OVRD, QSPI_CLK_OVR_ON=1 */
+	{OP_SET, 0x60006554, 0x00000000},	/* LVL2_CLK_GATE_OVRE */
+	{OP_AND, 0x600060d0, 0x1f7fffff},	/* PLLD_BASE: 31,30,29,23 = 0 */
+	{OP_AND, 0x60006410, 0xffff3fff},	/* CLK_SOURCE_SOR1 15,14 = 0 */
+	{OP_AND, 0x60006148, ~(7 << 29)},	/* CLK_SOURCE_VI: */
+	{OP_OR,  0x60006148, (4 << 29)},	/*   SRC=PLLP_OUT0 (4) */
+	{OP_AND, 0x60006180, ~(7 << 29)},	/* CLK_SOURCE_HOST1X: */
+	{OP_OR,  0x60006180, (4 << 29)},	/*   SRC=PLLP_OUT0 (4) */
+	{OP_AND, 0x600066a0, ~(7 << 29)},	/* CLK_SOURCE_NVENC: */
+	{OP_OR,  0x600066a0, (4 << 29)}		/*   SRC=PLLP_OUT0 (4) */
+};
+
+/*
+ * This workaround is to restore CAR CE's, SLCG overrides & PLLD settings
+ */
+static void mbist_workaround(void)
+{
+	int i;
+	u32 val;
+	struct workaround_op *wa_op;
+
+	for (i = 0; i < ARRAY_SIZE(workaround_sequence); ++i) {
+		wa_op = &workaround_sequence[i];
+		switch (wa_op->op) {
+		case OP_SET:
+			val = wa_op->val;
+			break;
+		case OP_OR:
+			val = read32((void *)wa_op->reg) | wa_op->val;
+			break;
+		case OP_AND:
+			val = read32((void *)wa_op->reg) & wa_op->val;
+			break;
+		case OP_UDELAY:
+			udelay(wa_op->val);
+			/* fall thru */
+		default:
+			continue;
+		}
+		write32((void *)wa_op->reg, val);
+	}
+}
+
 void main(void)
 {
 	// enable JTAG at the earliest stage
 	enable_jtag();
 
+	mbist_workaround();
+
 	clock_early_uart();
 
 	/* Configure mselect clock. */
@@ -90,6 +193,7 @@ void main(void)
 
 	pmc_print_rst_status();
 
+
 	bootblock_mainboard_init();
 
 	printk(BIOS_INFO, "T210 bootblock: Mainboard bootblock init done\n");