GNU Linux-libre 6.5.10-gnu
[releases.git] / kernel / events / hw_breakpoint.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2007 Alan Stern
4  * Copyright (C) IBM Corporation, 2009
5  * Copyright (C) 2009, Frederic Weisbecker <fweisbec@gmail.com>
6  *
7  * Thanks to Ingo Molnar for his many suggestions.
8  *
9  * Authors: Alan Stern <stern@rowland.harvard.edu>
10  *          K.Prasad <prasad@linux.vnet.ibm.com>
11  *          Frederic Weisbecker <fweisbec@gmail.com>
12  */
13
14 /*
15  * HW_breakpoint: a unified kernel/user-space hardware breakpoint facility,
16  * using the CPU's debug registers.
17  * This file contains the arch-independent routines.
18  */
19
20 #include <linux/hw_breakpoint.h>
21
22 #include <linux/atomic.h>
23 #include <linux/bug.h>
24 #include <linux/cpu.h>
25 #include <linux/export.h>
26 #include <linux/init.h>
27 #include <linux/irqflags.h>
28 #include <linux/kdebug.h>
29 #include <linux/kernel.h>
30 #include <linux/mutex.h>
31 #include <linux/notifier.h>
32 #include <linux/percpu-rwsem.h>
33 #include <linux/percpu.h>
34 #include <linux/rhashtable.h>
35 #include <linux/sched.h>
36 #include <linux/slab.h>
37
38 /*
39  * Datastructure to track the total uses of N slots across tasks or CPUs;
40  * bp_slots_histogram::count[N] is the number of assigned N+1 breakpoint slots.
41  */
42 struct bp_slots_histogram {
43 #ifdef hw_breakpoint_slots
44         atomic_t count[hw_breakpoint_slots(0)];
45 #else
46         atomic_t *count;
47 #endif
48 };
49
50 /*
51  * Per-CPU constraints data.
52  */
53 struct bp_cpuinfo {
54         /* Number of pinned CPU breakpoints in a CPU. */
55         unsigned int                    cpu_pinned;
56         /* Histogram of pinned task breakpoints in a CPU. */
57         struct bp_slots_histogram       tsk_pinned;
58 };
59
60 static DEFINE_PER_CPU(struct bp_cpuinfo, bp_cpuinfo[TYPE_MAX]);
61
62 static struct bp_cpuinfo *get_bp_info(int cpu, enum bp_type_idx type)
63 {
64         return per_cpu_ptr(bp_cpuinfo + type, cpu);
65 }
66
67 /* Number of pinned CPU breakpoints globally. */
68 static struct bp_slots_histogram cpu_pinned[TYPE_MAX];
69 /* Number of pinned CPU-independent task breakpoints. */
70 static struct bp_slots_histogram tsk_pinned_all[TYPE_MAX];
71
72 /* Keep track of the breakpoints attached to tasks */
73 static struct rhltable task_bps_ht;
74 static const struct rhashtable_params task_bps_ht_params = {
75         .head_offset = offsetof(struct hw_perf_event, bp_list),
76         .key_offset = offsetof(struct hw_perf_event, target),
77         .key_len = sizeof_field(struct hw_perf_event, target),
78         .automatic_shrinking = true,
79 };
80
81 static bool constraints_initialized __ro_after_init;
82
83 /*
84  * Synchronizes accesses to the per-CPU constraints; the locking rules are:
85  *
86  *  1. Atomic updates to bp_cpuinfo::tsk_pinned only require a held read-lock
87  *     (due to bp_slots_histogram::count being atomic, no update are lost).
88  *
89  *  2. Holding a write-lock is required for computations that require a
90  *     stable snapshot of all bp_cpuinfo::tsk_pinned.
91  *
92  *  3. In all other cases, non-atomic accesses require the appropriately held
93  *     lock (read-lock for read-only accesses; write-lock for reads/writes).
94  */
95 DEFINE_STATIC_PERCPU_RWSEM(bp_cpuinfo_sem);
96
97 /*
98  * Return mutex to serialize accesses to per-task lists in task_bps_ht. Since
99  * rhltable synchronizes concurrent insertions/deletions, independent tasks may
100  * insert/delete concurrently; therefore, a mutex per task is sufficient.
101  *
102  * Uses task_struct::perf_event_mutex, to avoid extending task_struct with a
103  * hw_breakpoint-only mutex, which may be infrequently used. The caveat here is
104  * that hw_breakpoint may contend with per-task perf event list management. The
105  * assumption is that perf usecases involving hw_breakpoints are very unlikely
106  * to result in unnecessary contention.
107  */
108 static inline struct mutex *get_task_bps_mutex(struct perf_event *bp)
109 {
110         struct task_struct *tsk = bp->hw.target;
111
112         return tsk ? &tsk->perf_event_mutex : NULL;
113 }
114
115 static struct mutex *bp_constraints_lock(struct perf_event *bp)
116 {
117         struct mutex *tsk_mtx = get_task_bps_mutex(bp);
118
119         if (tsk_mtx) {
120                 /*
121                  * Fully analogous to the perf_try_init_event() nesting
122                  * argument in the comment near perf_event_ctx_lock_nested();
123                  * this child->perf_event_mutex cannot ever deadlock against
124                  * the parent->perf_event_mutex usage from
125                  * perf_event_task_{en,dis}able().
126                  *
127                  * Specifically, inherited events will never occur on
128                  * ->perf_event_list.
129                  */
130                 mutex_lock_nested(tsk_mtx, SINGLE_DEPTH_NESTING);
131                 percpu_down_read(&bp_cpuinfo_sem);
132         } else {
133                 percpu_down_write(&bp_cpuinfo_sem);
134         }
135
136         return tsk_mtx;
137 }
138
139 static void bp_constraints_unlock(struct mutex *tsk_mtx)
140 {
141         if (tsk_mtx) {
142                 percpu_up_read(&bp_cpuinfo_sem);
143                 mutex_unlock(tsk_mtx);
144         } else {
145                 percpu_up_write(&bp_cpuinfo_sem);
146         }
147 }
148
149 static bool bp_constraints_is_locked(struct perf_event *bp)
150 {
151         struct mutex *tsk_mtx = get_task_bps_mutex(bp);
152
153         return percpu_is_write_locked(&bp_cpuinfo_sem) ||
154                (tsk_mtx ? mutex_is_locked(tsk_mtx) :
155                           percpu_is_read_locked(&bp_cpuinfo_sem));
156 }
157
158 static inline void assert_bp_constraints_lock_held(struct perf_event *bp)
159 {
160         struct mutex *tsk_mtx = get_task_bps_mutex(bp);
161
162         if (tsk_mtx)
163                 lockdep_assert_held(tsk_mtx);
164         lockdep_assert_held(&bp_cpuinfo_sem);
165 }
166
167 #ifdef hw_breakpoint_slots
168 /*
169  * Number of breakpoint slots is constant, and the same for all types.
170  */
171 static_assert(hw_breakpoint_slots(TYPE_INST) == hw_breakpoint_slots(TYPE_DATA));
172 static inline int hw_breakpoint_slots_cached(int type)  { return hw_breakpoint_slots(type); }
173 static inline int init_breakpoint_slots(void)           { return 0; }
174 #else
175 /*
176  * Dynamic number of breakpoint slots.
177  */
178 static int __nr_bp_slots[TYPE_MAX] __ro_after_init;
179
180 static inline int hw_breakpoint_slots_cached(int type)
181 {
182         return __nr_bp_slots[type];
183 }
184
185 static __init bool
186 bp_slots_histogram_alloc(struct bp_slots_histogram *hist, enum bp_type_idx type)
187 {
188         hist->count = kcalloc(hw_breakpoint_slots_cached(type), sizeof(*hist->count), GFP_KERNEL);
189         return hist->count;
190 }
191
192 static __init void bp_slots_histogram_free(struct bp_slots_histogram *hist)
193 {
194         kfree(hist->count);
195 }
196
197 static __init int init_breakpoint_slots(void)
198 {
199         int i, cpu, err_cpu;
200
201         for (i = 0; i < TYPE_MAX; i++)
202                 __nr_bp_slots[i] = hw_breakpoint_slots(i);
203
204         for_each_possible_cpu(cpu) {
205                 for (i = 0; i < TYPE_MAX; i++) {
206                         struct bp_cpuinfo *info = get_bp_info(cpu, i);
207
208                         if (!bp_slots_histogram_alloc(&info->tsk_pinned, i))
209                                 goto err;
210                 }
211         }
212         for (i = 0; i < TYPE_MAX; i++) {
213                 if (!bp_slots_histogram_alloc(&cpu_pinned[i], i))
214                         goto err;
215                 if (!bp_slots_histogram_alloc(&tsk_pinned_all[i], i))
216                         goto err;
217         }
218
219         return 0;
220 err:
221         for_each_possible_cpu(err_cpu) {
222                 for (i = 0; i < TYPE_MAX; i++)
223                         bp_slots_histogram_free(&get_bp_info(err_cpu, i)->tsk_pinned);
224                 if (err_cpu == cpu)
225                         break;
226         }
227         for (i = 0; i < TYPE_MAX; i++) {
228                 bp_slots_histogram_free(&cpu_pinned[i]);
229                 bp_slots_histogram_free(&tsk_pinned_all[i]);
230         }
231
232         return -ENOMEM;
233 }
234 #endif
235
236 static inline void
237 bp_slots_histogram_add(struct bp_slots_histogram *hist, int old, int val)
238 {
239         const int old_idx = old - 1;
240         const int new_idx = old_idx + val;
241
242         if (old_idx >= 0)
243                 WARN_ON(atomic_dec_return_relaxed(&hist->count[old_idx]) < 0);
244         if (new_idx >= 0)
245                 WARN_ON(atomic_inc_return_relaxed(&hist->count[new_idx]) < 0);
246 }
247
248 static int
249 bp_slots_histogram_max(struct bp_slots_histogram *hist, enum bp_type_idx type)
250 {
251         for (int i = hw_breakpoint_slots_cached(type) - 1; i >= 0; i--) {
252                 const int count = atomic_read(&hist->count[i]);
253
254                 /* Catch unexpected writers; we want a stable snapshot. */
255                 ASSERT_EXCLUSIVE_WRITER(hist->count[i]);
256                 if (count > 0)
257                         return i + 1;
258                 WARN(count < 0, "inconsistent breakpoint slots histogram");
259         }
260
261         return 0;
262 }
263
264 static int
265 bp_slots_histogram_max_merge(struct bp_slots_histogram *hist1, struct bp_slots_histogram *hist2,
266                              enum bp_type_idx type)
267 {
268         for (int i = hw_breakpoint_slots_cached(type) - 1; i >= 0; i--) {
269                 const int count1 = atomic_read(&hist1->count[i]);
270                 const int count2 = atomic_read(&hist2->count[i]);
271
272                 /* Catch unexpected writers; we want a stable snapshot. */
273                 ASSERT_EXCLUSIVE_WRITER(hist1->count[i]);
274                 ASSERT_EXCLUSIVE_WRITER(hist2->count[i]);
275                 if (count1 + count2 > 0)
276                         return i + 1;
277                 WARN(count1 < 0, "inconsistent breakpoint slots histogram");
278                 WARN(count2 < 0, "inconsistent breakpoint slots histogram");
279         }
280
281         return 0;
282 }
283
284 #ifndef hw_breakpoint_weight
285 static inline int hw_breakpoint_weight(struct perf_event *bp)
286 {
287         return 1;
288 }
289 #endif
290
291 static inline enum bp_type_idx find_slot_idx(u64 bp_type)
292 {
293         if (bp_type & HW_BREAKPOINT_RW)
294                 return TYPE_DATA;
295
296         return TYPE_INST;
297 }
298
299 /*
300  * Return the maximum number of pinned breakpoints a task has in this CPU.
301  */
302 static unsigned int max_task_bp_pinned(int cpu, enum bp_type_idx type)
303 {
304         struct bp_slots_histogram *tsk_pinned = &get_bp_info(cpu, type)->tsk_pinned;
305
306         /*
307          * At this point we want to have acquired the bp_cpuinfo_sem as a
308          * writer to ensure that there are no concurrent writers in
309          * toggle_bp_task_slot() to tsk_pinned, and we get a stable snapshot.
310          */
311         lockdep_assert_held_write(&bp_cpuinfo_sem);
312         return bp_slots_histogram_max_merge(tsk_pinned, &tsk_pinned_all[type], type);
313 }
314
315 /*
316  * Count the number of breakpoints of the same type and same task.
317  * The given event must be not on the list.
318  *
319  * If @cpu is -1, but the result of task_bp_pinned() is not CPU-independent,
320  * returns a negative value.
321  */
322 static int task_bp_pinned(int cpu, struct perf_event *bp, enum bp_type_idx type)
323 {
324         struct rhlist_head *head, *pos;
325         struct perf_event *iter;
326         int count = 0;
327
328         /*
329          * We need a stable snapshot of the per-task breakpoint list.
330          */
331         assert_bp_constraints_lock_held(bp);
332
333         rcu_read_lock();
334         head = rhltable_lookup(&task_bps_ht, &bp->hw.target, task_bps_ht_params);
335         if (!head)
336                 goto out;
337
338         rhl_for_each_entry_rcu(iter, pos, head, hw.bp_list) {
339                 if (find_slot_idx(iter->attr.bp_type) != type)
340                         continue;
341
342                 if (iter->cpu >= 0) {
343                         if (cpu == -1) {
344                                 count = -1;
345                                 goto out;
346                         } else if (cpu != iter->cpu)
347                                 continue;
348                 }
349
350                 count += hw_breakpoint_weight(iter);
351         }
352
353 out:
354         rcu_read_unlock();
355         return count;
356 }
357
358 static const struct cpumask *cpumask_of_bp(struct perf_event *bp)
359 {
360         if (bp->cpu >= 0)
361                 return cpumask_of(bp->cpu);
362         return cpu_possible_mask;
363 }
364
365 /*
366  * Returns the max pinned breakpoint slots in a given
367  * CPU (cpu > -1) or across all of them (cpu = -1).
368  */
369 static int
370 max_bp_pinned_slots(struct perf_event *bp, enum bp_type_idx type)
371 {
372         const struct cpumask *cpumask = cpumask_of_bp(bp);
373         int pinned_slots = 0;
374         int cpu;
375
376         if (bp->hw.target && bp->cpu < 0) {
377                 int max_pinned = task_bp_pinned(-1, bp, type);
378
379                 if (max_pinned >= 0) {
380                         /*
381                          * Fast path: task_bp_pinned() is CPU-independent and
382                          * returns the same value for any CPU.
383                          */
384                         max_pinned += bp_slots_histogram_max(&cpu_pinned[type], type);
385                         return max_pinned;
386                 }
387         }
388
389         for_each_cpu(cpu, cpumask) {
390                 struct bp_cpuinfo *info = get_bp_info(cpu, type);
391                 int nr;
392
393                 nr = info->cpu_pinned;
394                 if (!bp->hw.target)
395                         nr += max_task_bp_pinned(cpu, type);
396                 else
397                         nr += task_bp_pinned(cpu, bp, type);
398
399                 pinned_slots = max(nr, pinned_slots);
400         }
401
402         return pinned_slots;
403 }
404
405 /*
406  * Add/remove the given breakpoint in our constraint table
407  */
408 static int
409 toggle_bp_slot(struct perf_event *bp, bool enable, enum bp_type_idx type, int weight)
410 {
411         int cpu, next_tsk_pinned;
412
413         if (!enable)
414                 weight = -weight;
415
416         if (!bp->hw.target) {
417                 /*
418                  * Update the pinned CPU slots, in per-CPU bp_cpuinfo and in the
419                  * global histogram.
420                  */
421                 struct bp_cpuinfo *info = get_bp_info(bp->cpu, type);
422
423                 lockdep_assert_held_write(&bp_cpuinfo_sem);
424                 bp_slots_histogram_add(&cpu_pinned[type], info->cpu_pinned, weight);
425                 info->cpu_pinned += weight;
426                 return 0;
427         }
428
429         /*
430          * If bp->hw.target, tsk_pinned is only modified, but not used
431          * otherwise. We can permit concurrent updates as long as there are no
432          * other uses: having acquired bp_cpuinfo_sem as a reader allows
433          * concurrent updates here. Uses of tsk_pinned will require acquiring
434          * bp_cpuinfo_sem as a writer to stabilize tsk_pinned's value.
435          */
436         lockdep_assert_held_read(&bp_cpuinfo_sem);
437
438         /*
439          * Update the pinned task slots, in per-CPU bp_cpuinfo and in the global
440          * histogram. We need to take care of 4 cases:
441          *
442          *  1. This breakpoint targets all CPUs (cpu < 0), and there may only
443          *     exist other task breakpoints targeting all CPUs. In this case we
444          *     can simply update the global slots histogram.
445          *
446          *  2. This breakpoint targets a specific CPU (cpu >= 0), but there may
447          *     only exist other task breakpoints targeting all CPUs.
448          *
449          *     a. On enable: remove the existing breakpoints from the global
450          *        slots histogram and use the per-CPU histogram.
451          *
452          *     b. On disable: re-insert the existing breakpoints into the global
453          *        slots histogram and remove from per-CPU histogram.
454          *
455          *  3. Some other existing task breakpoints target specific CPUs. Only
456          *     update the per-CPU slots histogram.
457          */
458
459         if (!enable) {
460                 /*
461                  * Remove before updating histograms so we can determine if this
462                  * was the last task breakpoint for a specific CPU.
463                  */
464                 int ret = rhltable_remove(&task_bps_ht, &bp->hw.bp_list, task_bps_ht_params);
465
466                 if (ret)
467                         return ret;
468         }
469         /*
470          * Note: If !enable, next_tsk_pinned will not count the to-be-removed breakpoint.
471          */
472         next_tsk_pinned = task_bp_pinned(-1, bp, type);
473
474         if (next_tsk_pinned >= 0) {
475                 if (bp->cpu < 0) { /* Case 1: fast path */
476                         if (!enable)
477                                 next_tsk_pinned += hw_breakpoint_weight(bp);
478                         bp_slots_histogram_add(&tsk_pinned_all[type], next_tsk_pinned, weight);
479                 } else if (enable) { /* Case 2.a: slow path */
480                         /* Add existing to per-CPU histograms. */
481                         for_each_possible_cpu(cpu) {
482                                 bp_slots_histogram_add(&get_bp_info(cpu, type)->tsk_pinned,
483                                                        0, next_tsk_pinned);
484                         }
485                         /* Add this first CPU-pinned task breakpoint. */
486                         bp_slots_histogram_add(&get_bp_info(bp->cpu, type)->tsk_pinned,
487                                                next_tsk_pinned, weight);
488                         /* Rebalance global task pinned histogram. */
489                         bp_slots_histogram_add(&tsk_pinned_all[type], next_tsk_pinned,
490                                                -next_tsk_pinned);
491                 } else { /* Case 2.b: slow path */
492                         /* Remove this last CPU-pinned task breakpoint. */
493                         bp_slots_histogram_add(&get_bp_info(bp->cpu, type)->tsk_pinned,
494                                                next_tsk_pinned + hw_breakpoint_weight(bp), weight);
495                         /* Remove all from per-CPU histograms. */
496                         for_each_possible_cpu(cpu) {
497                                 bp_slots_histogram_add(&get_bp_info(cpu, type)->tsk_pinned,
498                                                        next_tsk_pinned, -next_tsk_pinned);
499                         }
500                         /* Rebalance global task pinned histogram. */
501                         bp_slots_histogram_add(&tsk_pinned_all[type], 0, next_tsk_pinned);
502                 }
503         } else { /* Case 3: slow path */
504                 const struct cpumask *cpumask = cpumask_of_bp(bp);
505
506                 for_each_cpu(cpu, cpumask) {
507                         next_tsk_pinned = task_bp_pinned(cpu, bp, type);
508                         if (!enable)
509                                 next_tsk_pinned += hw_breakpoint_weight(bp);
510                         bp_slots_histogram_add(&get_bp_info(cpu, type)->tsk_pinned,
511                                                next_tsk_pinned, weight);
512                 }
513         }
514
515         /*
516          * Readers want a stable snapshot of the per-task breakpoint list.
517          */
518         assert_bp_constraints_lock_held(bp);
519
520         if (enable)
521                 return rhltable_insert(&task_bps_ht, &bp->hw.bp_list, task_bps_ht_params);
522
523         return 0;
524 }
525
526 __weak int arch_reserve_bp_slot(struct perf_event *bp)
527 {
528         return 0;
529 }
530
531 __weak void arch_release_bp_slot(struct perf_event *bp)
532 {
533 }
534
535 /*
536  * Function to perform processor-specific cleanup during unregistration
537  */
538 __weak void arch_unregister_hw_breakpoint(struct perf_event *bp)
539 {
540         /*
541          * A weak stub function here for those archs that don't define
542          * it inside arch/.../kernel/hw_breakpoint.c
543          */
544 }
545
546 /*
547  * Constraints to check before allowing this new breakpoint counter.
548  *
549  * Note: Flexible breakpoints are currently unimplemented, but outlined in the
550  * below algorithm for completeness.  The implementation treats flexible as
551  * pinned due to no guarantee that we currently always schedule flexible events
552  * before a pinned event in a same CPU.
553  *
554  *  == Non-pinned counter == (Considered as pinned for now)
555  *
556  *   - If attached to a single cpu, check:
557  *
558  *       (per_cpu(info->flexible, cpu) || (per_cpu(info->cpu_pinned, cpu)
559  *           + max(per_cpu(info->tsk_pinned, cpu)))) < HBP_NUM
560  *
561  *       -> If there are already non-pinned counters in this cpu, it means
562  *          there is already a free slot for them.
563  *          Otherwise, we check that the maximum number of per task
564  *          breakpoints (for this cpu) plus the number of per cpu breakpoint
565  *          (for this cpu) doesn't cover every registers.
566  *
567  *   - If attached to every cpus, check:
568  *
569  *       (per_cpu(info->flexible, *) || (max(per_cpu(info->cpu_pinned, *))
570  *           + max(per_cpu(info->tsk_pinned, *)))) < HBP_NUM
571  *
572  *       -> This is roughly the same, except we check the number of per cpu
573  *          bp for every cpu and we keep the max one. Same for the per tasks
574  *          breakpoints.
575  *
576  *
577  * == Pinned counter ==
578  *
579  *   - If attached to a single cpu, check:
580  *
581  *       ((per_cpu(info->flexible, cpu) > 1) + per_cpu(info->cpu_pinned, cpu)
582  *            + max(per_cpu(info->tsk_pinned, cpu))) < HBP_NUM
583  *
584  *       -> Same checks as before. But now the info->flexible, if any, must keep
585  *          one register at least (or they will never be fed).
586  *
587  *   - If attached to every cpus, check:
588  *
589  *       ((per_cpu(info->flexible, *) > 1) + max(per_cpu(info->cpu_pinned, *))
590  *            + max(per_cpu(info->tsk_pinned, *))) < HBP_NUM
591  */
592 static int __reserve_bp_slot(struct perf_event *bp, u64 bp_type)
593 {
594         enum bp_type_idx type;
595         int max_pinned_slots;
596         int weight;
597         int ret;
598
599         /* We couldn't initialize breakpoint constraints on boot */
600         if (!constraints_initialized)
601                 return -ENOMEM;
602
603         /* Basic checks */
604         if (bp_type == HW_BREAKPOINT_EMPTY ||
605             bp_type == HW_BREAKPOINT_INVALID)
606                 return -EINVAL;
607
608         type = find_slot_idx(bp_type);
609         weight = hw_breakpoint_weight(bp);
610
611         /* Check if this new breakpoint can be satisfied across all CPUs. */
612         max_pinned_slots = max_bp_pinned_slots(bp, type) + weight;
613         if (max_pinned_slots > hw_breakpoint_slots_cached(type))
614                 return -ENOSPC;
615
616         ret = arch_reserve_bp_slot(bp);
617         if (ret)
618                 return ret;
619
620         return toggle_bp_slot(bp, true, type, weight);
621 }
622
623 int reserve_bp_slot(struct perf_event *bp)
624 {
625         struct mutex *mtx = bp_constraints_lock(bp);
626         int ret = __reserve_bp_slot(bp, bp->attr.bp_type);
627
628         bp_constraints_unlock(mtx);
629         return ret;
630 }
631
632 static void __release_bp_slot(struct perf_event *bp, u64 bp_type)
633 {
634         enum bp_type_idx type;
635         int weight;
636
637         arch_release_bp_slot(bp);
638
639         type = find_slot_idx(bp_type);
640         weight = hw_breakpoint_weight(bp);
641         WARN_ON(toggle_bp_slot(bp, false, type, weight));
642 }
643
644 void release_bp_slot(struct perf_event *bp)
645 {
646         struct mutex *mtx = bp_constraints_lock(bp);
647
648         arch_unregister_hw_breakpoint(bp);
649         __release_bp_slot(bp, bp->attr.bp_type);
650         bp_constraints_unlock(mtx);
651 }
652
653 static int __modify_bp_slot(struct perf_event *bp, u64 old_type, u64 new_type)
654 {
655         int err;
656
657         __release_bp_slot(bp, old_type);
658
659         err = __reserve_bp_slot(bp, new_type);
660         if (err) {
661                 /*
662                  * Reserve the old_type slot back in case
663                  * there's no space for the new type.
664                  *
665                  * This must succeed, because we just released
666                  * the old_type slot in the __release_bp_slot
667                  * call above. If not, something is broken.
668                  */
669                 WARN_ON(__reserve_bp_slot(bp, old_type));
670         }
671
672         return err;
673 }
674
675 static int modify_bp_slot(struct perf_event *bp, u64 old_type, u64 new_type)
676 {
677         struct mutex *mtx = bp_constraints_lock(bp);
678         int ret = __modify_bp_slot(bp, old_type, new_type);
679
680         bp_constraints_unlock(mtx);
681         return ret;
682 }
683
684 /*
685  * Allow the kernel debugger to reserve breakpoint slots without
686  * taking a lock using the dbg_* variant of for the reserve and
687  * release breakpoint slots.
688  */
689 int dbg_reserve_bp_slot(struct perf_event *bp)
690 {
691         int ret;
692
693         if (bp_constraints_is_locked(bp))
694                 return -1;
695
696         /* Locks aren't held; disable lockdep assert checking. */
697         lockdep_off();
698         ret = __reserve_bp_slot(bp, bp->attr.bp_type);
699         lockdep_on();
700
701         return ret;
702 }
703
704 int dbg_release_bp_slot(struct perf_event *bp)
705 {
706         if (bp_constraints_is_locked(bp))
707                 return -1;
708
709         /* Locks aren't held; disable lockdep assert checking. */
710         lockdep_off();
711         __release_bp_slot(bp, bp->attr.bp_type);
712         lockdep_on();
713
714         return 0;
715 }
716
717 static int hw_breakpoint_parse(struct perf_event *bp,
718                                const struct perf_event_attr *attr,
719                                struct arch_hw_breakpoint *hw)
720 {
721         int err;
722
723         err = hw_breakpoint_arch_parse(bp, attr, hw);
724         if (err)
725                 return err;
726
727         if (arch_check_bp_in_kernelspace(hw)) {
728                 if (attr->exclude_kernel)
729                         return -EINVAL;
730                 /*
731                  * Don't let unprivileged users set a breakpoint in the trap
732                  * path to avoid trap recursion attacks.
733                  */
734                 if (!capable(CAP_SYS_ADMIN))
735                         return -EPERM;
736         }
737
738         return 0;
739 }
740
741 int register_perf_hw_breakpoint(struct perf_event *bp)
742 {
743         struct arch_hw_breakpoint hw = { };
744         int err;
745
746         err = reserve_bp_slot(bp);
747         if (err)
748                 return err;
749
750         err = hw_breakpoint_parse(bp, &bp->attr, &hw);
751         if (err) {
752                 release_bp_slot(bp);
753                 return err;
754         }
755
756         bp->hw.info = hw;
757
758         return 0;
759 }
760
761 /**
762  * register_user_hw_breakpoint - register a hardware breakpoint for user space
763  * @attr: breakpoint attributes
764  * @triggered: callback to trigger when we hit the breakpoint
765  * @context: context data could be used in the triggered callback
766  * @tsk: pointer to 'task_struct' of the process to which the address belongs
767  */
768 struct perf_event *
769 register_user_hw_breakpoint(struct perf_event_attr *attr,
770                             perf_overflow_handler_t triggered,
771                             void *context,
772                             struct task_struct *tsk)
773 {
774         return perf_event_create_kernel_counter(attr, -1, tsk, triggered,
775                                                 context);
776 }
777 EXPORT_SYMBOL_GPL(register_user_hw_breakpoint);
778
779 static void hw_breakpoint_copy_attr(struct perf_event_attr *to,
780                                     struct perf_event_attr *from)
781 {
782         to->bp_addr = from->bp_addr;
783         to->bp_type = from->bp_type;
784         to->bp_len  = from->bp_len;
785         to->disabled = from->disabled;
786 }
787
788 int
789 modify_user_hw_breakpoint_check(struct perf_event *bp, struct perf_event_attr *attr,
790                                 bool check)
791 {
792         struct arch_hw_breakpoint hw = { };
793         int err;
794
795         err = hw_breakpoint_parse(bp, attr, &hw);
796         if (err)
797                 return err;
798
799         if (check) {
800                 struct perf_event_attr old_attr;
801
802                 old_attr = bp->attr;
803                 hw_breakpoint_copy_attr(&old_attr, attr);
804                 if (memcmp(&old_attr, attr, sizeof(*attr)))
805                         return -EINVAL;
806         }
807
808         if (bp->attr.bp_type != attr->bp_type) {
809                 err = modify_bp_slot(bp, bp->attr.bp_type, attr->bp_type);
810                 if (err)
811                         return err;
812         }
813
814         hw_breakpoint_copy_attr(&bp->attr, attr);
815         bp->hw.info = hw;
816
817         return 0;
818 }
819
820 /**
821  * modify_user_hw_breakpoint - modify a user-space hardware breakpoint
822  * @bp: the breakpoint structure to modify
823  * @attr: new breakpoint attributes
824  */
825 int modify_user_hw_breakpoint(struct perf_event *bp, struct perf_event_attr *attr)
826 {
827         int err;
828
829         /*
830          * modify_user_hw_breakpoint can be invoked with IRQs disabled and hence it
831          * will not be possible to raise IPIs that invoke __perf_event_disable.
832          * So call the function directly after making sure we are targeting the
833          * current task.
834          */
835         if (irqs_disabled() && bp->ctx && bp->ctx->task == current)
836                 perf_event_disable_local(bp);
837         else
838                 perf_event_disable(bp);
839
840         err = modify_user_hw_breakpoint_check(bp, attr, false);
841
842         if (!bp->attr.disabled)
843                 perf_event_enable(bp);
844
845         return err;
846 }
847 EXPORT_SYMBOL_GPL(modify_user_hw_breakpoint);
848
849 /**
850  * unregister_hw_breakpoint - unregister a user-space hardware breakpoint
851  * @bp: the breakpoint structure to unregister
852  */
853 void unregister_hw_breakpoint(struct perf_event *bp)
854 {
855         if (!bp)
856                 return;
857         perf_event_release_kernel(bp);
858 }
859 EXPORT_SYMBOL_GPL(unregister_hw_breakpoint);
860
861 /**
862  * register_wide_hw_breakpoint - register a wide breakpoint in the kernel
863  * @attr: breakpoint attributes
864  * @triggered: callback to trigger when we hit the breakpoint
865  * @context: context data could be used in the triggered callback
866  *
867  * @return a set of per_cpu pointers to perf events
868  */
869 struct perf_event * __percpu *
870 register_wide_hw_breakpoint(struct perf_event_attr *attr,
871                             perf_overflow_handler_t triggered,
872                             void *context)
873 {
874         struct perf_event * __percpu *cpu_events, *bp;
875         long err = 0;
876         int cpu;
877
878         cpu_events = alloc_percpu(typeof(*cpu_events));
879         if (!cpu_events)
880                 return (void __percpu __force *)ERR_PTR(-ENOMEM);
881
882         cpus_read_lock();
883         for_each_online_cpu(cpu) {
884                 bp = perf_event_create_kernel_counter(attr, cpu, NULL,
885                                                       triggered, context);
886                 if (IS_ERR(bp)) {
887                         err = PTR_ERR(bp);
888                         break;
889                 }
890
891                 per_cpu(*cpu_events, cpu) = bp;
892         }
893         cpus_read_unlock();
894
895         if (likely(!err))
896                 return cpu_events;
897
898         unregister_wide_hw_breakpoint(cpu_events);
899         return (void __percpu __force *)ERR_PTR(err);
900 }
901 EXPORT_SYMBOL_GPL(register_wide_hw_breakpoint);
902
903 /**
904  * unregister_wide_hw_breakpoint - unregister a wide breakpoint in the kernel
905  * @cpu_events: the per cpu set of events to unregister
906  */
907 void unregister_wide_hw_breakpoint(struct perf_event * __percpu *cpu_events)
908 {
909         int cpu;
910
911         for_each_possible_cpu(cpu)
912                 unregister_hw_breakpoint(per_cpu(*cpu_events, cpu));
913
914         free_percpu(cpu_events);
915 }
916 EXPORT_SYMBOL_GPL(unregister_wide_hw_breakpoint);
917
918 /**
919  * hw_breakpoint_is_used - check if breakpoints are currently used
920  *
921  * Returns: true if breakpoints are used, false otherwise.
922  */
923 bool hw_breakpoint_is_used(void)
924 {
925         int cpu;
926
927         if (!constraints_initialized)
928                 return false;
929
930         for_each_possible_cpu(cpu) {
931                 for (int type = 0; type < TYPE_MAX; ++type) {
932                         struct bp_cpuinfo *info = get_bp_info(cpu, type);
933
934                         if (info->cpu_pinned)
935                                 return true;
936
937                         for (int slot = 0; slot < hw_breakpoint_slots_cached(type); ++slot) {
938                                 if (atomic_read(&info->tsk_pinned.count[slot]))
939                                         return true;
940                         }
941                 }
942         }
943
944         for (int type = 0; type < TYPE_MAX; ++type) {
945                 for (int slot = 0; slot < hw_breakpoint_slots_cached(type); ++slot) {
946                         /*
947                          * Warn, because if there are CPU pinned counters,
948                          * should never get here; bp_cpuinfo::cpu_pinned should
949                          * be consistent with the global cpu_pinned histogram.
950                          */
951                         if (WARN_ON(atomic_read(&cpu_pinned[type].count[slot])))
952                                 return true;
953
954                         if (atomic_read(&tsk_pinned_all[type].count[slot]))
955                                 return true;
956                 }
957         }
958
959         return false;
960 }
961
962 static struct notifier_block hw_breakpoint_exceptions_nb = {
963         .notifier_call = hw_breakpoint_exceptions_notify,
964         /* we need to be notified first */
965         .priority = 0x7fffffff
966 };
967
968 static void bp_perf_event_destroy(struct perf_event *event)
969 {
970         release_bp_slot(event);
971 }
972
973 static int hw_breakpoint_event_init(struct perf_event *bp)
974 {
975         int err;
976
977         if (bp->attr.type != PERF_TYPE_BREAKPOINT)
978                 return -ENOENT;
979
980         /*
981          * no branch sampling for breakpoint events
982          */
983         if (has_branch_stack(bp))
984                 return -EOPNOTSUPP;
985
986         err = register_perf_hw_breakpoint(bp);
987         if (err)
988                 return err;
989
990         bp->destroy = bp_perf_event_destroy;
991
992         return 0;
993 }
994
995 static int hw_breakpoint_add(struct perf_event *bp, int flags)
996 {
997         if (!(flags & PERF_EF_START))
998                 bp->hw.state = PERF_HES_STOPPED;
999
1000         if (is_sampling_event(bp)) {
1001                 bp->hw.last_period = bp->hw.sample_period;
1002                 perf_swevent_set_period(bp);
1003         }
1004
1005         return arch_install_hw_breakpoint(bp);
1006 }
1007
1008 static void hw_breakpoint_del(struct perf_event *bp, int flags)
1009 {
1010         arch_uninstall_hw_breakpoint(bp);
1011 }
1012
1013 static void hw_breakpoint_start(struct perf_event *bp, int flags)
1014 {
1015         bp->hw.state = 0;
1016 }
1017
1018 static void hw_breakpoint_stop(struct perf_event *bp, int flags)
1019 {
1020         bp->hw.state = PERF_HES_STOPPED;
1021 }
1022
1023 static struct pmu perf_breakpoint = {
1024         .task_ctx_nr    = perf_sw_context, /* could eventually get its own */
1025
1026         .event_init     = hw_breakpoint_event_init,
1027         .add            = hw_breakpoint_add,
1028         .del            = hw_breakpoint_del,
1029         .start          = hw_breakpoint_start,
1030         .stop           = hw_breakpoint_stop,
1031         .read           = hw_breakpoint_pmu_read,
1032 };
1033
1034 int __init init_hw_breakpoint(void)
1035 {
1036         int ret;
1037
1038         ret = rhltable_init(&task_bps_ht, &task_bps_ht_params);
1039         if (ret)
1040                 return ret;
1041
1042         ret = init_breakpoint_slots();
1043         if (ret)
1044                 return ret;
1045
1046         constraints_initialized = true;
1047
1048         perf_pmu_register(&perf_breakpoint, "breakpoint", PERF_TYPE_BREAKPOINT);
1049
1050         return register_die_notifier(&hw_breakpoint_exceptions_nb);
1051 }