From ed04aab8134531d5baad75fc8e35f73147863440 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Micha=C5=82=20=C5=BBygowski?= <michal.zygowski@3mdeb.com>
Date: Thu, 17 Sep 2020 16:16:28 +0200
Subject: [PATCH] src/arch/ppc64/arch_timer.c: implement timer functions
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

Change-Id: I4a244df01f6d15cbefb3b01079f6eec943136983
Signed-off-by: Michał Żygowski <michal.zygowski@3mdeb.com>
Reviewed-on: https://review.coreboot.org/c/coreboot/+/57077
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
Reviewed-by: Krystian Hebel <krystian.hebel@3mdeb.com>
Reviewed-by: Arthur Heymans <arthur@aheymans.xyz>
---
 src/arch/ppc64/Makefile.inc |  2 ++
 src/arch/ppc64/arch_timer.c | 41 +++++++++++++++++++++++++++++++++++++
 2 files changed, 43 insertions(+)
 create mode 100644 src/arch/ppc64/arch_timer.c

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 <timer.h>
+#include <delay.h>
+#include <cpu/power/spr.h>
+
+/* 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;
+}