diff --git a/src/arch/ppc64/Makefile.inc b/src/arch/ppc64/Makefile.inc index d1774a1d15..13b61673bd 100644 --- a/src/arch/ppc64/Makefile.inc +++ b/src/arch/ppc64/Makefile.inc @@ -34,6 +34,7 @@ endif ################################################################################ ifeq ($(CONFIG_ARCH_ROMSTAGE_PPC64),y) +romstage-y += arch_timer.c romstage-y += boot.c romstage-y += stages.c romstage-y += rom_media.c @@ -64,6 +65,7 @@ ifeq ($(CONFIG_ARCH_RAMSTAGE_PPC64),y) ramstage-y += rom_media.c ramstage-y += stages.c +ramstage-y += arch_timer.c ramstage-y += boot.c ramstage-y += tables.c ramstage-y += \ diff --git a/src/arch/ppc64/arch_timer.c b/src/arch/ppc64/arch_timer.c new file mode 100644 index 0000000000..799bff03e1 --- /dev/null +++ b/src/arch/ppc64/arch_timer.c @@ -0,0 +1,41 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ + +#include +#include +#include + +/* Refer to hostboot/src/kernel/timemgr.C */ + +/* Time base frequency is 512 MHz so 512 ticks per usec */ +#define TB_TICKS_PER_USEC 512 + +__weak void init_timer(void) { /* do nothing */ } + +static struct monotonic_counter { + int initialized; + struct mono_time time; + uint64_t last_value; +} mono_counter; + +void timer_monotonic_get(struct mono_time *mt) +{ + uint64_t current_tick; + uint64_t usecs_elapsed; + + if (!mono_counter.initialized) { + mono_counter.last_value = read_spr(SPR_TB); + mono_counter.initialized = 1; + } + + current_tick = read_spr(SPR_TB); + usecs_elapsed = (current_tick - mono_counter.last_value) / TB_TICKS_PER_USEC; + + /* Update current time and tick values only if a full tick occurred. */ + if (usecs_elapsed) { + mono_time_add_usecs(&mono_counter.time, usecs_elapsed); + mono_counter.last_value = current_tick; + } + + /* Save result. */ + *mt = mono_counter.time; +}