]> git.kernelconcepts.de Git - karo-tx-linux.git/blob - kernel/trace/ftrace.c
ASoC: wm8510: Use IS_ENABLED() macro
[karo-tx-linux.git] / kernel / trace / ftrace.c
1 /*
2  * Infrastructure for profiling code inserted by 'gcc -pg'.
3  *
4  * Copyright (C) 2007-2008 Steven Rostedt <srostedt@redhat.com>
5  * Copyright (C) 2004-2008 Ingo Molnar <mingo@redhat.com>
6  *
7  * Originally ported from the -rt patch by:
8  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <acme@redhat.com>
9  *
10  * Based on code in the latency_tracer, that is:
11  *
12  *  Copyright (C) 2004-2006 Ingo Molnar
13  *  Copyright (C) 2004 Nadia Yvette Chambers
14  */
15
16 #include <linux/stop_machine.h>
17 #include <linux/clocksource.h>
18 #include <linux/kallsyms.h>
19 #include <linux/seq_file.h>
20 #include <linux/suspend.h>
21 #include <linux/debugfs.h>
22 #include <linux/hardirq.h>
23 #include <linux/kthread.h>
24 #include <linux/uaccess.h>
25 #include <linux/bsearch.h>
26 #include <linux/module.h>
27 #include <linux/ftrace.h>
28 #include <linux/sysctl.h>
29 #include <linux/slab.h>
30 #include <linux/ctype.h>
31 #include <linux/sort.h>
32 #include <linux/list.h>
33 #include <linux/hash.h>
34 #include <linux/rcupdate.h>
35
36 #include <trace/events/sched.h>
37
38 #include <asm/setup.h>
39
40 #include "trace_output.h"
41 #include "trace_stat.h"
42
43 #define FTRACE_WARN_ON(cond)                    \
44         ({                                      \
45                 int ___r = cond;                \
46                 if (WARN_ON(___r))              \
47                         ftrace_kill();          \
48                 ___r;                           \
49         })
50
51 #define FTRACE_WARN_ON_ONCE(cond)               \
52         ({                                      \
53                 int ___r = cond;                \
54                 if (WARN_ON_ONCE(___r))         \
55                         ftrace_kill();          \
56                 ___r;                           \
57         })
58
59 /* hash bits for specific function selection */
60 #define FTRACE_HASH_BITS 7
61 #define FTRACE_FUNC_HASHSIZE (1 << FTRACE_HASH_BITS)
62 #define FTRACE_HASH_DEFAULT_BITS 10
63 #define FTRACE_HASH_MAX_BITS 12
64
65 #define FL_GLOBAL_CONTROL_MASK (FTRACE_OPS_FL_GLOBAL | FTRACE_OPS_FL_CONTROL)
66
67 #ifdef CONFIG_DYNAMIC_FTRACE
68 #define INIT_REGEX_LOCK(opsname)        \
69         .regex_lock     = __MUTEX_INITIALIZER(opsname.regex_lock),
70 #else
71 #define INIT_REGEX_LOCK(opsname)
72 #endif
73
74 static struct ftrace_ops ftrace_list_end __read_mostly = {
75         .func           = ftrace_stub,
76         .flags          = FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_STUB,
77 };
78
79 /* ftrace_enabled is a method to turn ftrace on or off */
80 int ftrace_enabled __read_mostly;
81 static int last_ftrace_enabled;
82
83 /* Quick disabling of function tracer. */
84 int function_trace_stop __read_mostly;
85
86 /* Current function tracing op */
87 struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
88
89 /* List for set_ftrace_pid's pids. */
90 LIST_HEAD(ftrace_pids);
91 struct ftrace_pid {
92         struct list_head list;
93         struct pid *pid;
94 };
95
96 /*
97  * ftrace_disabled is set when an anomaly is discovered.
98  * ftrace_disabled is much stronger than ftrace_enabled.
99  */
100 static int ftrace_disabled __read_mostly;
101
102 static DEFINE_MUTEX(ftrace_lock);
103
104 static struct ftrace_ops *ftrace_global_list __read_mostly = &ftrace_list_end;
105 static struct ftrace_ops *ftrace_control_list __read_mostly = &ftrace_list_end;
106 static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
107 ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
108 ftrace_func_t ftrace_pid_function __read_mostly = ftrace_stub;
109 static struct ftrace_ops global_ops;
110 static struct ftrace_ops control_ops;
111
112 #if ARCH_SUPPORTS_FTRACE_OPS
113 static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
114                                  struct ftrace_ops *op, struct pt_regs *regs);
115 #else
116 /* See comment below, where ftrace_ops_list_func is defined */
117 static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
118 #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
119 #endif
120
121 /*
122  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
123  * can use rcu_dereference_raw_notrace() is that elements removed from this list
124  * are simply leaked, so there is no need to interact with a grace-period
125  * mechanism.  The rcu_dereference_raw_notrace() calls are needed to handle
126  * concurrent insertions into the ftrace_global_list.
127  *
128  * Silly Alpha and silly pointer-speculation compiler optimizations!
129  */
130 #define do_for_each_ftrace_op(op, list)                 \
131         op = rcu_dereference_raw_notrace(list);                 \
132         do
133
134 /*
135  * Optimized for just a single item in the list (as that is the normal case).
136  */
137 #define while_for_each_ftrace_op(op)                            \
138         while (likely(op = rcu_dereference_raw_notrace((op)->next)) &&  \
139                unlikely((op) != &ftrace_list_end))
140
141 static inline void ftrace_ops_init(struct ftrace_ops *ops)
142 {
143 #ifdef CONFIG_DYNAMIC_FTRACE
144         if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
145                 mutex_init(&ops->regex_lock);
146                 ops->flags |= FTRACE_OPS_FL_INITIALIZED;
147         }
148 #endif
149 }
150
151 /**
152  * ftrace_nr_registered_ops - return number of ops registered
153  *
154  * Returns the number of ftrace_ops registered and tracing functions
155  */
156 int ftrace_nr_registered_ops(void)
157 {
158         struct ftrace_ops *ops;
159         int cnt = 0;
160
161         mutex_lock(&ftrace_lock);
162
163         for (ops = ftrace_ops_list;
164              ops != &ftrace_list_end; ops = ops->next)
165                 cnt++;
166
167         mutex_unlock(&ftrace_lock);
168
169         return cnt;
170 }
171
172 static void
173 ftrace_global_list_func(unsigned long ip, unsigned long parent_ip,
174                         struct ftrace_ops *op, struct pt_regs *regs)
175 {
176         int bit;
177
178         bit = trace_test_and_set_recursion(TRACE_GLOBAL_START, TRACE_GLOBAL_MAX);
179         if (bit < 0)
180                 return;
181
182         do_for_each_ftrace_op(op, ftrace_global_list) {
183                 op->func(ip, parent_ip, op, regs);
184         } while_for_each_ftrace_op(op);
185
186         trace_clear_recursion(bit);
187 }
188
189 static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
190                             struct ftrace_ops *op, struct pt_regs *regs)
191 {
192         if (!test_tsk_trace_trace(current))
193                 return;
194
195         ftrace_pid_function(ip, parent_ip, op, regs);
196 }
197
198 static void set_ftrace_pid_function(ftrace_func_t func)
199 {
200         /* do not set ftrace_pid_function to itself! */
201         if (func != ftrace_pid_func)
202                 ftrace_pid_function = func;
203 }
204
205 /**
206  * clear_ftrace_function - reset the ftrace function
207  *
208  * This NULLs the ftrace function and in essence stops
209  * tracing.  There may be lag
210  */
211 void clear_ftrace_function(void)
212 {
213         ftrace_trace_function = ftrace_stub;
214         ftrace_pid_function = ftrace_stub;
215 }
216
217 static void control_ops_disable_all(struct ftrace_ops *ops)
218 {
219         int cpu;
220
221         for_each_possible_cpu(cpu)
222                 *per_cpu_ptr(ops->disabled, cpu) = 1;
223 }
224
225 static int control_ops_alloc(struct ftrace_ops *ops)
226 {
227         int __percpu *disabled;
228
229         disabled = alloc_percpu(int);
230         if (!disabled)
231                 return -ENOMEM;
232
233         ops->disabled = disabled;
234         control_ops_disable_all(ops);
235         return 0;
236 }
237
238 static void control_ops_free(struct ftrace_ops *ops)
239 {
240         free_percpu(ops->disabled);
241 }
242
243 static void update_global_ops(void)
244 {
245         ftrace_func_t func;
246
247         /*
248          * If there's only one function registered, then call that
249          * function directly. Otherwise, we need to iterate over the
250          * registered callers.
251          */
252         if (ftrace_global_list == &ftrace_list_end ||
253             ftrace_global_list->next == &ftrace_list_end) {
254                 func = ftrace_global_list->func;
255                 /*
256                  * As we are calling the function directly.
257                  * If it does not have recursion protection,
258                  * the function_trace_op needs to be updated
259                  * accordingly.
260                  */
261                 if (ftrace_global_list->flags & FTRACE_OPS_FL_RECURSION_SAFE)
262                         global_ops.flags |= FTRACE_OPS_FL_RECURSION_SAFE;
263                 else
264                         global_ops.flags &= ~FTRACE_OPS_FL_RECURSION_SAFE;
265         } else {
266                 func = ftrace_global_list_func;
267                 /* The list has its own recursion protection. */
268                 global_ops.flags |= FTRACE_OPS_FL_RECURSION_SAFE;
269         }
270
271
272         /* If we filter on pids, update to use the pid function */
273         if (!list_empty(&ftrace_pids)) {
274                 set_ftrace_pid_function(func);
275                 func = ftrace_pid_func;
276         }
277
278         global_ops.func = func;
279 }
280
281 static void update_ftrace_function(void)
282 {
283         ftrace_func_t func;
284
285         update_global_ops();
286
287         /*
288          * If we are at the end of the list and this ops is
289          * recursion safe and not dynamic and the arch supports passing ops,
290          * then have the mcount trampoline call the function directly.
291          */
292         if (ftrace_ops_list == &ftrace_list_end ||
293             (ftrace_ops_list->next == &ftrace_list_end &&
294              !(ftrace_ops_list->flags & FTRACE_OPS_FL_DYNAMIC) &&
295              (ftrace_ops_list->flags & FTRACE_OPS_FL_RECURSION_SAFE) &&
296              !FTRACE_FORCE_LIST_FUNC)) {
297                 /* Set the ftrace_ops that the arch callback uses */
298                 if (ftrace_ops_list == &global_ops)
299                         function_trace_op = ftrace_global_list;
300                 else
301                         function_trace_op = ftrace_ops_list;
302                 func = ftrace_ops_list->func;
303         } else {
304                 /* Just use the default ftrace_ops */
305                 function_trace_op = &ftrace_list_end;
306                 func = ftrace_ops_list_func;
307         }
308
309         ftrace_trace_function = func;
310 }
311
312 static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
313 {
314         ops->next = *list;
315         /*
316          * We are entering ops into the list but another
317          * CPU might be walking that list. We need to make sure
318          * the ops->next pointer is valid before another CPU sees
319          * the ops pointer included into the list.
320          */
321         rcu_assign_pointer(*list, ops);
322 }
323
324 static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
325 {
326         struct ftrace_ops **p;
327
328         /*
329          * If we are removing the last function, then simply point
330          * to the ftrace_stub.
331          */
332         if (*list == ops && ops->next == &ftrace_list_end) {
333                 *list = &ftrace_list_end;
334                 return 0;
335         }
336
337         for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
338                 if (*p == ops)
339                         break;
340
341         if (*p != ops)
342                 return -1;
343
344         *p = (*p)->next;
345         return 0;
346 }
347
348 static void add_ftrace_list_ops(struct ftrace_ops **list,
349                                 struct ftrace_ops *main_ops,
350                                 struct ftrace_ops *ops)
351 {
352         int first = *list == &ftrace_list_end;
353         add_ftrace_ops(list, ops);
354         if (first)
355                 add_ftrace_ops(&ftrace_ops_list, main_ops);
356 }
357
358 static int remove_ftrace_list_ops(struct ftrace_ops **list,
359                                   struct ftrace_ops *main_ops,
360                                   struct ftrace_ops *ops)
361 {
362         int ret = remove_ftrace_ops(list, ops);
363         if (!ret && *list == &ftrace_list_end)
364                 ret = remove_ftrace_ops(&ftrace_ops_list, main_ops);
365         return ret;
366 }
367
368 static int __register_ftrace_function(struct ftrace_ops *ops)
369 {
370         if (unlikely(ftrace_disabled))
371                 return -ENODEV;
372
373         if (FTRACE_WARN_ON(ops == &global_ops))
374                 return -EINVAL;
375
376         if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
377                 return -EBUSY;
378
379         /* We don't support both control and global flags set. */
380         if ((ops->flags & FL_GLOBAL_CONTROL_MASK) == FL_GLOBAL_CONTROL_MASK)
381                 return -EINVAL;
382
383 #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
384         /*
385          * If the ftrace_ops specifies SAVE_REGS, then it only can be used
386          * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
387          * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
388          */
389         if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
390             !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
391                 return -EINVAL;
392
393         if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
394                 ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
395 #endif
396
397         if (!core_kernel_data((unsigned long)ops))
398                 ops->flags |= FTRACE_OPS_FL_DYNAMIC;
399
400         if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
401                 add_ftrace_list_ops(&ftrace_global_list, &global_ops, ops);
402                 ops->flags |= FTRACE_OPS_FL_ENABLED;
403         } else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
404                 if (control_ops_alloc(ops))
405                         return -ENOMEM;
406                 add_ftrace_list_ops(&ftrace_control_list, &control_ops, ops);
407         } else
408                 add_ftrace_ops(&ftrace_ops_list, ops);
409
410         if (ftrace_enabled)
411                 update_ftrace_function();
412
413         return 0;
414 }
415
416 static void ftrace_sync(struct work_struct *work)
417 {
418         /*
419          * This function is just a stub to implement a hard force
420          * of synchronize_sched(). This requires synchronizing
421          * tasks even in userspace and idle.
422          *
423          * Yes, function tracing is rude.
424          */
425 }
426
427 static int __unregister_ftrace_function(struct ftrace_ops *ops)
428 {
429         int ret;
430
431         if (ftrace_disabled)
432                 return -ENODEV;
433
434         if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
435                 return -EBUSY;
436
437         if (FTRACE_WARN_ON(ops == &global_ops))
438                 return -EINVAL;
439
440         if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
441                 ret = remove_ftrace_list_ops(&ftrace_global_list,
442                                              &global_ops, ops);
443                 if (!ret)
444                         ops->flags &= ~FTRACE_OPS_FL_ENABLED;
445         } else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
446                 ret = remove_ftrace_list_ops(&ftrace_control_list,
447                                              &control_ops, ops);
448                 if (!ret) {
449                         /*
450                          * The ftrace_ops is now removed from the list,
451                          * so there'll be no new users. We must ensure
452                          * all current users are done before we free
453                          * the control data.
454                          * Note synchronize_sched() is not enough, as we
455                          * use preempt_disable() to do RCU, but the function
456                          * tracer can be called where RCU is not active
457                          * (before user_exit()).
458                          */
459                         schedule_on_each_cpu(ftrace_sync);
460                         control_ops_free(ops);
461                 }
462         } else
463                 ret = remove_ftrace_ops(&ftrace_ops_list, ops);
464
465         if (ret < 0)
466                 return ret;
467
468         if (ftrace_enabled)
469                 update_ftrace_function();
470
471         /*
472          * Dynamic ops may be freed, we must make sure that all
473          * callers are done before leaving this function.
474          *
475          * Again, normal synchronize_sched() is not good enough.
476          * We need to do a hard force of sched synchronization.
477          */
478         if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
479                 schedule_on_each_cpu(ftrace_sync);
480
481
482         return 0;
483 }
484
485 static void ftrace_update_pid_func(void)
486 {
487         /* Only do something if we are tracing something */
488         if (ftrace_trace_function == ftrace_stub)
489                 return;
490
491         update_ftrace_function();
492 }
493
494 #ifdef CONFIG_FUNCTION_PROFILER
495 struct ftrace_profile {
496         struct hlist_node               node;
497         unsigned long                   ip;
498         unsigned long                   counter;
499 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
500         unsigned long long              time;
501         unsigned long long              time_squared;
502 #endif
503 };
504
505 struct ftrace_profile_page {
506         struct ftrace_profile_page      *next;
507         unsigned long                   index;
508         struct ftrace_profile           records[];
509 };
510
511 struct ftrace_profile_stat {
512         atomic_t                        disabled;
513         struct hlist_head               *hash;
514         struct ftrace_profile_page      *pages;
515         struct ftrace_profile_page      *start;
516         struct tracer_stat              stat;
517 };
518
519 #define PROFILE_RECORDS_SIZE                                            \
520         (PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
521
522 #define PROFILES_PER_PAGE                                       \
523         (PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
524
525 static int ftrace_profile_enabled __read_mostly;
526
527 /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
528 static DEFINE_MUTEX(ftrace_profile_lock);
529
530 static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
531
532 #define FTRACE_PROFILE_HASH_BITS 10
533 #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
534
535 static void *
536 function_stat_next(void *v, int idx)
537 {
538         struct ftrace_profile *rec = v;
539         struct ftrace_profile_page *pg;
540
541         pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
542
543  again:
544         if (idx != 0)
545                 rec++;
546
547         if ((void *)rec >= (void *)&pg->records[pg->index]) {
548                 pg = pg->next;
549                 if (!pg)
550                         return NULL;
551                 rec = &pg->records[0];
552                 if (!rec->counter)
553                         goto again;
554         }
555
556         return rec;
557 }
558
559 static void *function_stat_start(struct tracer_stat *trace)
560 {
561         struct ftrace_profile_stat *stat =
562                 container_of(trace, struct ftrace_profile_stat, stat);
563
564         if (!stat || !stat->start)
565                 return NULL;
566
567         return function_stat_next(&stat->start->records[0], 0);
568 }
569
570 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
571 /* function graph compares on total time */
572 static int function_stat_cmp(void *p1, void *p2)
573 {
574         struct ftrace_profile *a = p1;
575         struct ftrace_profile *b = p2;
576
577         if (a->time < b->time)
578                 return -1;
579         if (a->time > b->time)
580                 return 1;
581         else
582                 return 0;
583 }
584 #else
585 /* not function graph compares against hits */
586 static int function_stat_cmp(void *p1, void *p2)
587 {
588         struct ftrace_profile *a = p1;
589         struct ftrace_profile *b = p2;
590
591         if (a->counter < b->counter)
592                 return -1;
593         if (a->counter > b->counter)
594                 return 1;
595         else
596                 return 0;
597 }
598 #endif
599
600 static int function_stat_headers(struct seq_file *m)
601 {
602 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
603         seq_printf(m, "  Function                               "
604                    "Hit    Time            Avg             s^2\n"
605                       "  --------                               "
606                    "---    ----            ---             ---\n");
607 #else
608         seq_printf(m, "  Function                               Hit\n"
609                       "  --------                               ---\n");
610 #endif
611         return 0;
612 }
613
614 static int function_stat_show(struct seq_file *m, void *v)
615 {
616         struct ftrace_profile *rec = v;
617         char str[KSYM_SYMBOL_LEN];
618         int ret = 0;
619 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
620         static struct trace_seq s;
621         unsigned long long avg;
622         unsigned long long stddev;
623 #endif
624         mutex_lock(&ftrace_profile_lock);
625
626         /* we raced with function_profile_reset() */
627         if (unlikely(rec->counter == 0)) {
628                 ret = -EBUSY;
629                 goto out;
630         }
631
632         kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
633         seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
634
635 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
636         seq_printf(m, "    ");
637         avg = rec->time;
638         do_div(avg, rec->counter);
639
640         /* Sample standard deviation (s^2) */
641         if (rec->counter <= 1)
642                 stddev = 0;
643         else {
644                 /*
645                  * Apply Welford's method:
646                  * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
647                  */
648                 stddev = rec->counter * rec->time_squared -
649                          rec->time * rec->time;
650
651                 /*
652                  * Divide only 1000 for ns^2 -> us^2 conversion.
653                  * trace_print_graph_duration will divide 1000 again.
654                  */
655                 do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
656         }
657
658         trace_seq_init(&s);
659         trace_print_graph_duration(rec->time, &s);
660         trace_seq_puts(&s, "    ");
661         trace_print_graph_duration(avg, &s);
662         trace_seq_puts(&s, "    ");
663         trace_print_graph_duration(stddev, &s);
664         trace_print_seq(m, &s);
665 #endif
666         seq_putc(m, '\n');
667 out:
668         mutex_unlock(&ftrace_profile_lock);
669
670         return ret;
671 }
672
673 static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
674 {
675         struct ftrace_profile_page *pg;
676
677         pg = stat->pages = stat->start;
678
679         while (pg) {
680                 memset(pg->records, 0, PROFILE_RECORDS_SIZE);
681                 pg->index = 0;
682                 pg = pg->next;
683         }
684
685         memset(stat->hash, 0,
686                FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
687 }
688
689 int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
690 {
691         struct ftrace_profile_page *pg;
692         int functions;
693         int pages;
694         int i;
695
696         /* If we already allocated, do nothing */
697         if (stat->pages)
698                 return 0;
699
700         stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
701         if (!stat->pages)
702                 return -ENOMEM;
703
704 #ifdef CONFIG_DYNAMIC_FTRACE
705         functions = ftrace_update_tot_cnt;
706 #else
707         /*
708          * We do not know the number of functions that exist because
709          * dynamic tracing is what counts them. With past experience
710          * we have around 20K functions. That should be more than enough.
711          * It is highly unlikely we will execute every function in
712          * the kernel.
713          */
714         functions = 20000;
715 #endif
716
717         pg = stat->start = stat->pages;
718
719         pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
720
721         for (i = 1; i < pages; i++) {
722                 pg->next = (void *)get_zeroed_page(GFP_KERNEL);
723                 if (!pg->next)
724                         goto out_free;
725                 pg = pg->next;
726         }
727
728         return 0;
729
730  out_free:
731         pg = stat->start;
732         while (pg) {
733                 unsigned long tmp = (unsigned long)pg;
734
735                 pg = pg->next;
736                 free_page(tmp);
737         }
738
739         stat->pages = NULL;
740         stat->start = NULL;
741
742         return -ENOMEM;
743 }
744
745 static int ftrace_profile_init_cpu(int cpu)
746 {
747         struct ftrace_profile_stat *stat;
748         int size;
749
750         stat = &per_cpu(ftrace_profile_stats, cpu);
751
752         if (stat->hash) {
753                 /* If the profile is already created, simply reset it */
754                 ftrace_profile_reset(stat);
755                 return 0;
756         }
757
758         /*
759          * We are profiling all functions, but usually only a few thousand
760          * functions are hit. We'll make a hash of 1024 items.
761          */
762         size = FTRACE_PROFILE_HASH_SIZE;
763
764         stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
765
766         if (!stat->hash)
767                 return -ENOMEM;
768
769         /* Preallocate the function profiling pages */
770         if (ftrace_profile_pages_init(stat) < 0) {
771                 kfree(stat->hash);
772                 stat->hash = NULL;
773                 return -ENOMEM;
774         }
775
776         return 0;
777 }
778
779 static int ftrace_profile_init(void)
780 {
781         int cpu;
782         int ret = 0;
783
784         for_each_online_cpu(cpu) {
785                 ret = ftrace_profile_init_cpu(cpu);
786                 if (ret)
787                         break;
788         }
789
790         return ret;
791 }
792
793 /* interrupts must be disabled */
794 static struct ftrace_profile *
795 ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
796 {
797         struct ftrace_profile *rec;
798         struct hlist_head *hhd;
799         unsigned long key;
800
801         key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
802         hhd = &stat->hash[key];
803
804         if (hlist_empty(hhd))
805                 return NULL;
806
807         hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
808                 if (rec->ip == ip)
809                         return rec;
810         }
811
812         return NULL;
813 }
814
815 static void ftrace_add_profile(struct ftrace_profile_stat *stat,
816                                struct ftrace_profile *rec)
817 {
818         unsigned long key;
819
820         key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
821         hlist_add_head_rcu(&rec->node, &stat->hash[key]);
822 }
823
824 /*
825  * The memory is already allocated, this simply finds a new record to use.
826  */
827 static struct ftrace_profile *
828 ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
829 {
830         struct ftrace_profile *rec = NULL;
831
832         /* prevent recursion (from NMIs) */
833         if (atomic_inc_return(&stat->disabled) != 1)
834                 goto out;
835
836         /*
837          * Try to find the function again since an NMI
838          * could have added it
839          */
840         rec = ftrace_find_profiled_func(stat, ip);
841         if (rec)
842                 goto out;
843
844         if (stat->pages->index == PROFILES_PER_PAGE) {
845                 if (!stat->pages->next)
846                         goto out;
847                 stat->pages = stat->pages->next;
848         }
849
850         rec = &stat->pages->records[stat->pages->index++];
851         rec->ip = ip;
852         ftrace_add_profile(stat, rec);
853
854  out:
855         atomic_dec(&stat->disabled);
856
857         return rec;
858 }
859
860 static void
861 function_profile_call(unsigned long ip, unsigned long parent_ip,
862                       struct ftrace_ops *ops, struct pt_regs *regs)
863 {
864         struct ftrace_profile_stat *stat;
865         struct ftrace_profile *rec;
866         unsigned long flags;
867
868         if (!ftrace_profile_enabled)
869                 return;
870
871         local_irq_save(flags);
872
873         stat = &__get_cpu_var(ftrace_profile_stats);
874         if (!stat->hash || !ftrace_profile_enabled)
875                 goto out;
876
877         rec = ftrace_find_profiled_func(stat, ip);
878         if (!rec) {
879                 rec = ftrace_profile_alloc(stat, ip);
880                 if (!rec)
881                         goto out;
882         }
883
884         rec->counter++;
885  out:
886         local_irq_restore(flags);
887 }
888
889 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
890 static int profile_graph_entry(struct ftrace_graph_ent *trace)
891 {
892         function_profile_call(trace->func, 0, NULL, NULL);
893         return 1;
894 }
895
896 static void profile_graph_return(struct ftrace_graph_ret *trace)
897 {
898         struct ftrace_profile_stat *stat;
899         unsigned long long calltime;
900         struct ftrace_profile *rec;
901         unsigned long flags;
902
903         local_irq_save(flags);
904         stat = &__get_cpu_var(ftrace_profile_stats);
905         if (!stat->hash || !ftrace_profile_enabled)
906                 goto out;
907
908         /* If the calltime was zero'd ignore it */
909         if (!trace->calltime)
910                 goto out;
911
912         calltime = trace->rettime - trace->calltime;
913
914         if (!(trace_flags & TRACE_ITER_GRAPH_TIME)) {
915                 int index;
916
917                 index = trace->depth;
918
919                 /* Append this call time to the parent time to subtract */
920                 if (index)
921                         current->ret_stack[index - 1].subtime += calltime;
922
923                 if (current->ret_stack[index].subtime < calltime)
924                         calltime -= current->ret_stack[index].subtime;
925                 else
926                         calltime = 0;
927         }
928
929         rec = ftrace_find_profiled_func(stat, trace->func);
930         if (rec) {
931                 rec->time += calltime;
932                 rec->time_squared += calltime * calltime;
933         }
934
935  out:
936         local_irq_restore(flags);
937 }
938
939 static int register_ftrace_profiler(void)
940 {
941         return register_ftrace_graph(&profile_graph_return,
942                                      &profile_graph_entry);
943 }
944
945 static void unregister_ftrace_profiler(void)
946 {
947         unregister_ftrace_graph();
948 }
949 #else
950 static struct ftrace_ops ftrace_profile_ops __read_mostly = {
951         .func           = function_profile_call,
952         .flags          = FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
953         INIT_REGEX_LOCK(ftrace_profile_ops)
954 };
955
956 static int register_ftrace_profiler(void)
957 {
958         return register_ftrace_function(&ftrace_profile_ops);
959 }
960
961 static void unregister_ftrace_profiler(void)
962 {
963         unregister_ftrace_function(&ftrace_profile_ops);
964 }
965 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
966
967 static ssize_t
968 ftrace_profile_write(struct file *filp, const char __user *ubuf,
969                      size_t cnt, loff_t *ppos)
970 {
971         unsigned long val;
972         int ret;
973
974         ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
975         if (ret)
976                 return ret;
977
978         val = !!val;
979
980         mutex_lock(&ftrace_profile_lock);
981         if (ftrace_profile_enabled ^ val) {
982                 if (val) {
983                         ret = ftrace_profile_init();
984                         if (ret < 0) {
985                                 cnt = ret;
986                                 goto out;
987                         }
988
989                         ret = register_ftrace_profiler();
990                         if (ret < 0) {
991                                 cnt = ret;
992                                 goto out;
993                         }
994                         ftrace_profile_enabled = 1;
995                 } else {
996                         ftrace_profile_enabled = 0;
997                         /*
998                          * unregister_ftrace_profiler calls stop_machine
999                          * so this acts like an synchronize_sched.
1000                          */
1001                         unregister_ftrace_profiler();
1002                 }
1003         }
1004  out:
1005         mutex_unlock(&ftrace_profile_lock);
1006
1007         *ppos += cnt;
1008
1009         return cnt;
1010 }
1011
1012 static ssize_t
1013 ftrace_profile_read(struct file *filp, char __user *ubuf,
1014                      size_t cnt, loff_t *ppos)
1015 {
1016         char buf[64];           /* big enough to hold a number */
1017         int r;
1018
1019         r = sprintf(buf, "%u\n", ftrace_profile_enabled);
1020         return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
1021 }
1022
1023 static const struct file_operations ftrace_profile_fops = {
1024         .open           = tracing_open_generic,
1025         .read           = ftrace_profile_read,
1026         .write          = ftrace_profile_write,
1027         .llseek         = default_llseek,
1028 };
1029
1030 /* used to initialize the real stat files */
1031 static struct tracer_stat function_stats __initdata = {
1032         .name           = "functions",
1033         .stat_start     = function_stat_start,
1034         .stat_next      = function_stat_next,
1035         .stat_cmp       = function_stat_cmp,
1036         .stat_headers   = function_stat_headers,
1037         .stat_show      = function_stat_show
1038 };
1039
1040 static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
1041 {
1042         struct ftrace_profile_stat *stat;
1043         struct dentry *entry;
1044         char *name;
1045         int ret;
1046         int cpu;
1047
1048         for_each_possible_cpu(cpu) {
1049                 stat = &per_cpu(ftrace_profile_stats, cpu);
1050
1051                 /* allocate enough for function name + cpu number */
1052                 name = kmalloc(32, GFP_KERNEL);
1053                 if (!name) {
1054                         /*
1055                          * The files created are permanent, if something happens
1056                          * we still do not free memory.
1057                          */
1058                         WARN(1,
1059                              "Could not allocate stat file for cpu %d\n",
1060                              cpu);
1061                         return;
1062                 }
1063                 stat->stat = function_stats;
1064                 snprintf(name, 32, "function%d", cpu);
1065                 stat->stat.name = name;
1066                 ret = register_stat_tracer(&stat->stat);
1067                 if (ret) {
1068                         WARN(1,
1069                              "Could not register function stat for cpu %d\n",
1070                              cpu);
1071                         kfree(name);
1072                         return;
1073                 }
1074         }
1075
1076         entry = debugfs_create_file("function_profile_enabled", 0644,
1077                                     d_tracer, NULL, &ftrace_profile_fops);
1078         if (!entry)
1079                 pr_warning("Could not create debugfs "
1080                            "'function_profile_enabled' entry\n");
1081 }
1082
1083 #else /* CONFIG_FUNCTION_PROFILER */
1084 static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
1085 {
1086 }
1087 #endif /* CONFIG_FUNCTION_PROFILER */
1088
1089 static struct pid * const ftrace_swapper_pid = &init_struct_pid;
1090
1091 loff_t
1092 ftrace_filter_lseek(struct file *file, loff_t offset, int whence)
1093 {
1094         loff_t ret;
1095
1096         if (file->f_mode & FMODE_READ)
1097                 ret = seq_lseek(file, offset, whence);
1098         else
1099                 file->f_pos = ret = 1;
1100
1101         return ret;
1102 }
1103
1104 #ifdef CONFIG_DYNAMIC_FTRACE
1105
1106 #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1107 # error Dynamic ftrace depends on MCOUNT_RECORD
1108 #endif
1109
1110 static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
1111
1112 struct ftrace_func_probe {
1113         struct hlist_node       node;
1114         struct ftrace_probe_ops *ops;
1115         unsigned long           flags;
1116         unsigned long           ip;
1117         void                    *data;
1118         struct list_head        free_list;
1119 };
1120
1121 struct ftrace_func_entry {
1122         struct hlist_node hlist;
1123         unsigned long ip;
1124 };
1125
1126 struct ftrace_hash {
1127         unsigned long           size_bits;
1128         struct hlist_head       *buckets;
1129         unsigned long           count;
1130         struct rcu_head         rcu;
1131 };
1132
1133 /*
1134  * We make these constant because no one should touch them,
1135  * but they are used as the default "empty hash", to avoid allocating
1136  * it all the time. These are in a read only section such that if
1137  * anyone does try to modify it, it will cause an exception.
1138  */
1139 static const struct hlist_head empty_buckets[1];
1140 static const struct ftrace_hash empty_hash = {
1141         .buckets = (struct hlist_head *)empty_buckets,
1142 };
1143 #define EMPTY_HASH      ((struct ftrace_hash *)&empty_hash)
1144
1145 static struct ftrace_ops global_ops = {
1146         .func                   = ftrace_stub,
1147         .notrace_hash           = EMPTY_HASH,
1148         .filter_hash            = EMPTY_HASH,
1149         .flags                  = FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
1150         INIT_REGEX_LOCK(global_ops)
1151 };
1152
1153 struct ftrace_page {
1154         struct ftrace_page      *next;
1155         struct dyn_ftrace       *records;
1156         int                     index;
1157         int                     size;
1158 };
1159
1160 static struct ftrace_page *ftrace_new_pgs;
1161
1162 #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1163 #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
1164
1165 /* estimate from running different kernels */
1166 #define NR_TO_INIT              10000
1167
1168 static struct ftrace_page       *ftrace_pages_start;
1169 static struct ftrace_page       *ftrace_pages;
1170
1171 static bool ftrace_hash_empty(struct ftrace_hash *hash)
1172 {
1173         return !hash || !hash->count;
1174 }
1175
1176 static struct ftrace_func_entry *
1177 ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1178 {
1179         unsigned long key;
1180         struct ftrace_func_entry *entry;
1181         struct hlist_head *hhd;
1182
1183         if (ftrace_hash_empty(hash))
1184                 return NULL;
1185
1186         if (hash->size_bits > 0)
1187                 key = hash_long(ip, hash->size_bits);
1188         else
1189                 key = 0;
1190
1191         hhd = &hash->buckets[key];
1192
1193         hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1194                 if (entry->ip == ip)
1195                         return entry;
1196         }
1197         return NULL;
1198 }
1199
1200 static void __add_hash_entry(struct ftrace_hash *hash,
1201                              struct ftrace_func_entry *entry)
1202 {
1203         struct hlist_head *hhd;
1204         unsigned long key;
1205
1206         if (hash->size_bits)
1207                 key = hash_long(entry->ip, hash->size_bits);
1208         else
1209                 key = 0;
1210
1211         hhd = &hash->buckets[key];
1212         hlist_add_head(&entry->hlist, hhd);
1213         hash->count++;
1214 }
1215
1216 static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1217 {
1218         struct ftrace_func_entry *entry;
1219
1220         entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1221         if (!entry)
1222                 return -ENOMEM;
1223
1224         entry->ip = ip;
1225         __add_hash_entry(hash, entry);
1226
1227         return 0;
1228 }
1229
1230 static void
1231 free_hash_entry(struct ftrace_hash *hash,
1232                   struct ftrace_func_entry *entry)
1233 {
1234         hlist_del(&entry->hlist);
1235         kfree(entry);
1236         hash->count--;
1237 }
1238
1239 static void
1240 remove_hash_entry(struct ftrace_hash *hash,
1241                   struct ftrace_func_entry *entry)
1242 {
1243         hlist_del(&entry->hlist);
1244         hash->count--;
1245 }
1246
1247 static void ftrace_hash_clear(struct ftrace_hash *hash)
1248 {
1249         struct hlist_head *hhd;
1250         struct hlist_node *tn;
1251         struct ftrace_func_entry *entry;
1252         int size = 1 << hash->size_bits;
1253         int i;
1254
1255         if (!hash->count)
1256                 return;
1257
1258         for (i = 0; i < size; i++) {
1259                 hhd = &hash->buckets[i];
1260                 hlist_for_each_entry_safe(entry, tn, hhd, hlist)
1261                         free_hash_entry(hash, entry);
1262         }
1263         FTRACE_WARN_ON(hash->count);
1264 }
1265
1266 static void free_ftrace_hash(struct ftrace_hash *hash)
1267 {
1268         if (!hash || hash == EMPTY_HASH)
1269                 return;
1270         ftrace_hash_clear(hash);
1271         kfree(hash->buckets);
1272         kfree(hash);
1273 }
1274
1275 static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
1276 {
1277         struct ftrace_hash *hash;
1278
1279         hash = container_of(rcu, struct ftrace_hash, rcu);
1280         free_ftrace_hash(hash);
1281 }
1282
1283 static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
1284 {
1285         if (!hash || hash == EMPTY_HASH)
1286                 return;
1287         call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
1288 }
1289
1290 void ftrace_free_filter(struct ftrace_ops *ops)
1291 {
1292         ftrace_ops_init(ops);
1293         free_ftrace_hash(ops->filter_hash);
1294         free_ftrace_hash(ops->notrace_hash);
1295 }
1296
1297 static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
1298 {
1299         struct ftrace_hash *hash;
1300         int size;
1301
1302         hash = kzalloc(sizeof(*hash), GFP_KERNEL);
1303         if (!hash)
1304                 return NULL;
1305
1306         size = 1 << size_bits;
1307         hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
1308
1309         if (!hash->buckets) {
1310                 kfree(hash);
1311                 return NULL;
1312         }
1313
1314         hash->size_bits = size_bits;
1315
1316         return hash;
1317 }
1318
1319 static struct ftrace_hash *
1320 alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
1321 {
1322         struct ftrace_func_entry *entry;
1323         struct ftrace_hash *new_hash;
1324         int size;
1325         int ret;
1326         int i;
1327
1328         new_hash = alloc_ftrace_hash(size_bits);
1329         if (!new_hash)
1330                 return NULL;
1331
1332         /* Empty hash? */
1333         if (ftrace_hash_empty(hash))
1334                 return new_hash;
1335
1336         size = 1 << hash->size_bits;
1337         for (i = 0; i < size; i++) {
1338                 hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
1339                         ret = add_hash_entry(new_hash, entry->ip);
1340                         if (ret < 0)
1341                                 goto free_hash;
1342                 }
1343         }
1344
1345         FTRACE_WARN_ON(new_hash->count != hash->count);
1346
1347         return new_hash;
1348
1349  free_hash:
1350         free_ftrace_hash(new_hash);
1351         return NULL;
1352 }
1353
1354 static void
1355 ftrace_hash_rec_disable(struct ftrace_ops *ops, int filter_hash);
1356 static void
1357 ftrace_hash_rec_enable(struct ftrace_ops *ops, int filter_hash);
1358
1359 static int
1360 ftrace_hash_move(struct ftrace_ops *ops, int enable,
1361                  struct ftrace_hash **dst, struct ftrace_hash *src)
1362 {
1363         struct ftrace_func_entry *entry;
1364         struct hlist_node *tn;
1365         struct hlist_head *hhd;
1366         struct ftrace_hash *old_hash;
1367         struct ftrace_hash *new_hash;
1368         int size = src->count;
1369         int bits = 0;
1370         int ret;
1371         int i;
1372
1373         /*
1374          * Remove the current set, update the hash and add
1375          * them back.
1376          */
1377         ftrace_hash_rec_disable(ops, enable);
1378
1379         /*
1380          * If the new source is empty, just free dst and assign it
1381          * the empty_hash.
1382          */
1383         if (!src->count) {
1384                 free_ftrace_hash_rcu(*dst);
1385                 rcu_assign_pointer(*dst, EMPTY_HASH);
1386                 /* still need to update the function records */
1387                 ret = 0;
1388                 goto out;
1389         }
1390
1391         /*
1392          * Make the hash size about 1/2 the # found
1393          */
1394         for (size /= 2; size; size >>= 1)
1395                 bits++;
1396
1397         /* Don't allocate too much */
1398         if (bits > FTRACE_HASH_MAX_BITS)
1399                 bits = FTRACE_HASH_MAX_BITS;
1400
1401         ret = -ENOMEM;
1402         new_hash = alloc_ftrace_hash(bits);
1403         if (!new_hash)
1404                 goto out;
1405
1406         size = 1 << src->size_bits;
1407         for (i = 0; i < size; i++) {
1408                 hhd = &src->buckets[i];
1409                 hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
1410                         remove_hash_entry(src, entry);
1411                         __add_hash_entry(new_hash, entry);
1412                 }
1413         }
1414
1415         old_hash = *dst;
1416         rcu_assign_pointer(*dst, new_hash);
1417         free_ftrace_hash_rcu(old_hash);
1418
1419         ret = 0;
1420  out:
1421         /*
1422          * Enable regardless of ret:
1423          *  On success, we enable the new hash.
1424          *  On failure, we re-enable the original hash.
1425          */
1426         ftrace_hash_rec_enable(ops, enable);
1427
1428         return ret;
1429 }
1430
1431 /*
1432  * Test the hashes for this ops to see if we want to call
1433  * the ops->func or not.
1434  *
1435  * It's a match if the ip is in the ops->filter_hash or
1436  * the filter_hash does not exist or is empty,
1437  *  AND
1438  * the ip is not in the ops->notrace_hash.
1439  *
1440  * This needs to be called with preemption disabled as
1441  * the hashes are freed with call_rcu_sched().
1442  */
1443 static int
1444 ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1445 {
1446         struct ftrace_hash *filter_hash;
1447         struct ftrace_hash *notrace_hash;
1448         int ret;
1449
1450 #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1451         /*
1452          * There's a small race when adding ops that the ftrace handler
1453          * that wants regs, may be called without them. We can not
1454          * allow that handler to be called if regs is NULL.
1455          */
1456         if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1457                 return 0;
1458 #endif
1459
1460         filter_hash = rcu_dereference_raw_notrace(ops->filter_hash);
1461         notrace_hash = rcu_dereference_raw_notrace(ops->notrace_hash);
1462
1463         if ((ftrace_hash_empty(filter_hash) ||
1464              ftrace_lookup_ip(filter_hash, ip)) &&
1465             (ftrace_hash_empty(notrace_hash) ||
1466              !ftrace_lookup_ip(notrace_hash, ip)))
1467                 ret = 1;
1468         else
1469                 ret = 0;
1470
1471         return ret;
1472 }
1473
1474 /*
1475  * This is a double for. Do not use 'break' to break out of the loop,
1476  * you must use a goto.
1477  */
1478 #define do_for_each_ftrace_rec(pg, rec)                                 \
1479         for (pg = ftrace_pages_start; pg; pg = pg->next) {              \
1480                 int _____i;                                             \
1481                 for (_____i = 0; _____i < pg->index; _____i++) {        \
1482                         rec = &pg->records[_____i];
1483
1484 #define while_for_each_ftrace_rec()             \
1485                 }                               \
1486         }
1487
1488
1489 static int ftrace_cmp_recs(const void *a, const void *b)
1490 {
1491         const struct dyn_ftrace *key = a;
1492         const struct dyn_ftrace *rec = b;
1493
1494         if (key->flags < rec->ip)
1495                 return -1;
1496         if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1497                 return 1;
1498         return 0;
1499 }
1500
1501 static unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1502 {
1503         struct ftrace_page *pg;
1504         struct dyn_ftrace *rec;
1505         struct dyn_ftrace key;
1506
1507         key.ip = start;
1508         key.flags = end;        /* overload flags, as it is unsigned long */
1509
1510         for (pg = ftrace_pages_start; pg; pg = pg->next) {
1511                 if (end < pg->records[0].ip ||
1512                     start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1513                         continue;
1514                 rec = bsearch(&key, pg->records, pg->index,
1515                               sizeof(struct dyn_ftrace),
1516                               ftrace_cmp_recs);
1517                 if (rec)
1518                         return rec->ip;
1519         }
1520
1521         return 0;
1522 }
1523
1524 /**
1525  * ftrace_location - return true if the ip giving is a traced location
1526  * @ip: the instruction pointer to check
1527  *
1528  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1529  * That is, the instruction that is either a NOP or call to
1530  * the function tracer. It checks the ftrace internal tables to
1531  * determine if the address belongs or not.
1532  */
1533 unsigned long ftrace_location(unsigned long ip)
1534 {
1535         return ftrace_location_range(ip, ip);
1536 }
1537
1538 /**
1539  * ftrace_text_reserved - return true if range contains an ftrace location
1540  * @start: start of range to search
1541  * @end: end of range to search (inclusive). @end points to the last byte to check.
1542  *
1543  * Returns 1 if @start and @end contains a ftrace location.
1544  * That is, the instruction that is either a NOP or call to
1545  * the function tracer. It checks the ftrace internal tables to
1546  * determine if the address belongs or not.
1547  */
1548 int ftrace_text_reserved(void *start, void *end)
1549 {
1550         unsigned long ret;
1551
1552         ret = ftrace_location_range((unsigned long)start,
1553                                     (unsigned long)end);
1554
1555         return (int)!!ret;
1556 }
1557
1558 static void __ftrace_hash_rec_update(struct ftrace_ops *ops,
1559                                      int filter_hash,
1560                                      bool inc)
1561 {
1562         struct ftrace_hash *hash;
1563         struct ftrace_hash *other_hash;
1564         struct ftrace_page *pg;
1565         struct dyn_ftrace *rec;
1566         int count = 0;
1567         int all = 0;
1568
1569         /* Only update if the ops has been registered */
1570         if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1571                 return;
1572
1573         /*
1574          * In the filter_hash case:
1575          *   If the count is zero, we update all records.
1576          *   Otherwise we just update the items in the hash.
1577          *
1578          * In the notrace_hash case:
1579          *   We enable the update in the hash.
1580          *   As disabling notrace means enabling the tracing,
1581          *   and enabling notrace means disabling, the inc variable
1582          *   gets inversed.
1583          */
1584         if (filter_hash) {
1585                 hash = ops->filter_hash;
1586                 other_hash = ops->notrace_hash;
1587                 if (ftrace_hash_empty(hash))
1588                         all = 1;
1589         } else {
1590                 inc = !inc;
1591                 hash = ops->notrace_hash;
1592                 other_hash = ops->filter_hash;
1593                 /*
1594                  * If the notrace hash has no items,
1595                  * then there's nothing to do.
1596                  */
1597                 if (ftrace_hash_empty(hash))
1598                         return;
1599         }
1600
1601         do_for_each_ftrace_rec(pg, rec) {
1602                 int in_other_hash = 0;
1603                 int in_hash = 0;
1604                 int match = 0;
1605
1606                 if (all) {
1607                         /*
1608                          * Only the filter_hash affects all records.
1609                          * Update if the record is not in the notrace hash.
1610                          */
1611                         if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1612                                 match = 1;
1613                 } else {
1614                         in_hash = !!ftrace_lookup_ip(hash, rec->ip);
1615                         in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1616
1617                         /*
1618                          *
1619                          */
1620                         if (filter_hash && in_hash && !in_other_hash)
1621                                 match = 1;
1622                         else if (!filter_hash && in_hash &&
1623                                  (in_other_hash || ftrace_hash_empty(other_hash)))
1624                                 match = 1;
1625                 }
1626                 if (!match)
1627                         continue;
1628
1629                 if (inc) {
1630                         rec->flags++;
1631                         if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == FTRACE_REF_MAX))
1632                                 return;
1633                         /*
1634                          * If any ops wants regs saved for this function
1635                          * then all ops will get saved regs.
1636                          */
1637                         if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
1638                                 rec->flags |= FTRACE_FL_REGS;
1639                 } else {
1640                         if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == 0))
1641                                 return;
1642                         rec->flags--;
1643                 }
1644                 count++;
1645                 /* Shortcut, if we handled all records, we are done. */
1646                 if (!all && count == hash->count)
1647                         return;
1648         } while_for_each_ftrace_rec();
1649 }
1650
1651 static void ftrace_hash_rec_disable(struct ftrace_ops *ops,
1652                                     int filter_hash)
1653 {
1654         __ftrace_hash_rec_update(ops, filter_hash, 0);
1655 }
1656
1657 static void ftrace_hash_rec_enable(struct ftrace_ops *ops,
1658                                    int filter_hash)
1659 {
1660         __ftrace_hash_rec_update(ops, filter_hash, 1);
1661 }
1662
1663 static void print_ip_ins(const char *fmt, unsigned char *p)
1664 {
1665         int i;
1666
1667         printk(KERN_CONT "%s", fmt);
1668
1669         for (i = 0; i < MCOUNT_INSN_SIZE; i++)
1670                 printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
1671 }
1672
1673 /**
1674  * ftrace_bug - report and shutdown function tracer
1675  * @failed: The failed type (EFAULT, EINVAL, EPERM)
1676  * @ip: The address that failed
1677  *
1678  * The arch code that enables or disables the function tracing
1679  * can call ftrace_bug() when it has detected a problem in
1680  * modifying the code. @failed should be one of either:
1681  * EFAULT - if the problem happens on reading the @ip address
1682  * EINVAL - if what is read at @ip is not what was expected
1683  * EPERM - if the problem happens on writting to the @ip address
1684  */
1685 void ftrace_bug(int failed, unsigned long ip)
1686 {
1687         switch (failed) {
1688         case -EFAULT:
1689                 FTRACE_WARN_ON_ONCE(1);
1690                 pr_info("ftrace faulted on modifying ");
1691                 print_ip_sym(ip);
1692                 break;
1693         case -EINVAL:
1694                 FTRACE_WARN_ON_ONCE(1);
1695                 pr_info("ftrace failed to modify ");
1696                 print_ip_sym(ip);
1697                 print_ip_ins(" actual: ", (unsigned char *)ip);
1698                 printk(KERN_CONT "\n");
1699                 break;
1700         case -EPERM:
1701                 FTRACE_WARN_ON_ONCE(1);
1702                 pr_info("ftrace faulted on writing ");
1703                 print_ip_sym(ip);
1704                 break;
1705         default:
1706                 FTRACE_WARN_ON_ONCE(1);
1707                 pr_info("ftrace faulted on unknown error ");
1708                 print_ip_sym(ip);
1709         }
1710 }
1711
1712 static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
1713 {
1714         unsigned long flag = 0UL;
1715
1716         /*
1717          * If we are updating calls:
1718          *
1719          *   If the record has a ref count, then we need to enable it
1720          *   because someone is using it.
1721          *
1722          *   Otherwise we make sure its disabled.
1723          *
1724          * If we are disabling calls, then disable all records that
1725          * are enabled.
1726          */
1727         if (enable && (rec->flags & ~FTRACE_FL_MASK))
1728                 flag = FTRACE_FL_ENABLED;
1729
1730         /*
1731          * If enabling and the REGS flag does not match the REGS_EN, then
1732          * do not ignore this record. Set flags to fail the compare against
1733          * ENABLED.
1734          */
1735         if (flag &&
1736             (!(rec->flags & FTRACE_FL_REGS) != !(rec->flags & FTRACE_FL_REGS_EN)))
1737                 flag |= FTRACE_FL_REGS;
1738
1739         /* If the state of this record hasn't changed, then do nothing */
1740         if ((rec->flags & FTRACE_FL_ENABLED) == flag)
1741                 return FTRACE_UPDATE_IGNORE;
1742
1743         if (flag) {
1744                 /* Save off if rec is being enabled (for return value) */
1745                 flag ^= rec->flags & FTRACE_FL_ENABLED;
1746
1747                 if (update) {
1748                         rec->flags |= FTRACE_FL_ENABLED;
1749                         if (flag & FTRACE_FL_REGS) {
1750                                 if (rec->flags & FTRACE_FL_REGS)
1751                                         rec->flags |= FTRACE_FL_REGS_EN;
1752                                 else
1753                                         rec->flags &= ~FTRACE_FL_REGS_EN;
1754                         }
1755                 }
1756
1757                 /*
1758                  * If this record is being updated from a nop, then
1759                  *   return UPDATE_MAKE_CALL.
1760                  * Otherwise, if the EN flag is set, then return
1761                  *   UPDATE_MODIFY_CALL_REGS to tell the caller to convert
1762                  *   from the non-save regs, to a save regs function.
1763                  * Otherwise,
1764                  *   return UPDATE_MODIFY_CALL to tell the caller to convert
1765                  *   from the save regs, to a non-save regs function.
1766                  */
1767                 if (flag & FTRACE_FL_ENABLED)
1768                         return FTRACE_UPDATE_MAKE_CALL;
1769                 else if (rec->flags & FTRACE_FL_REGS_EN)
1770                         return FTRACE_UPDATE_MODIFY_CALL_REGS;
1771                 else
1772                         return FTRACE_UPDATE_MODIFY_CALL;
1773         }
1774
1775         if (update) {
1776                 /* If there's no more users, clear all flags */
1777                 if (!(rec->flags & ~FTRACE_FL_MASK))
1778                         rec->flags = 0;
1779                 else
1780                         /* Just disable the record (keep REGS state) */
1781                         rec->flags &= ~FTRACE_FL_ENABLED;
1782         }
1783
1784         return FTRACE_UPDATE_MAKE_NOP;
1785 }
1786
1787 /**
1788  * ftrace_update_record, set a record that now is tracing or not
1789  * @rec: the record to update
1790  * @enable: set to 1 if the record is tracing, zero to force disable
1791  *
1792  * The records that represent all functions that can be traced need
1793  * to be updated when tracing has been enabled.
1794  */
1795 int ftrace_update_record(struct dyn_ftrace *rec, int enable)
1796 {
1797         return ftrace_check_record(rec, enable, 1);
1798 }
1799
1800 /**
1801  * ftrace_test_record, check if the record has been enabled or not
1802  * @rec: the record to test
1803  * @enable: set to 1 to check if enabled, 0 if it is disabled
1804  *
1805  * The arch code may need to test if a record is already set to
1806  * tracing to determine how to modify the function code that it
1807  * represents.
1808  */
1809 int ftrace_test_record(struct dyn_ftrace *rec, int enable)
1810 {
1811         return ftrace_check_record(rec, enable, 0);
1812 }
1813
1814 static int
1815 __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
1816 {
1817         unsigned long ftrace_old_addr;
1818         unsigned long ftrace_addr;
1819         int ret;
1820
1821         ret = ftrace_update_record(rec, enable);
1822
1823         if (rec->flags & FTRACE_FL_REGS)
1824                 ftrace_addr = (unsigned long)FTRACE_REGS_ADDR;
1825         else
1826                 ftrace_addr = (unsigned long)FTRACE_ADDR;
1827
1828         switch (ret) {
1829         case FTRACE_UPDATE_IGNORE:
1830                 return 0;
1831
1832         case FTRACE_UPDATE_MAKE_CALL:
1833                 return ftrace_make_call(rec, ftrace_addr);
1834
1835         case FTRACE_UPDATE_MAKE_NOP:
1836                 return ftrace_make_nop(NULL, rec, ftrace_addr);
1837
1838         case FTRACE_UPDATE_MODIFY_CALL_REGS:
1839         case FTRACE_UPDATE_MODIFY_CALL:
1840                 if (rec->flags & FTRACE_FL_REGS)
1841                         ftrace_old_addr = (unsigned long)FTRACE_ADDR;
1842                 else
1843                         ftrace_old_addr = (unsigned long)FTRACE_REGS_ADDR;
1844
1845                 return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
1846         }
1847
1848         return -1; /* unknow ftrace bug */
1849 }
1850
1851 void __weak ftrace_replace_code(int enable)
1852 {
1853         struct dyn_ftrace *rec;
1854         struct ftrace_page *pg;
1855         int failed;
1856
1857         if (unlikely(ftrace_disabled))
1858                 return;
1859
1860         do_for_each_ftrace_rec(pg, rec) {
1861                 failed = __ftrace_replace_code(rec, enable);
1862                 if (failed) {
1863                         ftrace_bug(failed, rec->ip);
1864                         /* Stop processing */
1865                         return;
1866                 }
1867         } while_for_each_ftrace_rec();
1868 }
1869
1870 struct ftrace_rec_iter {
1871         struct ftrace_page      *pg;
1872         int                     index;
1873 };
1874
1875 /**
1876  * ftrace_rec_iter_start, start up iterating over traced functions
1877  *
1878  * Returns an iterator handle that is used to iterate over all
1879  * the records that represent address locations where functions
1880  * are traced.
1881  *
1882  * May return NULL if no records are available.
1883  */
1884 struct ftrace_rec_iter *ftrace_rec_iter_start(void)
1885 {
1886         /*
1887          * We only use a single iterator.
1888          * Protected by the ftrace_lock mutex.
1889          */
1890         static struct ftrace_rec_iter ftrace_rec_iter;
1891         struct ftrace_rec_iter *iter = &ftrace_rec_iter;
1892
1893         iter->pg = ftrace_pages_start;
1894         iter->index = 0;
1895
1896         /* Could have empty pages */
1897         while (iter->pg && !iter->pg->index)
1898                 iter->pg = iter->pg->next;
1899
1900         if (!iter->pg)
1901                 return NULL;
1902
1903         return iter;
1904 }
1905
1906 /**
1907  * ftrace_rec_iter_next, get the next record to process.
1908  * @iter: The handle to the iterator.
1909  *
1910  * Returns the next iterator after the given iterator @iter.
1911  */
1912 struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
1913 {
1914         iter->index++;
1915
1916         if (iter->index >= iter->pg->index) {
1917                 iter->pg = iter->pg->next;
1918                 iter->index = 0;
1919
1920                 /* Could have empty pages */
1921                 while (iter->pg && !iter->pg->index)
1922                         iter->pg = iter->pg->next;
1923         }
1924
1925         if (!iter->pg)
1926                 return NULL;
1927
1928         return iter;
1929 }
1930
1931 /**
1932  * ftrace_rec_iter_record, get the record at the iterator location
1933  * @iter: The current iterator location
1934  *
1935  * Returns the record that the current @iter is at.
1936  */
1937 struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
1938 {
1939         return &iter->pg->records[iter->index];
1940 }
1941
1942 static int
1943 ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
1944 {
1945         unsigned long ip;
1946         int ret;
1947
1948         ip = rec->ip;
1949
1950         if (unlikely(ftrace_disabled))
1951                 return 0;
1952
1953         ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
1954         if (ret) {
1955                 ftrace_bug(ret, ip);
1956                 return 0;
1957         }
1958         return 1;
1959 }
1960
1961 /*
1962  * archs can override this function if they must do something
1963  * before the modifying code is performed.
1964  */
1965 int __weak ftrace_arch_code_modify_prepare(void)
1966 {
1967         return 0;
1968 }
1969
1970 /*
1971  * archs can override this function if they must do something
1972  * after the modifying code is performed.
1973  */
1974 int __weak ftrace_arch_code_modify_post_process(void)
1975 {
1976         return 0;
1977 }
1978
1979 void ftrace_modify_all_code(int command)
1980 {
1981         int update = command & FTRACE_UPDATE_TRACE_FUNC;
1982
1983         /*
1984          * If the ftrace_caller calls a ftrace_ops func directly,
1985          * we need to make sure that it only traces functions it
1986          * expects to trace. When doing the switch of functions,
1987          * we need to update to the ftrace_ops_list_func first
1988          * before the transition between old and new calls are set,
1989          * as the ftrace_ops_list_func will check the ops hashes
1990          * to make sure the ops are having the right functions
1991          * traced.
1992          */
1993         if (update)
1994                 ftrace_update_ftrace_func(ftrace_ops_list_func);
1995
1996         if (command & FTRACE_UPDATE_CALLS)
1997                 ftrace_replace_code(1);
1998         else if (command & FTRACE_DISABLE_CALLS)
1999                 ftrace_replace_code(0);
2000
2001         if (update && ftrace_trace_function != ftrace_ops_list_func)
2002                 ftrace_update_ftrace_func(ftrace_trace_function);
2003
2004         if (command & FTRACE_START_FUNC_RET)
2005                 ftrace_enable_ftrace_graph_caller();
2006         else if (command & FTRACE_STOP_FUNC_RET)
2007                 ftrace_disable_ftrace_graph_caller();
2008 }
2009
2010 static int __ftrace_modify_code(void *data)
2011 {
2012         int *command = data;
2013
2014         ftrace_modify_all_code(*command);
2015
2016         return 0;
2017 }
2018
2019 /**
2020  * ftrace_run_stop_machine, go back to the stop machine method
2021  * @command: The command to tell ftrace what to do
2022  *
2023  * If an arch needs to fall back to the stop machine method, the
2024  * it can call this function.
2025  */
2026 void ftrace_run_stop_machine(int command)
2027 {
2028         stop_machine(__ftrace_modify_code, &command, NULL);
2029 }
2030
2031 /**
2032  * arch_ftrace_update_code, modify the code to trace or not trace
2033  * @command: The command that needs to be done
2034  *
2035  * Archs can override this function if it does not need to
2036  * run stop_machine() to modify code.
2037  */
2038 void __weak arch_ftrace_update_code(int command)
2039 {
2040         ftrace_run_stop_machine(command);
2041 }
2042
2043 static void ftrace_run_update_code(int command)
2044 {
2045         int ret;
2046
2047         ret = ftrace_arch_code_modify_prepare();
2048         FTRACE_WARN_ON(ret);
2049         if (ret)
2050                 return;
2051         /*
2052          * Do not call function tracer while we update the code.
2053          * We are in stop machine.
2054          */
2055         function_trace_stop++;
2056
2057         /*
2058          * By default we use stop_machine() to modify the code.
2059          * But archs can do what ever they want as long as it
2060          * is safe. The stop_machine() is the safest, but also
2061          * produces the most overhead.
2062          */
2063         arch_ftrace_update_code(command);
2064
2065         function_trace_stop--;
2066
2067         ret = ftrace_arch_code_modify_post_process();
2068         FTRACE_WARN_ON(ret);
2069 }
2070
2071 static ftrace_func_t saved_ftrace_func;
2072 static int ftrace_start_up;
2073 static int global_start_up;
2074
2075 static void ftrace_startup_enable(int command)
2076 {
2077         if (saved_ftrace_func != ftrace_trace_function) {
2078                 saved_ftrace_func = ftrace_trace_function;
2079                 command |= FTRACE_UPDATE_TRACE_FUNC;
2080         }
2081
2082         if (!command || !ftrace_enabled)
2083                 return;
2084
2085         ftrace_run_update_code(command);
2086 }
2087
2088 static int ftrace_startup(struct ftrace_ops *ops, int command)
2089 {
2090         bool hash_enable = true;
2091
2092         if (unlikely(ftrace_disabled))
2093                 return -ENODEV;
2094
2095         ftrace_start_up++;
2096         command |= FTRACE_UPDATE_CALLS;
2097
2098         /* ops marked global share the filter hashes */
2099         if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
2100                 ops = &global_ops;
2101                 /* Don't update hash if global is already set */
2102                 if (global_start_up)
2103                         hash_enable = false;
2104                 global_start_up++;
2105         }
2106
2107         ops->flags |= FTRACE_OPS_FL_ENABLED;
2108         if (hash_enable)
2109                 ftrace_hash_rec_enable(ops, 1);
2110
2111         ftrace_startup_enable(command);
2112
2113         return 0;
2114 }
2115
2116 static void ftrace_shutdown(struct ftrace_ops *ops, int command)
2117 {
2118         bool hash_disable = true;
2119
2120         if (unlikely(ftrace_disabled))
2121                 return;
2122
2123         ftrace_start_up--;
2124         /*
2125          * Just warn in case of unbalance, no need to kill ftrace, it's not
2126          * critical but the ftrace_call callers may be never nopped again after
2127          * further ftrace uses.
2128          */
2129         WARN_ON_ONCE(ftrace_start_up < 0);
2130
2131         if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
2132                 ops = &global_ops;
2133                 global_start_up--;
2134                 WARN_ON_ONCE(global_start_up < 0);
2135                 /* Don't update hash if global still has users */
2136                 if (global_start_up) {
2137                         WARN_ON_ONCE(!ftrace_start_up);
2138                         hash_disable = false;
2139                 }
2140         }
2141
2142         if (hash_disable)
2143                 ftrace_hash_rec_disable(ops, 1);
2144
2145         if (ops != &global_ops || !global_start_up)
2146                 ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2147
2148         command |= FTRACE_UPDATE_CALLS;
2149
2150         if (saved_ftrace_func != ftrace_trace_function) {
2151                 saved_ftrace_func = ftrace_trace_function;
2152                 command |= FTRACE_UPDATE_TRACE_FUNC;
2153         }
2154
2155         if (!command || !ftrace_enabled)
2156                 return;
2157
2158         ftrace_run_update_code(command);
2159 }
2160
2161 static void ftrace_startup_sysctl(void)
2162 {
2163         if (unlikely(ftrace_disabled))
2164                 return;
2165
2166         /* Force update next time */
2167         saved_ftrace_func = NULL;
2168         /* ftrace_start_up is true if we want ftrace running */
2169         if (ftrace_start_up)
2170                 ftrace_run_update_code(FTRACE_UPDATE_CALLS);
2171 }
2172
2173 static void ftrace_shutdown_sysctl(void)
2174 {
2175         if (unlikely(ftrace_disabled))
2176                 return;
2177
2178         /* ftrace_start_up is true if ftrace is running */
2179         if (ftrace_start_up)
2180                 ftrace_run_update_code(FTRACE_DISABLE_CALLS);
2181 }
2182
2183 static cycle_t          ftrace_update_time;
2184 static unsigned long    ftrace_update_cnt;
2185 unsigned long           ftrace_update_tot_cnt;
2186
2187 static inline int ops_traces_mod(struct ftrace_ops *ops)
2188 {
2189         /*
2190          * Filter_hash being empty will default to trace module.
2191          * But notrace hash requires a test of individual module functions.
2192          */
2193         return ftrace_hash_empty(ops->filter_hash) &&
2194                 ftrace_hash_empty(ops->notrace_hash);
2195 }
2196
2197 /*
2198  * Check if the current ops references the record.
2199  *
2200  * If the ops traces all functions, then it was already accounted for.
2201  * If the ops does not trace the current record function, skip it.
2202  * If the ops ignores the function via notrace filter, skip it.
2203  */
2204 static inline bool
2205 ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
2206 {
2207         /* If ops isn't enabled, ignore it */
2208         if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
2209                 return 0;
2210
2211         /* If ops traces all mods, we already accounted for it */
2212         if (ops_traces_mod(ops))
2213                 return 0;
2214
2215         /* The function must be in the filter */
2216         if (!ftrace_hash_empty(ops->filter_hash) &&
2217             !ftrace_lookup_ip(ops->filter_hash, rec->ip))
2218                 return 0;
2219
2220         /* If in notrace hash, we ignore it too */
2221         if (ftrace_lookup_ip(ops->notrace_hash, rec->ip))
2222                 return 0;
2223
2224         return 1;
2225 }
2226
2227 static int referenced_filters(struct dyn_ftrace *rec)
2228 {
2229         struct ftrace_ops *ops;
2230         int cnt = 0;
2231
2232         for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
2233                 if (ops_references_rec(ops, rec))
2234                     cnt++;
2235         }
2236
2237         return cnt;
2238 }
2239
2240 static int ftrace_update_code(struct module *mod)
2241 {
2242         struct ftrace_page *pg;
2243         struct dyn_ftrace *p;
2244         cycle_t start, stop;
2245         unsigned long ref = 0;
2246         bool test = false;
2247         int i;
2248
2249         /*
2250          * When adding a module, we need to check if tracers are
2251          * currently enabled and if they are set to trace all functions.
2252          * If they are, we need to enable the module functions as well
2253          * as update the reference counts for those function records.
2254          */
2255         if (mod) {
2256                 struct ftrace_ops *ops;
2257
2258                 for (ops = ftrace_ops_list;
2259                      ops != &ftrace_list_end; ops = ops->next) {
2260                         if (ops->flags & FTRACE_OPS_FL_ENABLED) {
2261                                 if (ops_traces_mod(ops))
2262                                         ref++;
2263                                 else
2264                                         test = true;
2265                         }
2266                 }
2267         }
2268
2269         start = ftrace_now(raw_smp_processor_id());
2270         ftrace_update_cnt = 0;
2271
2272         for (pg = ftrace_new_pgs; pg; pg = pg->next) {
2273
2274                 for (i = 0; i < pg->index; i++) {
2275                         int cnt = ref;
2276
2277                         /* If something went wrong, bail without enabling anything */
2278                         if (unlikely(ftrace_disabled))
2279                                 return -1;
2280
2281                         p = &pg->records[i];
2282                         if (test)
2283                                 cnt += referenced_filters(p);
2284                         p->flags = cnt;
2285
2286                         /*
2287                          * Do the initial record conversion from mcount jump
2288                          * to the NOP instructions.
2289                          */
2290                         if (!ftrace_code_disable(mod, p))
2291                                 break;
2292
2293                         ftrace_update_cnt++;
2294
2295                         /*
2296                          * If the tracing is enabled, go ahead and enable the record.
2297                          *
2298                          * The reason not to enable the record immediatelly is the
2299                          * inherent check of ftrace_make_nop/ftrace_make_call for
2300                          * correct previous instructions.  Making first the NOP
2301                          * conversion puts the module to the correct state, thus
2302                          * passing the ftrace_make_call check.
2303                          */
2304                         if (ftrace_start_up && cnt) {
2305                                 int failed = __ftrace_replace_code(p, 1);
2306                                 if (failed)
2307                                         ftrace_bug(failed, p->ip);
2308                         }
2309                 }
2310         }
2311
2312         ftrace_new_pgs = NULL;
2313
2314         stop = ftrace_now(raw_smp_processor_id());
2315         ftrace_update_time = stop - start;
2316         ftrace_update_tot_cnt += ftrace_update_cnt;
2317
2318         return 0;
2319 }
2320
2321 static int ftrace_allocate_records(struct ftrace_page *pg, int count)
2322 {
2323         int order;
2324         int cnt;
2325
2326         if (WARN_ON(!count))
2327                 return -EINVAL;
2328
2329         order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
2330
2331         /*
2332          * We want to fill as much as possible. No more than a page
2333          * may be empty.
2334          */
2335         while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2336                 order--;
2337
2338  again:
2339         pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2340
2341         if (!pg->records) {
2342                 /* if we can't allocate this size, try something smaller */
2343                 if (!order)
2344                         return -ENOMEM;
2345                 order >>= 1;
2346                 goto again;
2347         }
2348
2349         cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2350         pg->size = cnt;
2351
2352         if (cnt > count)
2353                 cnt = count;
2354
2355         return cnt;
2356 }
2357
2358 static struct ftrace_page *
2359 ftrace_allocate_pages(unsigned long num_to_init)
2360 {
2361         struct ftrace_page *start_pg;
2362         struct ftrace_page *pg;
2363         int order;
2364         int cnt;
2365
2366         if (!num_to_init)
2367                 return 0;
2368
2369         start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
2370         if (!pg)
2371                 return NULL;
2372
2373         /*
2374          * Try to allocate as much as possible in one continues
2375          * location that fills in all of the space. We want to
2376          * waste as little space as possible.
2377          */
2378         for (;;) {
2379                 cnt = ftrace_allocate_records(pg, num_to_init);
2380                 if (cnt < 0)
2381                         goto free_pages;
2382
2383                 num_to_init -= cnt;
2384                 if (!num_to_init)
2385                         break;
2386
2387                 pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
2388                 if (!pg->next)
2389                         goto free_pages;
2390
2391                 pg = pg->next;
2392         }
2393
2394         return start_pg;
2395
2396  free_pages:
2397         while (start_pg) {
2398                 order = get_count_order(pg->size / ENTRIES_PER_PAGE);
2399                 free_pages((unsigned long)pg->records, order);
2400                 start_pg = pg->next;
2401                 kfree(pg);
2402                 pg = start_pg;
2403         }
2404         pr_info("ftrace: FAILED to allocate memory for functions\n");
2405         return NULL;
2406 }
2407
2408 static int __init ftrace_dyn_table_alloc(unsigned long num_to_init)
2409 {
2410         int cnt;
2411
2412         if (!num_to_init) {
2413                 pr_info("ftrace: No functions to be traced?\n");
2414                 return -1;
2415         }
2416
2417         cnt = num_to_init / ENTRIES_PER_PAGE;
2418         pr_info("ftrace: allocating %ld entries in %d pages\n",
2419                 num_to_init, cnt + 1);
2420
2421         return 0;
2422 }
2423
2424 #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
2425
2426 struct ftrace_iterator {
2427         loff_t                          pos;
2428         loff_t                          func_pos;
2429         struct ftrace_page              *pg;
2430         struct dyn_ftrace               *func;
2431         struct ftrace_func_probe        *probe;
2432         struct trace_parser             parser;
2433         struct ftrace_hash              *hash;
2434         struct ftrace_ops               *ops;
2435         int                             hidx;
2436         int                             idx;
2437         unsigned                        flags;
2438 };
2439
2440 static void *
2441 t_hash_next(struct seq_file *m, loff_t *pos)
2442 {
2443         struct ftrace_iterator *iter = m->private;
2444         struct hlist_node *hnd = NULL;
2445         struct hlist_head *hhd;
2446
2447         (*pos)++;
2448         iter->pos = *pos;
2449
2450         if (iter->probe)
2451                 hnd = &iter->probe->node;
2452  retry:
2453         if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
2454                 return NULL;
2455
2456         hhd = &ftrace_func_hash[iter->hidx];
2457
2458         if (hlist_empty(hhd)) {
2459                 iter->hidx++;
2460                 hnd = NULL;
2461                 goto retry;
2462         }
2463
2464         if (!hnd)
2465                 hnd = hhd->first;
2466         else {
2467                 hnd = hnd->next;
2468                 if (!hnd) {
2469                         iter->hidx++;
2470                         goto retry;
2471                 }
2472         }
2473
2474         if (WARN_ON_ONCE(!hnd))
2475                 return NULL;
2476
2477         iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
2478
2479         return iter;
2480 }
2481
2482 static void *t_hash_start(struct seq_file *m, loff_t *pos)
2483 {
2484         struct ftrace_iterator *iter = m->private;
2485         void *p = NULL;
2486         loff_t l;
2487
2488         if (!(iter->flags & FTRACE_ITER_DO_HASH))
2489                 return NULL;
2490
2491         if (iter->func_pos > *pos)
2492                 return NULL;
2493
2494         iter->hidx = 0;
2495         for (l = 0; l <= (*pos - iter->func_pos); ) {
2496                 p = t_hash_next(m, &l);
2497                 if (!p)
2498                         break;
2499         }
2500         if (!p)
2501                 return NULL;
2502
2503         /* Only set this if we have an item */
2504         iter->flags |= FTRACE_ITER_HASH;
2505
2506         return iter;
2507 }
2508
2509 static int
2510 t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
2511 {
2512         struct ftrace_func_probe *rec;
2513
2514         rec = iter->probe;
2515         if (WARN_ON_ONCE(!rec))
2516                 return -EIO;
2517
2518         if (rec->ops->print)
2519                 return rec->ops->print(m, rec->ip, rec->ops, rec->data);
2520
2521         seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
2522
2523         if (rec->data)
2524                 seq_printf(m, ":%p", rec->data);
2525         seq_putc(m, '\n');
2526
2527         return 0;
2528 }
2529
2530 static void *
2531 t_next(struct seq_file *m, void *v, loff_t *pos)
2532 {
2533         struct ftrace_iterator *iter = m->private;
2534         struct ftrace_ops *ops = iter->ops;
2535         struct dyn_ftrace *rec = NULL;
2536
2537         if (unlikely(ftrace_disabled))
2538                 return NULL;
2539
2540         if (iter->flags & FTRACE_ITER_HASH)
2541                 return t_hash_next(m, pos);
2542
2543         (*pos)++;
2544         iter->pos = iter->func_pos = *pos;
2545
2546         if (iter->flags & FTRACE_ITER_PRINTALL)
2547                 return t_hash_start(m, pos);
2548
2549  retry:
2550         if (iter->idx >= iter->pg->index) {
2551                 if (iter->pg->next) {
2552                         iter->pg = iter->pg->next;
2553                         iter->idx = 0;
2554                         goto retry;
2555                 }
2556         } else {
2557                 rec = &iter->pg->records[iter->idx++];
2558                 if (((iter->flags & FTRACE_ITER_FILTER) &&
2559                      !(ftrace_lookup_ip(ops->filter_hash, rec->ip))) ||
2560
2561                     ((iter->flags & FTRACE_ITER_NOTRACE) &&
2562                      !ftrace_lookup_ip(ops->notrace_hash, rec->ip)) ||
2563
2564                     ((iter->flags & FTRACE_ITER_ENABLED) &&
2565                      !(rec->flags & FTRACE_FL_ENABLED))) {
2566
2567                         rec = NULL;
2568                         goto retry;
2569                 }
2570         }
2571
2572         if (!rec)
2573                 return t_hash_start(m, pos);
2574
2575         iter->func = rec;
2576
2577         return iter;
2578 }
2579
2580 static void reset_iter_read(struct ftrace_iterator *iter)
2581 {
2582         iter->pos = 0;
2583         iter->func_pos = 0;
2584         iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_HASH);
2585 }
2586
2587 static void *t_start(struct seq_file *m, loff_t *pos)
2588 {
2589         struct ftrace_iterator *iter = m->private;
2590         struct ftrace_ops *ops = iter->ops;
2591         void *p = NULL;
2592         loff_t l;
2593
2594         mutex_lock(&ftrace_lock);
2595
2596         if (unlikely(ftrace_disabled))
2597                 return NULL;
2598
2599         /*
2600          * If an lseek was done, then reset and start from beginning.
2601          */
2602         if (*pos < iter->pos)
2603                 reset_iter_read(iter);
2604
2605         /*
2606          * For set_ftrace_filter reading, if we have the filter
2607          * off, we can short cut and just print out that all
2608          * functions are enabled.
2609          */
2610         if (iter->flags & FTRACE_ITER_FILTER &&
2611             ftrace_hash_empty(ops->filter_hash)) {
2612                 if (*pos > 0)
2613                         return t_hash_start(m, pos);
2614                 iter->flags |= FTRACE_ITER_PRINTALL;
2615                 /* reset in case of seek/pread */
2616                 iter->flags &= ~FTRACE_ITER_HASH;
2617                 return iter;
2618         }
2619
2620         if (iter->flags & FTRACE_ITER_HASH)
2621                 return t_hash_start(m, pos);
2622
2623         /*
2624          * Unfortunately, we need to restart at ftrace_pages_start
2625          * every time we let go of the ftrace_mutex. This is because
2626          * those pointers can change without the lock.
2627          */
2628         iter->pg = ftrace_pages_start;
2629         iter->idx = 0;
2630         for (l = 0; l <= *pos; ) {
2631                 p = t_next(m, p, &l);
2632                 if (!p)
2633                         break;
2634         }
2635
2636         if (!p)
2637                 return t_hash_start(m, pos);
2638
2639         return iter;
2640 }
2641
2642 static void t_stop(struct seq_file *m, void *p)
2643 {
2644         mutex_unlock(&ftrace_lock);
2645 }
2646
2647 static int t_show(struct seq_file *m, void *v)
2648 {
2649         struct ftrace_iterator *iter = m->private;
2650         struct dyn_ftrace *rec;
2651
2652         if (iter->flags & FTRACE_ITER_HASH)
2653                 return t_hash_show(m, iter);
2654
2655         if (iter->flags & FTRACE_ITER_PRINTALL) {
2656                 seq_printf(m, "#### all functions enabled ####\n");
2657                 return 0;
2658         }
2659
2660         rec = iter->func;
2661
2662         if (!rec)
2663                 return 0;
2664
2665         seq_printf(m, "%ps", (void *)rec->ip);
2666         if (iter->flags & FTRACE_ITER_ENABLED)
2667                 seq_printf(m, " (%ld)%s",
2668                            rec->flags & ~FTRACE_FL_MASK,
2669                            rec->flags & FTRACE_FL_REGS ? " R" : "");
2670         seq_printf(m, "\n");
2671
2672         return 0;
2673 }
2674
2675 static const struct seq_operations show_ftrace_seq_ops = {
2676         .start = t_start,
2677         .next = t_next,
2678         .stop = t_stop,
2679         .show = t_show,
2680 };
2681
2682 static int
2683 ftrace_avail_open(struct inode *inode, struct file *file)
2684 {
2685         struct ftrace_iterator *iter;
2686
2687         if (unlikely(ftrace_disabled))
2688                 return -ENODEV;
2689
2690         iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
2691         if (iter) {
2692                 iter->pg = ftrace_pages_start;
2693                 iter->ops = &global_ops;
2694         }
2695
2696         return iter ? 0 : -ENOMEM;
2697 }
2698
2699 static int
2700 ftrace_enabled_open(struct inode *inode, struct file *file)
2701 {
2702         struct ftrace_iterator *iter;
2703
2704         if (unlikely(ftrace_disabled))
2705                 return -ENODEV;
2706
2707         iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
2708         if (iter) {
2709                 iter->pg = ftrace_pages_start;
2710                 iter->flags = FTRACE_ITER_ENABLED;
2711                 iter->ops = &global_ops;
2712         }
2713
2714         return iter ? 0 : -ENOMEM;
2715 }
2716
2717 static void ftrace_filter_reset(struct ftrace_hash *hash)
2718 {
2719         mutex_lock(&ftrace_lock);
2720         ftrace_hash_clear(hash);
2721         mutex_unlock(&ftrace_lock);
2722 }
2723
2724 /**
2725  * ftrace_regex_open - initialize function tracer filter files
2726  * @ops: The ftrace_ops that hold the hash filters
2727  * @flag: The type of filter to process
2728  * @inode: The inode, usually passed in to your open routine
2729  * @file: The file, usually passed in to your open routine
2730  *
2731  * ftrace_regex_open() initializes the filter files for the
2732  * @ops. Depending on @flag it may process the filter hash or
2733  * the notrace hash of @ops. With this called from the open
2734  * routine, you can use ftrace_filter_write() for the write
2735  * routine if @flag has FTRACE_ITER_FILTER set, or
2736  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
2737  * ftrace_filter_lseek() should be used as the lseek routine, and
2738  * release must call ftrace_regex_release().
2739  */
2740 int
2741 ftrace_regex_open(struct ftrace_ops *ops, int flag,
2742                   struct inode *inode, struct file *file)
2743 {
2744         struct ftrace_iterator *iter;
2745         struct ftrace_hash *hash;
2746         int ret = 0;
2747
2748         ftrace_ops_init(ops);
2749
2750         if (unlikely(ftrace_disabled))
2751                 return -ENODEV;
2752
2753         iter = kzalloc(sizeof(*iter), GFP_KERNEL);
2754         if (!iter)
2755                 return -ENOMEM;
2756
2757         if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
2758                 kfree(iter);
2759                 return -ENOMEM;
2760         }
2761
2762         iter->ops = ops;
2763         iter->flags = flag;
2764
2765         mutex_lock(&ops->regex_lock);
2766
2767         if (flag & FTRACE_ITER_NOTRACE)
2768                 hash = ops->notrace_hash;
2769         else
2770                 hash = ops->filter_hash;
2771
2772         if (file->f_mode & FMODE_WRITE) {
2773                 iter->hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, hash);
2774                 if (!iter->hash) {
2775                         trace_parser_put(&iter->parser);
2776                         kfree(iter);
2777                         ret = -ENOMEM;
2778                         goto out_unlock;
2779                 }
2780         }
2781
2782         if ((file->f_mode & FMODE_WRITE) &&
2783             (file->f_flags & O_TRUNC))
2784                 ftrace_filter_reset(iter->hash);
2785
2786         if (file->f_mode & FMODE_READ) {
2787                 iter->pg = ftrace_pages_start;
2788
2789                 ret = seq_open(file, &show_ftrace_seq_ops);
2790                 if (!ret) {
2791                         struct seq_file *m = file->private_data;
2792                         m->private = iter;
2793                 } else {
2794                         /* Failed */
2795                         free_ftrace_hash(iter->hash);
2796                         trace_parser_put(&iter->parser);
2797                         kfree(iter);
2798                 }
2799         } else
2800                 file->private_data = iter;
2801
2802  out_unlock:
2803         mutex_unlock(&ops->regex_lock);
2804
2805         return ret;
2806 }
2807
2808 static int
2809 ftrace_filter_open(struct inode *inode, struct file *file)
2810 {
2811         return ftrace_regex_open(&global_ops,
2812                         FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
2813                         inode, file);
2814 }
2815
2816 static int
2817 ftrace_notrace_open(struct inode *inode, struct file *file)
2818 {
2819         return ftrace_regex_open(&global_ops, FTRACE_ITER_NOTRACE,
2820                                  inode, file);
2821 }
2822
2823 static int ftrace_match(char *str, char *regex, int len, int type)
2824 {
2825         int matched = 0;
2826         int slen;
2827
2828         switch (type) {
2829         case MATCH_FULL:
2830                 if (strcmp(str, regex) == 0)
2831                         matched = 1;
2832                 break;
2833         case MATCH_FRONT_ONLY:
2834                 if (strncmp(str, regex, len) == 0)
2835                         matched = 1;
2836                 break;
2837         case MATCH_MIDDLE_ONLY:
2838                 if (strstr(str, regex))
2839                         matched = 1;
2840                 break;
2841         case MATCH_END_ONLY:
2842                 slen = strlen(str);
2843                 if (slen >= len && memcmp(str + slen - len, regex, len) == 0)
2844                         matched = 1;
2845                 break;
2846         }
2847
2848         return matched;
2849 }
2850
2851 static int
2852 enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int not)
2853 {
2854         struct ftrace_func_entry *entry;
2855         int ret = 0;
2856
2857         entry = ftrace_lookup_ip(hash, rec->ip);
2858         if (not) {
2859                 /* Do nothing if it doesn't exist */
2860                 if (!entry)
2861                         return 0;
2862
2863                 free_hash_entry(hash, entry);
2864         } else {
2865                 /* Do nothing if it exists */
2866                 if (entry)
2867                         return 0;
2868
2869                 ret = add_hash_entry(hash, rec->ip);
2870         }
2871         return ret;
2872 }
2873
2874 static int
2875 ftrace_match_record(struct dyn_ftrace *rec, char *mod,
2876                     char *regex, int len, int type)
2877 {
2878         char str[KSYM_SYMBOL_LEN];
2879         char *modname;
2880
2881         kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
2882
2883         if (mod) {
2884                 /* module lookup requires matching the module */
2885                 if (!modname || strcmp(modname, mod))
2886                         return 0;
2887
2888                 /* blank search means to match all funcs in the mod */
2889                 if (!len)
2890                         return 1;
2891         }
2892
2893         return ftrace_match(str, regex, len, type);
2894 }
2895
2896 static int
2897 match_records(struct ftrace_hash *hash, char *buff,
2898               int len, char *mod, int not)
2899 {
2900         unsigned search_len = 0;
2901         struct ftrace_page *pg;
2902         struct dyn_ftrace *rec;
2903         int type = MATCH_FULL;
2904         char *search = buff;
2905         int found = 0;
2906         int ret;
2907
2908         if (len) {
2909                 type = filter_parse_regex(buff, len, &search, &not);
2910                 search_len = strlen(search);
2911         }
2912
2913         mutex_lock(&ftrace_lock);
2914
2915         if (unlikely(ftrace_disabled))
2916                 goto out_unlock;
2917
2918         do_for_each_ftrace_rec(pg, rec) {
2919                 if (ftrace_match_record(rec, mod, search, search_len, type)) {
2920                         ret = enter_record(hash, rec, not);
2921                         if (ret < 0) {
2922                                 found = ret;
2923                                 goto out_unlock;
2924                         }
2925                         found = 1;
2926                 }
2927         } while_for_each_ftrace_rec();
2928  out_unlock:
2929         mutex_unlock(&ftrace_lock);
2930
2931         return found;
2932 }
2933
2934 static int
2935 ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
2936 {
2937         return match_records(hash, buff, len, NULL, 0);
2938 }
2939
2940 static int
2941 ftrace_match_module_records(struct ftrace_hash *hash, char *buff, char *mod)
2942 {
2943         int not = 0;
2944
2945         /* blank or '*' mean the same */
2946         if (strcmp(buff, "*") == 0)
2947                 buff[0] = 0;
2948
2949         /* handle the case of 'dont filter this module' */
2950         if (strcmp(buff, "!") == 0 || strcmp(buff, "!*") == 0) {
2951                 buff[0] = 0;
2952                 not = 1;
2953         }
2954
2955         return match_records(hash, buff, strlen(buff), mod, not);
2956 }
2957
2958 /*
2959  * We register the module command as a template to show others how
2960  * to register the a command as well.
2961  */
2962
2963 static int
2964 ftrace_mod_callback(struct ftrace_hash *hash,
2965                     char *func, char *cmd, char *param, int enable)
2966 {
2967         char *mod;
2968         int ret = -EINVAL;
2969
2970         /*
2971          * cmd == 'mod' because we only registered this func
2972          * for the 'mod' ftrace_func_command.
2973          * But if you register one func with multiple commands,
2974          * you can tell which command was used by the cmd
2975          * parameter.
2976          */
2977
2978         /* we must have a module name */
2979         if (!param)
2980                 return ret;
2981
2982         mod = strsep(&param, ":");
2983         if (!strlen(mod))
2984                 return ret;
2985
2986         ret = ftrace_match_module_records(hash, func, mod);
2987         if (!ret)
2988                 ret = -EINVAL;
2989         if (ret < 0)
2990                 return ret;
2991
2992         return 0;
2993 }
2994
2995 static struct ftrace_func_command ftrace_mod_cmd = {
2996         .name                   = "mod",
2997         .func                   = ftrace_mod_callback,
2998 };
2999
3000 static int __init ftrace_mod_cmd_init(void)
3001 {
3002         return register_ftrace_command(&ftrace_mod_cmd);
3003 }
3004 core_initcall(ftrace_mod_cmd_init);
3005
3006 static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
3007                                       struct ftrace_ops *op, struct pt_regs *pt_regs)
3008 {
3009         struct ftrace_func_probe *entry;
3010         struct hlist_head *hhd;
3011         unsigned long key;
3012
3013         key = hash_long(ip, FTRACE_HASH_BITS);
3014
3015         hhd = &ftrace_func_hash[key];
3016
3017         if (hlist_empty(hhd))
3018                 return;
3019
3020         /*
3021          * Disable preemption for these calls to prevent a RCU grace
3022          * period. This syncs the hash iteration and freeing of items
3023          * on the hash. rcu_read_lock is too dangerous here.
3024          */
3025         preempt_disable_notrace();
3026         hlist_for_each_entry_rcu_notrace(entry, hhd, node) {
3027                 if (entry->ip == ip)
3028                         entry->ops->func(ip, parent_ip, &entry->data);
3029         }
3030         preempt_enable_notrace();
3031 }
3032
3033 static struct ftrace_ops trace_probe_ops __read_mostly =
3034 {
3035         .func           = function_trace_probe_call,
3036         .flags          = FTRACE_OPS_FL_INITIALIZED,
3037         INIT_REGEX_LOCK(trace_probe_ops)
3038 };
3039
3040 static int ftrace_probe_registered;
3041
3042 static void __enable_ftrace_function_probe(void)
3043 {
3044         int ret;
3045         int i;
3046
3047         if (ftrace_probe_registered) {
3048                 /* still need to update the function call sites */
3049                 if (ftrace_enabled)
3050                         ftrace_run_update_code(FTRACE_UPDATE_CALLS);
3051                 return;
3052         }
3053
3054         for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
3055                 struct hlist_head *hhd = &ftrace_func_hash[i];
3056                 if (hhd->first)
3057                         break;
3058         }
3059         /* Nothing registered? */
3060         if (i == FTRACE_FUNC_HASHSIZE)
3061                 return;
3062
3063         ret = __register_ftrace_function(&trace_probe_ops);
3064         if (!ret)
3065                 ret = ftrace_startup(&trace_probe_ops, 0);
3066
3067         ftrace_probe_registered = 1;
3068 }
3069
3070 static void __disable_ftrace_function_probe(void)
3071 {
3072         int ret;
3073         int i;
3074
3075         if (!ftrace_probe_registered)
3076                 return;
3077
3078         for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
3079                 struct hlist_head *hhd = &ftrace_func_hash[i];
3080                 if (hhd->first)
3081                         return;
3082         }
3083
3084         /* no more funcs left */
3085         ret = __unregister_ftrace_function(&trace_probe_ops);
3086         if (!ret)
3087                 ftrace_shutdown(&trace_probe_ops, 0);
3088
3089         ftrace_probe_registered = 0;
3090 }
3091
3092
3093 static void ftrace_free_entry(struct ftrace_func_probe *entry)
3094 {
3095         if (entry->ops->free)
3096                 entry->ops->free(entry->ops, entry->ip, &entry->data);
3097         kfree(entry);
3098 }
3099
3100 int
3101 register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
3102                               void *data)
3103 {
3104         struct ftrace_func_probe *entry;
3105         struct ftrace_hash **orig_hash = &trace_probe_ops.filter_hash;
3106         struct ftrace_hash *hash;
3107         struct ftrace_page *pg;
3108         struct dyn_ftrace *rec;
3109         int type, len, not;
3110         unsigned long key;
3111         int count = 0;
3112         char *search;
3113         int ret;
3114
3115         type = filter_parse_regex(glob, strlen(glob), &search, &not);
3116         len = strlen(search);
3117
3118         /* we do not support '!' for function probes */
3119         if (WARN_ON(not))
3120                 return -EINVAL;
3121
3122         mutex_lock(&trace_probe_ops.regex_lock);
3123
3124         hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3125         if (!hash) {
3126                 count = -ENOMEM;
3127                 goto out;
3128         }
3129
3130         if (unlikely(ftrace_disabled)) {
3131                 count = -ENODEV;
3132                 goto out;
3133         }
3134
3135         mutex_lock(&ftrace_lock);
3136
3137         do_for_each_ftrace_rec(pg, rec) {
3138
3139                 if (!ftrace_match_record(rec, NULL, search, len, type))
3140                         continue;
3141
3142                 entry = kmalloc(sizeof(*entry), GFP_KERNEL);
3143                 if (!entry) {
3144                         /* If we did not process any, then return error */
3145                         if (!count)
3146                                 count = -ENOMEM;
3147                         goto out_unlock;
3148                 }
3149
3150                 count++;
3151
3152                 entry->data = data;
3153
3154                 /*
3155                  * The caller might want to do something special
3156                  * for each function we find. We call the callback
3157                  * to give the caller an opportunity to do so.
3158                  */
3159                 if (ops->init) {
3160                         if (ops->init(ops, rec->ip, &entry->data) < 0) {
3161                                 /* caller does not like this func */
3162                                 kfree(entry);
3163                                 continue;
3164                         }
3165                 }
3166
3167                 ret = enter_record(hash, rec, 0);
3168                 if (ret < 0) {
3169                         kfree(entry);
3170                         count = ret;
3171                         goto out_unlock;
3172                 }
3173
3174                 entry->ops = ops;
3175                 entry->ip = rec->ip;
3176
3177                 key = hash_long(entry->ip, FTRACE_HASH_BITS);
3178                 hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
3179
3180         } while_for_each_ftrace_rec();
3181
3182         ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
3183         if (ret < 0)
3184                 count = ret;
3185
3186         __enable_ftrace_function_probe();
3187
3188  out_unlock:
3189         mutex_unlock(&ftrace_lock);
3190  out:
3191         mutex_unlock(&trace_probe_ops.regex_lock);
3192         free_ftrace_hash(hash);
3193
3194         return count;
3195 }
3196
3197 enum {
3198         PROBE_TEST_FUNC         = 1,
3199         PROBE_TEST_DATA         = 2
3200 };
3201
3202 static void
3203 __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
3204                                   void *data, int flags)
3205 {
3206         struct ftrace_func_entry *rec_entry;
3207         struct ftrace_func_probe *entry;
3208         struct ftrace_func_probe *p;
3209         struct ftrace_hash **orig_hash = &trace_probe_ops.filter_hash;
3210         struct list_head free_list;
3211         struct ftrace_hash *hash;
3212         struct hlist_node *tmp;
3213         char str[KSYM_SYMBOL_LEN];
3214         int type = MATCH_FULL;
3215         int i, len = 0;
3216         char *search;
3217
3218         if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
3219                 glob = NULL;
3220         else if (glob) {
3221                 int not;
3222
3223                 type = filter_parse_regex(glob, strlen(glob), &search, &not);
3224                 len = strlen(search);
3225
3226                 /* we do not support '!' for function probes */
3227                 if (WARN_ON(not))
3228                         return;
3229         }
3230
3231         mutex_lock(&trace_probe_ops.regex_lock);
3232
3233         hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3234         if (!hash)
3235                 /* Hmm, should report this somehow */
3236                 goto out_unlock;
3237
3238         INIT_LIST_HEAD(&free_list);
3239
3240         for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
3241                 struct hlist_head *hhd = &ftrace_func_hash[i];
3242
3243                 hlist_for_each_entry_safe(entry, tmp, hhd, node) {
3244
3245                         /* break up if statements for readability */
3246                         if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
3247                                 continue;
3248
3249                         if ((flags & PROBE_TEST_DATA) && entry->data != data)
3250                                 continue;
3251
3252                         /* do this last, since it is the most expensive */
3253                         if (glob) {
3254                                 kallsyms_lookup(entry->ip, NULL, NULL,
3255                                                 NULL, str);
3256                                 if (!ftrace_match(str, glob, len, type))
3257                                         continue;
3258                         }
3259
3260                         rec_entry = ftrace_lookup_ip(hash, entry->ip);
3261                         /* It is possible more than one entry had this ip */
3262                         if (rec_entry)
3263                                 free_hash_entry(hash, rec_entry);
3264
3265                         hlist_del_rcu(&entry->node);
3266                         list_add(&entry->free_list, &free_list);
3267                 }
3268         }
3269         mutex_lock(&ftrace_lock);
3270         __disable_ftrace_function_probe();
3271         /*
3272          * Remove after the disable is called. Otherwise, if the last
3273          * probe is removed, a null hash means *all enabled*.
3274          */
3275         ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
3276         synchronize_sched();
3277         list_for_each_entry_safe(entry, p, &free_list, free_list) {
3278                 list_del(&entry->free_list);
3279                 ftrace_free_entry(entry);
3280         }
3281         mutex_unlock(&ftrace_lock);
3282                 
3283  out_unlock:
3284         mutex_unlock(&trace_probe_ops.regex_lock);
3285         free_ftrace_hash(hash);
3286 }
3287
3288 void
3289 unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
3290                                 void *data)
3291 {
3292         __unregister_ftrace_function_probe(glob, ops, data,
3293                                           PROBE_TEST_FUNC | PROBE_TEST_DATA);
3294 }
3295
3296 void
3297 unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
3298 {
3299         __unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
3300 }
3301
3302 void unregister_ftrace_function_probe_all(char *glob)
3303 {
3304         __unregister_ftrace_function_probe(glob, NULL, NULL, 0);
3305 }
3306
3307 static LIST_HEAD(ftrace_commands);
3308 static DEFINE_MUTEX(ftrace_cmd_mutex);
3309
3310 /*
3311  * Currently we only register ftrace commands from __init, so mark this
3312  * __init too.
3313  */
3314 __init int register_ftrace_command(struct ftrace_func_command *cmd)
3315 {
3316         struct ftrace_func_command *p;
3317         int ret = 0;
3318
3319         mutex_lock(&ftrace_cmd_mutex);
3320         list_for_each_entry(p, &ftrace_commands, list) {
3321                 if (strcmp(cmd->name, p->name) == 0) {
3322                         ret = -EBUSY;
3323                         goto out_unlock;
3324                 }
3325         }
3326         list_add(&cmd->list, &ftrace_commands);
3327  out_unlock:
3328         mutex_unlock(&ftrace_cmd_mutex);
3329
3330         return ret;
3331 }
3332
3333 /*
3334  * Currently we only unregister ftrace commands from __init, so mark
3335  * this __init too.
3336  */
3337 __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
3338 {
3339         struct ftrace_func_command *p, *n;
3340         int ret = -ENODEV;
3341
3342         mutex_lock(&ftrace_cmd_mutex);
3343         list_for_each_entry_safe(p, n, &ftrace_commands, list) {
3344                 if (strcmp(cmd->name, p->name) == 0) {
3345                         ret = 0;
3346                         list_del_init(&p->list);
3347                         goto out_unlock;
3348                 }
3349         }
3350  out_unlock:
3351         mutex_unlock(&ftrace_cmd_mutex);
3352
3353         return ret;
3354 }
3355
3356 static int ftrace_process_regex(struct ftrace_hash *hash,
3357                                 char *buff, int len, int enable)
3358 {
3359         char *func, *command, *next = buff;
3360         struct ftrace_func_command *p;
3361         int ret = -EINVAL;
3362
3363         func = strsep(&next, ":");
3364
3365         if (!next) {
3366                 ret = ftrace_match_records(hash, func, len);
3367                 if (!ret)
3368                         ret = -EINVAL;
3369                 if (ret < 0)
3370                         return ret;
3371                 return 0;
3372         }
3373
3374         /* command found */
3375
3376         command = strsep(&next, ":");
3377
3378         mutex_lock(&ftrace_cmd_mutex);
3379         list_for_each_entry(p, &ftrace_commands, list) {
3380                 if (strcmp(p->name, command) == 0) {
3381                         ret = p->func(hash, func, command, next, enable);
3382                         goto out_unlock;
3383                 }
3384         }
3385  out_unlock:
3386         mutex_unlock(&ftrace_cmd_mutex);
3387
3388         return ret;
3389 }
3390
3391 static ssize_t
3392 ftrace_regex_write(struct file *file, const char __user *ubuf,
3393                    size_t cnt, loff_t *ppos, int enable)
3394 {
3395         struct ftrace_iterator *iter;
3396         struct trace_parser *parser;
3397         ssize_t ret, read;
3398
3399         if (!cnt)
3400                 return 0;
3401
3402         if (file->f_mode & FMODE_READ) {
3403                 struct seq_file *m = file->private_data;
3404                 iter = m->private;
3405         } else
3406                 iter = file->private_data;
3407
3408         if (unlikely(ftrace_disabled))
3409                 return -ENODEV;
3410
3411         /* iter->hash is a local copy, so we don't need regex_lock */
3412
3413         parser = &iter->parser;
3414         read = trace_get_user(parser, ubuf, cnt, ppos);
3415
3416         if (read >= 0 && trace_parser_loaded(parser) &&
3417             !trace_parser_cont(parser)) {
3418                 ret = ftrace_process_regex(iter->hash, parser->buffer,
3419                                            parser->idx, enable);
3420                 trace_parser_clear(parser);
3421                 if (ret < 0)
3422                         goto out;
3423         }
3424
3425         ret = read;
3426  out:
3427         return ret;
3428 }
3429
3430 ssize_t
3431 ftrace_filter_write(struct file *file, const char __user *ubuf,
3432                     size_t cnt, loff_t *ppos)
3433 {
3434         return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
3435 }
3436
3437 ssize_t
3438 ftrace_notrace_write(struct file *file, const char __user *ubuf,
3439                      size_t cnt, loff_t *ppos)
3440 {
3441         return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
3442 }
3443
3444 static int
3445 ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
3446 {
3447         struct ftrace_func_entry *entry;
3448
3449         if (!ftrace_location(ip))
3450                 return -EINVAL;
3451
3452         if (remove) {
3453                 entry = ftrace_lookup_ip(hash, ip);
3454                 if (!entry)
3455                         return -ENOENT;
3456                 free_hash_entry(hash, entry);
3457                 return 0;
3458         }
3459
3460         return add_hash_entry(hash, ip);
3461 }
3462
3463 static void ftrace_ops_update_code(struct ftrace_ops *ops)
3464 {
3465         if (ops->flags & FTRACE_OPS_FL_ENABLED && ftrace_enabled)
3466                 ftrace_run_update_code(FTRACE_UPDATE_CALLS);
3467 }
3468
3469 static int
3470 ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
3471                 unsigned long ip, int remove, int reset, int enable)
3472 {
3473         struct ftrace_hash **orig_hash;
3474         struct ftrace_hash *hash;
3475         int ret;
3476
3477         /* All global ops uses the global ops filters */
3478         if (ops->flags & FTRACE_OPS_FL_GLOBAL)
3479                 ops = &global_ops;
3480
3481         if (unlikely(ftrace_disabled))
3482                 return -ENODEV;
3483
3484         mutex_lock(&ops->regex_lock);
3485
3486         if (enable)
3487                 orig_hash = &ops->filter_hash;
3488         else
3489                 orig_hash = &ops->notrace_hash;
3490
3491         hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3492         if (!hash) {
3493                 ret = -ENOMEM;
3494                 goto out_regex_unlock;
3495         }
3496
3497         if (reset)
3498                 ftrace_filter_reset(hash);
3499         if (buf && !ftrace_match_records(hash, buf, len)) {
3500                 ret = -EINVAL;
3501                 goto out_regex_unlock;
3502         }
3503         if (ip) {
3504                 ret = ftrace_match_addr(hash, ip, remove);
3505                 if (ret < 0)
3506                         goto out_regex_unlock;
3507         }
3508
3509         mutex_lock(&ftrace_lock);
3510         ret = ftrace_hash_move(ops, enable, orig_hash, hash);
3511         if (!ret)
3512                 ftrace_ops_update_code(ops);
3513
3514         mutex_unlock(&ftrace_lock);
3515
3516  out_regex_unlock:
3517         mutex_unlock(&ops->regex_lock);
3518
3519         free_ftrace_hash(hash);
3520         return ret;
3521 }
3522
3523 static int
3524 ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
3525                 int reset, int enable)
3526 {
3527         return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
3528 }
3529
3530 /**
3531  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
3532  * @ops - the ops to set the filter with
3533  * @ip - the address to add to or remove from the filter.
3534  * @remove - non zero to remove the ip from the filter
3535  * @reset - non zero to reset all filters before applying this filter.
3536  *
3537  * Filters denote which functions should be enabled when tracing is enabled
3538  * If @ip is NULL, it failes to update filter.
3539  */
3540 int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
3541                          int remove, int reset)
3542 {
3543         ftrace_ops_init(ops);
3544         return ftrace_set_addr(ops, ip, remove, reset, 1);
3545 }
3546 EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
3547
3548 static int
3549 ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
3550                  int reset, int enable)
3551 {
3552         return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
3553 }
3554
3555 /**
3556  * ftrace_set_filter - set a function to filter on in ftrace
3557  * @ops - the ops to set the filter with
3558  * @buf - the string that holds the function filter text.
3559  * @len - the length of the string.
3560  * @reset - non zero to reset all filters before applying this filter.
3561  *
3562  * Filters denote which functions should be enabled when tracing is enabled.
3563  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
3564  */
3565 int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
3566                        int len, int reset)
3567 {
3568         ftrace_ops_init(ops);
3569         return ftrace_set_regex(ops, buf, len, reset, 1);
3570 }
3571 EXPORT_SYMBOL_GPL(ftrace_set_filter);
3572
3573 /**
3574  * ftrace_set_notrace - set a function to not trace in ftrace
3575  * @ops - the ops to set the notrace filter with
3576  * @buf - the string that holds the function notrace text.
3577  * @len - the length of the string.
3578  * @reset - non zero to reset all filters before applying this filter.
3579  *
3580  * Notrace Filters denote which functions should not be enabled when tracing
3581  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
3582  * for tracing.
3583  */
3584 int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
3585                         int len, int reset)
3586 {
3587         ftrace_ops_init(ops);
3588         return ftrace_set_regex(ops, buf, len, reset, 0);
3589 }
3590 EXPORT_SYMBOL_GPL(ftrace_set_notrace);
3591 /**
3592  * ftrace_set_filter - set a function to filter on in ftrace
3593  * @ops - the ops to set the filter with
3594  * @buf - the string that holds the function filter text.
3595  * @len - the length of the string.
3596  * @reset - non zero to reset all filters before applying this filter.
3597  *
3598  * Filters denote which functions should be enabled when tracing is enabled.
3599  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
3600  */
3601 void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
3602 {
3603         ftrace_set_regex(&global_ops, buf, len, reset, 1);
3604 }
3605 EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
3606
3607 /**
3608  * ftrace_set_notrace - set a function to not trace in ftrace
3609  * @ops - the ops to set the notrace filter with
3610  * @buf - the string that holds the function notrace text.
3611  * @len - the length of the string.
3612  * @reset - non zero to reset all filters before applying this filter.
3613  *
3614  * Notrace Filters denote which functions should not be enabled when tracing
3615  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
3616  * for tracing.
3617  */
3618 void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
3619 {
3620         ftrace_set_regex(&global_ops, buf, len, reset, 0);
3621 }
3622 EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
3623
3624 /*
3625  * command line interface to allow users to set filters on boot up.
3626  */
3627 #define FTRACE_FILTER_SIZE              COMMAND_LINE_SIZE
3628 static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
3629 static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
3630
3631 /* Used by function selftest to not test if filter is set */
3632 bool ftrace_filter_param __initdata;
3633
3634 static int __init set_ftrace_notrace(char *str)
3635 {
3636         ftrace_filter_param = true;
3637         strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
3638         return 1;
3639 }
3640 __setup("ftrace_notrace=", set_ftrace_notrace);
3641
3642 static int __init set_ftrace_filter(char *str)
3643 {
3644         ftrace_filter_param = true;
3645         strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
3646         return 1;
3647 }
3648 __setup("ftrace_filter=", set_ftrace_filter);
3649
3650 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3651 static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
3652 static int ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer);
3653
3654 static int __init set_graph_function(char *str)
3655 {
3656         strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
3657         return 1;
3658 }
3659 __setup("ftrace_graph_filter=", set_graph_function);
3660
3661 static void __init set_ftrace_early_graph(char *buf)
3662 {
3663         int ret;
3664         char *func;
3665
3666         while (buf) {
3667                 func = strsep(&buf, ",");
3668                 /* we allow only one expression at a time */
3669                 ret = ftrace_set_func(ftrace_graph_funcs, &ftrace_graph_count,
3670                                       FTRACE_GRAPH_MAX_FUNCS, func);
3671                 if (ret)
3672                         printk(KERN_DEBUG "ftrace: function %s not "
3673                                           "traceable\n", func);
3674         }
3675 }
3676 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3677
3678 void __init
3679 ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
3680 {
3681         char *func;
3682
3683         ftrace_ops_init(ops);
3684
3685         while (buf) {
3686                 func = strsep(&buf, ",");
3687                 ftrace_set_regex(ops, func, strlen(func), 0, enable);
3688         }
3689 }
3690
3691 static void __init set_ftrace_early_filters(void)
3692 {
3693         if (ftrace_filter_buf[0])
3694                 ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
3695         if (ftrace_notrace_buf[0])
3696                 ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
3697 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3698         if (ftrace_graph_buf[0])
3699                 set_ftrace_early_graph(ftrace_graph_buf);
3700 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3701 }
3702
3703 int ftrace_regex_release(struct inode *inode, struct file *file)
3704 {
3705         struct seq_file *m = (struct seq_file *)file->private_data;
3706         struct ftrace_iterator *iter;
3707         struct ftrace_hash **orig_hash;
3708         struct trace_parser *parser;
3709         int filter_hash;
3710         int ret;
3711
3712         if (file->f_mode & FMODE_READ) {
3713                 iter = m->private;
3714                 seq_release(inode, file);
3715         } else
3716                 iter = file->private_data;
3717
3718         parser = &iter->parser;
3719         if (trace_parser_loaded(parser)) {
3720                 parser->buffer[parser->idx] = 0;
3721                 ftrace_match_records(iter->hash, parser->buffer, parser->idx);
3722         }
3723
3724         trace_parser_put(parser);
3725
3726         mutex_lock(&iter->ops->regex_lock);
3727
3728         if (file->f_mode & FMODE_WRITE) {
3729                 filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
3730
3731                 if (filter_hash)
3732                         orig_hash = &iter->ops->filter_hash;
3733                 else
3734                         orig_hash = &iter->ops->notrace_hash;
3735
3736                 mutex_lock(&ftrace_lock);
3737                 ret = ftrace_hash_move(iter->ops, filter_hash,
3738                                        orig_hash, iter->hash);
3739                 if (!ret)
3740                         ftrace_ops_update_code(iter->ops);
3741
3742                 mutex_unlock(&ftrace_lock);
3743         }
3744
3745         mutex_unlock(&iter->ops->regex_lock);
3746         free_ftrace_hash(iter->hash);
3747         kfree(iter);
3748
3749         return 0;
3750 }
3751
3752 static const struct file_operations ftrace_avail_fops = {
3753         .open = ftrace_avail_open,
3754         .read = seq_read,
3755         .llseek = seq_lseek,
3756         .release = seq_release_private,
3757 };
3758
3759 static const struct file_operations ftrace_enabled_fops = {
3760         .open = ftrace_enabled_open,
3761         .read = seq_read,
3762         .llseek = seq_lseek,
3763         .release = seq_release_private,
3764 };
3765
3766 static const struct file_operations ftrace_filter_fops = {
3767         .open = ftrace_filter_open,
3768         .read = seq_read,
3769         .write = ftrace_filter_write,
3770         .llseek = ftrace_filter_lseek,
3771         .release = ftrace_regex_release,
3772 };
3773
3774 static const struct file_operations ftrace_notrace_fops = {
3775         .open = ftrace_notrace_open,
3776         .read = seq_read,
3777         .write = ftrace_notrace_write,
3778         .llseek = ftrace_filter_lseek,
3779         .release = ftrace_regex_release,
3780 };
3781
3782 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3783
3784 static DEFINE_MUTEX(graph_lock);
3785
3786 int ftrace_graph_count;
3787 int ftrace_graph_notrace_count;
3788 unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
3789 unsigned long ftrace_graph_notrace_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
3790
3791 struct ftrace_graph_data {
3792         unsigned long *table;
3793         size_t size;
3794         int *count;
3795         const struct seq_operations *seq_ops;
3796 };
3797
3798 static void *
3799 __g_next(struct seq_file *m, loff_t *pos)
3800 {
3801         struct ftrace_graph_data *fgd = m->private;
3802
3803         if (*pos >= *fgd->count)
3804                 return NULL;
3805         return &fgd->table[*pos];
3806 }
3807
3808 static void *
3809 g_next(struct seq_file *m, void *v, loff_t *pos)
3810 {
3811         (*pos)++;
3812         return __g_next(m, pos);
3813 }
3814
3815 static void *g_start(struct seq_file *m, loff_t *pos)
3816 {
3817         struct ftrace_graph_data *fgd = m->private;
3818
3819         mutex_lock(&graph_lock);
3820
3821         /* Nothing, tell g_show to print all functions are enabled */
3822         if (!*fgd->count && !*pos)
3823                 return (void *)1;
3824
3825         return __g_next(m, pos);
3826 }
3827
3828 static void g_stop(struct seq_file *m, void *p)
3829 {
3830         mutex_unlock(&graph_lock);
3831 }
3832
3833 static int g_show(struct seq_file *m, void *v)
3834 {
3835         unsigned long *ptr = v;
3836
3837         if (!ptr)
3838                 return 0;
3839
3840         if (ptr == (unsigned long *)1) {
3841                 seq_printf(m, "#### all functions enabled ####\n");
3842                 return 0;
3843         }
3844
3845         seq_printf(m, "%ps\n", (void *)*ptr);
3846
3847         return 0;
3848 }
3849
3850 static const struct seq_operations ftrace_graph_seq_ops = {
3851         .start = g_start,
3852         .next = g_next,
3853         .stop = g_stop,
3854         .show = g_show,
3855 };
3856
3857 static int
3858 __ftrace_graph_open(struct inode *inode, struct file *file,
3859                     struct ftrace_graph_data *fgd)
3860 {
3861         int ret = 0;
3862
3863         mutex_lock(&graph_lock);
3864         if ((file->f_mode & FMODE_WRITE) &&
3865             (file->f_flags & O_TRUNC)) {
3866                 *fgd->count = 0;
3867                 memset(fgd->table, 0, fgd->size * sizeof(*fgd->table));
3868         }
3869         mutex_unlock(&graph_lock);
3870
3871         if (file->f_mode & FMODE_READ) {
3872                 ret = seq_open(file, fgd->seq_ops);
3873                 if (!ret) {
3874                         struct seq_file *m = file->private_data;
3875                         m->private = fgd;
3876                 }
3877         } else
3878                 file->private_data = fgd;
3879
3880         return ret;
3881 }
3882
3883 static int
3884 ftrace_graph_open(struct inode *inode, struct file *file)
3885 {
3886         struct ftrace_graph_data *fgd;
3887
3888         if (unlikely(ftrace_disabled))
3889                 return -ENODEV;
3890
3891         fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
3892         if (fgd == NULL)
3893                 return -ENOMEM;
3894
3895         fgd->table = ftrace_graph_funcs;
3896         fgd->size = FTRACE_GRAPH_MAX_FUNCS;
3897         fgd->count = &ftrace_graph_count;
3898         fgd->seq_ops = &ftrace_graph_seq_ops;
3899
3900         return __ftrace_graph_open(inode, file, fgd);
3901 }
3902
3903 static int
3904 ftrace_graph_notrace_open(struct inode *inode, struct file *file)
3905 {
3906         struct ftrace_graph_data *fgd;
3907
3908         if (unlikely(ftrace_disabled))
3909                 return -ENODEV;
3910
3911         fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
3912         if (fgd == NULL)
3913                 return -ENOMEM;
3914
3915         fgd->table = ftrace_graph_notrace_funcs;
3916         fgd->size = FTRACE_GRAPH_MAX_FUNCS;
3917         fgd->count = &ftrace_graph_notrace_count;
3918         fgd->seq_ops = &ftrace_graph_seq_ops;
3919
3920         return __ftrace_graph_open(inode, file, fgd);
3921 }
3922
3923 static int
3924 ftrace_graph_release(struct inode *inode, struct file *file)
3925 {
3926         if (file->f_mode & FMODE_READ) {
3927                 struct seq_file *m = file->private_data;
3928
3929                 kfree(m->private);
3930                 seq_release(inode, file);
3931         } else {
3932                 kfree(file->private_data);
3933         }
3934
3935         return 0;
3936 }
3937
3938 static int
3939 ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer)
3940 {
3941         struct dyn_ftrace *rec;
3942         struct ftrace_page *pg;
3943         int search_len;
3944         int fail = 1;
3945         int type, not;
3946         char *search;
3947         bool exists;
3948         int i;
3949
3950         /* decode regex */
3951         type = filter_parse_regex(buffer, strlen(buffer), &search, &not);
3952         if (!not && *idx >= size)
3953                 return -EBUSY;
3954
3955         search_len = strlen(search);
3956
3957         mutex_lock(&ftrace_lock);
3958
3959         if (unlikely(ftrace_disabled)) {
3960                 mutex_unlock(&ftrace_lock);
3961                 return -ENODEV;
3962         }
3963
3964         do_for_each_ftrace_rec(pg, rec) {
3965
3966                 if (ftrace_match_record(rec, NULL, search, search_len, type)) {
3967                         /* if it is in the array */
3968                         exists = false;
3969                         for (i = 0; i < *idx; i++) {
3970                                 if (array[i] == rec->ip) {
3971                                         exists = true;
3972                                         break;
3973                                 }
3974                         }
3975
3976                         if (!not) {
3977                                 fail = 0;
3978                                 if (!exists) {
3979                                         array[(*idx)++] = rec->ip;
3980                                         if (*idx >= size)
3981                                                 goto out;
3982                                 }
3983                         } else {
3984                                 if (exists) {
3985                                         array[i] = array[--(*idx)];
3986                                         array[*idx] = 0;
3987                                         fail = 0;
3988                                 }
3989                         }
3990                 }
3991         } while_for_each_ftrace_rec();
3992 out:
3993         mutex_unlock(&ftrace_lock);
3994
3995         if (fail)
3996                 return -EINVAL;
3997
3998         return 0;
3999 }
4000
4001 static ssize_t
4002 ftrace_graph_write(struct file *file, const char __user *ubuf,
4003                    size_t cnt, loff_t *ppos)
4004 {
4005         struct trace_parser parser;
4006         ssize_t read, ret = 0;
4007         struct ftrace_graph_data *fgd = file->private_data;
4008
4009         if (!cnt)
4010                 return 0;
4011
4012         if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX))
4013                 return -ENOMEM;
4014
4015         read = trace_get_user(&parser, ubuf, cnt, ppos);
4016
4017         if (read >= 0 && trace_parser_loaded((&parser))) {
4018                 parser.buffer[parser.idx] = 0;
4019
4020                 mutex_lock(&graph_lock);
4021
4022                 /* we allow only one expression at a time */
4023                 ret = ftrace_set_func(fgd->table, fgd->count, fgd->size,
4024                                       parser.buffer);
4025
4026                 mutex_unlock(&graph_lock);
4027         }
4028
4029         if (!ret)
4030                 ret = read;
4031
4032         trace_parser_put(&parser);
4033
4034         return ret;
4035 }
4036
4037 static const struct file_operations ftrace_graph_fops = {
4038         .open           = ftrace_graph_open,
4039         .read           = seq_read,
4040         .write          = ftrace_graph_write,
4041         .llseek         = ftrace_filter_lseek,
4042         .release        = ftrace_graph_release,
4043 };
4044
4045 static const struct file_operations ftrace_graph_notrace_fops = {
4046         .open           = ftrace_graph_notrace_open,
4047         .read           = seq_read,
4048         .write          = ftrace_graph_write,
4049         .llseek         = ftrace_filter_lseek,
4050         .release        = ftrace_graph_release,
4051 };
4052 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4053
4054 static __init int ftrace_init_dyn_debugfs(struct dentry *d_tracer)
4055 {
4056
4057         trace_create_file("available_filter_functions", 0444,
4058                         d_tracer, NULL, &ftrace_avail_fops);
4059
4060         trace_create_file("enabled_functions", 0444,
4061                         d_tracer, NULL, &ftrace_enabled_fops);
4062
4063         trace_create_file("set_ftrace_filter", 0644, d_tracer,
4064                         NULL, &ftrace_filter_fops);
4065
4066         trace_create_file("set_ftrace_notrace", 0644, d_tracer,
4067                                     NULL, &ftrace_notrace_fops);
4068
4069 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4070         trace_create_file("set_graph_function", 0444, d_tracer,
4071                                     NULL,
4072                                     &ftrace_graph_fops);
4073         trace_create_file("set_graph_notrace", 0444, d_tracer,
4074                                     NULL,
4075                                     &ftrace_graph_notrace_fops);
4076 #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4077
4078         return 0;
4079 }
4080
4081 static int ftrace_cmp_ips(const void *a, const void *b)
4082 {
4083         const unsigned long *ipa = a;
4084         const unsigned long *ipb = b;
4085
4086         if (*ipa > *ipb)
4087                 return 1;
4088         if (*ipa < *ipb)
4089                 return -1;
4090         return 0;
4091 }
4092
4093 static void ftrace_swap_ips(void *a, void *b, int size)
4094 {
4095         unsigned long *ipa = a;
4096         unsigned long *ipb = b;
4097         unsigned long t;
4098
4099         t = *ipa;
4100         *ipa = *ipb;
4101         *ipb = t;
4102 }
4103
4104 static int ftrace_process_locs(struct module *mod,
4105                                unsigned long *start,
4106                                unsigned long *end)
4107 {
4108         struct ftrace_page *start_pg;
4109         struct ftrace_page *pg;
4110         struct dyn_ftrace *rec;
4111         unsigned long count;
4112         unsigned long *p;
4113         unsigned long addr;
4114         unsigned long flags = 0; /* Shut up gcc */
4115         int ret = -ENOMEM;
4116
4117         count = end - start;
4118
4119         if (!count)
4120                 return 0;
4121
4122         sort(start, count, sizeof(*start),
4123              ftrace_cmp_ips, ftrace_swap_ips);
4124
4125         start_pg = ftrace_allocate_pages(count);
4126         if (!start_pg)
4127                 return -ENOMEM;
4128
4129         mutex_lock(&ftrace_lock);
4130
4131         /*
4132          * Core and each module needs their own pages, as
4133          * modules will free them when they are removed.
4134          * Force a new page to be allocated for modules.
4135          */
4136         if (!mod) {
4137                 WARN_ON(ftrace_pages || ftrace_pages_start);
4138                 /* First initialization */
4139                 ftrace_pages = ftrace_pages_start = start_pg;
4140         } else {
4141                 if (!ftrace_pages)
4142                         goto out;
4143
4144                 if (WARN_ON(ftrace_pages->next)) {
4145                         /* Hmm, we have free pages? */
4146                         while (ftrace_pages->next)
4147                                 ftrace_pages = ftrace_pages->next;
4148                 }
4149
4150                 ftrace_pages->next = start_pg;
4151         }
4152
4153         p = start;
4154         pg = start_pg;
4155         while (p < end) {
4156                 addr = ftrace_call_adjust(*p++);
4157                 /*
4158                  * Some architecture linkers will pad between
4159                  * the different mcount_loc sections of different
4160                  * object files to satisfy alignments.
4161                  * Skip any NULL pointers.
4162                  */
4163                 if (!addr)
4164                         continue;
4165
4166                 if (pg->index == pg->size) {
4167                         /* We should have allocated enough */
4168                         if (WARN_ON(!pg->next))
4169                                 break;
4170                         pg = pg->next;
4171                 }
4172
4173                 rec = &pg->records[pg->index++];
4174                 rec->ip = addr;
4175         }
4176
4177         /* We should have used all pages */
4178         WARN_ON(pg->next);
4179
4180         /* Assign the last page to ftrace_pages */
4181         ftrace_pages = pg;
4182
4183         /* These new locations need to be initialized */
4184         ftrace_new_pgs = start_pg;
4185
4186         /*
4187          * We only need to disable interrupts on start up
4188          * because we are modifying code that an interrupt
4189          * may execute, and the modification is not atomic.
4190          * But for modules, nothing runs the code we modify
4191          * until we are finished with it, and there's no
4192          * reason to cause large interrupt latencies while we do it.
4193          */
4194         if (!mod)
4195                 local_irq_save(flags);
4196         ftrace_update_code(mod);
4197         if (!mod)
4198                 local_irq_restore(flags);
4199         ret = 0;
4200  out:
4201         mutex_unlock(&ftrace_lock);
4202
4203         return ret;
4204 }
4205
4206 #ifdef CONFIG_MODULES
4207
4208 #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
4209
4210 void ftrace_release_mod(struct module *mod)
4211 {
4212         struct dyn_ftrace *rec;
4213         struct ftrace_page **last_pg;
4214         struct ftrace_page *pg;
4215         int order;
4216
4217         mutex_lock(&ftrace_lock);
4218
4219         if (ftrace_disabled)
4220                 goto out_unlock;
4221
4222         /*
4223          * Each module has its own ftrace_pages, remove
4224          * them from the list.
4225          */
4226         last_pg = &ftrace_pages_start;
4227         for (pg = ftrace_pages_start; pg; pg = *last_pg) {
4228                 rec = &pg->records[0];
4229                 if (within_module_core(rec->ip, mod)) {
4230                         /*
4231                          * As core pages are first, the first
4232                          * page should never be a module page.
4233                          */
4234                         if (WARN_ON(pg == ftrace_pages_start))
4235                                 goto out_unlock;
4236
4237                         /* Check if we are deleting the last page */
4238                         if (pg == ftrace_pages)
4239                                 ftrace_pages = next_to_ftrace_page(last_pg);
4240
4241                         *last_pg = pg->next;
4242                         order = get_count_order(pg->size / ENTRIES_PER_PAGE);
4243                         free_pages((unsigned long)pg->records, order);
4244                         kfree(pg);
4245                 } else
4246                         last_pg = &pg->next;
4247         }
4248  out_unlock:
4249         mutex_unlock(&ftrace_lock);
4250 }
4251
4252 static void ftrace_init_module(struct module *mod,
4253                                unsigned long *start, unsigned long *end)
4254 {
4255         if (ftrace_disabled || start == end)
4256                 return;
4257         ftrace_process_locs(mod, start, end);
4258 }
4259
4260 static int ftrace_module_notify_enter(struct notifier_block *self,
4261                                       unsigned long val, void *data)
4262 {
4263         struct module *mod = data;
4264
4265         if (val == MODULE_STATE_COMING)
4266                 ftrace_init_module(mod, mod->ftrace_callsites,
4267                                    mod->ftrace_callsites +
4268                                    mod->num_ftrace_callsites);
4269         return 0;
4270 }
4271
4272 static int ftrace_module_notify_exit(struct notifier_block *self,
4273                                      unsigned long val, void *data)
4274 {
4275         struct module *mod = data;
4276
4277         if (val == MODULE_STATE_GOING)
4278                 ftrace_release_mod(mod);
4279
4280         return 0;
4281 }
4282 #else
4283 static int ftrace_module_notify_enter(struct notifier_block *self,
4284                                       unsigned long val, void *data)
4285 {
4286         return 0;
4287 }
4288 static int ftrace_module_notify_exit(struct notifier_block *self,
4289                                      unsigned long val, void *data)
4290 {
4291         return 0;
4292 }
4293 #endif /* CONFIG_MODULES */
4294
4295 struct notifier_block ftrace_module_enter_nb = {
4296         .notifier_call = ftrace_module_notify_enter,
4297         .priority = INT_MAX,    /* Run before anything that can use kprobes */
4298 };
4299
4300 struct notifier_block ftrace_module_exit_nb = {
4301         .notifier_call = ftrace_module_notify_exit,
4302         .priority = INT_MIN,    /* Run after anything that can remove kprobes */
4303 };
4304
4305 extern unsigned long __start_mcount_loc[];
4306 extern unsigned long __stop_mcount_loc[];
4307
4308 void __init ftrace_init(void)
4309 {
4310         unsigned long count, addr, flags;
4311         int ret;
4312
4313         /* Keep the ftrace pointer to the stub */
4314         addr = (unsigned long)ftrace_stub;
4315
4316         local_irq_save(flags);
4317         ftrace_dyn_arch_init(&addr);
4318         local_irq_restore(flags);
4319
4320         /* ftrace_dyn_arch_init places the return code in addr */
4321         if (addr)
4322                 goto failed;
4323
4324         count = __stop_mcount_loc - __start_mcount_loc;
4325
4326         ret = ftrace_dyn_table_alloc(count);
4327         if (ret)
4328                 goto failed;
4329
4330         last_ftrace_enabled = ftrace_enabled = 1;
4331
4332         ret = ftrace_process_locs(NULL,
4333                                   __start_mcount_loc,
4334                                   __stop_mcount_loc);
4335
4336         ret = register_module_notifier(&ftrace_module_enter_nb);
4337         if (ret)
4338                 pr_warning("Failed to register trace ftrace module enter notifier\n");
4339
4340         ret = register_module_notifier(&ftrace_module_exit_nb);
4341         if (ret)
4342                 pr_warning("Failed to register trace ftrace module exit notifier\n");
4343
4344         set_ftrace_early_filters();
4345
4346         return;
4347  failed:
4348         ftrace_disabled = 1;
4349 }
4350
4351 #else
4352
4353 static struct ftrace_ops global_ops = {
4354         .func                   = ftrace_stub,
4355         .flags                  = FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
4356         INIT_REGEX_LOCK(global_ops)
4357 };
4358
4359 static int __init ftrace_nodyn_init(void)
4360 {
4361         ftrace_enabled = 1;
4362         return 0;
4363 }
4364 core_initcall(ftrace_nodyn_init);
4365
4366 static inline int ftrace_init_dyn_debugfs(struct dentry *d_tracer) { return 0; }
4367 static inline void ftrace_startup_enable(int command) { }
4368 /* Keep as macros so we do not need to define the commands */
4369 # define ftrace_startup(ops, command)                   \
4370         ({                                              \
4371                 (ops)->flags |= FTRACE_OPS_FL_ENABLED;  \
4372                 0;                                      \
4373         })
4374 # define ftrace_shutdown(ops, command)  do { } while (0)
4375 # define ftrace_startup_sysctl()        do { } while (0)
4376 # define ftrace_shutdown_sysctl()       do { } while (0)
4377
4378 static inline int
4379 ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
4380 {
4381         return 1;
4382 }
4383
4384 #endif /* CONFIG_DYNAMIC_FTRACE */
4385
4386 static void
4387 ftrace_ops_control_func(unsigned long ip, unsigned long parent_ip,
4388                         struct ftrace_ops *op, struct pt_regs *regs)
4389 {
4390         if (unlikely(trace_recursion_test(TRACE_CONTROL_BIT)))
4391                 return;
4392
4393         /*
4394          * Some of the ops may be dynamically allocated,
4395          * they must be freed after a synchronize_sched().
4396          */
4397         preempt_disable_notrace();
4398         trace_recursion_set(TRACE_CONTROL_BIT);
4399
4400         /*
4401          * Control funcs (perf) uses RCU. Only trace if
4402          * RCU is currently active.
4403          */
4404         if (!rcu_is_watching())
4405                 goto out;
4406
4407         do_for_each_ftrace_op(op, ftrace_control_list) {
4408                 if (!(op->flags & FTRACE_OPS_FL_STUB) &&
4409                     !ftrace_function_local_disabled(op) &&
4410                     ftrace_ops_test(op, ip, regs))
4411                         op->func(ip, parent_ip, op, regs);
4412         } while_for_each_ftrace_op(op);
4413  out:
4414         trace_recursion_clear(TRACE_CONTROL_BIT);
4415         preempt_enable_notrace();
4416 }
4417
4418 static struct ftrace_ops control_ops = {
4419         .func   = ftrace_ops_control_func,
4420         .flags  = FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
4421         INIT_REGEX_LOCK(control_ops)
4422 };
4423
4424 static inline void
4425 __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
4426                        struct ftrace_ops *ignored, struct pt_regs *regs)
4427 {
4428         struct ftrace_ops *op;
4429         int bit;
4430
4431         if (function_trace_stop)
4432                 return;
4433
4434         bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
4435         if (bit < 0)
4436                 return;
4437
4438         /*
4439          * Some of the ops may be dynamically allocated,
4440          * they must be freed after a synchronize_sched().
4441          */
4442         preempt_disable_notrace();
4443         do_for_each_ftrace_op(op, ftrace_ops_list) {
4444                 if (ftrace_ops_test(op, ip, regs))
4445                         op->func(ip, parent_ip, op, regs);
4446         } while_for_each_ftrace_op(op);
4447         preempt_enable_notrace();
4448         trace_clear_recursion(bit);
4449 }
4450
4451 /*
4452  * Some archs only support passing ip and parent_ip. Even though
4453  * the list function ignores the op parameter, we do not want any
4454  * C side effects, where a function is called without the caller
4455  * sending a third parameter.
4456  * Archs are to support both the regs and ftrace_ops at the same time.
4457  * If they support ftrace_ops, it is assumed they support regs.
4458  * If call backs want to use regs, they must either check for regs
4459  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
4460  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
4461  * An architecture can pass partial regs with ftrace_ops and still
4462  * set the ARCH_SUPPORT_FTARCE_OPS.
4463  */
4464 #if ARCH_SUPPORTS_FTRACE_OPS
4465 static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
4466                                  struct ftrace_ops *op, struct pt_regs *regs)
4467 {
4468         __ftrace_ops_list_func(ip, parent_ip, NULL, regs);
4469 }
4470 #else
4471 static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
4472 {
4473         __ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
4474 }
4475 #endif
4476
4477 static void clear_ftrace_swapper(void)
4478 {
4479         struct task_struct *p;
4480         int cpu;
4481
4482         get_online_cpus();
4483         for_each_online_cpu(cpu) {
4484                 p = idle_task(cpu);
4485                 clear_tsk_trace_trace(p);
4486         }
4487         put_online_cpus();
4488 }
4489
4490 static void set_ftrace_swapper(void)
4491 {
4492         struct task_struct *p;
4493         int cpu;
4494
4495         get_online_cpus();
4496         for_each_online_cpu(cpu) {
4497                 p = idle_task(cpu);
4498                 set_tsk_trace_trace(p);
4499         }
4500         put_online_cpus();
4501 }
4502
4503 static void clear_ftrace_pid(struct pid *pid)
4504 {
4505         struct task_struct *p;
4506
4507         rcu_read_lock();
4508         do_each_pid_task(pid, PIDTYPE_PID, p) {
4509                 clear_tsk_trace_trace(p);
4510         } while_each_pid_task(pid, PIDTYPE_PID, p);
4511         rcu_read_unlock();
4512
4513         put_pid(pid);
4514 }
4515
4516 static void set_ftrace_pid(struct pid *pid)
4517 {
4518         struct task_struct *p;
4519
4520         rcu_read_lock();
4521         do_each_pid_task(pid, PIDTYPE_PID, p) {
4522                 set_tsk_trace_trace(p);
4523         } while_each_pid_task(pid, PIDTYPE_PID, p);
4524         rcu_read_unlock();
4525 }
4526
4527 static void clear_ftrace_pid_task(struct pid *pid)
4528 {
4529         if (pid == ftrace_swapper_pid)
4530                 clear_ftrace_swapper();
4531         else
4532                 clear_ftrace_pid(pid);
4533 }
4534
4535 static void set_ftrace_pid_task(struct pid *pid)
4536 {
4537         if (pid == ftrace_swapper_pid)
4538                 set_ftrace_swapper();
4539         else
4540                 set_ftrace_pid(pid);
4541 }
4542
4543 static int ftrace_pid_add(int p)
4544 {
4545         struct pid *pid;
4546         struct ftrace_pid *fpid;
4547         int ret = -EINVAL;
4548
4549         mutex_lock(&ftrace_lock);
4550
4551         if (!p)
4552                 pid = ftrace_swapper_pid;
4553         else
4554                 pid = find_get_pid(p);
4555
4556         if (!pid)
4557                 goto out;
4558
4559         ret = 0;
4560
4561         list_for_each_entry(fpid, &ftrace_pids, list)
4562                 if (fpid->pid == pid)
4563                         goto out_put;
4564
4565         ret = -ENOMEM;
4566
4567         fpid = kmalloc(sizeof(*fpid), GFP_KERNEL);
4568         if (!fpid)
4569                 goto out_put;
4570
4571         list_add(&fpid->list, &ftrace_pids);
4572         fpid->pid = pid;
4573
4574         set_ftrace_pid_task(pid);
4575
4576         ftrace_update_pid_func();
4577         ftrace_startup_enable(0);
4578
4579         mutex_unlock(&ftrace_lock);
4580         return 0;
4581
4582 out_put:
4583         if (pid != ftrace_swapper_pid)
4584                 put_pid(pid);
4585
4586 out:
4587         mutex_unlock(&ftrace_lock);
4588         return ret;
4589 }
4590
4591 static void ftrace_pid_reset(void)
4592 {
4593         struct ftrace_pid *fpid, *safe;
4594
4595         mutex_lock(&ftrace_lock);
4596         list_for_each_entry_safe(fpid, safe, &ftrace_pids, list) {
4597                 struct pid *pid = fpid->pid;
4598
4599                 clear_ftrace_pid_task(pid);
4600
4601                 list_del(&fpid->list);
4602                 kfree(fpid);
4603         }
4604
4605         ftrace_update_pid_func();
4606         ftrace_startup_enable(0);
4607
4608         mutex_unlock(&ftrace_lock);
4609 }
4610
4611 static void *fpid_start(struct seq_file *m, loff_t *pos)
4612 {
4613         mutex_lock(&ftrace_lock);
4614
4615         if (list_empty(&ftrace_pids) && (!*pos))
4616                 return (void *) 1;
4617
4618         return seq_list_start(&ftrace_pids, *pos);
4619 }
4620
4621 static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
4622 {
4623         if (v == (void *)1)
4624                 return NULL;
4625
4626         return seq_list_next(v, &ftrace_pids, pos);
4627 }
4628
4629 static void fpid_stop(struct seq_file *m, void *p)
4630 {
4631         mutex_unlock(&ftrace_lock);
4632 }
4633
4634 static int fpid_show(struct seq_file *m, void *v)
4635 {
4636         const struct ftrace_pid *fpid = list_entry(v, struct ftrace_pid, list);
4637
4638         if (v == (void *)1) {
4639                 seq_printf(m, "no pid\n");
4640                 return 0;
4641         }
4642
4643         if (fpid->pid == ftrace_swapper_pid)
4644                 seq_printf(m, "swapper tasks\n");
4645         else
4646                 seq_printf(m, "%u\n", pid_vnr(fpid->pid));
4647
4648         return 0;
4649 }
4650
4651 static const struct seq_operations ftrace_pid_sops = {
4652         .start = fpid_start,
4653         .next = fpid_next,
4654         .stop = fpid_stop,
4655         .show = fpid_show,
4656 };
4657
4658 static int
4659 ftrace_pid_open(struct inode *inode, struct file *file)
4660 {
4661         int ret = 0;
4662
4663         if ((file->f_mode & FMODE_WRITE) &&
4664             (file->f_flags & O_TRUNC))
4665                 ftrace_pid_reset();
4666
4667         if (file->f_mode & FMODE_READ)
4668                 ret = seq_open(file, &ftrace_pid_sops);
4669
4670         return ret;
4671 }
4672
4673 static ssize_t
4674 ftrace_pid_write(struct file *filp, const char __user *ubuf,
4675                    size_t cnt, loff_t *ppos)
4676 {
4677         char buf[64], *tmp;
4678         long val;
4679         int ret;
4680
4681         if (cnt >= sizeof(buf))
4682                 return -EINVAL;
4683
4684         if (copy_from_user(&buf, ubuf, cnt))
4685                 return -EFAULT;
4686
4687         buf[cnt] = 0;
4688
4689         /*
4690          * Allow "echo > set_ftrace_pid" or "echo -n '' > set_ftrace_pid"
4691          * to clean the filter quietly.
4692          */
4693         tmp = strstrip(buf);
4694         if (strlen(tmp) == 0)
4695                 return 1;
4696
4697         ret = kstrtol(tmp, 10, &val);
4698         if (ret < 0)
4699                 return ret;
4700
4701         ret = ftrace_pid_add(val);
4702
4703         return ret ? ret : cnt;
4704 }
4705
4706 static int
4707 ftrace_pid_release(struct inode *inode, struct file *file)
4708 {
4709         if (file->f_mode & FMODE_READ)
4710                 seq_release(inode, file);
4711
4712         return 0;
4713 }
4714
4715 static const struct file_operations ftrace_pid_fops = {
4716         .open           = ftrace_pid_open,
4717         .write          = ftrace_pid_write,
4718         .read           = seq_read,
4719         .llseek         = ftrace_filter_lseek,
4720         .release        = ftrace_pid_release,
4721 };
4722
4723 static __init int ftrace_init_debugfs(void)
4724 {
4725         struct dentry *d_tracer;
4726
4727         d_tracer = tracing_init_dentry();
4728         if (!d_tracer)
4729                 return 0;
4730
4731         ftrace_init_dyn_debugfs(d_tracer);
4732
4733         trace_create_file("set_ftrace_pid", 0644, d_tracer,
4734                             NULL, &ftrace_pid_fops);
4735
4736         ftrace_profile_debugfs(d_tracer);
4737
4738         return 0;
4739 }
4740 fs_initcall(ftrace_init_debugfs);
4741
4742 /**
4743  * ftrace_kill - kill ftrace
4744  *
4745  * This function should be used by panic code. It stops ftrace
4746  * but in a not so nice way. If you need to simply kill ftrace
4747  * from a non-atomic section, use ftrace_kill.
4748  */
4749 void ftrace_kill(void)
4750 {
4751         ftrace_disabled = 1;
4752         ftrace_enabled = 0;
4753         clear_ftrace_function();
4754 }
4755
4756 /**
4757  * Test if ftrace is dead or not.
4758  */
4759 int ftrace_is_dead(void)
4760 {
4761         return ftrace_disabled;
4762 }
4763
4764 /**
4765  * register_ftrace_function - register a function for profiling
4766  * @ops - ops structure that holds the function for profiling.
4767  *
4768  * Register a function to be called by all functions in the
4769  * kernel.
4770  *
4771  * Note: @ops->func and all the functions it calls must be labeled
4772  *       with "notrace", otherwise it will go into a
4773  *       recursive loop.
4774  */
4775 int register_ftrace_function(struct ftrace_ops *ops)
4776 {
4777         int ret = -1;
4778
4779         ftrace_ops_init(ops);
4780
4781         mutex_lock(&ftrace_lock);
4782
4783         ret = __register_ftrace_function(ops);
4784         if (!ret)
4785                 ret = ftrace_startup(ops, 0);
4786
4787         mutex_unlock(&ftrace_lock);
4788
4789         return ret;
4790 }
4791 EXPORT_SYMBOL_GPL(register_ftrace_function);
4792
4793 /**
4794  * unregister_ftrace_function - unregister a function for profiling.
4795  * @ops - ops structure that holds the function to unregister
4796  *
4797  * Unregister a function that was added to be called by ftrace profiling.
4798  */
4799 int unregister_ftrace_function(struct ftrace_ops *ops)
4800 {
4801         int ret;
4802
4803         mutex_lock(&ftrace_lock);
4804         ret = __unregister_ftrace_function(ops);
4805         if (!ret)
4806                 ftrace_shutdown(ops, 0);
4807         mutex_unlock(&ftrace_lock);
4808
4809         return ret;
4810 }
4811 EXPORT_SYMBOL_GPL(unregister_ftrace_function);
4812
4813 int
4814 ftrace_enable_sysctl(struct ctl_table *table, int write,
4815                      void __user *buffer, size_t *lenp,
4816                      loff_t *ppos)
4817 {
4818         int ret = -ENODEV;
4819
4820         mutex_lock(&ftrace_lock);
4821
4822         if (unlikely(ftrace_disabled))
4823                 goto out;
4824
4825         ret = proc_dointvec(table, write, buffer, lenp, ppos);
4826
4827         if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
4828                 goto out;
4829
4830         last_ftrace_enabled = !!ftrace_enabled;
4831
4832         if (ftrace_enabled) {
4833
4834                 ftrace_startup_sysctl();
4835
4836                 /* we are starting ftrace again */
4837                 if (ftrace_ops_list != &ftrace_list_end)
4838                         update_ftrace_function();
4839
4840         } else {
4841                 /* stopping ftrace calls (just send to ftrace_stub) */
4842                 ftrace_trace_function = ftrace_stub;
4843
4844                 ftrace_shutdown_sysctl();
4845         }
4846
4847  out:
4848         mutex_unlock(&ftrace_lock);
4849         return ret;
4850 }
4851
4852 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4853
4854 static int ftrace_graph_active;
4855 static struct notifier_block ftrace_suspend_notifier;
4856
4857 int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
4858 {
4859         return 0;
4860 }
4861
4862 /* The callbacks that hook a function */
4863 trace_func_graph_ret_t ftrace_graph_return =
4864                         (trace_func_graph_ret_t)ftrace_stub;
4865 trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
4866
4867 /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
4868 static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
4869 {
4870         int i;
4871         int ret = 0;
4872         unsigned long flags;
4873         int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
4874         struct task_struct *g, *t;
4875
4876         for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
4877                 ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
4878                                         * sizeof(struct ftrace_ret_stack),
4879                                         GFP_KERNEL);
4880                 if (!ret_stack_list[i]) {
4881                         start = 0;
4882                         end = i;
4883                         ret = -ENOMEM;
4884                         goto free;
4885                 }
4886         }
4887
4888         read_lock_irqsave(&tasklist_lock, flags);
4889         do_each_thread(g, t) {
4890                 if (start == end) {
4891                         ret = -EAGAIN;
4892                         goto unlock;
4893                 }
4894
4895                 if (t->ret_stack == NULL) {
4896                         atomic_set(&t->tracing_graph_pause, 0);
4897                         atomic_set(&t->trace_overrun, 0);
4898                         t->curr_ret_stack = -1;
4899                         /* Make sure the tasks see the -1 first: */
4900                         smp_wmb();
4901                         t->ret_stack = ret_stack_list[start++];
4902                 }
4903         } while_each_thread(g, t);
4904
4905 unlock:
4906         read_unlock_irqrestore(&tasklist_lock, flags);
4907 free:
4908         for (i = start; i < end; i++)
4909                 kfree(ret_stack_list[i]);
4910         return ret;
4911 }
4912
4913 static void
4914 ftrace_graph_probe_sched_switch(void *ignore,
4915                         struct task_struct *prev, struct task_struct *next)
4916 {
4917         unsigned long long timestamp;
4918         int index;
4919
4920         /*
4921          * Does the user want to count the time a function was asleep.
4922          * If so, do not update the time stamps.
4923          */
4924         if (trace_flags & TRACE_ITER_SLEEP_TIME)
4925                 return;
4926
4927         timestamp = trace_clock_local();
4928
4929         prev->ftrace_timestamp = timestamp;
4930
4931         /* only process tasks that we timestamped */
4932         if (!next->ftrace_timestamp)
4933                 return;
4934
4935         /*
4936          * Update all the counters in next to make up for the
4937          * time next was sleeping.
4938          */
4939         timestamp -= next->ftrace_timestamp;
4940
4941         for (index = next->curr_ret_stack; index >= 0; index--)
4942                 next->ret_stack[index].calltime += timestamp;
4943 }
4944
4945 /* Allocate a return stack for each task */
4946 static int start_graph_tracing(void)
4947 {
4948         struct ftrace_ret_stack **ret_stack_list;
4949         int ret, cpu;
4950
4951         ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
4952                                 sizeof(struct ftrace_ret_stack *),
4953                                 GFP_KERNEL);
4954
4955         if (!ret_stack_list)
4956                 return -ENOMEM;
4957
4958         /* The cpu_boot init_task->ret_stack will never be freed */
4959         for_each_online_cpu(cpu) {
4960                 if (!idle_task(cpu)->ret_stack)
4961                         ftrace_graph_init_idle_task(idle_task(cpu), cpu);
4962         }
4963
4964         do {
4965                 ret = alloc_retstack_tasklist(ret_stack_list);
4966         } while (ret == -EAGAIN);
4967
4968         if (!ret) {
4969                 ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
4970                 if (ret)
4971                         pr_info("ftrace_graph: Couldn't activate tracepoint"
4972                                 " probe to kernel_sched_switch\n");
4973         }
4974
4975         kfree(ret_stack_list);
4976         return ret;
4977 }
4978
4979 /*
4980  * Hibernation protection.
4981  * The state of the current task is too much unstable during
4982  * suspend/restore to disk. We want to protect against that.
4983  */
4984 static int
4985 ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
4986                                                         void *unused)
4987 {
4988         switch (state) {
4989         case PM_HIBERNATION_PREPARE:
4990                 pause_graph_tracing();
4991                 break;
4992
4993         case PM_POST_HIBERNATION:
4994                 unpause_graph_tracing();
4995                 break;
4996         }
4997         return NOTIFY_DONE;
4998 }
4999
5000 int register_ftrace_graph(trace_func_graph_ret_t retfunc,
5001                         trace_func_graph_ent_t entryfunc)
5002 {
5003         int ret = 0;
5004
5005         mutex_lock(&ftrace_lock);
5006
5007         /* we currently allow only one tracer registered at a time */
5008         if (ftrace_graph_active) {
5009                 ret = -EBUSY;
5010                 goto out;
5011         }
5012
5013         ftrace_suspend_notifier.notifier_call = ftrace_suspend_notifier_call;
5014         register_pm_notifier(&ftrace_suspend_notifier);
5015
5016         ftrace_graph_active++;
5017         ret = start_graph_tracing();
5018         if (ret) {
5019                 ftrace_graph_active--;
5020                 goto out;
5021         }
5022
5023         ftrace_graph_return = retfunc;
5024         ftrace_graph_entry = entryfunc;
5025
5026         ret = ftrace_startup(&global_ops, FTRACE_START_FUNC_RET);
5027
5028 out:
5029         mutex_unlock(&ftrace_lock);
5030         return ret;
5031 }
5032
5033 void unregister_ftrace_graph(void)
5034 {
5035         mutex_lock(&ftrace_lock);
5036
5037         if (unlikely(!ftrace_graph_active))
5038                 goto out;
5039
5040         ftrace_graph_active--;
5041         ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
5042         ftrace_graph_entry = ftrace_graph_entry_stub;
5043         ftrace_shutdown(&global_ops, FTRACE_STOP_FUNC_RET);
5044         unregister_pm_notifier(&ftrace_suspend_notifier);
5045         unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
5046
5047  out:
5048         mutex_unlock(&ftrace_lock);
5049 }
5050
5051 static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
5052
5053 static void
5054 graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
5055 {
5056         atomic_set(&t->tracing_graph_pause, 0);
5057         atomic_set(&t->trace_overrun, 0);
5058         t->ftrace_timestamp = 0;
5059         /* make curr_ret_stack visible before we add the ret_stack */
5060         smp_wmb();
5061         t->ret_stack = ret_stack;
5062 }
5063
5064 /*
5065  * Allocate a return stack for the idle task. May be the first
5066  * time through, or it may be done by CPU hotplug online.
5067  */
5068 void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
5069 {
5070         t->curr_ret_stack = -1;
5071         /*
5072          * The idle task has no parent, it either has its own
5073          * stack or no stack at all.
5074          */
5075         if (t->ret_stack)
5076                 WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
5077
5078         if (ftrace_graph_active) {
5079                 struct ftrace_ret_stack *ret_stack;
5080
5081                 ret_stack = per_cpu(idle_ret_stack, cpu);
5082                 if (!ret_stack) {
5083                         ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
5084                                             * sizeof(struct ftrace_ret_stack),
5085                                             GFP_KERNEL);
5086                         if (!ret_stack)
5087                                 return;
5088                         per_cpu(idle_ret_stack, cpu) = ret_stack;
5089                 }
5090                 graph_init_task(t, ret_stack);
5091         }
5092 }
5093
5094 /* Allocate a return stack for newly created task */
5095 void ftrace_graph_init_task(struct task_struct *t)
5096 {
5097         /* Make sure we do not use the parent ret_stack */
5098         t->ret_stack = NULL;
5099         t->curr_ret_stack = -1;
5100
5101         if (ftrace_graph_active) {
5102                 struct ftrace_ret_stack *ret_stack;
5103
5104                 ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
5105                                 * sizeof(struct ftrace_ret_stack),
5106                                 GFP_KERNEL);
5107                 if (!ret_stack)
5108                         return;
5109                 graph_init_task(t, ret_stack);
5110         }
5111 }
5112
5113 void ftrace_graph_exit_task(struct task_struct *t)
5114 {
5115         struct ftrace_ret_stack *ret_stack = t->ret_stack;
5116
5117         t->ret_stack = NULL;
5118         /* NULL must become visible to IRQs before we free it: */
5119         barrier();
5120
5121         kfree(ret_stack);
5122 }
5123
5124 void ftrace_graph_stop(void)
5125 {
5126         ftrace_stop();
5127 }
5128 #endif