1 files changed, 33 insertions, 0 deletions
diff --git a/src/mainboard/prodrive/hermes/bootblock.c b/src/mainboard/prodrive/hermes/bootblock.c
new file mode 100644
index 0000000000..1426a552d4
--- /dev/null
+++ b/src/mainboard/prodrive/hermes/bootblock.c
@@ -0,0 +1,33 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#include <bootblock_common.h>
+#include <console/console.h>
+#include <soc/gpio.h>
+#include <variant/gpio.h>
+#include "gpio.h"
+
+static void early_config_gpio(void)
+{
+	/* This is a hack for FSP because it does things in MemoryInit()
+	 * which it shouldn't do. We have to prepare certain gpios here
+	 * because of the brokenness in FSP. */
+	size_t num = 0;
+	const struct pad_config *early_gpio_table = get_early_gpio_table(&num);
+
+	gpio_configure_pads(early_gpio_table, num);
+}
+
+void bootblock_mainboard_early_init(void)
+{
+	early_config_gpio();
+}
+
+void bootblock_mainboard_init(void)
+{
+	u8 bmc_hsi = (gpio_get(GPP_K13) << 3) |
+		(gpio_get(GPP_K12) << 2) |
+		(gpio_get(GPP_K14) << 1) |
+		(gpio_get(GPP_K16) << 0);
+
+	printk(BIOS_INFO, "BMC HSI 0x%x\n", bmc_hsi);
+}