1
2
3
4
5
6
7#include <common.h>
8#include <init.h>
9#include <time.h>
10#include <asm/global_data.h>
11#include <asm/io.h>
12#include <div64.h>
13#include <bootstage.h>
14
15DECLARE_GLOBAL_DATA_PTR;
16
17#ifndef CONFIG_SYS_HZ_CLOCK
18static inline u32 read_cntfrq(void)
19{
20 u32 frq;
21
22 asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (frq));
23 return frq;
24}
25#endif
26
27int timer_init(void)
28{
29 gd->arch.tbl = 0;
30 gd->arch.tbu = 0;
31
32#ifdef CONFIG_SYS_HZ_CLOCK
33 gd->arch.timer_rate_hz = CONFIG_SYS_HZ_CLOCK;
34#else
35 gd->arch.timer_rate_hz = read_cntfrq();
36#endif
37 return 0;
38}
39
40unsigned long long get_ticks(void)
41{
42 ulong nowl, nowu;
43
44 asm volatile("mrrc p15, 0, %0, %1, c14" : "=r" (nowl), "=r" (nowu));
45
46 gd->arch.tbl = nowl;
47 gd->arch.tbu = nowu;
48
49 return (((unsigned long long)gd->arch.tbu) << 32) | gd->arch.tbl;
50}
51
52
53ulong timer_get_boot_us(void)
54{
55 if (!gd->arch.timer_rate_hz)
56 timer_init();
57
58 return lldiv(get_ticks(), gd->arch.timer_rate_hz / 1000000);
59}
60
61ulong get_tbclk(void)
62{
63 return gd->arch.timer_rate_hz;
64}
65