Bluetooth: Verify that l2cap_get_conf_opt provides large enough buffer
[pandora-kernel.git] / kernel / events / hw_breakpoint.c
1 /*
2  * This program is free software; you can redistribute it and/or modify
3  * it under the terms of the GNU General Public License as published by
4  * the Free Software Foundation; either version 2 of the License, or
5  * (at your option) any later version.
6  *
7  * This program is distributed in the hope that it will be useful,
8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
10  * GNU General Public License for more details.
11  *
12  * You should have received a copy of the GNU General Public License
13  * along with this program; if not, write to the Free Software
14  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
15  *
16  * Copyright (C) 2007 Alan Stern
17  * Copyright (C) IBM Corporation, 2009
18  * Copyright (C) 2009, Frederic Weisbecker <fweisbec@gmail.com>
19  *
20  * Thanks to Ingo Molnar for his many suggestions.
21  *
22  * Authors: Alan Stern <stern@rowland.harvard.edu>
23  *          K.Prasad <prasad@linux.vnet.ibm.com>
24  *          Frederic Weisbecker <fweisbec@gmail.com>
25  */
26
27 /*
28  * HW_breakpoint: a unified kernel/user-space hardware breakpoint facility,
29  * using the CPU's debug registers.
30  * This file contains the arch-independent routines.
31  */
32
33 #include <linux/irqflags.h>
34 #include <linux/kallsyms.h>
35 #include <linux/notifier.h>
36 #include <linux/kprobes.h>
37 #include <linux/kdebug.h>
38 #include <linux/kernel.h>
39 #include <linux/module.h>
40 #include <linux/percpu.h>
41 #include <linux/sched.h>
42 #include <linux/init.h>
43 #include <linux/slab.h>
44 #include <linux/list.h>
45 #include <linux/cpu.h>
46 #include <linux/smp.h>
47
48 #include <linux/hw_breakpoint.h>
49
50
51 /*
52  * Constraints data
53  */
54
55 /* Number of pinned cpu breakpoints in a cpu */
56 static DEFINE_PER_CPU(unsigned int, nr_cpu_bp_pinned[TYPE_MAX]);
57
58 /* Number of pinned task breakpoints in a cpu */
59 static DEFINE_PER_CPU(unsigned int *, nr_task_bp_pinned[TYPE_MAX]);
60
61 /* Number of non-pinned cpu/task breakpoints in a cpu */
62 static DEFINE_PER_CPU(unsigned int, nr_bp_flexible[TYPE_MAX]);
63
64 static int nr_slots[TYPE_MAX];
65
66 /* Keep track of the breakpoints attached to tasks */
67 static LIST_HEAD(bp_task_head);
68
69 static int constraints_initialized;
70
71 /* Gather the number of total pinned and un-pinned bp in a cpuset */
72 struct bp_busy_slots {
73         unsigned int pinned;
74         unsigned int flexible;
75 };
76
77 /* Serialize accesses to the above constraints */
78 static DEFINE_MUTEX(nr_bp_mutex);
79
80 __weak int hw_breakpoint_weight(struct perf_event *bp)
81 {
82         return 1;
83 }
84
85 static inline enum bp_type_idx find_slot_idx(struct perf_event *bp)
86 {
87         if (bp->attr.bp_type & HW_BREAKPOINT_RW)
88                 return TYPE_DATA;
89
90         return TYPE_INST;
91 }
92
93 /*
94  * Report the maximum number of pinned breakpoints a task
95  * have in this cpu
96  */
97 static unsigned int max_task_bp_pinned(int cpu, enum bp_type_idx type)
98 {
99         int i;
100         unsigned int *tsk_pinned = per_cpu(nr_task_bp_pinned[type], cpu);
101
102         for (i = nr_slots[type] - 1; i >= 0; i--) {
103                 if (tsk_pinned[i] > 0)
104                         return i + 1;
105         }
106
107         return 0;
108 }
109
110 /*
111  * Count the number of breakpoints of the same type and same task.
112  * The given event must be not on the list.
113  */
114 static int task_bp_pinned(struct perf_event *bp, enum bp_type_idx type)
115 {
116         struct task_struct *tsk = bp->hw.bp_target;
117         struct perf_event *iter;
118         int count = 0;
119
120         list_for_each_entry(iter, &bp_task_head, hw.bp_list) {
121                 if (iter->hw.bp_target == tsk && find_slot_idx(iter) == type)
122                         count += hw_breakpoint_weight(iter);
123         }
124
125         return count;
126 }
127
128 /*
129  * Report the number of pinned/un-pinned breakpoints we have in
130  * a given cpu (cpu > -1) or in all of them (cpu = -1).
131  */
132 static void
133 fetch_bp_busy_slots(struct bp_busy_slots *slots, struct perf_event *bp,
134                     enum bp_type_idx type)
135 {
136         int cpu = bp->cpu;
137         struct task_struct *tsk = bp->hw.bp_target;
138
139         if (cpu >= 0) {
140                 slots->pinned = per_cpu(nr_cpu_bp_pinned[type], cpu);
141                 if (!tsk)
142                         slots->pinned += max_task_bp_pinned(cpu, type);
143                 else
144                         slots->pinned += task_bp_pinned(bp, type);
145                 slots->flexible = per_cpu(nr_bp_flexible[type], cpu);
146
147                 return;
148         }
149
150         for_each_possible_cpu(cpu) {
151                 unsigned int nr;
152
153                 nr = per_cpu(nr_cpu_bp_pinned[type], cpu);
154                 if (!tsk)
155                         nr += max_task_bp_pinned(cpu, type);
156                 else
157                         nr += task_bp_pinned(bp, type);
158
159                 if (nr > slots->pinned)
160                         slots->pinned = nr;
161
162                 nr = per_cpu(nr_bp_flexible[type], cpu);
163
164                 if (nr > slots->flexible)
165                         slots->flexible = nr;
166         }
167 }
168
169 /*
170  * For now, continue to consider flexible as pinned, until we can
171  * ensure no flexible event can ever be scheduled before a pinned event
172  * in a same cpu.
173  */
174 static void
175 fetch_this_slot(struct bp_busy_slots *slots, int weight)
176 {
177         slots->pinned += weight;
178 }
179
180 /*
181  * Add a pinned breakpoint for the given task in our constraint table
182  */
183 static void toggle_bp_task_slot(struct perf_event *bp, int cpu, bool enable,
184                                 enum bp_type_idx type, int weight)
185 {
186         unsigned int *tsk_pinned;
187         int old_count = 0;
188         int old_idx = 0;
189         int idx = 0;
190
191         old_count = task_bp_pinned(bp, type);
192         old_idx = old_count - 1;
193         idx = old_idx + weight;
194
195         /* tsk_pinned[n] is the number of tasks having n breakpoints */
196         tsk_pinned = per_cpu(nr_task_bp_pinned[type], cpu);
197         if (enable) {
198                 tsk_pinned[idx]++;
199                 if (old_count > 0)
200                         tsk_pinned[old_idx]--;
201         } else {
202                 tsk_pinned[idx]--;
203                 if (old_count > 0)
204                         tsk_pinned[old_idx]++;
205         }
206 }
207
208 /*
209  * Add/remove the given breakpoint in our constraint table
210  */
211 static void
212 toggle_bp_slot(struct perf_event *bp, bool enable, enum bp_type_idx type,
213                int weight)
214 {
215         int cpu = bp->cpu;
216         struct task_struct *tsk = bp->hw.bp_target;
217
218         /* Pinned counter cpu profiling */
219         if (!tsk) {
220
221                 if (enable)
222                         per_cpu(nr_cpu_bp_pinned[type], bp->cpu) += weight;
223                 else
224                         per_cpu(nr_cpu_bp_pinned[type], bp->cpu) -= weight;
225                 return;
226         }
227
228         /* Pinned counter task profiling */
229
230         if (!enable)
231                 list_del(&bp->hw.bp_list);
232
233         if (cpu >= 0) {
234                 toggle_bp_task_slot(bp, cpu, enable, type, weight);
235         } else {
236                 for_each_possible_cpu(cpu)
237                         toggle_bp_task_slot(bp, cpu, enable, type, weight);
238         }
239
240         if (enable)
241                 list_add_tail(&bp->hw.bp_list, &bp_task_head);
242 }
243
244 /*
245  * Function to perform processor-specific cleanup during unregistration
246  */
247 __weak void arch_unregister_hw_breakpoint(struct perf_event *bp)
248 {
249         /*
250          * A weak stub function here for those archs that don't define
251          * it inside arch/.../kernel/hw_breakpoint.c
252          */
253 }
254
255 /*
256  * Contraints to check before allowing this new breakpoint counter:
257  *
258  *  == Non-pinned counter == (Considered as pinned for now)
259  *
260  *   - If attached to a single cpu, check:
261  *
262  *       (per_cpu(nr_bp_flexible, cpu) || (per_cpu(nr_cpu_bp_pinned, cpu)
263  *           + max(per_cpu(nr_task_bp_pinned, cpu)))) < HBP_NUM
264  *
265  *       -> If there are already non-pinned counters in this cpu, it means
266  *          there is already a free slot for them.
267  *          Otherwise, we check that the maximum number of per task
268  *          breakpoints (for this cpu) plus the number of per cpu breakpoint
269  *          (for this cpu) doesn't cover every registers.
270  *
271  *   - If attached to every cpus, check:
272  *
273  *       (per_cpu(nr_bp_flexible, *) || (max(per_cpu(nr_cpu_bp_pinned, *))
274  *           + max(per_cpu(nr_task_bp_pinned, *)))) < HBP_NUM
275  *
276  *       -> This is roughly the same, except we check the number of per cpu
277  *          bp for every cpu and we keep the max one. Same for the per tasks
278  *          breakpoints.
279  *
280  *
281  * == Pinned counter ==
282  *
283  *   - If attached to a single cpu, check:
284  *
285  *       ((per_cpu(nr_bp_flexible, cpu) > 1) + per_cpu(nr_cpu_bp_pinned, cpu)
286  *            + max(per_cpu(nr_task_bp_pinned, cpu))) < HBP_NUM
287  *
288  *       -> Same checks as before. But now the nr_bp_flexible, if any, must keep
289  *          one register at least (or they will never be fed).
290  *
291  *   - If attached to every cpus, check:
292  *
293  *       ((per_cpu(nr_bp_flexible, *) > 1) + max(per_cpu(nr_cpu_bp_pinned, *))
294  *            + max(per_cpu(nr_task_bp_pinned, *))) < HBP_NUM
295  */
296 static int __reserve_bp_slot(struct perf_event *bp)
297 {
298         struct bp_busy_slots slots = {0};
299         enum bp_type_idx type;
300         int weight;
301
302         /* We couldn't initialize breakpoint constraints on boot */
303         if (!constraints_initialized)
304                 return -ENOMEM;
305
306         /* Basic checks */
307         if (bp->attr.bp_type == HW_BREAKPOINT_EMPTY ||
308             bp->attr.bp_type == HW_BREAKPOINT_INVALID)
309                 return -EINVAL;
310
311         type = find_slot_idx(bp);
312         weight = hw_breakpoint_weight(bp);
313
314         fetch_bp_busy_slots(&slots, bp, type);
315         /*
316          * Simulate the addition of this breakpoint to the constraints
317          * and see the result.
318          */
319         fetch_this_slot(&slots, weight);
320
321         /* Flexible counters need to keep at least one slot */
322         if (slots.pinned + (!!slots.flexible) > nr_slots[type])
323                 return -ENOSPC;
324
325         toggle_bp_slot(bp, true, type, weight);
326
327         return 0;
328 }
329
330 int reserve_bp_slot(struct perf_event *bp)
331 {
332         int ret;
333
334         mutex_lock(&nr_bp_mutex);
335
336         ret = __reserve_bp_slot(bp);
337
338         mutex_unlock(&nr_bp_mutex);
339
340         return ret;
341 }
342
343 static void __release_bp_slot(struct perf_event *bp)
344 {
345         enum bp_type_idx type;
346         int weight;
347
348         type = find_slot_idx(bp);
349         weight = hw_breakpoint_weight(bp);
350         toggle_bp_slot(bp, false, type, weight);
351 }
352
353 void release_bp_slot(struct perf_event *bp)
354 {
355         mutex_lock(&nr_bp_mutex);
356
357         arch_unregister_hw_breakpoint(bp);
358         __release_bp_slot(bp);
359
360         mutex_unlock(&nr_bp_mutex);
361 }
362
363 /*
364  * Allow the kernel debugger to reserve breakpoint slots without
365  * taking a lock using the dbg_* variant of for the reserve and
366  * release breakpoint slots.
367  */
368 int dbg_reserve_bp_slot(struct perf_event *bp)
369 {
370         if (mutex_is_locked(&nr_bp_mutex))
371                 return -1;
372
373         return __reserve_bp_slot(bp);
374 }
375
376 int dbg_release_bp_slot(struct perf_event *bp)
377 {
378         if (mutex_is_locked(&nr_bp_mutex))
379                 return -1;
380
381         __release_bp_slot(bp);
382
383         return 0;
384 }
385
386 static int validate_hw_breakpoint(struct perf_event *bp)
387 {
388         int ret;
389
390         ret = arch_validate_hwbkpt_settings(bp);
391         if (ret)
392                 return ret;
393
394         if (arch_check_bp_in_kernelspace(bp)) {
395                 if (bp->attr.exclude_kernel)
396                         return -EINVAL;
397                 /*
398                  * Don't let unprivileged users set a breakpoint in the trap
399                  * path to avoid trap recursion attacks.
400                  */
401                 if (!capable(CAP_SYS_ADMIN))
402                         return -EPERM;
403         }
404
405         return 0;
406 }
407
408 int register_perf_hw_breakpoint(struct perf_event *bp)
409 {
410         int ret;
411
412         ret = reserve_bp_slot(bp);
413         if (ret)
414                 return ret;
415
416         ret = validate_hw_breakpoint(bp);
417
418         /* if arch_validate_hwbkpt_settings() fails then release bp slot */
419         if (ret)
420                 release_bp_slot(bp);
421
422         return ret;
423 }
424
425 /**
426  * register_user_hw_breakpoint - register a hardware breakpoint for user space
427  * @attr: breakpoint attributes
428  * @triggered: callback to trigger when we hit the breakpoint
429  * @tsk: pointer to 'task_struct' of the process to which the address belongs
430  */
431 struct perf_event *
432 register_user_hw_breakpoint(struct perf_event_attr *attr,
433                             perf_overflow_handler_t triggered,
434                             void *context,
435                             struct task_struct *tsk)
436 {
437         return perf_event_create_kernel_counter(attr, -1, tsk, triggered,
438                                                 context);
439 }
440 EXPORT_SYMBOL_GPL(register_user_hw_breakpoint);
441
442 /**
443  * modify_user_hw_breakpoint - modify a user-space hardware breakpoint
444  * @bp: the breakpoint structure to modify
445  * @attr: new breakpoint attributes
446  */
447 int modify_user_hw_breakpoint(struct perf_event *bp, struct perf_event_attr *attr)
448 {
449         /*
450          * modify_user_hw_breakpoint can be invoked with IRQs disabled and hence it
451          * will not be possible to raise IPIs that invoke __perf_event_disable.
452          * So call the function directly after making sure we are targeting the
453          * current task.
454          */
455         if (irqs_disabled() && bp->ctx && bp->ctx->task == current)
456                 __perf_event_disable(bp);
457         else
458                 perf_event_disable(bp);
459
460         bp->attr.bp_addr = attr->bp_addr;
461         bp->attr.bp_type = attr->bp_type;
462         bp->attr.bp_len = attr->bp_len;
463         bp->attr.disabled = 1;
464
465         if (!attr->disabled) {
466                 int err = validate_hw_breakpoint(bp);
467
468                 if (err)
469                         return err;
470
471                 perf_event_enable(bp);
472                 bp->attr.disabled = 0;
473         }
474
475         return 0;
476 }
477 EXPORT_SYMBOL_GPL(modify_user_hw_breakpoint);
478
479 /**
480  * unregister_hw_breakpoint - unregister a user-space hardware breakpoint
481  * @bp: the breakpoint structure to unregister
482  */
483 void unregister_hw_breakpoint(struct perf_event *bp)
484 {
485         if (!bp)
486                 return;
487         perf_event_release_kernel(bp);
488 }
489 EXPORT_SYMBOL_GPL(unregister_hw_breakpoint);
490
491 /**
492  * register_wide_hw_breakpoint - register a wide breakpoint in the kernel
493  * @attr: breakpoint attributes
494  * @triggered: callback to trigger when we hit the breakpoint
495  *
496  * @return a set of per_cpu pointers to perf events
497  */
498 struct perf_event * __percpu *
499 register_wide_hw_breakpoint(struct perf_event_attr *attr,
500                             perf_overflow_handler_t triggered,
501                             void *context)
502 {
503         struct perf_event * __percpu *cpu_events, **pevent, *bp;
504         long err;
505         int cpu;
506
507         cpu_events = alloc_percpu(typeof(*cpu_events));
508         if (!cpu_events)
509                 return (void __percpu __force *)ERR_PTR(-ENOMEM);
510
511         get_online_cpus();
512         for_each_online_cpu(cpu) {
513                 pevent = per_cpu_ptr(cpu_events, cpu);
514                 bp = perf_event_create_kernel_counter(attr, cpu, NULL,
515                                                       triggered, context);
516
517                 *pevent = bp;
518
519                 if (IS_ERR(bp)) {
520                         err = PTR_ERR(bp);
521                         goto fail;
522                 }
523         }
524         put_online_cpus();
525
526         return cpu_events;
527
528 fail:
529         for_each_online_cpu(cpu) {
530                 pevent = per_cpu_ptr(cpu_events, cpu);
531                 if (IS_ERR(*pevent))
532                         break;
533                 unregister_hw_breakpoint(*pevent);
534         }
535         put_online_cpus();
536
537         free_percpu(cpu_events);
538         return (void __percpu __force *)ERR_PTR(err);
539 }
540 EXPORT_SYMBOL_GPL(register_wide_hw_breakpoint);
541
542 /**
543  * unregister_wide_hw_breakpoint - unregister a wide breakpoint in the kernel
544  * @cpu_events: the per cpu set of events to unregister
545  */
546 void unregister_wide_hw_breakpoint(struct perf_event * __percpu *cpu_events)
547 {
548         int cpu;
549         struct perf_event **pevent;
550
551         for_each_possible_cpu(cpu) {
552                 pevent = per_cpu_ptr(cpu_events, cpu);
553                 unregister_hw_breakpoint(*pevent);
554         }
555         free_percpu(cpu_events);
556 }
557 EXPORT_SYMBOL_GPL(unregister_wide_hw_breakpoint);
558
559 static struct notifier_block hw_breakpoint_exceptions_nb = {
560         .notifier_call = hw_breakpoint_exceptions_notify,
561         /* we need to be notified first */
562         .priority = 0x7fffffff
563 };
564
565 static void bp_perf_event_destroy(struct perf_event *event)
566 {
567         release_bp_slot(event);
568 }
569
570 static int hw_breakpoint_event_init(struct perf_event *bp)
571 {
572         int err;
573
574         if (bp->attr.type != PERF_TYPE_BREAKPOINT)
575                 return -ENOENT;
576
577         err = register_perf_hw_breakpoint(bp);
578         if (err)
579                 return err;
580
581         bp->destroy = bp_perf_event_destroy;
582
583         return 0;
584 }
585
586 static int hw_breakpoint_add(struct perf_event *bp, int flags)
587 {
588         if (!(flags & PERF_EF_START))
589                 bp->hw.state = PERF_HES_STOPPED;
590
591         return arch_install_hw_breakpoint(bp);
592 }
593
594 static void hw_breakpoint_del(struct perf_event *bp, int flags)
595 {
596         arch_uninstall_hw_breakpoint(bp);
597 }
598
599 static void hw_breakpoint_start(struct perf_event *bp, int flags)
600 {
601         bp->hw.state = 0;
602 }
603
604 static void hw_breakpoint_stop(struct perf_event *bp, int flags)
605 {
606         bp->hw.state = PERF_HES_STOPPED;
607 }
608
609 static struct pmu perf_breakpoint = {
610         .task_ctx_nr    = perf_sw_context, /* could eventually get its own */
611
612         .event_init     = hw_breakpoint_event_init,
613         .add            = hw_breakpoint_add,
614         .del            = hw_breakpoint_del,
615         .start          = hw_breakpoint_start,
616         .stop           = hw_breakpoint_stop,
617         .read           = hw_breakpoint_pmu_read,
618 };
619
620 int __init init_hw_breakpoint(void)
621 {
622         unsigned int **task_bp_pinned;
623         int cpu, err_cpu;
624         int i;
625
626         for (i = 0; i < TYPE_MAX; i++)
627                 nr_slots[i] = hw_breakpoint_slots(i);
628
629         for_each_possible_cpu(cpu) {
630                 for (i = 0; i < TYPE_MAX; i++) {
631                         task_bp_pinned = &per_cpu(nr_task_bp_pinned[i], cpu);
632                         *task_bp_pinned = kzalloc(sizeof(int) * nr_slots[i],
633                                                   GFP_KERNEL);
634                         if (!*task_bp_pinned)
635                                 goto err_alloc;
636                 }
637         }
638
639         constraints_initialized = 1;
640
641         perf_pmu_register(&perf_breakpoint, "breakpoint", PERF_TYPE_BREAKPOINT);
642
643         return register_die_notifier(&hw_breakpoint_exceptions_nb);
644
645  err_alloc:
646         for_each_possible_cpu(err_cpu) {
647                 if (err_cpu == cpu)
648                         break;
649                 for (i = 0; i < TYPE_MAX; i++)
650                         kfree(per_cpu(nr_task_bp_pinned[i], cpu));
651         }
652
653         return -ENOMEM;
654 }
655
656