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 */