2 files changed, 78 insertions, 0 deletions
diff --git a/src/soc/mediatek/common/early_init.c b/src/soc/mediatek/common/early_init.c
new file mode 100644
index 0000000000..329663c8c3
--- /dev/null
+++ b/src/soc/mediatek/common/early_init.c
@@ -0,0 +1,52 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#include <assert.h>
+#include <soc/early_init.h>
+#include <stdlib.h>
+#include <string.h>
+
+static struct early_init_data *find_early_init(void)
+{
+	assert(sizeof(struct early_init_data) <= REGION_SIZE(early_init_data));
+	return (struct early_init_data *)_early_init_data;
+}
+
+void early_init_clear(void)
+{
+	struct early_init_data *data = find_early_init();
+
+	if (!data)
+		return;
+
+	memset(data, 0, sizeof(*data));
+}
+
+void early_init_save_time(enum early_init_type init_type)
+{
+	struct early_init_data *data = find_early_init();
+
+	if (!data)
+		return;
+
+	timer_monotonic_get(&data->init_time[init_type]);
+}
+
+uint64_t early_init_get_elapsed_time_us(enum early_init_type init_type)
+{
+	struct early_init_data *data = find_early_init();
+	struct mono_time cur_time;
+
+	if (!data)
+		return 0;
+
+	memset(&cur_time, 0, sizeof(cur_time));
+
+	/* If early init data was never saved */
+	if (!memcmp(&data->init_time[init_type], &cur_time, sizeof(cur_time)))
+		return 0;
+
+	timer_monotonic_get(&cur_time);
+
+	return mono_time_diff_microseconds(&data->init_time[init_type],
+					   &cur_time);
+}
diff --git a/src/soc/mediatek/common/include/soc/early_init.h b/src/soc/mediatek/common/include/soc/early_init.h
new file mode 100644
index 0000000000..2811b0d69a
--- /dev/null
+++ b/src/soc/mediatek/common/include/soc/early_init.h
@@ -0,0 +1,26 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#ifndef SOC_MEDIATEK_EARLY_INIT_H
+#define SOC_MEDIATEK_EARLY_INIT_H
+
+#include <soc/symbols.h>
+#include <stdint.h>
+#include <symbols.h>
+#include <timer.h>
+
+DECLARE_REGION(early_init_data);
+
+enum early_init_type {
+	EARLY_INIT_PCIE,
+	EARLY_INIT_MAX,
+};
+
+struct early_init_data {
+	struct mono_time init_time[EARLY_INIT_MAX];
+};
+
+void early_init_clear(void);
+void early_init_save_time(enum early_init_type init_type);
+uint64_t early_init_get_elapsed_time_us(enum early_init_type init_type);
+
+#endif /* SOC_MEDIATEK_EARLY_INIT_H */