From 41faa22c532def4093a65366764d12298c6a10d3 Mon Sep 17 00:00:00 2001 From: Jianjun Wang Date: Tue, 22 Mar 2022 15:26:52 +0800 Subject: soc/mediatek: Add early_init for passing data across stages Add support for "early_init_data" region, which can be used to store data initialized in an early stage (such as bootblock), and retrieve it in later stages (such as ramstage). TEST=Build pass and boot up to kernel successfully via SSD on Dojo board, here is the SSD information in boot log: == NVME IDENTIFY CONTROLLER DATA == PCI VID : 0x15b7 PCI SSVID : 0x15b7 SN : 21517J440114 MN : WDC PC SN530 SDBPTPZ-256G-1006 RAB : 0x4 AERL : 0x7 SQES : 0x66 CQES : 0x44 NN : 0x1 Identified NVMe model WDC PC SN530 SDBPTPZ-256G-1006 BUG=b:178565024 BRANCH=cherry Signed-off-by: Jianjun Wang Change-Id: I01f91b7fe2cbe4f73b5c616bb7aae778dee27d9a Reviewed-on: https://review.coreboot.org/c/coreboot/+/63019 Tested-by: build bot (Jenkins) Reviewed-by: Yu-Ping Wu --- src/soc/mediatek/common/early_init.c | 52 ++++++++++++++++++++++++ src/soc/mediatek/common/include/soc/early_init.h | 26 ++++++++++++ 2 files changed, 78 insertions(+) create mode 100644 src/soc/mediatek/common/early_init.c create mode 100644 src/soc/mediatek/common/include/soc/early_init.h 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 +#include +#include +#include + +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 +#include +#include +#include + +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 */ -- cgit v1.2.3