mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-10 13:16:16 +09:00
41575d8e4c
This construct is quite long-winded. In earlier days it made some sense since auto-allocation was a strange concept. But with driver model now used pretty universally, we can shorten this to 'auto'. This reduces verbosity and makes it easier to read. Coincidentally it also ensures that every declaration is on one line, thus making dtoc's job easier. Signed-off-by: Simon Glass <sjg@chromium.org>
86 lines
1.8 KiB
C
86 lines
1.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2017, STMicroelectronics - All Rights Reserved
|
|
* Author(s): Patrice Chotard, <patrice.chotard@st.com> for STMicroelectronics.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <clk.h>
|
|
#include <timer.h>
|
|
#include <linux/err.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/arch-armv7/globaltimer.h>
|
|
|
|
struct sti_timer_priv {
|
|
struct globaltimer *global_timer;
|
|
};
|
|
|
|
static u64 sti_timer_get_count(struct udevice *dev)
|
|
{
|
|
struct sti_timer_priv *priv = dev_get_priv(dev);
|
|
struct globaltimer *global_timer = priv->global_timer;
|
|
u32 low, high;
|
|
u64 timer;
|
|
u32 old = readl(&global_timer->cnt_h);
|
|
|
|
while (1) {
|
|
low = readl(&global_timer->cnt_l);
|
|
high = readl(&global_timer->cnt_h);
|
|
if (old == high)
|
|
break;
|
|
else
|
|
old = high;
|
|
}
|
|
timer = high;
|
|
return (u64)((timer << 32) | low);
|
|
}
|
|
|
|
static int sti_timer_probe(struct udevice *dev)
|
|
{
|
|
struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
|
struct sti_timer_priv *priv = dev_get_priv(dev);
|
|
struct clk clk;
|
|
int err;
|
|
ulong ret;
|
|
|
|
/* get arm global timer base address */
|
|
priv->global_timer = (struct globaltimer *)dev_read_addr_ptr(dev);
|
|
if (!priv->global_timer)
|
|
return -ENOENT;
|
|
|
|
err = clk_get_by_index(dev, 0, &clk);
|
|
if (!err) {
|
|
ret = clk_get_rate(&clk);
|
|
if (IS_ERR_VALUE(ret))
|
|
return ret;
|
|
uc_priv->clock_rate = ret;
|
|
} else {
|
|
uc_priv->clock_rate = CONFIG_SYS_HZ_CLOCK;
|
|
}
|
|
|
|
/* init timer */
|
|
writel(0x01, &priv->global_timer->ctl);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct timer_ops sti_timer_ops = {
|
|
.get_count = sti_timer_get_count,
|
|
};
|
|
|
|
static const struct udevice_id sti_timer_ids[] = {
|
|
{ .compatible = "arm,cortex-a9-global-timer" },
|
|
{}
|
|
};
|
|
|
|
U_BOOT_DRIVER(sti_timer) = {
|
|
.name = "sti_timer",
|
|
.id = UCLASS_TIMER,
|
|
.of_match = sti_timer_ids,
|
|
.priv_auto = sizeof(struct sti_timer_priv),
|
|
.probe = sti_timer_probe,
|
|
.ops = &sti_timer_ops,
|
|
};
|