1 files changed, 124 insertions, 1 deletions
diff --git a/src/mainboard/intel/apollolake_rvp/romstage.c b/src/mainboard/intel/apollolake_rvp/romstage.c
index 7cfef9f210..99fa5a973e 100644
--- a/src/mainboard/intel/apollolake_rvp/romstage.c
+++ b/src/mainboard/intel/apollolake_rvp/romstage.c
@@ -1 +1,124 @@
-/* Nothing here yet, but this file is needed by the build system */
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2015 Intel Corp.
+ * (Written by Lance Zhao <lijian.zhao@intel.com> for Intel Corp.)
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <soc/romstage.h>
+#include <string.h>
+#include <fsp/api.h>
+#include <soc/fsp/FspmUpd.h>
+
+static const uint8_t swizzling_rvp1[] = {
+	 0,  1,  2,  3,  4,  5,  6,  7,  8,  9, 10, 11, 12, 13, 14, 15,
+	16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
+};
+
+static const uint8_t swizzling0_rvp2[] = {
+	23, 21, 16, 17, 18, 19, 22, 20,  3,  5,  2,  4,  7,  0,  6,  1,
+	24, 27, 26, 30, 28, 25, 29, 31, 13,  8, 12, 15, 10, 14, 11,  9,
+};
+
+static const uint8_t swizzling1_rvp2[] = {
+	10, 14, 12, 13,  9, 11, 15,  8,  1,  6,  2,  5,  0,  7,  3,  4,
+	21, 18, 19, 22, 20, 17, 16, 23, 29, 28, 24, 27, 31, 30, 26, 25,
+};
+
+static const uint8_t swizzling2_rvp2[] = {
+	13, 15, 10, 14,  9, 12,  8, 11, 22, 19, 16, 23, 21, 17, 20, 18,
+	26, 24, 28, 29, 31, 30, 27, 25,  4,  5,  1,  0,  3,  6,  7,  2,
+};
+
+static const uint8_t swizzling3_rvp2[] = {
+	 0,  3,  6,  7,  4,  5,  1,  2, 20, 17, 21, 16, 23, 18, 22, 19,
+	15,  9, 11, 14, 12,  8, 13, 10, 26, 29, 24, 31, 25, 30, 27, 28,
+};
+
+static void rvp1_fill_memory_params(struct FSPM_UPD *mupd)
+{
+	mupd->FspmConfig.Profile = 33;
+	mupd->FspmConfig.DIMM0SPDAddress = 0xa0;
+	mupd->FspmConfig.DIMM1SPDAddress = 0xa4;
+	mupd->FspmConfig.Ch0_RankEnable = 0;
+	mupd->FspmConfig.Ch0_DeviceWidth = 0;
+	mupd->FspmConfig.Ch0_DramDensity = 0;
+	mupd->FspmConfig.Ch0_Option = 3;
+	mupd->FspmConfig.Ch1_RankEnable = 0;
+	mupd->FspmConfig.Ch1_DeviceWidth = 0;
+	mupd->FspmConfig.Ch1_DramDensity = 0;
+	mupd->FspmConfig.Ch1_Option = 3;
+	mupd->FspmConfig.Ch2_RankEnable = 0;
+	mupd->FspmConfig.Ch2_DeviceWidth = 0;
+	mupd->FspmConfig.Ch2_DramDensity = 0;
+	mupd->FspmConfig.Ch2_Option = 3;
+	mupd->FspmConfig.Ch3_RankEnable = 0;
+	mupd->FspmConfig.Ch3_DeviceWidth = 0;
+	mupd->FspmConfig.Ch3_DramDensity = 0;
+	mupd->FspmConfig.Ch3_Option = 3;
+	memcpy(mupd->FspmConfig.Ch0_Bit_swizzling, swizzling_rvp1, sizeof(swizzling_rvp1));
+	memcpy(mupd->FspmConfig.Ch1_Bit_swizzling, swizzling_rvp1, sizeof(swizzling_rvp1));
+	memcpy(mupd->FspmConfig.Ch2_Bit_swizzling, swizzling_rvp1, sizeof(swizzling_rvp1));
+	memcpy(mupd->FspmConfig.Ch3_Bit_swizzling, swizzling_rvp1, sizeof(swizzling_rvp1));
+}
+
+static void rvp2_fill_memory_params(struct FSPM_UPD *mupd)
+{
+	mupd->FspmConfig.Profile = 5;
+	mupd->FspmConfig.DIMM0SPDAddress = 0;
+	mupd->FspmConfig.DIMM1SPDAddress = 0;
+	mupd->FspmConfig.Ch0_RankEnable = 3;
+	mupd->FspmConfig.Ch0_DeviceWidth = 2;
+	mupd->FspmConfig.Ch0_DramDensity = 0;
+	mupd->FspmConfig.Ch0_Option = 3;
+	mupd->FspmConfig.Ch1_RankEnable = 3;
+	mupd->FspmConfig.Ch1_DeviceWidth = 2;
+	mupd->FspmConfig.Ch1_DramDensity = 0;
+	mupd->FspmConfig.Ch1_Option = 3;
+	mupd->FspmConfig.Ch2_RankEnable = 3;
+	mupd->FspmConfig.Ch2_DeviceWidth = 2;
+	mupd->FspmConfig.Ch2_DramDensity = 0;
+	mupd->FspmConfig.Ch2_Option = 3;
+	mupd->FspmConfig.Ch3_RankEnable = 3;
+	mupd->FspmConfig.Ch3_DeviceWidth = 2;
+	mupd->FspmConfig.Ch3_DramDensity = 0;
+	mupd->FspmConfig.Ch3_Option = 3;
+	memcpy(mupd->FspmConfig.Ch0_Bit_swizzling, swizzling0_rvp2,
+	       sizeof(swizzling0_rvp2));
+	memcpy(mupd->FspmConfig.Ch1_Bit_swizzling, swizzling1_rvp2,
+	       sizeof(swizzling1_rvp2));
+	memcpy(mupd->FspmConfig.Ch2_Bit_swizzling, swizzling2_rvp2,
+	       sizeof(swizzling2_rvp2));
+	memcpy(mupd->FspmConfig.Ch3_Bit_swizzling, swizzling3_rvp2,
+	       sizeof(swizzling3_rvp2));
+}
+
+void mainboard_memory_init_params(struct FSPM_UPD *mupd)
+{
+	mupd->FspmConfig.Package = 0;
+	mupd->FspmConfig.MemoryDown = 1;
+	mupd->FspmConfig.DDR3LPageSize = 0;
+	mupd->FspmConfig.DDR3LASR = 0;
+	mupd->FspmConfig.ScramblerSupport = 1;
+	mupd->FspmConfig.ChannelHashMask = 0;
+	mupd->FspmConfig.SliceHashMask = 0;
+	mupd->FspmConfig.InterleavedMode = 0;
+	mupd->FspmConfig.ChannelsSlicesEnable = 0;
+	mupd->FspmConfig.MinRefRate2xEnable = 0;
+	mupd->FspmConfig.DualRankSupportEnable = 1;
+	mupd->FspmConfig.DisableFastBoot = 0;
+	mupd->FspmConfig.RmtMode = 0;
+	mupd->FspmConfig.MemorySizeLimit = 0;
+	mupd->FspmConfig.LowMemoryMaxValue = 0;
+	mupd->FspmConfig.HighMemoryMaxValue = 0;
+
+	if (IS_ENABLED(CONFIG_BOARD_INTEL_APOLLOLAKE_RVP1))
+		rvp1_fill_memory_params(mupd);
+	else
+		rvp2_fill_memory_params(mupd);
+}