Loading...
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
13int 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 */
20static __always_inline
21void 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 asm volatile("mcr p15, 0, %0, c14, c2, 1" : : "r" (val));
27 break;
28 case ARCH_TIMER_REG_TVAL:
29 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 asm volatile("mcr p15, 0, %0, c14, c3, 1" : : "r" (val));
36 break;
37 case ARCH_TIMER_REG_TVAL:
38 asm volatile("mcr p15, 0, %0, c14, c3, 0" : : "r" (val));
39 break;
40 }
41 }
42
43 isb();
44}
45
46static __always_inline
47u32 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 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 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
74static inline u32 arch_timer_get_cntfrq(void)
75{
76 u32 val;
77 asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (val));
78 return val;
79}
80
81static inline u64 arch_counter_get_cntpct(void)
82{
83 u64 cval;
84
85 isb();
86 asm volatile("mrrc p15, 0, %Q0, %R0, c14" : "=r" (cval));
87 return cval;
88}
89
90static inline u64 arch_counter_get_cntvct(void)
91{
92 u64 cval;
93
94 isb();
95 asm volatile("mrrc p15, 1, %Q0, %R0, c14" : "=r" (cval));
96 return cval;
97}
98
99static inline u32 arch_timer_get_cntkctl(void)
100{
101 u32 cntkctl;
102 asm volatile("mrc p15, 0, %0, c14, c1, 0" : "=r" (cntkctl));
103 return cntkctl;
104}
105
106static inline void arch_timer_set_cntkctl(u32 cntkctl)
107{
108 asm volatile("mcr p15, 0, %0, c14, c1, 0" : : "r" (cntkctl));
109}
110
111#endif
112
113#endif
1/* SPDX-License-Identifier: GPL-2.0 */
2#ifndef __ASMARM_ARCH_TIMER_H
3#define __ASMARM_ARCH_TIMER_H
4
5#include <asm/barrier.h>
6#include <asm/errno.h>
7#include <asm/hwcap.h>
8#include <linux/clocksource.h>
9#include <linux/init.h>
10#include <linux/io-64-nonatomic-lo-hi.h>
11#include <linux/types.h>
12
13#include <clocksource/arm_arch_timer.h>
14
15#ifdef CONFIG_ARM_ARCH_TIMER
16/* 32bit ARM doesn't know anything about timer errata... */
17#define has_erratum_handler(h) (false)
18#define erratum_handler(h) (arch_timer_##h)
19
20int arch_timer_arch_init(void);
21
22/*
23 * These register accessors are marked inline so the compiler can
24 * nicely work out which register we want, and chuck away the rest of
25 * the code. At least it does so with a recent GCC (4.6.3).
26 */
27static __always_inline
28void arch_timer_reg_write_cp15(int access, enum arch_timer_reg reg, u64 val)
29{
30 if (access == ARCH_TIMER_PHYS_ACCESS) {
31 switch (reg) {
32 case ARCH_TIMER_REG_CTRL:
33 asm volatile("mcr p15, 0, %0, c14, c2, 1" : : "r" ((u32)val));
34 isb();
35 break;
36 case ARCH_TIMER_REG_CVAL:
37 asm volatile("mcrr p15, 2, %Q0, %R0, c14" : : "r" (val));
38 break;
39 default:
40 BUILD_BUG();
41 }
42 } else if (access == ARCH_TIMER_VIRT_ACCESS) {
43 switch (reg) {
44 case ARCH_TIMER_REG_CTRL:
45 asm volatile("mcr p15, 0, %0, c14, c3, 1" : : "r" ((u32)val));
46 isb();
47 break;
48 case ARCH_TIMER_REG_CVAL:
49 asm volatile("mcrr p15, 3, %Q0, %R0, c14" : : "r" (val));
50 break;
51 default:
52 BUILD_BUG();
53 }
54 } else {
55 BUILD_BUG();
56 }
57}
58
59static __always_inline
60u32 arch_timer_reg_read_cp15(int access, enum arch_timer_reg reg)
61{
62 u32 val = 0;
63
64 if (access == ARCH_TIMER_PHYS_ACCESS) {
65 switch (reg) {
66 case ARCH_TIMER_REG_CTRL:
67 asm volatile("mrc p15, 0, %0, c14, c2, 1" : "=r" (val));
68 break;
69 default:
70 BUILD_BUG();
71 }
72 } else if (access == ARCH_TIMER_VIRT_ACCESS) {
73 switch (reg) {
74 case ARCH_TIMER_REG_CTRL:
75 asm volatile("mrc p15, 0, %0, c14, c3, 1" : "=r" (val));
76 break;
77 default:
78 BUILD_BUG();
79 }
80 } else {
81 BUILD_BUG();
82 }
83
84 return val;
85}
86
87static inline u32 arch_timer_get_cntfrq(void)
88{
89 u32 val;
90 asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (val));
91 return val;
92}
93
94static inline u64 __arch_counter_get_cntpct(void)
95{
96 u64 cval;
97
98 isb();
99 asm volatile("mrrc p15, 0, %Q0, %R0, c14" : "=r" (cval));
100 return cval;
101}
102
103static inline u64 __arch_counter_get_cntpct_stable(void)
104{
105 return __arch_counter_get_cntpct();
106}
107
108static inline u64 __arch_counter_get_cntvct(void)
109{
110 u64 cval;
111
112 isb();
113 asm volatile("mrrc p15, 1, %Q0, %R0, c14" : "=r" (cval));
114 return cval;
115}
116
117static inline u64 __arch_counter_get_cntvct_stable(void)
118{
119 return __arch_counter_get_cntvct();
120}
121
122static inline u32 arch_timer_get_cntkctl(void)
123{
124 u32 cntkctl;
125 asm volatile("mrc p15, 0, %0, c14, c1, 0" : "=r" (cntkctl));
126 return cntkctl;
127}
128
129static inline void arch_timer_set_cntkctl(u32 cntkctl)
130{
131 asm volatile("mcr p15, 0, %0, c14, c1, 0" : : "r" (cntkctl));
132 isb();
133}
134
135static inline void arch_timer_set_evtstrm_feature(void)
136{
137 elf_hwcap |= HWCAP_EVTSTRM;
138}
139
140static inline bool arch_timer_have_evtstrm_feature(void)
141{
142 return elf_hwcap & HWCAP_EVTSTRM;
143}
144#endif
145
146#endif