blob: 1ae99deeec5491ebddfd212acd8de384e8969d0f [file] [log] [blame]
Greg Kroah-Hartmanb2441312017-11-01 15:07:57 +01001// SPDX-License-Identifier: GPL-2.0
Will Deacon43eab872010-11-13 19:04:32 +00002/*
3 * ARMv6 Performance counter handling code.
4 *
5 * Copyright (C) 2009 picoChip Designs, Ltd., Jamie Iles
6 *
7 * ARMv6 has 2 configurable performance counters and a single cycle counter.
8 * They all share a single reset bit but can be written to zero so we can use
9 * that for a reset.
10 *
11 * The counters can't be individually enabled or disabled so when we remove
12 * one event and replace it with another we could get spurious counts from the
13 * wrong event. However, we can take advantage of the fact that the
14 * performance counters can export events to the event bus, and the event bus
15 * itself can be monitored. This requires that we *don't* export the events to
16 * the event bus. The procedure for disabling a configurable counter is:
17 * - change the counter to count the ETMEXTOUT[0] signal (0x20). This
18 * effectively stops the counter from counting.
19 * - disable the counter's interrupt generation (each counter has it's
20 * own interrupt enable bit).
21 * Once stopped, the counter value can be written as 0 to reset.
22 *
23 * To enable a counter:
24 * - enable the counter's interrupt generation.
25 * - set the new event type.
26 *
27 * Note: the dedicated cycle counter only counts cycles and can't be
28 * enabled/disabled independently of the others. When we want to disable the
29 * cycle counter, we have to just disable the interrupt reporting and start
30 * ignoring that counter. When re-enabling, we have to reset the value and
31 * enable the interrupt.
32 */
33
Russell Kinge399b1a2011-01-17 15:08:32 +000034#if defined(CONFIG_CPU_V6) || defined(CONFIG_CPU_V6K)
Mark Rutland1fe115b2015-05-26 17:23:37 +010035
36#include <asm/cputype.h>
37#include <asm/irq_regs.h>
Mark Rutland1fe115b2015-05-26 17:23:37 +010038
39#include <linux/of.h>
Mark Rutlandfa8ad782015-07-06 12:23:53 +010040#include <linux/perf/arm_pmu.h>
Mark Rutland1fe115b2015-05-26 17:23:37 +010041#include <linux/platform_device.h>
42
Will Deacon43eab872010-11-13 19:04:32 +000043enum armv6_perf_types {
44 ARMV6_PERFCTR_ICACHE_MISS = 0x0,
45 ARMV6_PERFCTR_IBUF_STALL = 0x1,
46 ARMV6_PERFCTR_DDEP_STALL = 0x2,
47 ARMV6_PERFCTR_ITLB_MISS = 0x3,
48 ARMV6_PERFCTR_DTLB_MISS = 0x4,
49 ARMV6_PERFCTR_BR_EXEC = 0x5,
50 ARMV6_PERFCTR_BR_MISPREDICT = 0x6,
51 ARMV6_PERFCTR_INSTR_EXEC = 0x7,
52 ARMV6_PERFCTR_DCACHE_HIT = 0x9,
53 ARMV6_PERFCTR_DCACHE_ACCESS = 0xA,
54 ARMV6_PERFCTR_DCACHE_MISS = 0xB,
55 ARMV6_PERFCTR_DCACHE_WBACK = 0xC,
56 ARMV6_PERFCTR_SW_PC_CHANGE = 0xD,
57 ARMV6_PERFCTR_MAIN_TLB_MISS = 0xF,
58 ARMV6_PERFCTR_EXPL_D_ACCESS = 0x10,
59 ARMV6_PERFCTR_LSU_FULL_STALL = 0x11,
60 ARMV6_PERFCTR_WBUF_DRAINED = 0x12,
61 ARMV6_PERFCTR_CPU_CYCLES = 0xFF,
62 ARMV6_PERFCTR_NOP = 0x20,
63};
64
65enum armv6_counters {
Will Deacond2b41f72011-07-19 22:41:36 +010066 ARMV6_CYCLE_COUNTER = 0,
Will Deacon43eab872010-11-13 19:04:32 +000067 ARMV6_COUNTER0,
68 ARMV6_COUNTER1,
69};
70
71/*
72 * The hardware events that we support. We do support cache operations but
73 * we have harvard caches and no way to combine instruction and data
74 * accesses/misses in hardware.
75 */
76static const unsigned armv6_perf_map[PERF_COUNT_HW_MAX] = {
Mark Rutlandcf20ae82014-05-30 17:46:13 +010077 PERF_MAP_ALL_UNSUPPORTED,
Will Deacon0445e7a2011-09-29 18:23:39 +010078 [PERF_COUNT_HW_CPU_CYCLES] = ARMV6_PERFCTR_CPU_CYCLES,
79 [PERF_COUNT_HW_INSTRUCTIONS] = ARMV6_PERFCTR_INSTR_EXEC,
Will Deacon0445e7a2011-09-29 18:23:39 +010080 [PERF_COUNT_HW_BRANCH_INSTRUCTIONS] = ARMV6_PERFCTR_BR_EXEC,
81 [PERF_COUNT_HW_BRANCH_MISSES] = ARMV6_PERFCTR_BR_MISPREDICT,
Will Deacon0445e7a2011-09-29 18:23:39 +010082 [PERF_COUNT_HW_STALLED_CYCLES_FRONTEND] = ARMV6_PERFCTR_IBUF_STALL,
83 [PERF_COUNT_HW_STALLED_CYCLES_BACKEND] = ARMV6_PERFCTR_LSU_FULL_STALL,
Will Deacon43eab872010-11-13 19:04:32 +000084};
85
86static const unsigned armv6_perf_cache_map[PERF_COUNT_HW_CACHE_MAX]
87 [PERF_COUNT_HW_CACHE_OP_MAX]
88 [PERF_COUNT_HW_CACHE_RESULT_MAX] = {
Mark Rutlandcf20ae82014-05-30 17:46:13 +010089 PERF_CACHE_MAP_ALL_UNSUPPORTED,
90
91 /*
92 * The performance counters don't differentiate between read and write
93 * accesses/misses so this isn't strictly correct, but it's the best we
94 * can do. Writes and reads get combined.
95 */
96 [C(L1D)][C(OP_READ)][C(RESULT_ACCESS)] = ARMV6_PERFCTR_DCACHE_ACCESS,
97 [C(L1D)][C(OP_READ)][C(RESULT_MISS)] = ARMV6_PERFCTR_DCACHE_MISS,
98 [C(L1D)][C(OP_WRITE)][C(RESULT_ACCESS)] = ARMV6_PERFCTR_DCACHE_ACCESS,
99 [C(L1D)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6_PERFCTR_DCACHE_MISS,
100
101 [C(L1I)][C(OP_READ)][C(RESULT_MISS)] = ARMV6_PERFCTR_ICACHE_MISS,
102
103 /*
104 * The ARM performance counters can count micro DTLB misses, micro ITLB
105 * misses and main TLB misses. There isn't an event for TLB misses, so
106 * use the micro misses here and if users want the main TLB misses they
107 * can use a raw counter.
108 */
109 [C(DTLB)][C(OP_READ)][C(RESULT_MISS)] = ARMV6_PERFCTR_DTLB_MISS,
110 [C(DTLB)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6_PERFCTR_DTLB_MISS,
111
112 [C(ITLB)][C(OP_READ)][C(RESULT_MISS)] = ARMV6_PERFCTR_ITLB_MISS,
113 [C(ITLB)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6_PERFCTR_ITLB_MISS,
Will Deacon43eab872010-11-13 19:04:32 +0000114};
115
116enum armv6mpcore_perf_types {
117 ARMV6MPCORE_PERFCTR_ICACHE_MISS = 0x0,
118 ARMV6MPCORE_PERFCTR_IBUF_STALL = 0x1,
119 ARMV6MPCORE_PERFCTR_DDEP_STALL = 0x2,
120 ARMV6MPCORE_PERFCTR_ITLB_MISS = 0x3,
121 ARMV6MPCORE_PERFCTR_DTLB_MISS = 0x4,
122 ARMV6MPCORE_PERFCTR_BR_EXEC = 0x5,
123 ARMV6MPCORE_PERFCTR_BR_NOTPREDICT = 0x6,
124 ARMV6MPCORE_PERFCTR_BR_MISPREDICT = 0x7,
125 ARMV6MPCORE_PERFCTR_INSTR_EXEC = 0x8,
126 ARMV6MPCORE_PERFCTR_DCACHE_RDACCESS = 0xA,
127 ARMV6MPCORE_PERFCTR_DCACHE_RDMISS = 0xB,
128 ARMV6MPCORE_PERFCTR_DCACHE_WRACCESS = 0xC,
129 ARMV6MPCORE_PERFCTR_DCACHE_WRMISS = 0xD,
130 ARMV6MPCORE_PERFCTR_DCACHE_EVICTION = 0xE,
131 ARMV6MPCORE_PERFCTR_SW_PC_CHANGE = 0xF,
132 ARMV6MPCORE_PERFCTR_MAIN_TLB_MISS = 0x10,
133 ARMV6MPCORE_PERFCTR_EXPL_MEM_ACCESS = 0x11,
134 ARMV6MPCORE_PERFCTR_LSU_FULL_STALL = 0x12,
135 ARMV6MPCORE_PERFCTR_WBUF_DRAINED = 0x13,
136 ARMV6MPCORE_PERFCTR_CPU_CYCLES = 0xFF,
137};
138
139/*
140 * The hardware events that we support. We do support cache operations but
141 * we have harvard caches and no way to combine instruction and data
142 * accesses/misses in hardware.
143 */
144static const unsigned armv6mpcore_perf_map[PERF_COUNT_HW_MAX] = {
Mark Rutlandcf20ae82014-05-30 17:46:13 +0100145 PERF_MAP_ALL_UNSUPPORTED,
Will Deacon0445e7a2011-09-29 18:23:39 +0100146 [PERF_COUNT_HW_CPU_CYCLES] = ARMV6MPCORE_PERFCTR_CPU_CYCLES,
147 [PERF_COUNT_HW_INSTRUCTIONS] = ARMV6MPCORE_PERFCTR_INSTR_EXEC,
Will Deacon0445e7a2011-09-29 18:23:39 +0100148 [PERF_COUNT_HW_BRANCH_INSTRUCTIONS] = ARMV6MPCORE_PERFCTR_BR_EXEC,
149 [PERF_COUNT_HW_BRANCH_MISSES] = ARMV6MPCORE_PERFCTR_BR_MISPREDICT,
Will Deacon0445e7a2011-09-29 18:23:39 +0100150 [PERF_COUNT_HW_STALLED_CYCLES_FRONTEND] = ARMV6MPCORE_PERFCTR_IBUF_STALL,
151 [PERF_COUNT_HW_STALLED_CYCLES_BACKEND] = ARMV6MPCORE_PERFCTR_LSU_FULL_STALL,
Will Deacon43eab872010-11-13 19:04:32 +0000152};
153
154static const unsigned armv6mpcore_perf_cache_map[PERF_COUNT_HW_CACHE_MAX]
155 [PERF_COUNT_HW_CACHE_OP_MAX]
156 [PERF_COUNT_HW_CACHE_RESULT_MAX] = {
Mark Rutlandcf20ae82014-05-30 17:46:13 +0100157 PERF_CACHE_MAP_ALL_UNSUPPORTED,
158
159 [C(L1D)][C(OP_READ)][C(RESULT_ACCESS)] = ARMV6MPCORE_PERFCTR_DCACHE_RDACCESS,
160 [C(L1D)][C(OP_READ)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_DCACHE_RDMISS,
161 [C(L1D)][C(OP_WRITE)][C(RESULT_ACCESS)] = ARMV6MPCORE_PERFCTR_DCACHE_WRACCESS,
162 [C(L1D)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_DCACHE_WRMISS,
163
164 [C(L1I)][C(OP_READ)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_ICACHE_MISS,
165
166 /*
167 * The ARM performance counters can count micro DTLB misses, micro ITLB
168 * misses and main TLB misses. There isn't an event for TLB misses, so
169 * use the micro misses here and if users want the main TLB misses they
170 * can use a raw counter.
171 */
172 [C(DTLB)][C(OP_READ)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_DTLB_MISS,
173 [C(DTLB)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_DTLB_MISS,
174
175 [C(ITLB)][C(OP_READ)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_ITLB_MISS,
176 [C(ITLB)][C(OP_WRITE)][C(RESULT_MISS)] = ARMV6MPCORE_PERFCTR_ITLB_MISS,
Will Deacon43eab872010-11-13 19:04:32 +0000177};
178
179static inline unsigned long
180armv6_pmcr_read(void)
181{
182 u32 val;
183 asm volatile("mrc p15, 0, %0, c15, c12, 0" : "=r"(val));
184 return val;
185}
186
187static inline void
188armv6_pmcr_write(unsigned long val)
189{
190 asm volatile("mcr p15, 0, %0, c15, c12, 0" : : "r"(val));
191}
192
193#define ARMV6_PMCR_ENABLE (1 << 0)
194#define ARMV6_PMCR_CTR01_RESET (1 << 1)
195#define ARMV6_PMCR_CCOUNT_RESET (1 << 2)
196#define ARMV6_PMCR_CCOUNT_DIV (1 << 3)
197#define ARMV6_PMCR_COUNT0_IEN (1 << 4)
198#define ARMV6_PMCR_COUNT1_IEN (1 << 5)
199#define ARMV6_PMCR_CCOUNT_IEN (1 << 6)
200#define ARMV6_PMCR_COUNT0_OVERFLOW (1 << 8)
201#define ARMV6_PMCR_COUNT1_OVERFLOW (1 << 9)
202#define ARMV6_PMCR_CCOUNT_OVERFLOW (1 << 10)
203#define ARMV6_PMCR_EVT_COUNT0_SHIFT 20
204#define ARMV6_PMCR_EVT_COUNT0_MASK (0xFF << ARMV6_PMCR_EVT_COUNT0_SHIFT)
205#define ARMV6_PMCR_EVT_COUNT1_SHIFT 12
206#define ARMV6_PMCR_EVT_COUNT1_MASK (0xFF << ARMV6_PMCR_EVT_COUNT1_SHIFT)
207
208#define ARMV6_PMCR_OVERFLOWED_MASK \
209 (ARMV6_PMCR_COUNT0_OVERFLOW | ARMV6_PMCR_COUNT1_OVERFLOW | \
210 ARMV6_PMCR_CCOUNT_OVERFLOW)
211
212static inline int
213armv6_pmcr_has_overflowed(unsigned long pmcr)
214{
215 return pmcr & ARMV6_PMCR_OVERFLOWED_MASK;
216}
217
218static inline int
219armv6_pmcr_counter_has_overflowed(unsigned long pmcr,
220 enum armv6_counters counter)
221{
222 int ret = 0;
223
224 if (ARMV6_CYCLE_COUNTER == counter)
225 ret = pmcr & ARMV6_PMCR_CCOUNT_OVERFLOW;
226 else if (ARMV6_COUNTER0 == counter)
227 ret = pmcr & ARMV6_PMCR_COUNT0_OVERFLOW;
228 else if (ARMV6_COUNTER1 == counter)
229 ret = pmcr & ARMV6_PMCR_COUNT1_OVERFLOW;
230 else
231 WARN_ONCE(1, "invalid counter number (%d)\n", counter);
232
233 return ret;
234}
235
Suzuki K Poulose3a952002018-07-10 09:57:59 +0100236static inline u64 armv6pmu_read_counter(struct perf_event *event)
Will Deacon43eab872010-11-13 19:04:32 +0000237{
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100238 struct hw_perf_event *hwc = &event->hw;
239 int counter = hwc->idx;
Will Deacon43eab872010-11-13 19:04:32 +0000240 unsigned long value = 0;
241
242 if (ARMV6_CYCLE_COUNTER == counter)
243 asm volatile("mrc p15, 0, %0, c15, c12, 1" : "=r"(value));
244 else if (ARMV6_COUNTER0 == counter)
245 asm volatile("mrc p15, 0, %0, c15, c12, 2" : "=r"(value));
246 else if (ARMV6_COUNTER1 == counter)
247 asm volatile("mrc p15, 0, %0, c15, c12, 3" : "=r"(value));
248 else
249 WARN_ONCE(1, "invalid counter number (%d)\n", counter);
250
251 return value;
252}
253
Suzuki K Poulose3a952002018-07-10 09:57:59 +0100254static inline void armv6pmu_write_counter(struct perf_event *event, u64 value)
Will Deacon43eab872010-11-13 19:04:32 +0000255{
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100256 struct hw_perf_event *hwc = &event->hw;
257 int counter = hwc->idx;
258
Will Deacon43eab872010-11-13 19:04:32 +0000259 if (ARMV6_CYCLE_COUNTER == counter)
260 asm volatile("mcr p15, 0, %0, c15, c12, 1" : : "r"(value));
261 else if (ARMV6_COUNTER0 == counter)
262 asm volatile("mcr p15, 0, %0, c15, c12, 2" : : "r"(value));
263 else if (ARMV6_COUNTER1 == counter)
264 asm volatile("mcr p15, 0, %0, c15, c12, 3" : : "r"(value));
265 else
266 WARN_ONCE(1, "invalid counter number (%d)\n", counter);
267}
268
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100269static void armv6pmu_enable_event(struct perf_event *event)
Will Deacon43eab872010-11-13 19:04:32 +0000270{
271 unsigned long val, mask, evt, flags;
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100272 struct arm_pmu *cpu_pmu = to_arm_pmu(event->pmu);
273 struct hw_perf_event *hwc = &event->hw;
Mark Rutland11679252014-05-13 19:36:31 +0100274 struct pmu_hw_events *events = this_cpu_ptr(cpu_pmu->hw_events);
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100275 int idx = hwc->idx;
Will Deacon43eab872010-11-13 19:04:32 +0000276
277 if (ARMV6_CYCLE_COUNTER == idx) {
278 mask = 0;
279 evt = ARMV6_PMCR_CCOUNT_IEN;
280 } else if (ARMV6_COUNTER0 == idx) {
281 mask = ARMV6_PMCR_EVT_COUNT0_MASK;
282 evt = (hwc->config_base << ARMV6_PMCR_EVT_COUNT0_SHIFT) |
283 ARMV6_PMCR_COUNT0_IEN;
284 } else if (ARMV6_COUNTER1 == idx) {
285 mask = ARMV6_PMCR_EVT_COUNT1_MASK;
286 evt = (hwc->config_base << ARMV6_PMCR_EVT_COUNT1_SHIFT) |
287 ARMV6_PMCR_COUNT1_IEN;
288 } else {
289 WARN_ONCE(1, "invalid counter number (%d)\n", idx);
290 return;
291 }
292
293 /*
294 * Mask out the current event and set the counter to count the event
295 * that we're interested in.
296 */
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100297 raw_spin_lock_irqsave(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000298 val = armv6_pmcr_read();
299 val &= ~mask;
300 val |= evt;
301 armv6_pmcr_write(val);
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100302 raw_spin_unlock_irqrestore(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000303}
304
305static irqreturn_t
Mark Rutland0788f1e2018-05-10 11:35:15 +0100306armv6pmu_handle_irq(struct arm_pmu *cpu_pmu)
Will Deacon43eab872010-11-13 19:04:32 +0000307{
308 unsigned long pmcr = armv6_pmcr_read();
309 struct perf_sample_data data;
Mark Rutland11679252014-05-13 19:36:31 +0100310 struct pmu_hw_events *cpuc = this_cpu_ptr(cpu_pmu->hw_events);
Will Deacon43eab872010-11-13 19:04:32 +0000311 struct pt_regs *regs;
312 int idx;
313
314 if (!armv6_pmcr_has_overflowed(pmcr))
315 return IRQ_NONE;
316
317 regs = get_irq_regs();
318
319 /*
320 * The interrupts are cleared by writing the overflow flags back to
321 * the control register. All of the other bits don't have any effect
322 * if they are rewritten, so write the whole value back.
323 */
324 armv6_pmcr_write(pmcr);
325
Mark Rutland8be3f9a2011-05-17 11:20:11 +0100326 for (idx = 0; idx < cpu_pmu->num_events; ++idx) {
Will Deacon43eab872010-11-13 19:04:32 +0000327 struct perf_event *event = cpuc->events[idx];
328 struct hw_perf_event *hwc;
329
Will Deaconf6f5a302012-03-06 17:34:50 +0100330 /* Ignore if we don't have an event. */
331 if (!event)
Will Deacon43eab872010-11-13 19:04:32 +0000332 continue;
333
334 /*
335 * We have a single interrupt for all counters. Check that
336 * each counter has overflowed before we process it.
337 */
338 if (!armv6_pmcr_counter_has_overflowed(pmcr, idx))
339 continue;
340
341 hwc = &event->hw;
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100342 armpmu_event_update(event);
Robert Richterfd0d0002012-04-02 20:19:08 +0200343 perf_sample_data_init(&data, 0, hwc->last_period);
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100344 if (!armpmu_event_set_period(event))
Will Deacon43eab872010-11-13 19:04:32 +0000345 continue;
346
Peter Zijlstraa8b0ca12011-06-27 14:41:57 +0200347 if (perf_event_overflow(event, &data, regs))
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100348 cpu_pmu->disable(event);
Will Deacon43eab872010-11-13 19:04:32 +0000349 }
350
351 /*
352 * Handle the pending perf events.
353 *
354 * Note: this call *must* be run with interrupts disabled. For
355 * platforms that can have the PMU interrupts raised as an NMI, this
356 * will not work.
357 */
358 irq_work_run();
359
360 return IRQ_HANDLED;
361}
362
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100363static void armv6pmu_start(struct arm_pmu *cpu_pmu)
Will Deacon43eab872010-11-13 19:04:32 +0000364{
365 unsigned long flags, val;
Mark Rutland11679252014-05-13 19:36:31 +0100366 struct pmu_hw_events *events = this_cpu_ptr(cpu_pmu->hw_events);
Will Deacon43eab872010-11-13 19:04:32 +0000367
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100368 raw_spin_lock_irqsave(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000369 val = armv6_pmcr_read();
370 val |= ARMV6_PMCR_ENABLE;
371 armv6_pmcr_write(val);
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100372 raw_spin_unlock_irqrestore(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000373}
374
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100375static void armv6pmu_stop(struct arm_pmu *cpu_pmu)
Will Deacon43eab872010-11-13 19:04:32 +0000376{
377 unsigned long flags, val;
Mark Rutland11679252014-05-13 19:36:31 +0100378 struct pmu_hw_events *events = this_cpu_ptr(cpu_pmu->hw_events);
Will Deacon43eab872010-11-13 19:04:32 +0000379
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100380 raw_spin_lock_irqsave(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000381 val = armv6_pmcr_read();
382 val &= ~ARMV6_PMCR_ENABLE;
383 armv6_pmcr_write(val);
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100384 raw_spin_unlock_irqrestore(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000385}
386
387static int
Mark Rutland8be3f9a2011-05-17 11:20:11 +0100388armv6pmu_get_event_idx(struct pmu_hw_events *cpuc,
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100389 struct perf_event *event)
Will Deacon43eab872010-11-13 19:04:32 +0000390{
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100391 struct hw_perf_event *hwc = &event->hw;
Will Deacon43eab872010-11-13 19:04:32 +0000392 /* Always place a cycle counter into the cycle counter. */
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100393 if (ARMV6_PERFCTR_CPU_CYCLES == hwc->config_base) {
Will Deacon43eab872010-11-13 19:04:32 +0000394 if (test_and_set_bit(ARMV6_CYCLE_COUNTER, cpuc->used_mask))
395 return -EAGAIN;
396
397 return ARMV6_CYCLE_COUNTER;
398 } else {
399 /*
400 * For anything other than a cycle counter, try and use
401 * counter0 and counter1.
402 */
403 if (!test_and_set_bit(ARMV6_COUNTER1, cpuc->used_mask))
404 return ARMV6_COUNTER1;
405
406 if (!test_and_set_bit(ARMV6_COUNTER0, cpuc->used_mask))
407 return ARMV6_COUNTER0;
408
409 /* The counters are all in use. */
410 return -EAGAIN;
411 }
412}
413
Suzuki K Poulose7dfc8db2018-07-10 09:58:01 +0100414static void armv6pmu_clear_event_idx(struct pmu_hw_events *cpuc,
415 struct perf_event *event)
416{
417 clear_bit(event->hw.idx, cpuc->used_mask);
418}
419
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100420static void armv6pmu_disable_event(struct perf_event *event)
Will Deacon43eab872010-11-13 19:04:32 +0000421{
422 unsigned long val, mask, evt, flags;
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100423 struct arm_pmu *cpu_pmu = to_arm_pmu(event->pmu);
424 struct hw_perf_event *hwc = &event->hw;
Mark Rutland11679252014-05-13 19:36:31 +0100425 struct pmu_hw_events *events = this_cpu_ptr(cpu_pmu->hw_events);
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100426 int idx = hwc->idx;
Will Deacon43eab872010-11-13 19:04:32 +0000427
428 if (ARMV6_CYCLE_COUNTER == idx) {
429 mask = ARMV6_PMCR_CCOUNT_IEN;
430 evt = 0;
431 } else if (ARMV6_COUNTER0 == idx) {
432 mask = ARMV6_PMCR_COUNT0_IEN | ARMV6_PMCR_EVT_COUNT0_MASK;
433 evt = ARMV6_PERFCTR_NOP << ARMV6_PMCR_EVT_COUNT0_SHIFT;
434 } else if (ARMV6_COUNTER1 == idx) {
435 mask = ARMV6_PMCR_COUNT1_IEN | ARMV6_PMCR_EVT_COUNT1_MASK;
436 evt = ARMV6_PERFCTR_NOP << ARMV6_PMCR_EVT_COUNT1_SHIFT;
437 } else {
438 WARN_ONCE(1, "invalid counter number (%d)\n", idx);
439 return;
440 }
441
442 /*
443 * Mask out the current event and set the counter to count the number
444 * of ETM bus signal assertion cycles. The external reporting should
445 * be disabled and so this should never increment.
446 */
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100447 raw_spin_lock_irqsave(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000448 val = armv6_pmcr_read();
449 val &= ~mask;
450 val |= evt;
451 armv6_pmcr_write(val);
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100452 raw_spin_unlock_irqrestore(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000453}
454
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100455static void armv6mpcore_pmu_disable_event(struct perf_event *event)
Will Deacon43eab872010-11-13 19:04:32 +0000456{
457 unsigned long val, mask, flags, evt = 0;
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100458 struct arm_pmu *cpu_pmu = to_arm_pmu(event->pmu);
459 struct hw_perf_event *hwc = &event->hw;
Mark Rutland11679252014-05-13 19:36:31 +0100460 struct pmu_hw_events *events = this_cpu_ptr(cpu_pmu->hw_events);
Sudeep KarkadaNageshaed6f2a52012-07-30 12:00:02 +0100461 int idx = hwc->idx;
Will Deacon43eab872010-11-13 19:04:32 +0000462
463 if (ARMV6_CYCLE_COUNTER == idx) {
464 mask = ARMV6_PMCR_CCOUNT_IEN;
465 } else if (ARMV6_COUNTER0 == idx) {
466 mask = ARMV6_PMCR_COUNT0_IEN;
467 } else if (ARMV6_COUNTER1 == idx) {
468 mask = ARMV6_PMCR_COUNT1_IEN;
469 } else {
470 WARN_ONCE(1, "invalid counter number (%d)\n", idx);
471 return;
472 }
473
474 /*
475 * Unlike UP ARMv6, we don't have a way of stopping the counters. We
476 * simply disable the interrupt reporting.
477 */
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100478 raw_spin_lock_irqsave(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000479 val = armv6_pmcr_read();
480 val &= ~mask;
481 val |= evt;
482 armv6_pmcr_write(val);
Mark Rutland0f78d2d2011-04-28 10:17:04 +0100483 raw_spin_unlock_irqrestore(&events->pmu_lock, flags);
Will Deacon43eab872010-11-13 19:04:32 +0000484}
485
Mark Rutlande1f431b2011-04-28 15:47:10 +0100486static int armv6_map_event(struct perf_event *event)
487{
Will Deacon6dbc0022012-07-29 12:36:28 +0100488 return armpmu_map_event(event, &armv6_perf_map,
Mark Rutlande1f431b2011-04-28 15:47:10 +0100489 &armv6_perf_cache_map, 0xFF);
490}
491
Mark Rutland3d1ff752012-12-19 16:33:24 +0000492static void armv6pmu_init(struct arm_pmu *cpu_pmu)
Will Deacon43eab872010-11-13 19:04:32 +0000493{
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100494 cpu_pmu->handle_irq = armv6pmu_handle_irq;
495 cpu_pmu->enable = armv6pmu_enable_event;
496 cpu_pmu->disable = armv6pmu_disable_event;
497 cpu_pmu->read_counter = armv6pmu_read_counter;
498 cpu_pmu->write_counter = armv6pmu_write_counter;
499 cpu_pmu->get_event_idx = armv6pmu_get_event_idx;
Suzuki K Poulose7dfc8db2018-07-10 09:58:01 +0100500 cpu_pmu->clear_event_idx = armv6pmu_clear_event_idx;
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100501 cpu_pmu->start = armv6pmu_start;
502 cpu_pmu->stop = armv6pmu_stop;
503 cpu_pmu->map_event = armv6_map_event;
504 cpu_pmu->num_events = 3;
Mark Rutland3d1ff752012-12-19 16:33:24 +0000505}
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100506
Mark Rutland3d1ff752012-12-19 16:33:24 +0000507static int armv6_1136_pmu_init(struct arm_pmu *cpu_pmu)
508{
509 armv6pmu_init(cpu_pmu);
510 cpu_pmu->name = "armv6_1136";
511 return 0;
512}
513
514static int armv6_1156_pmu_init(struct arm_pmu *cpu_pmu)
515{
516 armv6pmu_init(cpu_pmu);
517 cpu_pmu->name = "armv6_1156";
518 return 0;
519}
520
521static int armv6_1176_pmu_init(struct arm_pmu *cpu_pmu)
522{
523 armv6pmu_init(cpu_pmu);
524 cpu_pmu->name = "armv6_1176";
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100525 return 0;
Will Deacon43eab872010-11-13 19:04:32 +0000526}
527
528/*
529 * ARMv6mpcore is almost identical to single core ARMv6 with the exception
530 * that some of the events have different enumerations and that there is no
531 * *hack* to stop the programmable counters. To stop the counters we simply
532 * disable the interrupt reporting and update the event. When unthrottling we
533 * reset the period and enable the interrupt reporting.
534 */
Mark Rutlande1f431b2011-04-28 15:47:10 +0100535
536static int armv6mpcore_map_event(struct perf_event *event)
537{
Will Deacon6dbc0022012-07-29 12:36:28 +0100538 return armpmu_map_event(event, &armv6mpcore_perf_map,
Mark Rutlande1f431b2011-04-28 15:47:10 +0100539 &armv6mpcore_perf_cache_map, 0xFF);
540}
541
Greg Kroah-Hartman351a1022012-12-21 14:02:24 -0800542static int armv6mpcore_pmu_init(struct arm_pmu *cpu_pmu)
Will Deacon43eab872010-11-13 19:04:32 +0000543{
Mark Rutland3d1ff752012-12-19 16:33:24 +0000544 cpu_pmu->name = "armv6_11mpcore";
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100545 cpu_pmu->handle_irq = armv6pmu_handle_irq;
546 cpu_pmu->enable = armv6pmu_enable_event;
547 cpu_pmu->disable = armv6mpcore_pmu_disable_event;
548 cpu_pmu->read_counter = armv6pmu_read_counter;
549 cpu_pmu->write_counter = armv6pmu_write_counter;
550 cpu_pmu->get_event_idx = armv6pmu_get_event_idx;
Suzuki K Poulose7dfc8db2018-07-10 09:58:01 +0100551 cpu_pmu->clear_event_idx = armv6pmu_clear_event_idx;
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100552 cpu_pmu->start = armv6pmu_start;
553 cpu_pmu->stop = armv6pmu_stop;
554 cpu_pmu->map_event = armv6mpcore_map_event;
555 cpu_pmu->num_events = 3;
Sudeep KarkadaNagesha513c99c2012-07-31 10:11:23 +0100556
557 return 0;
Will Deacon43eab872010-11-13 19:04:32 +0000558}
Mark Rutland1fe115b2015-05-26 17:23:37 +0100559
Arvind Yadavd5f7b822017-06-15 14:55:37 +0530560static const struct of_device_id armv6_pmu_of_device_ids[] = {
Mark Rutland1fe115b2015-05-26 17:23:37 +0100561 {.compatible = "arm,arm11mpcore-pmu", .data = armv6mpcore_pmu_init},
562 {.compatible = "arm,arm1176-pmu", .data = armv6_1176_pmu_init},
563 {.compatible = "arm,arm1136-pmu", .data = armv6_1136_pmu_init},
564 { /* sentinel value */ }
565};
566
567static const struct pmu_probe_info armv6_pmu_probe_table[] = {
568 ARM_PMU_PROBE(ARM_CPU_PART_ARM1136, armv6_1136_pmu_init),
569 ARM_PMU_PROBE(ARM_CPU_PART_ARM1156, armv6_1156_pmu_init),
570 ARM_PMU_PROBE(ARM_CPU_PART_ARM1176, armv6_1176_pmu_init),
571 ARM_PMU_PROBE(ARM_CPU_PART_ARM11MPCORE, armv6mpcore_pmu_init),
572 { /* sentinel value */ }
573};
574
575static int armv6_pmu_device_probe(struct platform_device *pdev)
Mark Rutland3d1ff752012-12-19 16:33:24 +0000576{
Mark Rutland1fe115b2015-05-26 17:23:37 +0100577 return arm_pmu_device_probe(pdev, armv6_pmu_of_device_ids,
578 armv6_pmu_probe_table);
Mark Rutland3d1ff752012-12-19 16:33:24 +0000579}
580
Mark Rutland1fe115b2015-05-26 17:23:37 +0100581static struct platform_driver armv6_pmu_driver = {
582 .driver = {
583 .name = "armv6-pmu",
584 .of_match_table = armv6_pmu_of_device_ids,
585 },
586 .probe = armv6_pmu_device_probe,
587};
Mark Rutland3d1ff752012-12-19 16:33:24 +0000588
Geliang Tangb128cb52016-11-23 22:39:52 +0800589builtin_platform_driver(armv6_pmu_driver);
Russell Kinge399b1a2011-01-17 15:08:32 +0000590#endif /* CONFIG_CPU_V6 || CONFIG_CPU_V6K */