forked from Mirrors/opensbi
lib: utils: Add simple FDT timer framework
We add simple timer framework which will select and use timer driver based on details in FDT passed by previous booting stage. Signed-off-by: Anup Patel <anup.patel@wdc.com> Reviewed-by: Atish Patra <atish.patra@wdc.com>
This commit is contained in:
35
include/sbi_utils/timer/fdt_timer.h
Normal file
35
include/sbi_utils/timer/fdt_timer.h
Normal file
@@ -0,0 +1,35 @@
|
||||
/*
|
||||
* SPDX-License-Identifier: BSD-2-Clause
|
||||
*
|
||||
* Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
||||
*
|
||||
* Authors:
|
||||
* Anup Patel <anup.patel@wdc.com>
|
||||
*/
|
||||
|
||||
#ifndef __FDT_TIMER_H__
|
||||
#define __FDT_TIMER_H__
|
||||
|
||||
#include <sbi/sbi_types.h>
|
||||
|
||||
struct fdt_timer {
|
||||
const struct fdt_match *match_table;
|
||||
int (*cold_init)(void *fdt, int nodeoff, const struct fdt_match *match);
|
||||
int (*warm_init)(void);
|
||||
void (*exit)(void);
|
||||
u64 (*value)(void);
|
||||
void (*event_stop)(void);
|
||||
void (*event_start)(u64 next_event);
|
||||
};
|
||||
|
||||
u64 fdt_timer_value(void);
|
||||
|
||||
void fdt_timer_event_stop(void);
|
||||
|
||||
void fdt_timer_event_start(u64 next_event);
|
||||
|
||||
void fdt_timer_exit(void);
|
||||
|
||||
int fdt_timer_init(bool cold_boot);
|
||||
|
||||
#endif
|
110
lib/utils/timer/fdt_timer.c
Normal file
110
lib/utils/timer/fdt_timer.c
Normal file
@@ -0,0 +1,110 @@
|
||||
/*
|
||||
* SPDX-License-Identifier: BSD-2-Clause
|
||||
*
|
||||
* Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
||||
*
|
||||
* Authors:
|
||||
* Anup Patel <anup.patel@wdc.com>
|
||||
*/
|
||||
|
||||
#include <sbi/sbi_scratch.h>
|
||||
#include <sbi_utils/fdt/fdt_helper.h>
|
||||
#include <sbi_utils/timer/fdt_timer.h>
|
||||
|
||||
extern struct fdt_timer fdt_timer_clint;
|
||||
|
||||
static struct fdt_timer *timer_drivers[] = {
|
||||
&fdt_timer_clint
|
||||
};
|
||||
|
||||
static u64 dummy_value(void)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void dummy_event_stop(void)
|
||||
{
|
||||
}
|
||||
|
||||
static void dummy_event_start(u64 next_event)
|
||||
{
|
||||
}
|
||||
|
||||
static struct fdt_timer dummy = {
|
||||
.match_table = NULL,
|
||||
.cold_init = NULL,
|
||||
.warm_init = NULL,
|
||||
.exit = NULL,
|
||||
.value = dummy_value,
|
||||
.event_stop = dummy_event_stop,
|
||||
.event_start = dummy_event_start
|
||||
};
|
||||
|
||||
static struct fdt_timer *current_driver = &dummy;
|
||||
|
||||
u64 fdt_timer_value(void)
|
||||
{
|
||||
return current_driver->value();
|
||||
}
|
||||
|
||||
void fdt_timer_event_stop(void)
|
||||
{
|
||||
current_driver->event_stop();
|
||||
}
|
||||
|
||||
void fdt_timer_event_start(u64 next_event)
|
||||
{
|
||||
current_driver->event_start(next_event);
|
||||
}
|
||||
|
||||
void fdt_timer_exit(void)
|
||||
{
|
||||
if (current_driver->exit)
|
||||
current_driver->exit();
|
||||
}
|
||||
|
||||
static int fdt_timer_warm_init(void)
|
||||
{
|
||||
if (current_driver->warm_init)
|
||||
return current_driver->warm_init();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int fdt_timer_cold_init(void)
|
||||
{
|
||||
int pos, noff, rc;
|
||||
struct fdt_timer *drv;
|
||||
const struct fdt_match *match;
|
||||
void *fdt = sbi_scratch_thishart_arg1_ptr();
|
||||
|
||||
for (pos = 0; pos < array_size(timer_drivers); pos++) {
|
||||
drv = timer_drivers[pos];
|
||||
|
||||
noff = fdt_find_match(fdt, drv->match_table, &match);
|
||||
if (noff < 0)
|
||||
continue;
|
||||
|
||||
if (drv->cold_init) {
|
||||
rc = drv->cold_init(fdt, noff, match);
|
||||
if (rc)
|
||||
return rc;
|
||||
}
|
||||
current_driver = drv;
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int fdt_timer_init(bool cold_boot)
|
||||
{
|
||||
int rc;
|
||||
|
||||
if (cold_boot) {
|
||||
rc = fdt_timer_cold_init();
|
||||
if (rc)
|
||||
return rc;
|
||||
}
|
||||
|
||||
return fdt_timer_warm_init();
|
||||
}
|
46
lib/utils/timer/fdt_timer_clint.c
Normal file
46
lib/utils/timer/fdt_timer_clint.c
Normal file
@@ -0,0 +1,46 @@
|
||||
/*
|
||||
* SPDX-License-Identifier: BSD-2-Clause
|
||||
*
|
||||
* Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
||||
*
|
||||
* Authors:
|
||||
* Anup Patel <anup.patel@wdc.com>
|
||||
*/
|
||||
|
||||
#include <sbi_utils/fdt/fdt_helper.h>
|
||||
#include <sbi_utils/timer/fdt_timer.h>
|
||||
#include <sbi_utils/sys/clint.h>
|
||||
|
||||
static int timer_clint_cold_init(void *fdt, int nodeoff,
|
||||
const struct fdt_match *match)
|
||||
{
|
||||
int rc;
|
||||
u32 max_hartid;
|
||||
unsigned long addr;
|
||||
|
||||
rc = fdt_parse_max_hart_id(fdt, &max_hartid);
|
||||
if (rc)
|
||||
return rc;
|
||||
|
||||
rc = fdt_get_node_addr_size(fdt, nodeoff, &addr, NULL);
|
||||
if (rc)
|
||||
return rc;
|
||||
|
||||
/* TODO: We should figure-out CLINT has_64bit_mmio from DT node */
|
||||
return clint_cold_timer_init(addr, max_hartid + 1, TRUE);
|
||||
}
|
||||
|
||||
static const struct fdt_match timer_clint_match[] = {
|
||||
{ .compatible = "riscv,clint0" },
|
||||
{ },
|
||||
};
|
||||
|
||||
struct fdt_timer fdt_timer_clint = {
|
||||
.match_table = timer_clint_match,
|
||||
.cold_init = timer_clint_cold_init,
|
||||
.warm_init = clint_warm_timer_init,
|
||||
.exit = NULL,
|
||||
.value = clint_timer_value,
|
||||
.event_stop = clint_timer_event_stop,
|
||||
.event_start = clint_timer_event_start,
|
||||
};
|
11
lib/utils/timer/objects.mk
Normal file
11
lib/utils/timer/objects.mk
Normal file
@@ -0,0 +1,11 @@
|
||||
#
|
||||
# SPDX-License-Identifier: BSD-2-Clause
|
||||
#
|
||||
# Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
||||
#
|
||||
# Authors:
|
||||
# Anup Patel <anup.patel@wdc.com>
|
||||
#
|
||||
|
||||
libsbiutils-objs-y += timer/fdt_timer.o
|
||||
libsbiutils-objs-y += timer/fdt_timer_clint.o
|
Reference in New Issue
Block a user