2015-10-09 05:46:34 +00:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <common.h>
|
|
|
|
#include <dm.h>
|
2016-01-16 16:03:58 +00:00
|
|
|
#include <dm/lists.h>
|
|
|
|
#include <dm/device-internal.h>
|
2017-09-11 20:04:10 +00:00
|
|
|
#include <dm/root.h>
|
2016-12-09 14:18:32 +00:00
|
|
|
#include <clk.h>
|
2015-10-09 05:46:34 +00:00
|
|
|
#include <errno.h>
|
|
|
|
#include <timer.h>
|
|
|
|
|
2015-11-13 08:11:15 +00:00
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
|
2015-10-09 05:46:34 +00:00
|
|
|
/*
|
2015-11-13 08:11:14 +00:00
|
|
|
* Implement a timer uclass to work with lib/time.c. The timer is usually
|
2015-11-24 20:31:17 +00:00
|
|
|
* a 32/64 bits free-running up counter. The get_rate() method is used to get
|
2015-10-09 05:46:34 +00:00
|
|
|
* the input clock frequency of the timer. The get_count() method is used
|
2015-11-24 20:31:17 +00:00
|
|
|
* to get the current 64 bits count value. If the hardware is counting down,
|
2015-10-09 05:46:34 +00:00
|
|
|
* the value should be inversed inside the method. There may be no real
|
|
|
|
* tick, and no timer interrupt.
|
|
|
|
*/
|
|
|
|
|
2016-02-24 16:14:48 +00:00
|
|
|
int notrace timer_get_count(struct udevice *dev, u64 *count)
|
2015-10-09 05:46:34 +00:00
|
|
|
{
|
|
|
|
const struct timer_ops *ops = device_get_ops(dev);
|
|
|
|
|
|
|
|
if (!ops->get_count)
|
|
|
|
return -ENOSYS;
|
|
|
|
|
|
|
|
return ops->get_count(dev, count);
|
|
|
|
}
|
|
|
|
|
2016-02-24 16:14:48 +00:00
|
|
|
unsigned long notrace timer_get_rate(struct udevice *dev)
|
2015-10-09 05:46:34 +00:00
|
|
|
{
|
2016-02-24 16:14:48 +00:00
|
|
|
struct timer_dev_priv *uc_priv = dev->uclass_priv;
|
2015-10-09 05:46:34 +00:00
|
|
|
|
|
|
|
return uc_priv->clock_rate;
|
|
|
|
}
|
|
|
|
|
2015-11-13 08:11:15 +00:00
|
|
|
static int timer_pre_probe(struct udevice *dev)
|
|
|
|
{
|
2017-07-28 15:19:58 +00:00
|
|
|
#if !CONFIG_IS_ENABLED(OF_PLATDATA)
|
2015-11-13 08:11:15 +00:00
|
|
|
struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
2016-12-09 14:18:32 +00:00
|
|
|
struct clk timer_clk;
|
|
|
|
int err;
|
|
|
|
ulong ret;
|
2015-11-13 08:11:15 +00:00
|
|
|
|
2016-12-09 14:18:32 +00:00
|
|
|
err = clk_get_by_index(dev, 0, &timer_clk);
|
|
|
|
if (!err) {
|
|
|
|
ret = clk_get_rate(&timer_clk);
|
|
|
|
if (IS_ERR_VALUE(ret))
|
|
|
|
return ret;
|
|
|
|
uc_priv->clock_rate = ret;
|
2017-09-11 20:04:10 +00:00
|
|
|
} else {
|
|
|
|
uc_priv->clock_rate =
|
|
|
|
dev_read_u32_default(dev, "clock-frequency", 0);
|
|
|
|
}
|
2017-07-28 15:19:58 +00:00
|
|
|
#endif
|
2015-11-13 08:11:15 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2016-01-06 17:33:03 +00:00
|
|
|
static int timer_post_probe(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
|
|
|
|
|
|
|
if (!uc_priv->clock_rate)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-24 20:31:17 +00:00
|
|
|
u64 timer_conv_64(u32 count)
|
|
|
|
{
|
|
|
|
/* increment tbh if tbl has rolled over */
|
|
|
|
if (count < gd->timebase_l)
|
|
|
|
gd->timebase_h++;
|
|
|
|
gd->timebase_l = count;
|
|
|
|
return ((u64)gd->timebase_h << 32) | gd->timebase_l;
|
|
|
|
}
|
|
|
|
|
2016-01-16 16:03:58 +00:00
|
|
|
int notrace dm_timer_init(void)
|
|
|
|
{
|
|
|
|
struct udevice *dev = NULL;
|
2017-09-11 20:04:10 +00:00
|
|
|
__maybe_unused ofnode node;
|
2016-01-16 16:03:58 +00:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (gd->timer)
|
|
|
|
return 0;
|
|
|
|
|
2017-09-11 20:04:11 +00:00
|
|
|
/*
|
|
|
|
* Directly access gd->dm_root to suppress error messages, if the
|
|
|
|
* virtual root driver does not yet exist.
|
|
|
|
*/
|
|
|
|
if (gd->dm_root == NULL)
|
|
|
|
return -EAGAIN;
|
|
|
|
|
2017-07-28 15:19:58 +00:00
|
|
|
#if !CONFIG_IS_ENABLED(OF_PLATDATA)
|
2016-01-16 16:03:58 +00:00
|
|
|
/* Check for a chosen timer to be used for tick */
|
2017-09-11 20:04:10 +00:00
|
|
|
node = ofnode_get_chosen_node("tick-timer");
|
|
|
|
|
|
|
|
if (ofnode_valid(node) &&
|
|
|
|
uclass_get_device_by_ofnode(UCLASS_TIMER, node, &dev)) {
|
|
|
|
/*
|
|
|
|
* If the timer is not marked to be bound before
|
|
|
|
* relocation, bind it anyway.
|
|
|
|
*/
|
|
|
|
if (!lists_bind_fdt(dm_root(), node, &dev)) {
|
|
|
|
ret = device_probe(dev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
}
|
2017-07-28 15:19:58 +00:00
|
|
|
#endif
|
2017-09-11 20:04:10 +00:00
|
|
|
|
|
|
|
if (!dev) {
|
|
|
|
/* Fall back to the first available timer */
|
2016-02-11 20:23:26 +00:00
|
|
|
ret = uclass_first_device_err(UCLASS_TIMER, &dev);
|
2016-01-16 16:03:58 +00:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (dev) {
|
|
|
|
gd->timer = dev;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
2015-10-09 05:46:34 +00:00
|
|
|
UCLASS_DRIVER(timer) = {
|
|
|
|
.id = UCLASS_TIMER,
|
|
|
|
.name = "timer",
|
2015-11-13 08:11:15 +00:00
|
|
|
.pre_probe = timer_pre_probe,
|
2015-12-24 10:38:06 +00:00
|
|
|
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
2016-01-06 17:33:03 +00:00
|
|
|
.post_probe = timer_post_probe,
|
2015-10-09 05:46:34 +00:00
|
|
|
.per_device_auto_alloc_size = sizeof(struct timer_dev_priv),
|
|
|
|
};
|