mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-18 16:08:53 +09:00
![Michal Simek](/assets/img/avatar_default.png)
This function is required for adding bootstage support. Also enable it directly for ZynqMP R5 configuration. Signed-off-by: Michal Simek <michal.simek@xilinx.com>
116 lines
2.7 KiB
C
116 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2018 Xilinx, Inc. (Michal Simek)
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <timer.h>
|
|
#include <asm/io.h>
|
|
|
|
#define CNT_CNTRL_RESET BIT(4)
|
|
|
|
struct cadence_ttc_regs {
|
|
u32 clk_cntrl1; /* 0x0 - Clock Control 1 */
|
|
u32 clk_cntrl2; /* 0x4 - Clock Control 2 */
|
|
u32 clk_cntrl3; /* 0x8 - Clock Control 3 */
|
|
u32 counter_cntrl1; /* 0xC - Counter Control 1 */
|
|
u32 counter_cntrl2; /* 0x10 - Counter Control 2 */
|
|
u32 counter_cntrl3; /* 0x14 - Counter Control 3 */
|
|
u32 counter_val1; /* 0x18 - Counter Control 1 */
|
|
u32 counter_val2; /* 0x1C - Counter Control 2 */
|
|
u32 counter_val3; /* 0x20 - Counter Control 3 */
|
|
u32 reserved[15];
|
|
u32 interrupt_enable1; /* 0x60 - Interrupt Enable 1 */
|
|
u32 interrupt_enable2; /* 0x64 - Interrupt Enable 2 */
|
|
u32 interrupt_enable3; /* 0x68 - Interrupt Enable 3 */
|
|
};
|
|
|
|
struct cadence_ttc_priv {
|
|
struct cadence_ttc_regs *regs;
|
|
};
|
|
|
|
#if CONFIG_IS_ENABLED(BOOTSTAGE)
|
|
ulong timer_get_boot_us(void)
|
|
{
|
|
u64 ticks = 0;
|
|
u32 rate = 1;
|
|
u64 us;
|
|
int ret;
|
|
|
|
ret = dm_timer_init();
|
|
if (!ret) {
|
|
/* The timer is available */
|
|
rate = timer_get_rate(gd->timer);
|
|
timer_get_count(gd->timer, &ticks);
|
|
} else {
|
|
return 0;
|
|
}
|
|
|
|
us = (ticks * 1000) / rate;
|
|
return us;
|
|
}
|
|
#endif
|
|
|
|
static int cadence_ttc_get_count(struct udevice *dev, u64 *count)
|
|
{
|
|
struct cadence_ttc_priv *priv = dev_get_priv(dev);
|
|
|
|
*count = readl(&priv->regs->counter_val1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cadence_ttc_probe(struct udevice *dev)
|
|
{
|
|
struct cadence_ttc_priv *priv = dev_get_priv(dev);
|
|
|
|
/* Disable interrupts for sure */
|
|
writel(0, &priv->regs->interrupt_enable1);
|
|
writel(0, &priv->regs->interrupt_enable2);
|
|
writel(0, &priv->regs->interrupt_enable3);
|
|
|
|
/* Make sure that clocks are configured properly without prescaller */
|
|
writel(0, &priv->regs->clk_cntrl1);
|
|
writel(0, &priv->regs->clk_cntrl2);
|
|
writel(0, &priv->regs->clk_cntrl3);
|
|
|
|
/* Reset and enable this counter */
|
|
writel(CNT_CNTRL_RESET, &priv->regs->counter_cntrl1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cadence_ttc_ofdata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct cadence_ttc_priv *priv = dev_get_priv(dev);
|
|
|
|
priv->regs = map_physmem(dev_read_addr(dev),
|
|
sizeof(struct cadence_ttc_regs), MAP_NOCACHE);
|
|
if (IS_ERR(priv->regs))
|
|
return PTR_ERR(priv->regs);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct timer_ops cadence_ttc_ops = {
|
|
.get_count = cadence_ttc_get_count,
|
|
};
|
|
|
|
static const struct udevice_id cadence_ttc_ids[] = {
|
|
{ .compatible = "cdns,ttc" },
|
|
{}
|
|
};
|
|
|
|
U_BOOT_DRIVER(cadence_ttc) = {
|
|
.name = "cadence_ttc",
|
|
.id = UCLASS_TIMER,
|
|
.of_match = cadence_ttc_ids,
|
|
.ofdata_to_platdata = cadence_ttc_ofdata_to_platdata,
|
|
.priv_auto_alloc_size = sizeof(struct cadence_ttc_priv),
|
|
.probe = cadence_ttc_probe,
|
|
.ops = &cadence_ttc_ops,
|
|
.flags = DM_FLAG_PRE_RELOC,
|
|
};
|