[people/ms/u-boot.git] / drivers / timer / sandbox_timer.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",
};
Commit	Line	Data
9961a0b6 TC	1	/*
	2	* Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
	3	*
	4	* SPDX-License-Identifier: GPL-2.0+
	5	*/
	6
	7	#include <common.h>
	8	#include <dm.h>
	9	#include <errno.h>
	10	#include <timer.h>
	11	#include <os.h>
	12
01476eaf SG	13	#define SANDBOX_TIMER_RATE 1000000
01476eaf SG	14
9961a0b6 TC	15	/* system timer offset in ms */
	16	static unsigned long sandbox_timer_offset;
	17
	18	void sandbox_timer_add_offset(unsigned long offset)
	19	{
	20	sandbox_timer_offset += offset;
	21	}
	22
01476eaf SG	23	u64 notrace timer_early_get_count(void)
	24	{
	25	return os_get_nsec() / 1000 + sandbox_timer_offset * 1000;
	26	}
	27
	28	unsigned long notrace timer_early_get_rate(void)
	29	{
	30	return SANDBOX_TIMER_RATE;
	31	}
	32
	33	static notrace int sandbox_timer_get_count(struct udevice dev, u64 count)
9961a0b6	34	{
01476eaf	35	*count = timer_early_get_count();
9961a0b6 TC	36
	37	return 0;
	38	}
	39
	40	static int sandbox_timer_probe(struct udevice *dev)
	41	{
bb883f82 SW	42	struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
	43
	44	if (!uc_priv->clock_rate)
01476eaf	45	uc_priv->clock_rate = SANDBOX_TIMER_RATE;
bb883f82	46
9961a0b6 TC	47	return 0;
	48	}
	49
	50	static const struct timer_ops sandbox_timer_ops = {
	51	.get_count = sandbox_timer_get_count,
	52	};
	53
	54	static const struct udevice_id sandbox_timer_ids[] = {
	55	{ .compatible = "sandbox,timer" },
	56	{ }
	57	};
	58
	59	U_BOOT_DRIVER(sandbox_timer) = {
	60	.name = "sandbox_timer",
	61	.id = UCLASS_TIMER,
	62	.of_match = sandbox_timer_ids,
	63	.probe = sandbox_timer_probe,
	64	.ops = &sandbox_timer_ops,
	65	.flags = DM_FLAG_PRE_RELOC,
	66	};
bb883f82 SW	67
	68	/* This is here in case we don't have a device tree */
	69	U_BOOT_DEVICE(sandbox_timer_non_fdt) = {
	70	.name = "sandbox_timer",
	71	};