Merge branch 'staging-next' of git://git.kernel.org/pub/scm/linux/kernel/git/gregkh...
[pandora-kernel.git] / arch / sparc / kernel / perf_event.c
1 /* Performance event support for sparc64.
2  *
3  * Copyright (C) 2009, 2010 David S. Miller <davem@davemloft.net>
4  *
5  * This code is based almost entirely upon the x86 perf event
6  * code, which is:
7  *
8  *  Copyright (C) 2008 Thomas Gleixner <tglx@linutronix.de>
9  *  Copyright (C) 2008-2009 Red Hat, Inc., Ingo Molnar
10  *  Copyright (C) 2009 Jaswinder Singh Rajput
11  *  Copyright (C) 2009 Advanced Micro Devices, Inc., Robert Richter
12  *  Copyright (C) 2008-2009 Red Hat, Inc., Peter Zijlstra <pzijlstr@redhat.com>
13  */
14
15 #include <linux/perf_event.h>
16 #include <linux/kprobes.h>
17 #include <linux/ftrace.h>
18 #include <linux/kernel.h>
19 #include <linux/kdebug.h>
20 #include <linux/mutex.h>
21
22 #include <asm/stacktrace.h>
23 #include <asm/cpudata.h>
24 #include <asm/uaccess.h>
25 #include <asm/atomic.h>
26 #include <asm/nmi.h>
27 #include <asm/pcr.h>
28
29 #include "kstack.h"
30
31 /* Sparc64 chips have two performance counters, 32-bits each, with
32  * overflow interrupts generated on transition from 0xffffffff to 0.
33  * The counters are accessed in one go using a 64-bit register.
34  *
35  * Both counters are controlled using a single control register.  The
36  * only way to stop all sampling is to clear all of the context (user,
37  * supervisor, hypervisor) sampling enable bits.  But these bits apply
38  * to both counters, thus the two counters can't be enabled/disabled
39  * individually.
40  *
41  * The control register has two event fields, one for each of the two
42  * counters.  It's thus nearly impossible to have one counter going
43  * while keeping the other one stopped.  Therefore it is possible to
44  * get overflow interrupts for counters not currently "in use" and
45  * that condition must be checked in the overflow interrupt handler.
46  *
47  * So we use a hack, in that we program inactive counters with the
48  * "sw_count0" and "sw_count1" events.  These count how many times
49  * the instruction "sethi %hi(0xfc000), %g0" is executed.  It's an
50  * unusual way to encode a NOP and therefore will not trigger in
51  * normal code.
52  */
53
54 #define MAX_HWEVENTS                    2
55 #define MAX_PERIOD                      ((1UL << 32) - 1)
56
57 #define PIC_UPPER_INDEX                 0
58 #define PIC_LOWER_INDEX                 1
59 #define PIC_NO_INDEX                    -1
60
61 struct cpu_hw_events {
62         /* Number of events currently scheduled onto this cpu.
63          * This tells how many entries in the arrays below
64          * are valid.
65          */
66         int                     n_events;
67
68         /* Number of new events added since the last hw_perf_disable().
69          * This works because the perf event layer always adds new
70          * events inside of a perf_{disable,enable}() sequence.
71          */
72         int                     n_added;
73
74         /* Array of events current scheduled on this cpu.  */
75         struct perf_event       *event[MAX_HWEVENTS];
76
77         /* Array of encoded longs, specifying the %pcr register
78          * encoding and the mask of PIC counters this even can
79          * be scheduled on.  See perf_event_encode() et al.
80          */
81         unsigned long           events[MAX_HWEVENTS];
82
83         /* The current counter index assigned to an event.  When the
84          * event hasn't been programmed into the cpu yet, this will
85          * hold PIC_NO_INDEX.  The event->hw.idx value tells us where
86          * we ought to schedule the event.
87          */
88         int                     current_idx[MAX_HWEVENTS];
89
90         /* Software copy of %pcr register on this cpu.  */
91         u64                     pcr;
92
93         /* Enabled/disable state.  */
94         int                     enabled;
95
96         unsigned int            group_flag;
97 };
98 DEFINE_PER_CPU(struct cpu_hw_events, cpu_hw_events) = { .enabled = 1, };
99
100 /* An event map describes the characteristics of a performance
101  * counter event.  In particular it gives the encoding as well as
102  * a mask telling which counters the event can be measured on.
103  */
104 struct perf_event_map {
105         u16     encoding;
106         u8      pic_mask;
107 #define PIC_NONE        0x00
108 #define PIC_UPPER       0x01
109 #define PIC_LOWER       0x02
110 };
111
112 /* Encode a perf_event_map entry into a long.  */
113 static unsigned long perf_event_encode(const struct perf_event_map *pmap)
114 {
115         return ((unsigned long) pmap->encoding << 16) | pmap->pic_mask;
116 }
117
118 static u8 perf_event_get_msk(unsigned long val)
119 {
120         return val & 0xff;
121 }
122
123 static u64 perf_event_get_enc(unsigned long val)
124 {
125         return val >> 16;
126 }
127
128 #define C(x) PERF_COUNT_HW_CACHE_##x
129
130 #define CACHE_OP_UNSUPPORTED    0xfffe
131 #define CACHE_OP_NONSENSE       0xffff
132
133 typedef struct perf_event_map cache_map_t
134                                 [PERF_COUNT_HW_CACHE_MAX]
135                                 [PERF_COUNT_HW_CACHE_OP_MAX]
136                                 [PERF_COUNT_HW_CACHE_RESULT_MAX];
137
138 struct sparc_pmu {
139         const struct perf_event_map     *(*event_map)(int);
140         const cache_map_t               *cache_map;
141         int                             max_events;
142         int                             upper_shift;
143         int                             lower_shift;
144         int                             event_mask;
145         int                             hv_bit;
146         int                             irq_bit;
147         int                             upper_nop;
148         int                             lower_nop;
149 };
150
151 static const struct perf_event_map ultra3_perfmon_event_map[] = {
152         [PERF_COUNT_HW_CPU_CYCLES] = { 0x0000, PIC_UPPER | PIC_LOWER },
153         [PERF_COUNT_HW_INSTRUCTIONS] = { 0x0001, PIC_UPPER | PIC_LOWER },
154         [PERF_COUNT_HW_CACHE_REFERENCES] = { 0x0009, PIC_LOWER },
155         [PERF_COUNT_HW_CACHE_MISSES] = { 0x0009, PIC_UPPER },
156 };
157
158 static const struct perf_event_map *ultra3_event_map(int event_id)
159 {
160         return &ultra3_perfmon_event_map[event_id];
161 }
162
163 static const cache_map_t ultra3_cache_map = {
164 [C(L1D)] = {
165         [C(OP_READ)] = {
166                 [C(RESULT_ACCESS)] = { 0x09, PIC_LOWER, },
167                 [C(RESULT_MISS)] = { 0x09, PIC_UPPER, },
168         },
169         [C(OP_WRITE)] = {
170                 [C(RESULT_ACCESS)] = { 0x0a, PIC_LOWER },
171                 [C(RESULT_MISS)] = { 0x0a, PIC_UPPER },
172         },
173         [C(OP_PREFETCH)] = {
174                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
175                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
176         },
177 },
178 [C(L1I)] = {
179         [C(OP_READ)] = {
180                 [C(RESULT_ACCESS)] = { 0x09, PIC_LOWER, },
181                 [C(RESULT_MISS)] = { 0x09, PIC_UPPER, },
182         },
183         [ C(OP_WRITE) ] = {
184                 [ C(RESULT_ACCESS) ] = { CACHE_OP_NONSENSE },
185                 [ C(RESULT_MISS)   ] = { CACHE_OP_NONSENSE },
186         },
187         [ C(OP_PREFETCH) ] = {
188                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
189                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
190         },
191 },
192 [C(LL)] = {
193         [C(OP_READ)] = {
194                 [C(RESULT_ACCESS)] = { 0x0c, PIC_LOWER, },
195                 [C(RESULT_MISS)] = { 0x0c, PIC_UPPER, },
196         },
197         [C(OP_WRITE)] = {
198                 [C(RESULT_ACCESS)] = { 0x0c, PIC_LOWER },
199                 [C(RESULT_MISS)] = { 0x0c, PIC_UPPER },
200         },
201         [C(OP_PREFETCH)] = {
202                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
203                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
204         },
205 },
206 [C(DTLB)] = {
207         [C(OP_READ)] = {
208                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
209                 [C(RESULT_MISS)] = { 0x12, PIC_UPPER, },
210         },
211         [ C(OP_WRITE) ] = {
212                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
213                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
214         },
215         [ C(OP_PREFETCH) ] = {
216                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
217                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
218         },
219 },
220 [C(ITLB)] = {
221         [C(OP_READ)] = {
222                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
223                 [C(RESULT_MISS)] = { 0x11, PIC_UPPER, },
224         },
225         [ C(OP_WRITE) ] = {
226                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
227                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
228         },
229         [ C(OP_PREFETCH) ] = {
230                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
231                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
232         },
233 },
234 [C(BPU)] = {
235         [C(OP_READ)] = {
236                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
237                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
238         },
239         [ C(OP_WRITE) ] = {
240                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
241                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
242         },
243         [ C(OP_PREFETCH) ] = {
244                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
245                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
246         },
247 },
248 };
249
250 static const struct sparc_pmu ultra3_pmu = {
251         .event_map      = ultra3_event_map,
252         .cache_map      = &ultra3_cache_map,
253         .max_events     = ARRAY_SIZE(ultra3_perfmon_event_map),
254         .upper_shift    = 11,
255         .lower_shift    = 4,
256         .event_mask     = 0x3f,
257         .upper_nop      = 0x1c,
258         .lower_nop      = 0x14,
259 };
260
261 /* Niagara1 is very limited.  The upper PIC is hard-locked to count
262  * only instructions, so it is free running which creates all kinds of
263  * problems.  Some hardware designs make one wonder if the creator
264  * even looked at how this stuff gets used by software.
265  */
266 static const struct perf_event_map niagara1_perfmon_event_map[] = {
267         [PERF_COUNT_HW_CPU_CYCLES] = { 0x00, PIC_UPPER },
268         [PERF_COUNT_HW_INSTRUCTIONS] = { 0x00, PIC_UPPER },
269         [PERF_COUNT_HW_CACHE_REFERENCES] = { 0, PIC_NONE },
270         [PERF_COUNT_HW_CACHE_MISSES] = { 0x03, PIC_LOWER },
271 };
272
273 static const struct perf_event_map *niagara1_event_map(int event_id)
274 {
275         return &niagara1_perfmon_event_map[event_id];
276 }
277
278 static const cache_map_t niagara1_cache_map = {
279 [C(L1D)] = {
280         [C(OP_READ)] = {
281                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
282                 [C(RESULT_MISS)] = { 0x03, PIC_LOWER, },
283         },
284         [C(OP_WRITE)] = {
285                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
286                 [C(RESULT_MISS)] = { 0x03, PIC_LOWER, },
287         },
288         [C(OP_PREFETCH)] = {
289                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
290                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
291         },
292 },
293 [C(L1I)] = {
294         [C(OP_READ)] = {
295                 [C(RESULT_ACCESS)] = { 0x00, PIC_UPPER },
296                 [C(RESULT_MISS)] = { 0x02, PIC_LOWER, },
297         },
298         [ C(OP_WRITE) ] = {
299                 [ C(RESULT_ACCESS) ] = { CACHE_OP_NONSENSE },
300                 [ C(RESULT_MISS)   ] = { CACHE_OP_NONSENSE },
301         },
302         [ C(OP_PREFETCH) ] = {
303                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
304                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
305         },
306 },
307 [C(LL)] = {
308         [C(OP_READ)] = {
309                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
310                 [C(RESULT_MISS)] = { 0x07, PIC_LOWER, },
311         },
312         [C(OP_WRITE)] = {
313                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
314                 [C(RESULT_MISS)] = { 0x07, PIC_LOWER, },
315         },
316         [C(OP_PREFETCH)] = {
317                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
318                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
319         },
320 },
321 [C(DTLB)] = {
322         [C(OP_READ)] = {
323                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
324                 [C(RESULT_MISS)] = { 0x05, PIC_LOWER, },
325         },
326         [ C(OP_WRITE) ] = {
327                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
328                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
329         },
330         [ C(OP_PREFETCH) ] = {
331                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
332                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
333         },
334 },
335 [C(ITLB)] = {
336         [C(OP_READ)] = {
337                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
338                 [C(RESULT_MISS)] = { 0x04, PIC_LOWER, },
339         },
340         [ C(OP_WRITE) ] = {
341                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
342                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
343         },
344         [ C(OP_PREFETCH) ] = {
345                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
346                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
347         },
348 },
349 [C(BPU)] = {
350         [C(OP_READ)] = {
351                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
352                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
353         },
354         [ C(OP_WRITE) ] = {
355                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
356                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
357         },
358         [ C(OP_PREFETCH) ] = {
359                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
360                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
361         },
362 },
363 };
364
365 static const struct sparc_pmu niagara1_pmu = {
366         .event_map      = niagara1_event_map,
367         .cache_map      = &niagara1_cache_map,
368         .max_events     = ARRAY_SIZE(niagara1_perfmon_event_map),
369         .upper_shift    = 0,
370         .lower_shift    = 4,
371         .event_mask     = 0x7,
372         .upper_nop      = 0x0,
373         .lower_nop      = 0x0,
374 };
375
376 static const struct perf_event_map niagara2_perfmon_event_map[] = {
377         [PERF_COUNT_HW_CPU_CYCLES] = { 0x02ff, PIC_UPPER | PIC_LOWER },
378         [PERF_COUNT_HW_INSTRUCTIONS] = { 0x02ff, PIC_UPPER | PIC_LOWER },
379         [PERF_COUNT_HW_CACHE_REFERENCES] = { 0x0208, PIC_UPPER | PIC_LOWER },
380         [PERF_COUNT_HW_CACHE_MISSES] = { 0x0302, PIC_UPPER | PIC_LOWER },
381         [PERF_COUNT_HW_BRANCH_INSTRUCTIONS] = { 0x0201, PIC_UPPER | PIC_LOWER },
382         [PERF_COUNT_HW_BRANCH_MISSES] = { 0x0202, PIC_UPPER | PIC_LOWER },
383 };
384
385 static const struct perf_event_map *niagara2_event_map(int event_id)
386 {
387         return &niagara2_perfmon_event_map[event_id];
388 }
389
390 static const cache_map_t niagara2_cache_map = {
391 [C(L1D)] = {
392         [C(OP_READ)] = {
393                 [C(RESULT_ACCESS)] = { 0x0208, PIC_UPPER | PIC_LOWER, },
394                 [C(RESULT_MISS)] = { 0x0302, PIC_UPPER | PIC_LOWER, },
395         },
396         [C(OP_WRITE)] = {
397                 [C(RESULT_ACCESS)] = { 0x0210, PIC_UPPER | PIC_LOWER, },
398                 [C(RESULT_MISS)] = { 0x0302, PIC_UPPER | PIC_LOWER, },
399         },
400         [C(OP_PREFETCH)] = {
401                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
402                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
403         },
404 },
405 [C(L1I)] = {
406         [C(OP_READ)] = {
407                 [C(RESULT_ACCESS)] = { 0x02ff, PIC_UPPER | PIC_LOWER, },
408                 [C(RESULT_MISS)] = { 0x0301, PIC_UPPER | PIC_LOWER, },
409         },
410         [ C(OP_WRITE) ] = {
411                 [ C(RESULT_ACCESS) ] = { CACHE_OP_NONSENSE },
412                 [ C(RESULT_MISS)   ] = { CACHE_OP_NONSENSE },
413         },
414         [ C(OP_PREFETCH) ] = {
415                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
416                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
417         },
418 },
419 [C(LL)] = {
420         [C(OP_READ)] = {
421                 [C(RESULT_ACCESS)] = { 0x0208, PIC_UPPER | PIC_LOWER, },
422                 [C(RESULT_MISS)] = { 0x0330, PIC_UPPER | PIC_LOWER, },
423         },
424         [C(OP_WRITE)] = {
425                 [C(RESULT_ACCESS)] = { 0x0210, PIC_UPPER | PIC_LOWER, },
426                 [C(RESULT_MISS)] = { 0x0320, PIC_UPPER | PIC_LOWER, },
427         },
428         [C(OP_PREFETCH)] = {
429                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
430                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
431         },
432 },
433 [C(DTLB)] = {
434         [C(OP_READ)] = {
435                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
436                 [C(RESULT_MISS)] = { 0x0b08, PIC_UPPER | PIC_LOWER, },
437         },
438         [ C(OP_WRITE) ] = {
439                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
440                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
441         },
442         [ C(OP_PREFETCH) ] = {
443                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
444                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
445         },
446 },
447 [C(ITLB)] = {
448         [C(OP_READ)] = {
449                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
450                 [C(RESULT_MISS)] = { 0xb04, PIC_UPPER | PIC_LOWER, },
451         },
452         [ C(OP_WRITE) ] = {
453                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
454                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
455         },
456         [ C(OP_PREFETCH) ] = {
457                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
458                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
459         },
460 },
461 [C(BPU)] = {
462         [C(OP_READ)] = {
463                 [C(RESULT_ACCESS)] = { CACHE_OP_UNSUPPORTED },
464                 [C(RESULT_MISS)] = { CACHE_OP_UNSUPPORTED },
465         },
466         [ C(OP_WRITE) ] = {
467                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
468                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
469         },
470         [ C(OP_PREFETCH) ] = {
471                 [ C(RESULT_ACCESS) ] = { CACHE_OP_UNSUPPORTED },
472                 [ C(RESULT_MISS)   ] = { CACHE_OP_UNSUPPORTED },
473         },
474 },
475 };
476
477 static const struct sparc_pmu niagara2_pmu = {
478         .event_map      = niagara2_event_map,
479         .cache_map      = &niagara2_cache_map,
480         .max_events     = ARRAY_SIZE(niagara2_perfmon_event_map),
481         .upper_shift    = 19,
482         .lower_shift    = 6,
483         .event_mask     = 0xfff,
484         .hv_bit         = 0x8,
485         .irq_bit        = 0x30,
486         .upper_nop      = 0x220,
487         .lower_nop      = 0x220,
488 };
489
490 static const struct sparc_pmu *sparc_pmu __read_mostly;
491
492 static u64 event_encoding(u64 event_id, int idx)
493 {
494         if (idx == PIC_UPPER_INDEX)
495                 event_id <<= sparc_pmu->upper_shift;
496         else
497                 event_id <<= sparc_pmu->lower_shift;
498         return event_id;
499 }
500
501 static u64 mask_for_index(int idx)
502 {
503         return event_encoding(sparc_pmu->event_mask, idx);
504 }
505
506 static u64 nop_for_index(int idx)
507 {
508         return event_encoding(idx == PIC_UPPER_INDEX ?
509                               sparc_pmu->upper_nop :
510                               sparc_pmu->lower_nop, idx);
511 }
512
513 static inline void sparc_pmu_enable_event(struct cpu_hw_events *cpuc, struct hw_perf_event *hwc, int idx)
514 {
515         u64 val, mask = mask_for_index(idx);
516
517         val = cpuc->pcr;
518         val &= ~mask;
519         val |= hwc->config;
520         cpuc->pcr = val;
521
522         pcr_ops->write(cpuc->pcr);
523 }
524
525 static inline void sparc_pmu_disable_event(struct cpu_hw_events *cpuc, struct hw_perf_event *hwc, int idx)
526 {
527         u64 mask = mask_for_index(idx);
528         u64 nop = nop_for_index(idx);
529         u64 val;
530
531         val = cpuc->pcr;
532         val &= ~mask;
533         val |= nop;
534         cpuc->pcr = val;
535
536         pcr_ops->write(cpuc->pcr);
537 }
538
539 static u32 read_pmc(int idx)
540 {
541         u64 val;
542
543         read_pic(val);
544         if (idx == PIC_UPPER_INDEX)
545                 val >>= 32;
546
547         return val & 0xffffffff;
548 }
549
550 static void write_pmc(int idx, u64 val)
551 {
552         u64 shift, mask, pic;
553
554         shift = 0;
555         if (idx == PIC_UPPER_INDEX)
556                 shift = 32;
557
558         mask = ((u64) 0xffffffff) << shift;
559         val <<= shift;
560
561         read_pic(pic);
562         pic &= ~mask;
563         pic |= val;
564         write_pic(pic);
565 }
566
567 static u64 sparc_perf_event_update(struct perf_event *event,
568                                    struct hw_perf_event *hwc, int idx)
569 {
570         int shift = 64 - 32;
571         u64 prev_raw_count, new_raw_count;
572         s64 delta;
573
574 again:
575         prev_raw_count = local64_read(&hwc->prev_count);
576         new_raw_count = read_pmc(idx);
577
578         if (local64_cmpxchg(&hwc->prev_count, prev_raw_count,
579                              new_raw_count) != prev_raw_count)
580                 goto again;
581
582         delta = (new_raw_count << shift) - (prev_raw_count << shift);
583         delta >>= shift;
584
585         local64_add(delta, &event->count);
586         local64_sub(delta, &hwc->period_left);
587
588         return new_raw_count;
589 }
590
591 static int sparc_perf_event_set_period(struct perf_event *event,
592                                        struct hw_perf_event *hwc, int idx)
593 {
594         s64 left = local64_read(&hwc->period_left);
595         s64 period = hwc->sample_period;
596         int ret = 0;
597
598         if (unlikely(left <= -period)) {
599                 left = period;
600                 local64_set(&hwc->period_left, left);
601                 hwc->last_period = period;
602                 ret = 1;
603         }
604
605         if (unlikely(left <= 0)) {
606                 left += period;
607                 local64_set(&hwc->period_left, left);
608                 hwc->last_period = period;
609                 ret = 1;
610         }
611         if (left > MAX_PERIOD)
612                 left = MAX_PERIOD;
613
614         local64_set(&hwc->prev_count, (u64)-left);
615
616         write_pmc(idx, (u64)(-left) & 0xffffffff);
617
618         perf_event_update_userpage(event);
619
620         return ret;
621 }
622
623 /* If performance event entries have been added, move existing
624  * events around (if necessary) and then assign new entries to
625  * counters.
626  */
627 static u64 maybe_change_configuration(struct cpu_hw_events *cpuc, u64 pcr)
628 {
629         int i;
630
631         if (!cpuc->n_added)
632                 goto out;
633
634         /* Read in the counters which are moving.  */
635         for (i = 0; i < cpuc->n_events; i++) {
636                 struct perf_event *cp = cpuc->event[i];
637
638                 if (cpuc->current_idx[i] != PIC_NO_INDEX &&
639                     cpuc->current_idx[i] != cp->hw.idx) {
640                         sparc_perf_event_update(cp, &cp->hw,
641                                                 cpuc->current_idx[i]);
642                         cpuc->current_idx[i] = PIC_NO_INDEX;
643                 }
644         }
645
646         /* Assign to counters all unassigned events.  */
647         for (i = 0; i < cpuc->n_events; i++) {
648                 struct perf_event *cp = cpuc->event[i];
649                 struct hw_perf_event *hwc = &cp->hw;
650                 int idx = hwc->idx;
651                 u64 enc;
652
653                 if (cpuc->current_idx[i] != PIC_NO_INDEX)
654                         continue;
655
656                 sparc_perf_event_set_period(cp, hwc, idx);
657                 cpuc->current_idx[i] = idx;
658
659                 enc = perf_event_get_enc(cpuc->events[i]);
660                 pcr &= ~mask_for_index(idx);
661                 if (hwc->state & PERF_HES_STOPPED)
662                         pcr |= nop_for_index(idx);
663                 else
664                         pcr |= event_encoding(enc, idx);
665         }
666 out:
667         return pcr;
668 }
669
670 static void sparc_pmu_enable(struct pmu *pmu)
671 {
672         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
673         u64 pcr;
674
675         if (cpuc->enabled)
676                 return;
677
678         cpuc->enabled = 1;
679         barrier();
680
681         pcr = cpuc->pcr;
682         if (!cpuc->n_events) {
683                 pcr = 0;
684         } else {
685                 pcr = maybe_change_configuration(cpuc, pcr);
686
687                 /* We require that all of the events have the same
688                  * configuration, so just fetch the settings from the
689                  * first entry.
690                  */
691                 cpuc->pcr = pcr | cpuc->event[0]->hw.config_base;
692         }
693
694         pcr_ops->write(cpuc->pcr);
695 }
696
697 static void sparc_pmu_disable(struct pmu *pmu)
698 {
699         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
700         u64 val;
701
702         if (!cpuc->enabled)
703                 return;
704
705         cpuc->enabled = 0;
706         cpuc->n_added = 0;
707
708         val = cpuc->pcr;
709         val &= ~(PCR_UTRACE | PCR_STRACE |
710                  sparc_pmu->hv_bit | sparc_pmu->irq_bit);
711         cpuc->pcr = val;
712
713         pcr_ops->write(cpuc->pcr);
714 }
715
716 static int active_event_index(struct cpu_hw_events *cpuc,
717                               struct perf_event *event)
718 {
719         int i;
720
721         for (i = 0; i < cpuc->n_events; i++) {
722                 if (cpuc->event[i] == event)
723                         break;
724         }
725         BUG_ON(i == cpuc->n_events);
726         return cpuc->current_idx[i];
727 }
728
729 static void sparc_pmu_start(struct perf_event *event, int flags)
730 {
731         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
732         int idx = active_event_index(cpuc, event);
733
734         if (flags & PERF_EF_RELOAD) {
735                 WARN_ON_ONCE(!(event->hw.state & PERF_HES_UPTODATE));
736                 sparc_perf_event_set_period(event, &event->hw, idx);
737         }
738
739         event->hw.state = 0;
740
741         sparc_pmu_enable_event(cpuc, &event->hw, idx);
742 }
743
744 static void sparc_pmu_stop(struct perf_event *event, int flags)
745 {
746         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
747         int idx = active_event_index(cpuc, event);
748
749         if (!(event->hw.state & PERF_HES_STOPPED)) {
750                 sparc_pmu_disable_event(cpuc, &event->hw, idx);
751                 event->hw.state |= PERF_HES_STOPPED;
752         }
753
754         if (!(event->hw.state & PERF_HES_UPTODATE) && (flags & PERF_EF_UPDATE)) {
755                 sparc_perf_event_update(event, &event->hw, idx);
756                 event->hw.state |= PERF_HES_UPTODATE;
757         }
758 }
759
760 static void sparc_pmu_del(struct perf_event *event, int _flags)
761 {
762         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
763         unsigned long flags;
764         int i;
765
766         local_irq_save(flags);
767         perf_pmu_disable(event->pmu);
768
769         for (i = 0; i < cpuc->n_events; i++) {
770                 if (event == cpuc->event[i]) {
771                         /* Absorb the final count and turn off the
772                          * event.
773                          */
774                         sparc_pmu_stop(event, PERF_EF_UPDATE);
775
776                         /* Shift remaining entries down into
777                          * the existing slot.
778                          */
779                         while (++i < cpuc->n_events) {
780                                 cpuc->event[i - 1] = cpuc->event[i];
781                                 cpuc->events[i - 1] = cpuc->events[i];
782                                 cpuc->current_idx[i - 1] =
783                                         cpuc->current_idx[i];
784                         }
785
786                         perf_event_update_userpage(event);
787
788                         cpuc->n_events--;
789                         break;
790                 }
791         }
792
793         perf_pmu_enable(event->pmu);
794         local_irq_restore(flags);
795 }
796
797 static void sparc_pmu_read(struct perf_event *event)
798 {
799         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
800         int idx = active_event_index(cpuc, event);
801         struct hw_perf_event *hwc = &event->hw;
802
803         sparc_perf_event_update(event, hwc, idx);
804 }
805
806 static atomic_t active_events = ATOMIC_INIT(0);
807 static DEFINE_MUTEX(pmc_grab_mutex);
808
809 static void perf_stop_nmi_watchdog(void *unused)
810 {
811         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
812
813         stop_nmi_watchdog(NULL);
814         cpuc->pcr = pcr_ops->read();
815 }
816
817 void perf_event_grab_pmc(void)
818 {
819         if (atomic_inc_not_zero(&active_events))
820                 return;
821
822         mutex_lock(&pmc_grab_mutex);
823         if (atomic_read(&active_events) == 0) {
824                 if (atomic_read(&nmi_active) > 0) {
825                         on_each_cpu(perf_stop_nmi_watchdog, NULL, 1);
826                         BUG_ON(atomic_read(&nmi_active) != 0);
827                 }
828                 atomic_inc(&active_events);
829         }
830         mutex_unlock(&pmc_grab_mutex);
831 }
832
833 void perf_event_release_pmc(void)
834 {
835         if (atomic_dec_and_mutex_lock(&active_events, &pmc_grab_mutex)) {
836                 if (atomic_read(&nmi_active) == 0)
837                         on_each_cpu(start_nmi_watchdog, NULL, 1);
838                 mutex_unlock(&pmc_grab_mutex);
839         }
840 }
841
842 static const struct perf_event_map *sparc_map_cache_event(u64 config)
843 {
844         unsigned int cache_type, cache_op, cache_result;
845         const struct perf_event_map *pmap;
846
847         if (!sparc_pmu->cache_map)
848                 return ERR_PTR(-ENOENT);
849
850         cache_type = (config >>  0) & 0xff;
851         if (cache_type >= PERF_COUNT_HW_CACHE_MAX)
852                 return ERR_PTR(-EINVAL);
853
854         cache_op = (config >>  8) & 0xff;
855         if (cache_op >= PERF_COUNT_HW_CACHE_OP_MAX)
856                 return ERR_PTR(-EINVAL);
857
858         cache_result = (config >> 16) & 0xff;
859         if (cache_result >= PERF_COUNT_HW_CACHE_RESULT_MAX)
860                 return ERR_PTR(-EINVAL);
861
862         pmap = &((*sparc_pmu->cache_map)[cache_type][cache_op][cache_result]);
863
864         if (pmap->encoding == CACHE_OP_UNSUPPORTED)
865                 return ERR_PTR(-ENOENT);
866
867         if (pmap->encoding == CACHE_OP_NONSENSE)
868                 return ERR_PTR(-EINVAL);
869
870         return pmap;
871 }
872
873 static void hw_perf_event_destroy(struct perf_event *event)
874 {
875         perf_event_release_pmc();
876 }
877
878 /* Make sure all events can be scheduled into the hardware at
879  * the same time.  This is simplified by the fact that we only
880  * need to support 2 simultaneous HW events.
881  *
882  * As a side effect, the evts[]->hw.idx values will be assigned
883  * on success.  These are pending indexes.  When the events are
884  * actually programmed into the chip, these values will propagate
885  * to the per-cpu cpuc->current_idx[] slots, see the code in
886  * maybe_change_configuration() for details.
887  */
888 static int sparc_check_constraints(struct perf_event **evts,
889                                    unsigned long *events, int n_ev)
890 {
891         u8 msk0 = 0, msk1 = 0;
892         int idx0 = 0;
893
894         /* This case is possible when we are invoked from
895          * hw_perf_group_sched_in().
896          */
897         if (!n_ev)
898                 return 0;
899
900         if (n_ev > MAX_HWEVENTS)
901                 return -1;
902
903         msk0 = perf_event_get_msk(events[0]);
904         if (n_ev == 1) {
905                 if (msk0 & PIC_LOWER)
906                         idx0 = 1;
907                 goto success;
908         }
909         BUG_ON(n_ev != 2);
910         msk1 = perf_event_get_msk(events[1]);
911
912         /* If both events can go on any counter, OK.  */
913         if (msk0 == (PIC_UPPER | PIC_LOWER) &&
914             msk1 == (PIC_UPPER | PIC_LOWER))
915                 goto success;
916
917         /* If one event is limited to a specific counter,
918          * and the other can go on both, OK.
919          */
920         if ((msk0 == PIC_UPPER || msk0 == PIC_LOWER) &&
921             msk1 == (PIC_UPPER | PIC_LOWER)) {
922                 if (msk0 & PIC_LOWER)
923                         idx0 = 1;
924                 goto success;
925         }
926
927         if ((msk1 == PIC_UPPER || msk1 == PIC_LOWER) &&
928             msk0 == (PIC_UPPER | PIC_LOWER)) {
929                 if (msk1 & PIC_UPPER)
930                         idx0 = 1;
931                 goto success;
932         }
933
934         /* If the events are fixed to different counters, OK.  */
935         if ((msk0 == PIC_UPPER && msk1 == PIC_LOWER) ||
936             (msk0 == PIC_LOWER && msk1 == PIC_UPPER)) {
937                 if (msk0 & PIC_LOWER)
938                         idx0 = 1;
939                 goto success;
940         }
941
942         /* Otherwise, there is a conflict.  */
943         return -1;
944
945 success:
946         evts[0]->hw.idx = idx0;
947         if (n_ev == 2)
948                 evts[1]->hw.idx = idx0 ^ 1;
949         return 0;
950 }
951
952 static int check_excludes(struct perf_event **evts, int n_prev, int n_new)
953 {
954         int eu = 0, ek = 0, eh = 0;
955         struct perf_event *event;
956         int i, n, first;
957
958         n = n_prev + n_new;
959         if (n <= 1)
960                 return 0;
961
962         first = 1;
963         for (i = 0; i < n; i++) {
964                 event = evts[i];
965                 if (first) {
966                         eu = event->attr.exclude_user;
967                         ek = event->attr.exclude_kernel;
968                         eh = event->attr.exclude_hv;
969                         first = 0;
970                 } else if (event->attr.exclude_user != eu ||
971                            event->attr.exclude_kernel != ek ||
972                            event->attr.exclude_hv != eh) {
973                         return -EAGAIN;
974                 }
975         }
976
977         return 0;
978 }
979
980 static int collect_events(struct perf_event *group, int max_count,
981                           struct perf_event *evts[], unsigned long *events,
982                           int *current_idx)
983 {
984         struct perf_event *event;
985         int n = 0;
986
987         if (!is_software_event(group)) {
988                 if (n >= max_count)
989                         return -1;
990                 evts[n] = group;
991                 events[n] = group->hw.event_base;
992                 current_idx[n++] = PIC_NO_INDEX;
993         }
994         list_for_each_entry(event, &group->sibling_list, group_entry) {
995                 if (!is_software_event(event) &&
996                     event->state != PERF_EVENT_STATE_OFF) {
997                         if (n >= max_count)
998                                 return -1;
999                         evts[n] = event;
1000                         events[n] = event->hw.event_base;
1001                         current_idx[n++] = PIC_NO_INDEX;
1002                 }
1003         }
1004         return n;
1005 }
1006
1007 static int sparc_pmu_add(struct perf_event *event, int ef_flags)
1008 {
1009         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
1010         int n0, ret = -EAGAIN;
1011         unsigned long flags;
1012
1013         local_irq_save(flags);
1014         perf_pmu_disable(event->pmu);
1015
1016         n0 = cpuc->n_events;
1017         if (n0 >= MAX_HWEVENTS)
1018                 goto out;
1019
1020         cpuc->event[n0] = event;
1021         cpuc->events[n0] = event->hw.event_base;
1022         cpuc->current_idx[n0] = PIC_NO_INDEX;
1023
1024         event->hw.state = PERF_HES_UPTODATE;
1025         if (!(ef_flags & PERF_EF_START))
1026                 event->hw.state |= PERF_HES_STOPPED;
1027
1028         /*
1029          * If group events scheduling transaction was started,
1030          * skip the schedulability test here, it will be peformed
1031          * at commit time(->commit_txn) as a whole
1032          */
1033         if (cpuc->group_flag & PERF_EVENT_TXN)
1034                 goto nocheck;
1035
1036         if (check_excludes(cpuc->event, n0, 1))
1037                 goto out;
1038         if (sparc_check_constraints(cpuc->event, cpuc->events, n0 + 1))
1039                 goto out;
1040
1041 nocheck:
1042         cpuc->n_events++;
1043         cpuc->n_added++;
1044
1045         ret = 0;
1046 out:
1047         perf_pmu_enable(event->pmu);
1048         local_irq_restore(flags);
1049         return ret;
1050 }
1051
1052 static int sparc_pmu_event_init(struct perf_event *event)
1053 {
1054         struct perf_event_attr *attr = &event->attr;
1055         struct perf_event *evts[MAX_HWEVENTS];
1056         struct hw_perf_event *hwc = &event->hw;
1057         unsigned long events[MAX_HWEVENTS];
1058         int current_idx_dmy[MAX_HWEVENTS];
1059         const struct perf_event_map *pmap;
1060         int n;
1061
1062         if (atomic_read(&nmi_active) < 0)
1063                 return -ENODEV;
1064
1065         switch (attr->type) {
1066         case PERF_TYPE_HARDWARE:
1067                 if (attr->config >= sparc_pmu->max_events)
1068                         return -EINVAL;
1069                 pmap = sparc_pmu->event_map(attr->config);
1070                 break;
1071
1072         case PERF_TYPE_HW_CACHE:
1073                 pmap = sparc_map_cache_event(attr->config);
1074                 if (IS_ERR(pmap))
1075                         return PTR_ERR(pmap);
1076                 break;
1077
1078         case PERF_TYPE_RAW:
1079                 pmap = NULL;
1080                 break;
1081
1082         default:
1083                 return -ENOENT;
1084
1085         }
1086
1087         if (pmap) {
1088                 hwc->event_base = perf_event_encode(pmap);
1089         } else {
1090                 /*
1091                  * User gives us "(encoding << 16) | pic_mask" for
1092                  * PERF_TYPE_RAW events.
1093                  */
1094                 hwc->event_base = attr->config;
1095         }
1096
1097         /* We save the enable bits in the config_base.  */
1098         hwc->config_base = sparc_pmu->irq_bit;
1099         if (!attr->exclude_user)
1100                 hwc->config_base |= PCR_UTRACE;
1101         if (!attr->exclude_kernel)
1102                 hwc->config_base |= PCR_STRACE;
1103         if (!attr->exclude_hv)
1104                 hwc->config_base |= sparc_pmu->hv_bit;
1105
1106         n = 0;
1107         if (event->group_leader != event) {
1108                 n = collect_events(event->group_leader,
1109                                    MAX_HWEVENTS - 1,
1110                                    evts, events, current_idx_dmy);
1111                 if (n < 0)
1112                         return -EINVAL;
1113         }
1114         events[n] = hwc->event_base;
1115         evts[n] = event;
1116
1117         if (check_excludes(evts, n, 1))
1118                 return -EINVAL;
1119
1120         if (sparc_check_constraints(evts, events, n + 1))
1121                 return -EINVAL;
1122
1123         hwc->idx = PIC_NO_INDEX;
1124
1125         /* Try to do all error checking before this point, as unwinding
1126          * state after grabbing the PMC is difficult.
1127          */
1128         perf_event_grab_pmc();
1129         event->destroy = hw_perf_event_destroy;
1130
1131         if (!hwc->sample_period) {
1132                 hwc->sample_period = MAX_PERIOD;
1133                 hwc->last_period = hwc->sample_period;
1134                 local64_set(&hwc->period_left, hwc->sample_period);
1135         }
1136
1137         return 0;
1138 }
1139
1140 /*
1141  * Start group events scheduling transaction
1142  * Set the flag to make pmu::enable() not perform the
1143  * schedulability test, it will be performed at commit time
1144  */
1145 static void sparc_pmu_start_txn(struct pmu *pmu)
1146 {
1147         struct cpu_hw_events *cpuhw = &__get_cpu_var(cpu_hw_events);
1148
1149         perf_pmu_disable(pmu);
1150         cpuhw->group_flag |= PERF_EVENT_TXN;
1151 }
1152
1153 /*
1154  * Stop group events scheduling transaction
1155  * Clear the flag and pmu::enable() will perform the
1156  * schedulability test.
1157  */
1158 static void sparc_pmu_cancel_txn(struct pmu *pmu)
1159 {
1160         struct cpu_hw_events *cpuhw = &__get_cpu_var(cpu_hw_events);
1161
1162         cpuhw->group_flag &= ~PERF_EVENT_TXN;
1163         perf_pmu_enable(pmu);
1164 }
1165
1166 /*
1167  * Commit group events scheduling transaction
1168  * Perform the group schedulability test as a whole
1169  * Return 0 if success
1170  */
1171 static int sparc_pmu_commit_txn(struct pmu *pmu)
1172 {
1173         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
1174         int n;
1175
1176         if (!sparc_pmu)
1177                 return -EINVAL;
1178
1179         cpuc = &__get_cpu_var(cpu_hw_events);
1180         n = cpuc->n_events;
1181         if (check_excludes(cpuc->event, 0, n))
1182                 return -EINVAL;
1183         if (sparc_check_constraints(cpuc->event, cpuc->events, n))
1184                 return -EAGAIN;
1185
1186         cpuc->group_flag &= ~PERF_EVENT_TXN;
1187         perf_pmu_enable(pmu);
1188         return 0;
1189 }
1190
1191 static struct pmu pmu = {
1192         .pmu_enable     = sparc_pmu_enable,
1193         .pmu_disable    = sparc_pmu_disable,
1194         .event_init     = sparc_pmu_event_init,
1195         .add            = sparc_pmu_add,
1196         .del            = sparc_pmu_del,
1197         .start          = sparc_pmu_start,
1198         .stop           = sparc_pmu_stop,
1199         .read           = sparc_pmu_read,
1200         .start_txn      = sparc_pmu_start_txn,
1201         .cancel_txn     = sparc_pmu_cancel_txn,
1202         .commit_txn     = sparc_pmu_commit_txn,
1203 };
1204
1205 void perf_event_print_debug(void)
1206 {
1207         unsigned long flags;
1208         u64 pcr, pic;
1209         int cpu;
1210
1211         if (!sparc_pmu)
1212                 return;
1213
1214         local_irq_save(flags);
1215
1216         cpu = smp_processor_id();
1217
1218         pcr = pcr_ops->read();
1219         read_pic(pic);
1220
1221         pr_info("\n");
1222         pr_info("CPU#%d: PCR[%016llx] PIC[%016llx]\n",
1223                 cpu, pcr, pic);
1224
1225         local_irq_restore(flags);
1226 }
1227
1228 static int __kprobes perf_event_nmi_handler(struct notifier_block *self,
1229                                             unsigned long cmd, void *__args)
1230 {
1231         struct die_args *args = __args;
1232         struct perf_sample_data data;
1233         struct cpu_hw_events *cpuc;
1234         struct pt_regs *regs;
1235         int i;
1236
1237         if (!atomic_read(&active_events))
1238                 return NOTIFY_DONE;
1239
1240         switch (cmd) {
1241         case DIE_NMI:
1242                 break;
1243
1244         default:
1245                 return NOTIFY_DONE;
1246         }
1247
1248         regs = args->regs;
1249
1250         perf_sample_data_init(&data, 0);
1251
1252         cpuc = &__get_cpu_var(cpu_hw_events);
1253
1254         /* If the PMU has the TOE IRQ enable bits, we need to do a
1255          * dummy write to the %pcr to clear the overflow bits and thus
1256          * the interrupt.
1257          *
1258          * Do this before we peek at the counters to determine
1259          * overflow so we don't lose any events.
1260          */
1261         if (sparc_pmu->irq_bit)
1262                 pcr_ops->write(cpuc->pcr);
1263
1264         for (i = 0; i < cpuc->n_events; i++) {
1265                 struct perf_event *event = cpuc->event[i];
1266                 int idx = cpuc->current_idx[i];
1267                 struct hw_perf_event *hwc;
1268                 u64 val;
1269
1270                 hwc = &event->hw;
1271                 val = sparc_perf_event_update(event, hwc, idx);
1272                 if (val & (1ULL << 31))
1273                         continue;
1274
1275                 data.period = event->hw.last_period;
1276                 if (!sparc_perf_event_set_period(event, hwc, idx))
1277                         continue;
1278
1279                 if (perf_event_overflow(event, 1, &data, regs))
1280                         sparc_pmu_stop(event, 0);
1281         }
1282
1283         return NOTIFY_STOP;
1284 }
1285
1286 static __read_mostly struct notifier_block perf_event_nmi_notifier = {
1287         .notifier_call          = perf_event_nmi_handler,
1288 };
1289
1290 static bool __init supported_pmu(void)
1291 {
1292         if (!strcmp(sparc_pmu_type, "ultra3") ||
1293             !strcmp(sparc_pmu_type, "ultra3+") ||
1294             !strcmp(sparc_pmu_type, "ultra3i") ||
1295             !strcmp(sparc_pmu_type, "ultra4+")) {
1296                 sparc_pmu = &ultra3_pmu;
1297                 return true;
1298         }
1299         if (!strcmp(sparc_pmu_type, "niagara")) {
1300                 sparc_pmu = &niagara1_pmu;
1301                 return true;
1302         }
1303         if (!strcmp(sparc_pmu_type, "niagara2")) {
1304                 sparc_pmu = &niagara2_pmu;
1305                 return true;
1306         }
1307         return false;
1308 }
1309
1310 int __init init_hw_perf_events(void)
1311 {
1312         pr_info("Performance events: ");
1313
1314         if (!supported_pmu()) {
1315                 pr_cont("No support for PMU type '%s'\n", sparc_pmu_type);
1316                 return 0;
1317         }
1318
1319         pr_cont("Supported PMU type is '%s'\n", sparc_pmu_type);
1320
1321         perf_pmu_register(&pmu, "cpu", PERF_TYPE_RAW);
1322         register_die_notifier(&perf_event_nmi_notifier);
1323
1324         return 0;
1325 }
1326 early_initcall(init_hw_perf_events);
1327
1328 void perf_callchain_kernel(struct perf_callchain_entry *entry,
1329                            struct pt_regs *regs)
1330 {
1331         unsigned long ksp, fp;
1332 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
1333         int graph = 0;
1334 #endif
1335
1336         stack_trace_flush();
1337
1338         perf_callchain_store(entry, regs->tpc);
1339
1340         ksp = regs->u_regs[UREG_I6];
1341         fp = ksp + STACK_BIAS;
1342         do {
1343                 struct sparc_stackf *sf;
1344                 struct pt_regs *regs;
1345                 unsigned long pc;
1346
1347                 if (!kstack_valid(current_thread_info(), fp))
1348                         break;
1349
1350                 sf = (struct sparc_stackf *) fp;
1351                 regs = (struct pt_regs *) (sf + 1);
1352
1353                 if (kstack_is_trap_frame(current_thread_info(), regs)) {
1354                         if (user_mode(regs))
1355                                 break;
1356                         pc = regs->tpc;
1357                         fp = regs->u_regs[UREG_I6] + STACK_BIAS;
1358                 } else {
1359                         pc = sf->callers_pc;
1360                         fp = (unsigned long)sf->fp + STACK_BIAS;
1361                 }
1362                 perf_callchain_store(entry, pc);
1363 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
1364                 if ((pc + 8UL) == (unsigned long) &return_to_handler) {
1365                         int index = current->curr_ret_stack;
1366                         if (current->ret_stack && index >= graph) {
1367                                 pc = current->ret_stack[index - graph].ret;
1368                                 perf_callchain_store(entry, pc);
1369                                 graph++;
1370                         }
1371                 }
1372 #endif
1373         } while (entry->nr < PERF_MAX_STACK_DEPTH);
1374 }
1375
1376 static void perf_callchain_user_64(struct perf_callchain_entry *entry,
1377                                    struct pt_regs *regs)
1378 {
1379         unsigned long ufp;
1380
1381         perf_callchain_store(entry, regs->tpc);
1382
1383         ufp = regs->u_regs[UREG_I6] + STACK_BIAS;
1384         do {
1385                 struct sparc_stackf *usf, sf;
1386                 unsigned long pc;
1387
1388                 usf = (struct sparc_stackf *) ufp;
1389                 if (__copy_from_user_inatomic(&sf, usf, sizeof(sf)))
1390                         break;
1391
1392                 pc = sf.callers_pc;
1393                 ufp = (unsigned long)sf.fp + STACK_BIAS;
1394                 perf_callchain_store(entry, pc);
1395         } while (entry->nr < PERF_MAX_STACK_DEPTH);
1396 }
1397
1398 static void perf_callchain_user_32(struct perf_callchain_entry *entry,
1399                                    struct pt_regs *regs)
1400 {
1401         unsigned long ufp;
1402
1403         perf_callchain_store(entry, regs->tpc);
1404
1405         ufp = regs->u_regs[UREG_I6] & 0xffffffffUL;
1406         do {
1407                 struct sparc_stackf32 *usf, sf;
1408                 unsigned long pc;
1409
1410                 usf = (struct sparc_stackf32 *) ufp;
1411                 if (__copy_from_user_inatomic(&sf, usf, sizeof(sf)))
1412                         break;
1413
1414                 pc = sf.callers_pc;
1415                 ufp = (unsigned long)sf.fp;
1416                 perf_callchain_store(entry, pc);
1417         } while (entry->nr < PERF_MAX_STACK_DEPTH);
1418 }
1419
1420 void
1421 perf_callchain_user(struct perf_callchain_entry *entry, struct pt_regs *regs)
1422 {
1423         flushw_user();
1424         if (test_thread_flag(TIF_32BIT))
1425                 perf_callchain_user_32(entry, regs);
1426         else
1427                 perf_callchain_user_64(entry, regs);
1428 }