mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-24 23:41:23 +01:00
2e5cc9051b
To read 64bit time in 32 bit we have to read lower & upper half separately and 'or' them together. However, upper half time may have changed by the time we read lower half. Thus, the resultant 64 bit time may not be accurate. Consider lower half time value only if upper half time value has not changed. Signed-off-by: Atish Patra <atish.patra@wdc.com> Reviewed-by: Anup Patel <anup.patel@wdc.com>
148 lines
3.1 KiB
C
148 lines
3.1 KiB
C
/*
|
|
* 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_io.h>
|
|
#include <sbi/riscv_atomic.h>
|
|
#include <sbi/sbi_hart.h>
|
|
#include <sbi_utils/sys/clint.h>
|
|
|
|
static u32 clint_ipi_hart_count;
|
|
static volatile void *clint_ipi_base;
|
|
static volatile u32 *clint_ipi;
|
|
|
|
void clint_ipi_send(u32 target_hart)
|
|
{
|
|
if (clint_ipi_hart_count <= target_hart)
|
|
return;
|
|
|
|
/* Set CLINT IPI */
|
|
writel(1, &clint_ipi[target_hart]);
|
|
}
|
|
|
|
void clint_ipi_clear(u32 target_hart)
|
|
{
|
|
if (clint_ipi_hart_count <= target_hart)
|
|
return;
|
|
|
|
/* Clear CLINT IPI */
|
|
writel(0, &clint_ipi[target_hart]);
|
|
}
|
|
|
|
int clint_warm_ipi_init(void)
|
|
{
|
|
u32 hartid = sbi_current_hartid();
|
|
|
|
if (!clint_ipi_base)
|
|
return -1;
|
|
|
|
/* Clear CLINT IPI */
|
|
clint_ipi_clear(hartid);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int clint_cold_ipi_init(unsigned long base, u32 hart_count)
|
|
{
|
|
/* Figure-out CLINT IPI register address */
|
|
clint_ipi_hart_count = hart_count;
|
|
clint_ipi_base = (void *)base;
|
|
clint_ipi = (u32 *)clint_ipi_base;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u32 clint_time_hart_count;
|
|
static volatile void *clint_time_base;
|
|
static volatile u64 *clint_time_val;
|
|
static volatile u64 *clint_time_cmp;
|
|
|
|
static inline u32 clint_time_read_hi()
|
|
{
|
|
return readl_relaxed((u32 *)clint_time_val + 1);
|
|
}
|
|
|
|
u64 clint_timer_value(void)
|
|
{
|
|
#if __riscv_xlen == 64
|
|
return readq_relaxed(clint_time_val);
|
|
#else
|
|
u32 lo, hi;
|
|
|
|
do {
|
|
hi = clint_time_read_hi();
|
|
lo = readl_relaxed(clint_time_val);
|
|
} while (hi != clint_time_read_hi());
|
|
|
|
return ((u64)hi << 32) | (u64)lo;
|
|
#endif
|
|
}
|
|
|
|
void clint_timer_event_stop(void)
|
|
{
|
|
u32 target_hart = sbi_current_hartid();
|
|
|
|
if (clint_time_hart_count <= target_hart)
|
|
return;
|
|
|
|
/* Clear CLINT Time Compare */
|
|
#if __riscv_xlen == 64
|
|
writeq_relaxed(-1ULL, &clint_time_cmp[target_hart]);
|
|
#else
|
|
writel_relaxed(-1UL, &clint_time_cmp[target_hart]);
|
|
writel_relaxed(-1UL, (void *)(&clint_time_cmp[target_hart]) + 0x04);
|
|
#endif
|
|
}
|
|
|
|
void clint_timer_event_start(u64 next_event)
|
|
{
|
|
u32 target_hart = sbi_current_hartid();
|
|
|
|
if (clint_time_hart_count <= target_hart)
|
|
return;
|
|
|
|
/* Program CLINT Time Compare */
|
|
#if __riscv_xlen == 64
|
|
writeq_relaxed(next_event, &clint_time_cmp[target_hart]);
|
|
#else
|
|
u32 mask = -1UL;
|
|
writel_relaxed(next_event & mask, &clint_time_cmp[target_hart]);
|
|
writel_relaxed(next_event >> 32,
|
|
(void *)(&clint_time_cmp[target_hart]) + 0x04);
|
|
#endif
|
|
}
|
|
|
|
int clint_warm_timer_init(void)
|
|
{
|
|
u32 target_hart = sbi_current_hartid();
|
|
|
|
if (clint_time_hart_count <= target_hart || !clint_time_base)
|
|
return -1;
|
|
|
|
/* Clear CLINT Time Compare */
|
|
#if __riscv_xlen == 64
|
|
writeq_relaxed(-1ULL, &clint_time_cmp[target_hart]);
|
|
#else
|
|
writel_relaxed(-1UL, &clint_time_cmp[target_hart]);
|
|
writel_relaxed(-1UL, (void *)(&clint_time_cmp[target_hart]) + 0x04);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int clint_cold_timer_init(unsigned long base, u32 hart_count)
|
|
{
|
|
/* Figure-out CLINT Time register address */
|
|
clint_time_hart_count = hart_count;
|
|
clint_time_base = (void *)base;
|
|
clint_time_val = (u64 *)(clint_time_base + 0xbff8);
|
|
clint_time_cmp = (u64 *)(clint_time_base + 0x4000);
|
|
|
|
return 0;
|
|
}
|