1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2014, STMicroelectronics - All Rights Reserved
4 * Author(s): Vikas Manocha, <vikas.manocha@st.com> for STMicroelectronics.
11 #include <asm/arch-stv0991/hardware.h>
12 #include <asm/arch-stv0991/stv0991_cgu.h>
13 #include <asm/arch-stv0991/stv0991_gpt.h>
15 static struct stv0991_cgu_regs *const stv0991_cgu_regs = \
16 (struct stv0991_cgu_regs *) (CGU_BASE_ADDR);
18 #define READ_TIMER() (readl(&gpt1_regs_ptr->cnt) & GPT_FREE_RUNNING)
19 #define GPT_RESOLUTION (CONFIG_STV0991_HZ_CLOCK / CONFIG_STV0991_HZ)
21 DECLARE_GLOBAL_DATA_PTR;
23 #define timestamp gd->arch.tbl
24 #define lastdec gd->arch.lastinc
26 static ulong get_timer_masked(void);
30 /* Timer1 clock configuration */
31 writel(TIMER1_CLK_CFG, &stv0991_cgu_regs->tim_freq);
32 writel(readl(&stv0991_cgu_regs->cgu_enable_2) |
33 TIMER1_CLK_EN, &stv0991_cgu_regs->cgu_enable_2);
36 writel(readl(&gpt1_regs_ptr->cr1) & ~GPT_CR1_CEN, &gpt1_regs_ptr->cr1);
37 writel(GPT_PRESCALER_128, &gpt1_regs_ptr->psc);
38 /* Configure timer for auto-reload */
39 writel(readl(&gpt1_regs_ptr->cr1) | GPT_MODE_AUTO_RELOAD,
42 /* load value for free running */
43 writel(GPT_FREE_RUNNING, &gpt1_regs_ptr->arr);
46 writel(readl(&gpt1_regs_ptr->cr1) | GPT_CR1_CEN,
50 lastdec = READ_TIMER();
57 * timer without interrupts
59 ulong get_timer(ulong base)
61 return (get_timer_masked() / GPT_RESOLUTION) - base;
64 void __udelay(unsigned long usec)
67 ulong start = get_timer_masked();
68 ulong tenudelcnt = CONFIG_STV0991_HZ_CLOCK / (1000 * 100);
71 rndoff = (usec % 10) ? 1 : 0;
73 /* tenudelcnt timer tick gives 10 microsecconds delay */
74 tmo = ((usec / 10) + rndoff) * tenudelcnt;
76 while ((ulong) (get_timer_masked() - start) < tmo)
80 static ulong get_timer_masked(void)
82 ulong now = READ_TIMER();
86 timestamp += now - lastdec;
88 /* we have an overflow ... */
89 timestamp += now + GPT_FREE_RUNNING - lastdec;
97 * This function is derived from PowerPC code (read timebase as long long).
98 * On ARM it just returns the timer value.
100 unsigned long long get_ticks(void)
106 * This function is derived from PowerPC code (timebase clock frequency).
107 * On ARM it returns the number of timer ticks per second.
109 ulong get_tbclk(void)
111 return CONFIG_STV0991_HZ;