1 files changed, 61 insertions, 0 deletions
diff --git a/board/volmar/fw_config.c b/board/volmar/fw_config.c
new file mode 100644
index 0000000000..544f276d25
--- /dev/null
+++ b/board/volmar/fw_config.c
@@ -0,0 +1,61 @@
+/* Copyright 2022 The Chromium OS Authors. All rights reserved.
+ * Use of this source code is governed by a BSD-style license that can be
+ * found in the LICENSE file.
+ */
+
+#include "cbi.h"
+#include "common.h"
+#include "compile_time_macros.h"
+#include "console.h"
+#include "cros_board_info.h"
+#include "fw_config.h"
+
+#define CPRINTS(format, args...) cprints(CC_CHIPSET, format, ## args)
+
+static union brya_cbi_fw_config fw_config;
+BUILD_ASSERT(sizeof(fw_config) == sizeof(uint32_t));
+
+/*
+ * FW_CONFIG defaults for brya if the CBI.FW_CONFIG data is not
+ * initialized.
+ */
+static const union brya_cbi_fw_config fw_config_defaults = {
+	.usb_db = DB_USB3_PS8815,
+	.kb_bl = KEYBOARD_BACKLIGHT_ENABLED,
+};
+
+/****************************************************************************
+ * Brya FW_CONFIG access
+ */
+void board_init_fw_config(void)
+{
+	if (cbi_get_fw_config(&fw_config.raw_value)) {
+		CPRINTS("CBI: Read FW_CONFIG failed, using board defaults");
+		fw_config = fw_config_defaults;
+	}
+
+	if (get_board_id() == 0) {
+		/*
+		 * Early boards have a zero'd out FW_CONFIG, so replace
+		 * it with a sensible default value. If DB_USB_ABSENT2
+		 * was used as an alternate encoding of DB_USB_ABSENT to
+		 * avoid the zero check, then fix it.
+		 */
+		if (fw_config.raw_value == 0) {
+			CPRINTS("CBI: FW_CONFIG is zero, using board defaults");
+			fw_config = fw_config_defaults;
+		} else if (fw_config.usb_db == DB_USB_ABSENT2) {
+			fw_config.usb_db = DB_USB_ABSENT;
+		}
+	}
+}
+
+union brya_cbi_fw_config get_fw_config(void)
+{
+	return fw_config;
+}
+
+enum ec_cfg_usb_db_type ec_cfg_usb_db_type(void)
+{
+	return fw_config.usb_db;
+}