Add submodule dependency filesHEADmaster

Change-Id: Iaf8d18082d3991dec7c0ebbea540f092188eb4ec

1 files changed, 203 insertions, 0 deletions

diff --git a/roms/opensbi/lib/utils/sys/clint.c b/roms/opensbi/lib/utils/sys/clint.c
new file mode 100644
index 000000000..7a392aad8
--- /dev/null
+++ b/roms/opensbi/lib/utils/sys/clint.c
@@ -0,0 +1,203 @@
+/*
+ * SPDX-License-Identifier: BSD-2-Clause
+ *
+ * Copyright (c) 2019 Western Digital Corporation or its affiliates.
+ *
+ * Authors:
+ *   Anup Patel <anup.patel@wdc.com>
+ */
+
+#include <sbi/riscv_asm.h>
+#include <sbi/riscv_atomic.h>
+#include <sbi/riscv_io.h>
+#include <sbi/sbi_error.h>
+#include <sbi/sbi_hartmask.h>
+#include <sbi_utils/sys/clint.h>
+
+#define CLINT_IPI_OFF		0
+#define CLINT_TIME_CMP_OFF	0x4000
+#define CLINT_TIME_VAL_OFF	0xbff8
+
+static struct clint_data *clint_ipi_hartid2data[SBI_HARTMASK_MAX_BITS];
+
+void clint_ipi_send(u32 target_hart)
+{
+	struct clint_data *clint;
+
+	if (SBI_HARTMASK_MAX_BITS <= target_hart)
+		return;
+	clint = clint_ipi_hartid2data[target_hart];
+	if (!clint)
+		return;
+
+	/* Set CLINT IPI */
+	writel(1, &clint->ipi[target_hart - clint->first_hartid]);
+}
+
+void clint_ipi_clear(u32 target_hart)
+{
+	struct clint_data *clint;
+
+	if (SBI_HARTMASK_MAX_BITS <= target_hart)
+		return;
+	clint = clint_ipi_hartid2data[target_hart];
+	if (!clint)
+		return;
+
+	/* Clear CLINT IPI */
+	writel(0, &clint->ipi[target_hart - clint->first_hartid]);
+}
+
+int clint_warm_ipi_init(void)
+{
+	/* Clear CLINT IPI for current HART */
+	clint_ipi_clear(current_hartid());
+
+	return 0;
+}
+
+int clint_cold_ipi_init(struct clint_data *clint)
+{
+	u32 i;
+
+	if (!clint)
+		return SBI_EINVAL;
+
+	/* Initialize private data */
+	clint->ipi = (void *)clint->addr;
+
+	/* Update IPI hartid table */
+	for (i = 0; i < clint->hart_count; i++)
+		clint_ipi_hartid2data[clint->first_hartid + i] = clint;
+
+	return 0;
+}
+
+static struct clint_data *clint_timer_hartid2data[SBI_HARTMASK_MAX_BITS];
+
+#if __riscv_xlen != 32
+static u64 clint_time_rd64(volatile u64 *addr)
+{
+	return readq_relaxed(addr);
+}
+
+static void clint_time_wr64(u64 value, volatile u64 *addr)
+{
+	writeq_relaxed(value, addr);
+}
+#endif
+
+static u64 clint_time_rd32(volatile u64 *addr)
+{
+	u32 lo, hi;
+
+	do {
+		hi = readl_relaxed((u32 *)addr + 1);
+		lo = readl_relaxed((u32 *)addr);
+	} while (hi != readl_relaxed((u32 *)addr + 1));
+
+	return ((u64)hi << 32) | (u64)lo;
+}
+
+static void clint_time_wr32(u64 value, volatile u64 *addr)
+{
+	u32 mask = -1U;
+
+	writel_relaxed(value & mask, (void *)(addr));
+	writel_relaxed(value >> 32, (void *)(addr) + 0x04);
+}
+
+u64 clint_timer_value(void)
+{
+	struct clint_data *clint = clint_timer_hartid2data[current_hartid()];
+
+	/* Read CLINT Time Value */
+	return clint->time_rd(clint->time_val) + clint->time_delta;
+}
+
+void clint_timer_event_stop(void)
+{
+	u32 target_hart = current_hartid();
+	struct clint_data *clint = clint_timer_hartid2data[target_hart];
+
+	/* Clear CLINT Time Compare */
+	clint->time_wr(-1ULL,
+			&clint->time_cmp[target_hart - clint->first_hartid]);
+}
+
+void clint_timer_event_start(u64 next_event)
+{
+	u32 target_hart = current_hartid();
+	struct clint_data *clint = clint_timer_hartid2data[target_hart];
+
+	/* Program CLINT Time Compare */
+	clint->time_wr(next_event - clint->time_delta,
+		       &clint->time_cmp[target_hart - clint->first_hartid]);
+}
+
+int clint_warm_timer_init(void)
+{
+	u64 v1, v2, mv;
+	u32 target_hart = current_hartid();
+	struct clint_data *reference;
+	struct clint_data *clint = clint_timer_hartid2data[target_hart];
+
+	if (!clint)
+		return SBI_ENODEV;
+
+	/*
+	 * Compute delta if reference available
+	 *
+	 * We deliberately compute time_delta in warm init so that time_delta
+	 * is computed on a HART which is going to use given CLINT. We use
+	 * atomic flag timer_delta_computed to ensure that only one HART does
+	 * time_delta computation.
+	 */
+	if (clint->time_delta_reference) {
+		reference = clint->time_delta_reference;
+		if (!atomic_raw_xchg_ulong(&clint->time_delta_computed, 1)) {
+			v1 = clint->time_rd(clint->time_val);
+			mv = reference->time_rd(reference->time_val);
+			v2 = clint->time_rd(clint->time_val);
+			clint->time_delta = mv - ((v1 / 2) + (v2 / 2));
+		}
+	}
+
+	/* Clear CLINT Time Compare */
+	clint->time_wr(-1ULL,
+		       &clint->time_cmp[target_hart - clint->first_hartid]);
+
+	return 0;
+}
+
+int clint_cold_timer_init(struct clint_data *clint,
+			  struct clint_data *reference)
+{
+	u32 i;
+
+	if (!clint)
+		return SBI_EINVAL;
+
+	/* Initialize private data */
+	clint->time_delta_reference = reference;
+	clint->time_delta_computed = 0;
+	clint->time_delta = 0;
+	clint->time_val = (u64 *)((void *)clint->addr + CLINT_TIME_VAL_OFF);
+	clint->time_cmp = (u64 *)((void *)clint->addr + CLINT_TIME_CMP_OFF);
+	clint->time_rd = clint_time_rd32;
+	clint->time_wr = clint_time_wr32;
+
+	/* Override read/write accessors for 64bit MMIO */
+#if __riscv_xlen != 32
+	if (clint->has_64bit_mmio) {
+		clint->time_rd = clint_time_rd64;
+		clint->time_wr = clint_time_wr64;
+	}
+#endif
+
+	/* Update timer hartid table */
+	for (i = 0; i < clint->hart_count; i++)
+		clint_timer_hartid2data[clint->first_hartid + i] = clint;
+
+	return 0;
+}