forked from rrcarlosr/Jetpack
72 lines
1.4 KiB
C
72 lines
1.4 KiB
C
|
/*
|
||
|
|
* Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: GPL-2.0+
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
#include <dm.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <timer.h>
|
||
|
|
#include <os.h>
|
||
|
|
|
||
|
|
#define SANDBOX_TIMER_RATE 1000000
|
||
|
|
|
||
|
|
/* system timer offset in ms */
|
||
|
|
static unsigned long sandbox_timer_offset;
|
||
|
|
|
||
|
|
void sandbox_timer_add_offset(unsigned long offset)
|
||
|
|
{
|
||
|
|
sandbox_timer_offset += offset;
|
||
|
|
}
|
||
|
|
|
||
|
|
u64 notrace timer_early_get_count(void)
|
||
|
|
{
|
||
|
|
return os_get_nsec() / 1000 + sandbox_timer_offset * 1000;
|
||
|
|
}
|
||
|
|
|
||
|
|
unsigned long notrace timer_early_get_rate(void)
|
||
|
|
{
|
||
|
|
return SANDBOX_TIMER_RATE;
|
||
|
|
}
|
||
|
|
|
||
|
|
static notrace int sandbox_timer_get_count(struct udevice *dev, u64 *count)
|
||
|
|
{
|
||
|
|
*count = timer_early_get_count();
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int sandbox_timer_probe(struct udevice *dev)
|
||
|
|
{
|
||
|
|
struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
||
|
|
|
||
|
|
if (!uc_priv->clock_rate)
|
||
|
|
uc_priv->clock_rate = SANDBOX_TIMER_RATE;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct timer_ops sandbox_timer_ops = {
|
||
|
|
.get_count = sandbox_timer_get_count,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct udevice_id sandbox_timer_ids[] = {
|
||
|
|
{ .compatible = "sandbox,timer" },
|
||
|
|
{ }
|
||
|
|
};
|
||
|
|
|
||
|
|
U_BOOT_DRIVER(sandbox_timer) = {
|
||
|
|
.name = "sandbox_timer",
|
||
|
|
.id = UCLASS_TIMER,
|
||
|
|
.of_match = sandbox_timer_ids,
|
||
|
|
.probe = sandbox_timer_probe,
|
||
|
|
.ops = &sandbox_timer_ops,
|
||
|
|
.flags = DM_FLAG_PRE_RELOC,
|
||
|
|
};
|
||
|
|
|
||
|
|
/* This is here in case we don't have a device tree */
|
||
|
|
U_BOOT_DEVICE(sandbox_timer_non_fdt) = {
|
||
|
|
.name = "sandbox_timer",
|
||
|
|
};
|