Branch data Line data Source code
1 : : #ifndef __ASMARM_ARCH_TIMER_H
2 : : #define __ASMARM_ARCH_TIMER_H
3 : :
4 : : #include <asm/barrier.h>
5 : : #include <asm/errno.h>
6 : : #include <linux/clocksource.h>
7 : : #include <linux/init.h>
8 : : #include <linux/types.h>
9 : :
10 : : #include <clocksource/arm_arch_timer.h>
11 : :
12 : : #ifdef CONFIG_ARM_ARCH_TIMER
13 : : int arch_timer_arch_init(void);
14 : :
15 : : /*
16 : : * These register accessors are marked inline so the compiler can
17 : : * nicely work out which register we want, and chuck away the rest of
18 : : * the code. At least it does so with a recent GCC (4.6.3).
19 : : */
20 : : static __always_inline
21 : : void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u32 val)
22 : : {
23 : : if (access == ARCH_TIMER_PHYS_ACCESS) {
24 : : switch (reg) {
25 : : case ARCH_TIMER_REG_CTRL:
26 : 0 : asm volatile("mcr p15, 0, %0, c14, c2, 1" : : "r" (val));
27 : : break;
28 : : case ARCH_TIMER_REG_TVAL:
29 : 0 : asm volatile("mcr p15, 0, %0, c14, c2, 0" : : "r" (val));
30 : : break;
31 : : }
32 : : } else if (access == ARCH_TIMER_VIRT_ACCESS) {
33 : : switch (reg) {
34 : : case ARCH_TIMER_REG_CTRL:
35 : 22480371 : asm volatile("mcr p15, 0, %0, c14, c3, 1" : : "r" (val));
36 : : break;
37 : : case ARCH_TIMER_REG_TVAL:
38 : 14947258 : asm volatile("mcr p15, 0, %0, c14, c3, 0" : : "r" (val));
39 : : break;
40 : : }
41 : : }
42 : :
43 : 37438059 : isb();
44 : : }
45 : :
46 : : static __always_inline
47 : : u32 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg)
48 : : {
49 : : u32 val = 0;
50 : :
51 : : if (access == ARCH_TIMER_PHYS_ACCESS) {
52 : : switch (reg) {
53 : : case ARCH_TIMER_REG_CTRL:
54 : 0 : asm volatile("mrc p15, 0, %0, c14, c2, 1" : "=r" (val));
55 : : break;
56 : : case ARCH_TIMER_REG_TVAL:
57 : : asm volatile("mrc p15, 0, %0, c14, c2, 0" : "=r" (val));
58 : : break;
59 : : }
60 : : } else if (access == ARCH_TIMER_VIRT_ACCESS) {
61 : : switch (reg) {
62 : : case ARCH_TIMER_REG_CTRL:
63 : 22414691 : asm volatile("mrc p15, 0, %0, c14, c3, 1" : "=r" (val));
64 : : break;
65 : : case ARCH_TIMER_REG_TVAL:
66 : : asm volatile("mrc p15, 0, %0, c14, c3, 0" : "=r" (val));
67 : : break;
68 : : }
69 : : }
70 : :
71 : : return val;
72 : : }
73 : :
74 : : static inline u32 arch_timer_get_cntfrq(void)
75 : : {
76 : : u32 val;
77 : 0 : asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (val));
78 : : return val;
79 : : }
80 : :
81 : 0 : static inline u64 arch_counter_get_cntvct(void)
82 : : {
83 : : u64 cval;
84 : :
85 : 262307961 : isb();
86 : 263410109 : asm volatile("mrrc p15, 1, %Q0, %R0, c14" : "=r" (cval));
87 : 262826340 : return cval;
88 : : }
89 : :
90 : : static inline u32 arch_timer_get_cntkctl(void)
91 : : {
92 : : u32 cntkctl;
93 : 4966413 : asm volatile("mrc p15, 0, %0, c14, c1, 0" : "=r" (cntkctl));
94 : : return cntkctl;
95 : : }
96 : :
97 : : static inline void arch_timer_set_cntkctl(u32 cntkctl)
98 : : {
99 : 3916753 : asm volatile("mcr p15, 0, %0, c14, c1, 0" : : "r" (cntkctl));
100 : : }
101 : :
102 : : static inline void arch_counter_set_user_access(void)
103 : : {
104 : : u32 cntkctl = arch_timer_get_cntkctl();
105 : :
106 : : /* Disable user access to both physical/virtual counters/timers */
107 : : /* Also disable virtual event stream */
108 : 81 : cntkctl &= ~(ARCH_TIMER_USR_PT_ACCESS_EN
109 : : | ARCH_TIMER_USR_VT_ACCESS_EN
110 : : | ARCH_TIMER_USR_VCT_ACCESS_EN
111 : : | ARCH_TIMER_USR_PCT_ACCESS_EN);
112 : : arch_timer_set_cntkctl(cntkctl);
113 : : }
114 : :
115 : : static inline void arch_timer_evtstrm_enable(int divider)
116 : : {
117 : : u32 cntkctl = arch_timer_get_cntkctl();
118 : 81 : cntkctl &= ~ARCH_TIMER_EVT_TRIGGER_MASK;
119 : : /* Set the divider and enable virtual event stream */
120 : 81 : cntkctl |= (divider << ARCH_TIMER_EVT_TRIGGER_SHIFT)
121 : : | ARCH_TIMER_VIRT_EVT_EN;
122 : : arch_timer_set_cntkctl(cntkctl);
123 : 81 : elf_hwcap |= HWCAP_EVTSTRM;
124 : : }
125 : :
126 : : #endif
127 : :
128 : : #endif
|
