// SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2017, STMicroelectronics - All Rights Reserved * Author(s): Patrice Chotard, for STMicroelectronics. */ #include #include #include #include #include #include #include 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_alloc_size = sizeof(struct sti_timer_priv), .probe = sti_timer_probe, .ops = &sti_timer_ops, };