git.maemo.org Git - h-e-n/blob - 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 William Lee Irwin III
  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/debugfs.h>
  21 #include <linux/hardirq.h>
  22 #include <linux/kthread.h>
  23 #include <linux/uaccess.h>
  24 #include <linux/kprobes.h>
  25 #include <linux/ftrace.h>
  26 #include <linux/sysctl.h>
  27 #include <linux/ctype.h>
  28 #include <linux/list.h>
  29
  30 #include <asm/ftrace.h>
  31
  32 #include "trace.h"
  33
  34 #define FTRACE_WARN_ON(cond)                    \
  35         do {                                    \
  36                 if (WARN_ON(cond))              \
  37                         ftrace_kill();          \
  38         } while (0)
  39
  40 #define FTRACE_WARN_ON_ONCE(cond)               \
  41         do {                                    \
  42                 if (WARN_ON_ONCE(cond))         \
  43                         ftrace_kill();          \
  44         } while (0)
  45
  46 /* ftrace_enabled is a method to turn ftrace on or off */
  47 int ftrace_enabled __read_mostly;
  48 static int last_ftrace_enabled;
  49
  50 /*
  51  * ftrace_disabled is set when an anomaly is discovered.
  52  * ftrace_disabled is much stronger than ftrace_enabled.
  53  */
  54 static int ftrace_disabled __read_mostly;
  55
  56 static DEFINE_SPINLOCK(ftrace_lock);
  57 static DEFINE_MUTEX(ftrace_sysctl_lock);
  58
  59 static struct ftrace_ops ftrace_list_end __read_mostly =
  60 {
  61         .func = ftrace_stub,
  62 };
  63
  64 static struct ftrace_ops *ftrace_list __read_mostly = &ftrace_list_end;
  65 ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
  66
  67 static void ftrace_list_func(unsigned long ip, unsigned long parent_ip)
  68 {
  69         struct ftrace_ops *op = ftrace_list;
  70
  71         /* in case someone actually ports this to alpha! */
  72         read_barrier_depends();
  73
  74         while (op != &ftrace_list_end) {
  75                 /* silly alpha */
  76                 read_barrier_depends();
  77                 op->func(ip, parent_ip);
  78                 op = op->next;
  79         };
  80 }
  81
  82 /**
  83  * clear_ftrace_function - reset the ftrace function
  84  *
  85  * This NULLs the ftrace function and in essence stops
  86  * tracing.  There may be lag
  87  */
  88 void clear_ftrace_function(void)
  89 {
  90         ftrace_trace_function = ftrace_stub;
  91 }
  92
  93 static int __register_ftrace_function(struct ftrace_ops *ops)
  94 {
  95         /* should not be called from interrupt context */
  96         spin_lock(&ftrace_lock);
  97
  98         ops->next = ftrace_list;
  99         /*
 100          * We are entering ops into the ftrace_list but another
 101          * CPU might be walking that list. We need to make sure
 102          * the ops->next pointer is valid before another CPU sees
 103          * the ops pointer included into the ftrace_list.
 104          */
 105         smp_wmb();
 106         ftrace_list = ops;
 107
 108         if (ftrace_enabled) {
 109                 /*
 110                  * For one func, simply call it directly.
 111                  * For more than one func, call the chain.
 112                  */
 113                 if (ops->next == &ftrace_list_end)
 114                         ftrace_trace_function = ops->func;
 115                 else
 116                         ftrace_trace_function = ftrace_list_func;
 117         }
 118
 119         spin_unlock(&ftrace_lock);
 120
 121         return 0;
 122 }
 123
 124 static int __unregister_ftrace_function(struct ftrace_ops *ops)
 125 {
 126         struct ftrace_ops **p;
 127         int ret = 0;
 128
 129         /* should not be called from interrupt context */
 130         spin_lock(&ftrace_lock);
 131
 132         /*
 133          * If we are removing the last function, then simply point
 134          * to the ftrace_stub.
 135          */
 136         if (ftrace_list == ops && ops->next == &ftrace_list_end) {
 137                 ftrace_trace_function = ftrace_stub;
 138                 ftrace_list = &ftrace_list_end;
 139                 goto out;
 140         }
 141
 142         for (p = &ftrace_list; *p != &ftrace_list_end; p = &(*p)->next)
 143                 if (*p == ops)
 144                         break;
 145
 146         if (*p != ops) {
 147                 ret = -1;
 148                 goto out;
 149         }
 150
 151         *p = (*p)->next;
 152
 153         if (ftrace_enabled) {
 154                 /* If we only have one func left, then call that directly */
 155                 if (ftrace_list == &ftrace_list_end ||
 156                     ftrace_list->next == &ftrace_list_end)
 157                         ftrace_trace_function = ftrace_list->func;
 158         }
 159
 160  out:
 161         spin_unlock(&ftrace_lock);
 162
 163         return ret;
 164 }
 165
 166 #ifdef CONFIG_DYNAMIC_FTRACE
 167 #ifndef CONFIG_FTRACE_MCOUNT_RECORD
 168 # error Dynamic ftrace depends on MCOUNT_RECORD
 169 #endif
 170
 171 /*
 172  * Since MCOUNT_ADDR may point to mcount itself, we do not want
 173  * to get it confused by reading a reference in the code as we
 174  * are parsing on objcopy output of text. Use a variable for
 175  * it instead.
 176  */
 177 static unsigned long mcount_addr = MCOUNT_ADDR;
 178
 179 enum {
 180         FTRACE_ENABLE_CALLS             = (1 << 0),
 181         FTRACE_DISABLE_CALLS            = (1 << 1),
 182         FTRACE_UPDATE_TRACE_FUNC        = (1 << 2),
 183         FTRACE_ENABLE_MCOUNT            = (1 << 3),
 184         FTRACE_DISABLE_MCOUNT           = (1 << 4),
 185 };
 186
 187 static int ftrace_filtered;
 188 static int tracing_on;
 189
 190 static LIST_HEAD(ftrace_new_addrs);
 191
 192 static DEFINE_MUTEX(ftrace_regex_lock);
 193
 194 struct ftrace_page {
 195         struct ftrace_page      *next;
 196         unsigned long           index;
 197         struct dyn_ftrace       records[];
 198 };
 199
 200 #define ENTRIES_PER_PAGE \
 201   ((PAGE_SIZE - sizeof(struct ftrace_page)) / sizeof(struct dyn_ftrace))
 202
 203 /* estimate from running different kernels */
 204 #define NR_TO_INIT              10000
 205
 206 static struct ftrace_page       *ftrace_pages_start;
 207 static struct ftrace_page       *ftrace_pages;
 208
 209 static struct dyn_ftrace *ftrace_free_records;
 210
 211
 212 #ifdef CONFIG_KPROBES
 213
 214 static int frozen_record_count;
 215
 216 static inline void freeze_record(struct dyn_ftrace *rec)
 217 {
 218         if (!(rec->flags & FTRACE_FL_FROZEN)) {
 219                 rec->flags |= FTRACE_FL_FROZEN;
 220                 frozen_record_count++;
 221         }
 222 }
 223
 224 static inline void unfreeze_record(struct dyn_ftrace *rec)
 225 {
 226         if (rec->flags & FTRACE_FL_FROZEN) {
 227                 rec->flags &= ~FTRACE_FL_FROZEN;
 228                 frozen_record_count--;
 229         }
 230 }
 231
 232 static inline int record_frozen(struct dyn_ftrace *rec)
 233 {
 234         return rec->flags & FTRACE_FL_FROZEN;
 235 }
 236 #else
 237 # define freeze_record(rec)                     ({ 0; })
 238 # define unfreeze_record(rec)                   ({ 0; })
 239 # define record_frozen(rec)                     ({ 0; })
 240 #endif /* CONFIG_KPROBES */
 241
 242 static void ftrace_free_rec(struct dyn_ftrace *rec)
 243 {
 244         rec->ip = (unsigned long)ftrace_free_records;
 245         ftrace_free_records = rec;
 246         rec->flags |= FTRACE_FL_FREE;
 247 }
 248
 249 void ftrace_release(void *start, unsigned long size)
 250 {
 251         struct dyn_ftrace *rec;
 252         struct ftrace_page *pg;
 253         unsigned long s = (unsigned long)start;
 254         unsigned long e = s + size;
 255         int i;
 256
 257         if (ftrace_disabled || !start)
 258                 return;
 259
 260         /* should not be called from interrupt context */
 261         spin_lock(&ftrace_lock);
 262
 263         for (pg = ftrace_pages_start; pg; pg = pg->next) {
 264                 for (i = 0; i < pg->index; i++) {
 265                         rec = &pg->records[i];
 266
 267                         if ((rec->ip >= s) && (rec->ip < e))
 268                                 ftrace_free_rec(rec);
 269                 }
 270         }
 271         spin_unlock(&ftrace_lock);
 272 }
 273
 274 static struct dyn_ftrace *ftrace_alloc_dyn_node(unsigned long ip)
 275 {
 276         struct dyn_ftrace *rec;
 277
 278         /* First check for freed records */
 279         if (ftrace_free_records) {
 280                 rec = ftrace_free_records;
 281
 282                 if (unlikely(!(rec->flags & FTRACE_FL_FREE))) {
 283                         FTRACE_WARN_ON_ONCE(1);
 284                         ftrace_free_records = NULL;
 285                         return NULL;
 286                 }
 287
 288                 ftrace_free_records = (void *)rec->ip;
 289                 memset(rec, 0, sizeof(*rec));
 290                 return rec;
 291         }
 292
 293         if (ftrace_pages->index == ENTRIES_PER_PAGE) {
 294                 if (!ftrace_pages->next) {
 295                         /* allocate another page */
 296                         ftrace_pages->next =
 297                                 (void *)get_zeroed_page(GFP_KERNEL);
 298                         if (!ftrace_pages->next)
 299                                 return NULL;
 300                 }
 301                 ftrace_pages = ftrace_pages->next;
 302         }
 303
 304         return &ftrace_pages->records[ftrace_pages->index++];
 305 }
 306
 307 static struct dyn_ftrace *
 308 ftrace_record_ip(unsigned long ip)
 309 {
 310         struct dyn_ftrace *rec;
 311
 312         if (!ftrace_enabled || ftrace_disabled)
 313                 return NULL;
 314
 315         rec = ftrace_alloc_dyn_node(ip);
 316         if (!rec)
 317                 return NULL;
 318
 319         rec->ip = ip;
 320
 321         list_add(&rec->list, &ftrace_new_addrs);
 322
 323         return rec;
 324 }
 325
 326 #define FTRACE_ADDR ((long)(ftrace_caller))
 327
 328 static int
 329 __ftrace_replace_code(struct dyn_ftrace *rec,
 330                       unsigned char *nop, int enable)
 331 {
 332         unsigned long ip, fl;
 333         unsigned char *call, *old, *new;
 334
 335         ip = rec->ip;
 336
 337         /*
 338          * If this record is not to be traced and
 339          * it is not enabled then do nothing.
 340          *
 341          * If this record is not to be traced and
 342          * it is enabled then disabled it.
 343          *
 344          */
 345         if (rec->flags & FTRACE_FL_NOTRACE) {
 346                 if (rec->flags & FTRACE_FL_ENABLED)
 347                         rec->flags &= ~FTRACE_FL_ENABLED;
 348                 else
 349                         return 0;
 350
 351         } else if (ftrace_filtered && enable) {
 352                 /*
 353                  * Filtering is on:
 354                  */
 355
 356                 fl = rec->flags & (FTRACE_FL_FILTER | FTRACE_FL_ENABLED);
 357
 358                 /* Record is filtered and enabled, do nothing */
 359                 if (fl == (FTRACE_FL_FILTER | FTRACE_FL_ENABLED))
 360                         return 0;
 361
 362                 /* Record is not filtered and is not enabled do nothing */
 363                 if (!fl)
 364                         return 0;
 365
 366                 /* Record is not filtered but enabled, disable it */
 367                 if (fl == FTRACE_FL_ENABLED)
 368                         rec->flags &= ~FTRACE_FL_ENABLED;
 369                 else
 370                 /* Otherwise record is filtered but not enabled, enable it */
 371                         rec->flags |= FTRACE_FL_ENABLED;
 372         } else {
 373                 /* Disable or not filtered */
 374
 375                 if (enable) {
 376                         /* if record is enabled, do nothing */
 377                         if (rec->flags & FTRACE_FL_ENABLED)
 378                                 return 0;
 379
 380                         rec->flags |= FTRACE_FL_ENABLED;
 381
 382                 } else {
 383
 384                         /* if record is not enabled do nothing */
 385                         if (!(rec->flags & FTRACE_FL_ENABLED))
 386                                 return 0;
 387
 388                         rec->flags &= ~FTRACE_FL_ENABLED;
 389                 }
 390         }
 391
 392         call = ftrace_call_replace(ip, FTRACE_ADDR);
 393
 394         if (rec->flags & FTRACE_FL_ENABLED) {
 395                 old = nop;
 396                 new = call;
 397         } else {
 398                 old = call;
 399                 new = nop;
 400         }
 401
 402         return ftrace_modify_code(ip, old, new);
 403 }
 404
 405 static void ftrace_replace_code(int enable)
 406 {
 407         int i, failed;
 408         unsigned char *nop = NULL;
 409         struct dyn_ftrace *rec;
 410         struct ftrace_page *pg;
 411
 412         nop = ftrace_nop_replace();
 413
 414         for (pg = ftrace_pages_start; pg; pg = pg->next) {
 415                 for (i = 0; i < pg->index; i++) {
 416                         rec = &pg->records[i];
 417
 418                         /* don't modify code that has already faulted */
 419                         if (rec->flags & FTRACE_FL_FAILED)
 420                                 continue;
 421
 422                         /* ignore updates to this record's mcount site */
 423                         if (get_kprobe((void *)rec->ip)) {
 424                                 freeze_record(rec);
 425                                 continue;
 426                         } else {
 427                                 unfreeze_record(rec);
 428                         }
 429
 430                         failed = __ftrace_replace_code(rec, nop, enable);
 431                         if (failed && (rec->flags & FTRACE_FL_CONVERTED)) {
 432                                 rec->flags |= FTRACE_FL_FAILED;
 433                                 if ((system_state == SYSTEM_BOOTING) ||
 434                                     !core_kernel_text(rec->ip)) {
 435                                         ftrace_free_rec(rec);
 436                                 }
 437                         }
 438                 }
 439         }
 440 }
 441
 442 static void print_ip_ins(const char *fmt, unsigned char *p)
 443 {
 444         int i;
 445
 446         printk(KERN_CONT "%s", fmt);
 447
 448         for (i = 0; i < MCOUNT_INSN_SIZE; i++)
 449                 printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
 450 }
 451
 452 static int
 453 ftrace_code_disable(struct dyn_ftrace *rec)
 454 {
 455         unsigned long ip;
 456         unsigned char *nop, *call;
 457         int ret;
 458
 459         ip = rec->ip;
 460
 461         nop = ftrace_nop_replace();
 462         call = ftrace_call_replace(ip, mcount_addr);
 463
 464         ret = ftrace_modify_code(ip, call, nop);
 465         if (ret) {
 466                 switch (ret) {
 467                 case -EFAULT:
 468                         FTRACE_WARN_ON_ONCE(1);
 469                         pr_info("ftrace faulted on modifying ");
 470                         print_ip_sym(ip);
 471                         break;
 472                 case -EINVAL:
 473                         FTRACE_WARN_ON_ONCE(1);
 474                         pr_info("ftrace failed to modify ");
 475                         print_ip_sym(ip);
 476                         print_ip_ins(" expected: ", call);
 477                         print_ip_ins(" actual: ", (unsigned char *)ip);
 478                         print_ip_ins(" replace: ", nop);
 479                         printk(KERN_CONT "\n");
 480                         break;
 481                 case -EPERM:
 482                         FTRACE_WARN_ON_ONCE(1);
 483                         pr_info("ftrace faulted on writing ");
 484                         print_ip_sym(ip);
 485                         break;
 486                 default:
 487                         FTRACE_WARN_ON_ONCE(1);
 488                         pr_info("ftrace faulted on unknown error ");
 489                         print_ip_sym(ip);
 490                 }
 491
 492                 rec->flags |= FTRACE_FL_FAILED;
 493                 return 0;
 494         }
 495         return 1;
 496 }
 497
 498 static int __ftrace_modify_code(void *data)
 499 {
 500         int *command = data;
 501
 502         if (*command & FTRACE_ENABLE_CALLS) {
 503                 ftrace_replace_code(1);
 504                 tracing_on = 1;
 505         } else if (*command & FTRACE_DISABLE_CALLS) {
 506                 ftrace_replace_code(0);
 507                 tracing_on = 0;
 508         }
 509
 510         if (*command & FTRACE_UPDATE_TRACE_FUNC)
 511                 ftrace_update_ftrace_func(ftrace_trace_function);
 512
 513         return 0;
 514 }
 515
 516 static void ftrace_run_update_code(int command)
 517 {
 518         stop_machine(__ftrace_modify_code, &command, NULL);
 519 }
 520
 521 static ftrace_func_t saved_ftrace_func;
 522 static int ftrace_start;
 523 static DEFINE_MUTEX(ftrace_start_lock);
 524
 525 static void ftrace_startup(void)
 526 {
 527         int command = 0;
 528
 529         if (unlikely(ftrace_disabled))
 530                 return;
 531
 532         mutex_lock(&ftrace_start_lock);
 533         ftrace_start++;
 534         command |= FTRACE_ENABLE_CALLS;
 535
 536         if (saved_ftrace_func != ftrace_trace_function) {
 537                 saved_ftrace_func = ftrace_trace_function;
 538                 command |= FTRACE_UPDATE_TRACE_FUNC;
 539         }
 540
 541         if (!command || !ftrace_enabled)
 542                 goto out;
 543
 544         ftrace_run_update_code(command);
 545  out:
 546         mutex_unlock(&ftrace_start_lock);
 547 }
 548
 549 static void ftrace_shutdown(void)
 550 {
 551         int command = 0;
 552
 553         if (unlikely(ftrace_disabled))
 554                 return;
 555
 556         mutex_lock(&ftrace_start_lock);
 557         ftrace_start--;
 558         if (!ftrace_start)
 559                 command |= FTRACE_DISABLE_CALLS;
 560
 561         if (saved_ftrace_func != ftrace_trace_function) {
 562                 saved_ftrace_func = ftrace_trace_function;
 563                 command |= FTRACE_UPDATE_TRACE_FUNC;
 564         }
 565
 566         if (!command || !ftrace_enabled)
 567                 goto out;
 568
 569         ftrace_run_update_code(command);
 570  out:
 571         mutex_unlock(&ftrace_start_lock);
 572 }
 573
 574 static void ftrace_startup_sysctl(void)
 575 {
 576         int command = FTRACE_ENABLE_MCOUNT;
 577
 578         if (unlikely(ftrace_disabled))
 579                 return;
 580
 581         mutex_lock(&ftrace_start_lock);
 582         /* Force update next time */
 583         saved_ftrace_func = NULL;
 584         /* ftrace_start is true if we want ftrace running */
 585         if (ftrace_start)
 586                 command |= FTRACE_ENABLE_CALLS;
 587
 588         ftrace_run_update_code(command);
 589         mutex_unlock(&ftrace_start_lock);
 590 }
 591
 592 static void ftrace_shutdown_sysctl(void)
 593 {
 594         int command = FTRACE_DISABLE_MCOUNT;
 595
 596         if (unlikely(ftrace_disabled))
 597                 return;
 598
 599         mutex_lock(&ftrace_start_lock);
 600         /* ftrace_start is true if ftrace is running */
 601         if (ftrace_start)
 602                 command |= FTRACE_DISABLE_CALLS;
 603
 604         ftrace_run_update_code(command);
 605         mutex_unlock(&ftrace_start_lock);
 606 }
 607
 608 static cycle_t          ftrace_update_time;
 609 static unsigned long    ftrace_update_cnt;
 610 unsigned long           ftrace_update_tot_cnt;
 611
 612 static int ftrace_update_code(void)
 613 {
 614         struct dyn_ftrace *p, *t;
 615         cycle_t start, stop;
 616
 617         start = ftrace_now(raw_smp_processor_id());
 618         ftrace_update_cnt = 0;
 619
 620         list_for_each_entry_safe(p, t, &ftrace_new_addrs, list) {
 621
 622                 /* If something went wrong, bail without enabling anything */
 623                 if (unlikely(ftrace_disabled))
 624                         return -1;
 625
 626                 list_del_init(&p->list);
 627
 628                 /* convert record (i.e, patch mcount-call with NOP) */
 629                 if (ftrace_code_disable(p)) {
 630                         p->flags |= FTRACE_FL_CONVERTED;
 631                         ftrace_update_cnt++;
 632                 } else
 633                         ftrace_free_rec(p);
 634         }
 635
 636         stop = ftrace_now(raw_smp_processor_id());
 637         ftrace_update_time = stop - start;
 638         ftrace_update_tot_cnt += ftrace_update_cnt;
 639
 640         return 0;
 641 }
 642
 643 static int __init ftrace_dyn_table_alloc(unsigned long num_to_init)
 644 {
 645         struct ftrace_page *pg;
 646         int cnt;
 647         int i;
 648
 649         /* allocate a few pages */
 650         ftrace_pages_start = (void *)get_zeroed_page(GFP_KERNEL);
 651         if (!ftrace_pages_start)
 652                 return -1;
 653
 654         /*
 655          * Allocate a few more pages.
 656          *
 657          * TODO: have some parser search vmlinux before
 658          *   final linking to find all calls to ftrace.
 659          *   Then we can:
 660          *    a) know how many pages to allocate.
 661          *     and/or
 662          *    b) set up the table then.
 663          *
 664          *  The dynamic code is still necessary for
 665          *  modules.
 666          */
 667
 668         pg = ftrace_pages = ftrace_pages_start;
 669
 670         cnt = num_to_init / ENTRIES_PER_PAGE;
 671         pr_info("ftrace: allocating %ld entries in %d pages\n",
 672                 num_to_init, cnt);
 673
 674         for (i = 0; i < cnt; i++) {
 675                 pg->next = (void *)get_zeroed_page(GFP_KERNEL);
 676
 677                 /* If we fail, we'll try later anyway */
 678                 if (!pg->next)
 679                         break;
 680
 681                 pg = pg->next;
 682         }
 683
 684         return 0;
 685 }
 686
 687 enum {
 688         FTRACE_ITER_FILTER      = (1 << 0),
 689         FTRACE_ITER_CONT        = (1 << 1),
 690         FTRACE_ITER_NOTRACE     = (1 << 2),
 691         FTRACE_ITER_FAILURES    = (1 << 3),
 692 };
 693
 694 #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
 695
 696 struct ftrace_iterator {
 697         loff_t                  pos;
 698         struct ftrace_page      *pg;
 699         unsigned                idx;
 700         unsigned                flags;
 701         unsigned char           buffer[FTRACE_BUFF_MAX+1];
 702         unsigned                buffer_idx;
 703         unsigned                filtered;
 704 };
 705
 706 static void *
 707 t_next(struct seq_file *m, void *v, loff_t *pos)
 708 {
 709         struct ftrace_iterator *iter = m->private;
 710         struct dyn_ftrace *rec = NULL;
 711
 712         (*pos)++;
 713
 714         /* should not be called from interrupt context */
 715         spin_lock(&ftrace_lock);
 716  retry:
 717         if (iter->idx >= iter->pg->index) {
 718                 if (iter->pg->next) {
 719                         iter->pg = iter->pg->next;
 720                         iter->idx = 0;
 721                         goto retry;
 722                 }
 723         } else {
 724                 rec = &iter->pg->records[iter->idx++];
 725                 if ((rec->flags & FTRACE_FL_FREE) ||
 726
 727                     (!(iter->flags & FTRACE_ITER_FAILURES) &&
 728                      (rec->flags & FTRACE_FL_FAILED)) ||
 729
 730                     ((iter->flags & FTRACE_ITER_FAILURES) &&
 731                      !(rec->flags & FTRACE_FL_FAILED)) ||
 732
 733                     ((iter->flags & FTRACE_ITER_FILTER) &&
 734                      !(rec->flags & FTRACE_FL_FILTER)) ||
 735
 736                     ((iter->flags & FTRACE_ITER_NOTRACE) &&
 737                      !(rec->flags & FTRACE_FL_NOTRACE))) {
 738                         rec = NULL;
 739                         goto retry;
 740                 }
 741         }
 742         spin_unlock(&ftrace_lock);
 743
 744         iter->pos = *pos;
 745
 746         return rec;
 747 }
 748
 749 static void *t_start(struct seq_file *m, loff_t *pos)
 750 {
 751         struct ftrace_iterator *iter = m->private;
 752         void *p = NULL;
 753         loff_t l = -1;
 754
 755         if (*pos != iter->pos) {
 756                 for (p = t_next(m, p, &l); p && l < *pos; p = t_next(m, p, &l))
 757                         ;
 758         } else {
 759                 l = *pos;
 760                 p = t_next(m, p, &l);
 761         }
 762
 763         return p;
 764 }
 765
 766 static void t_stop(struct seq_file *m, void *p)
 767 {
 768 }
 769
 770 static int t_show(struct seq_file *m, void *v)
 771 {
 772         struct dyn_ftrace *rec = v;
 773         char str[KSYM_SYMBOL_LEN];
 774
 775         if (!rec)
 776                 return 0;
 777
 778         kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
 779
 780         seq_printf(m, "%s\n", str);
 781
 782         return 0;
 783 }
 784
 785 static struct seq_operations show_ftrace_seq_ops = {
 786         .start = t_start,
 787         .next = t_next,
 788         .stop = t_stop,
 789         .show = t_show,
 790 };
 791
 792 static int
 793 ftrace_avail_open(struct inode *inode, struct file *file)
 794 {
 795         struct ftrace_iterator *iter;
 796         int ret;
 797
 798         if (unlikely(ftrace_disabled))
 799                 return -ENODEV;
 800
 801         iter = kzalloc(sizeof(*iter), GFP_KERNEL);
 802         if (!iter)
 803                 return -ENOMEM;
 804
 805         iter->pg = ftrace_pages_start;
 806         iter->pos = -1;
 807
 808         ret = seq_open(file, &show_ftrace_seq_ops);
 809         if (!ret) {
 810                 struct seq_file *m = file->private_data;
 811
 812                 m->private = iter;
 813         } else {
 814                 kfree(iter);
 815         }
 816
 817         return ret;
 818 }
 819
 820 int ftrace_avail_release(struct inode *inode, struct file *file)
 821 {
 822         struct seq_file *m = (struct seq_file *)file->private_data;
 823         struct ftrace_iterator *iter = m->private;
 824
 825         seq_release(inode, file);
 826         kfree(iter);
 827
 828         return 0;
 829 }
 830
 831 static int
 832 ftrace_failures_open(struct inode *inode, struct file *file)
 833 {
 834         int ret;
 835         struct seq_file *m;
 836         struct ftrace_iterator *iter;
 837
 838         ret = ftrace_avail_open(inode, file);
 839         if (!ret) {
 840                 m = (struct seq_file *)file->private_data;
 841                 iter = (struct ftrace_iterator *)m->private;
 842                 iter->flags = FTRACE_ITER_FAILURES;
 843         }
 844
 845         return ret;
 846 }
 847
 848
 849 static void ftrace_filter_reset(int enable)
 850 {
 851         struct ftrace_page *pg;
 852         struct dyn_ftrace *rec;
 853         unsigned long type = enable ? FTRACE_FL_FILTER : FTRACE_FL_NOTRACE;
 854         unsigned i;
 855
 856         /* should not be called from interrupt context */
 857         spin_lock(&ftrace_lock);
 858         if (enable)
 859                 ftrace_filtered = 0;
 860         pg = ftrace_pages_start;
 861         while (pg) {
 862                 for (i = 0; i < pg->index; i++) {
 863                         rec = &pg->records[i];
 864                         if (rec->flags & FTRACE_FL_FAILED)
 865                                 continue;
 866                         rec->flags &= ~type;
 867                 }
 868                 pg = pg->next;
 869         }
 870         spin_unlock(&ftrace_lock);
 871 }
 872
 873 static int
 874 ftrace_regex_open(struct inode *inode, struct file *file, int enable)
 875 {
 876         struct ftrace_iterator *iter;
 877         int ret = 0;
 878
 879         if (unlikely(ftrace_disabled))
 880                 return -ENODEV;
 881
 882         iter = kzalloc(sizeof(*iter), GFP_KERNEL);
 883         if (!iter)
 884                 return -ENOMEM;
 885
 886         mutex_lock(&ftrace_regex_lock);
 887         if ((file->f_mode & FMODE_WRITE) &&
 888             !(file->f_flags & O_APPEND))
 889                 ftrace_filter_reset(enable);
 890
 891         if (file->f_mode & FMODE_READ) {
 892                 iter->pg = ftrace_pages_start;
 893                 iter->pos = -1;
 894                 iter->flags = enable ? FTRACE_ITER_FILTER :
 895                         FTRACE_ITER_NOTRACE;
 896
 897                 ret = seq_open(file, &show_ftrace_seq_ops);
 898                 if (!ret) {
 899                         struct seq_file *m = file->private_data;
 900                         m->private = iter;
 901                 } else
 902                         kfree(iter);
 903         } else
 904                 file->private_data = iter;
 905         mutex_unlock(&ftrace_regex_lock);
 906
 907         return ret;
 908 }
 909
 910 static int
 911 ftrace_filter_open(struct inode *inode, struct file *file)
 912 {
 913         return ftrace_regex_open(inode, file, 1);
 914 }
 915
 916 static int
 917 ftrace_notrace_open(struct inode *inode, struct file *file)
 918 {
 919         return ftrace_regex_open(inode, file, 0);
 920 }
 921
 922 static ssize_t
 923 ftrace_regex_read(struct file *file, char __user *ubuf,
 924                        size_t cnt, loff_t *ppos)
 925 {
 926         if (file->f_mode & FMODE_READ)
 927                 return seq_read(file, ubuf, cnt, ppos);
 928         else
 929                 return -EPERM;
 930 }
 931
 932 static loff_t
 933 ftrace_regex_lseek(struct file *file, loff_t offset, int origin)
 934 {
 935         loff_t ret;
 936
 937         if (file->f_mode & FMODE_READ)
 938                 ret = seq_lseek(file, offset, origin);
 939         else
 940                 file->f_pos = ret = 1;
 941
 942         return ret;
 943 }
 944
 945 enum {
 946         MATCH_FULL,
 947         MATCH_FRONT_ONLY,
 948         MATCH_MIDDLE_ONLY,
 949         MATCH_END_ONLY,
 950 };
 951
 952 static void
 953 ftrace_match(unsigned char *buff, int len, int enable)
 954 {
 955         char str[KSYM_SYMBOL_LEN];
 956         char *search = NULL;
 957         struct ftrace_page *pg;
 958         struct dyn_ftrace *rec;
 959         int type = MATCH_FULL;
 960         unsigned long flag = enable ? FTRACE_FL_FILTER : FTRACE_FL_NOTRACE;
 961         unsigned i, match = 0, search_len = 0;
 962
 963         for (i = 0; i < len; i++) {
 964                 if (buff[i] == '*') {
 965                         if (!i) {
 966                                 search = buff + i + 1;
 967                                 type = MATCH_END_ONLY;
 968                                 search_len = len - (i + 1);
 969                         } else {
 970                                 if (type == MATCH_END_ONLY) {
 971                                         type = MATCH_MIDDLE_ONLY;
 972                                 } else {
 973                                         match = i;
 974                                         type = MATCH_FRONT_ONLY;
 975                                 }
 976                                 buff[i] = 0;
 977                                 break;
 978                         }
 979                 }
 980         }
 981
 982         /* should not be called from interrupt context */
 983         spin_lock(&ftrace_lock);
 984         if (enable)
 985                 ftrace_filtered = 1;
 986         pg = ftrace_pages_start;
 987         while (pg) {
 988                 for (i = 0; i < pg->index; i++) {
 989                         int matched = 0;
 990                         char *ptr;
 991
 992                         rec = &pg->records[i];
 993                         if (rec->flags & FTRACE_FL_FAILED)
 994                                 continue;
 995                         kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
 996                         switch (type) {
 997                         case MATCH_FULL:
 998                                 if (strcmp(str, buff) == 0)
 999                                         matched = 1;
1000                                 break;
1001                         case MATCH_FRONT_ONLY:
1002                                 if (memcmp(str, buff, match) == 0)
1003                                         matched = 1;
1004                                 break;
1005                         case MATCH_MIDDLE_ONLY:
1006                                 if (strstr(str, search))
1007                                         matched = 1;
1008                                 break;
1009                         case MATCH_END_ONLY:
1010                                 ptr = strstr(str, search);
1011                                 if (ptr && (ptr[search_len] == 0))
1012                                         matched = 1;
1013                                 break;
1014                         }
1015                         if (matched)
1016                                 rec->flags |= flag;
1017                 }
1018                 pg = pg->next;
1019         }
1020         spin_unlock(&ftrace_lock);
1021 }
1022
1023 static ssize_t
1024 ftrace_regex_write(struct file *file, const char __user *ubuf,
1025                    size_t cnt, loff_t *ppos, int enable)
1026 {
1027         struct ftrace_iterator *iter;
1028         char ch;
1029         size_t read = 0;
1030         ssize_t ret;
1031
1032         if (!cnt || cnt < 0)
1033                 return 0;
1034
1035         mutex_lock(&ftrace_regex_lock);
1036
1037         if (file->f_mode & FMODE_READ) {
1038                 struct seq_file *m = file->private_data;
1039                 iter = m->private;
1040         } else
1041                 iter = file->private_data;
1042
1043         if (!*ppos) {
1044                 iter->flags &= ~FTRACE_ITER_CONT;
1045                 iter->buffer_idx = 0;
1046         }
1047
1048         ret = get_user(ch, ubuf++);
1049         if (ret)
1050                 goto out;
1051         read++;
1052         cnt--;
1053
1054         if (!(iter->flags & ~FTRACE_ITER_CONT)) {
1055                 /* skip white space */
1056                 while (cnt && isspace(ch)) {
1057                         ret = get_user(ch, ubuf++);
1058                         if (ret)
1059                                 goto out;
1060                         read++;
1061                         cnt--;
1062                 }
1063
1064                 if (isspace(ch)) {
1065                         file->f_pos += read;
1066                         ret = read;
1067                         goto out;
1068                 }
1069
1070                 iter->buffer_idx = 0;
1071         }
1072
1073         while (cnt && !isspace(ch)) {
1074                 if (iter->buffer_idx < FTRACE_BUFF_MAX)
1075                         iter->buffer[iter->buffer_idx++] = ch;
1076                 else {
1077                         ret = -EINVAL;
1078                         goto out;
1079                 }
1080                 ret = get_user(ch, ubuf++);
1081                 if (ret)
1082                         goto out;
1083                 read++;
1084                 cnt--;
1085         }
1086
1087         if (isspace(ch)) {
1088                 iter->filtered++;
1089                 iter->buffer[iter->buffer_idx] = 0;
1090                 ftrace_match(iter->buffer, iter->buffer_idx, enable);
1091                 iter->buffer_idx = 0;
1092         } else
1093                 iter->flags |= FTRACE_ITER_CONT;
1094
1095
1096         file->f_pos += read;
1097
1098         ret = read;
1099  out:
1100         mutex_unlock(&ftrace_regex_lock);
1101
1102         return ret;
1103 }
1104
1105 static ssize_t
1106 ftrace_filter_write(struct file *file, const char __user *ubuf,
1107                     size_t cnt, loff_t *ppos)
1108 {
1109         return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
1110 }
1111
1112 static ssize_t
1113 ftrace_notrace_write(struct file *file, const char __user *ubuf,
1114                      size_t cnt, loff_t *ppos)
1115 {
1116         return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
1117 }
1118
1119 static void
1120 ftrace_set_regex(unsigned char *buf, int len, int reset, int enable)
1121 {
1122         if (unlikely(ftrace_disabled))
1123                 return;
1124
1125         mutex_lock(&ftrace_regex_lock);
1126         if (reset)
1127                 ftrace_filter_reset(enable);
1128         if (buf)
1129                 ftrace_match(buf, len, enable);
1130         mutex_unlock(&ftrace_regex_lock);
1131 }
1132
1133 /**
1134  * ftrace_set_filter - set a function to filter on in ftrace
1135  * @buf - the string that holds the function filter text.
1136  * @len - the length of the string.
1137  * @reset - non zero to reset all filters before applying this filter.
1138  *
1139  * Filters denote which functions should be enabled when tracing is enabled.
1140  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
1141  */
1142 void ftrace_set_filter(unsigned char *buf, int len, int reset)
1143 {
1144         ftrace_set_regex(buf, len, reset, 1);
1145 }
1146
1147 /**
1148  * ftrace_set_notrace - set a function to not trace in ftrace
1149  * @buf - the string that holds the function notrace text.
1150  * @len - the length of the string.
1151  * @reset - non zero to reset all filters before applying this filter.
1152  *
1153  * Notrace Filters denote which functions should not be enabled when tracing
1154  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
1155  * for tracing.
1156  */
1157 void ftrace_set_notrace(unsigned char *buf, int len, int reset)
1158 {
1159         ftrace_set_regex(buf, len, reset, 0);
1160 }
1161
1162 static int
1163 ftrace_regex_release(struct inode *inode, struct file *file, int enable)
1164 {
1165         struct seq_file *m = (struct seq_file *)file->private_data;
1166         struct ftrace_iterator *iter;
1167
1168         mutex_lock(&ftrace_regex_lock);
1169         if (file->f_mode & FMODE_READ) {
1170                 iter = m->private;
1171
1172                 seq_release(inode, file);
1173         } else
1174                 iter = file->private_data;
1175
1176         if (iter->buffer_idx) {
1177                 iter->filtered++;
1178                 iter->buffer[iter->buffer_idx] = 0;
1179                 ftrace_match(iter->buffer, iter->buffer_idx, enable);
1180         }
1181
1182         mutex_lock(&ftrace_sysctl_lock);
1183         mutex_lock(&ftrace_start_lock);
1184         if (ftrace_start && ftrace_enabled)
1185                 ftrace_run_update_code(FTRACE_ENABLE_CALLS);
1186         mutex_unlock(&ftrace_start_lock);
1187         mutex_unlock(&ftrace_sysctl_lock);
1188
1189         kfree(iter);
1190         mutex_unlock(&ftrace_regex_lock);
1191         return 0;
1192 }
1193
1194 static int
1195 ftrace_filter_release(struct inode *inode, struct file *file)
1196 {
1197         return ftrace_regex_release(inode, file, 1);
1198 }
1199
1200 static int
1201 ftrace_notrace_release(struct inode *inode, struct file *file)
1202 {
1203         return ftrace_regex_release(inode, file, 0);
1204 }
1205
1206 static struct file_operations ftrace_avail_fops = {
1207         .open = ftrace_avail_open,
1208         .read = seq_read,
1209         .llseek = seq_lseek,
1210         .release = ftrace_avail_release,
1211 };
1212
1213 static struct file_operations ftrace_failures_fops = {
1214         .open = ftrace_failures_open,
1215         .read = seq_read,
1216         .llseek = seq_lseek,
1217         .release = ftrace_avail_release,
1218 };
1219
1220 static struct file_operations ftrace_filter_fops = {
1221         .open = ftrace_filter_open,
1222         .read = ftrace_regex_read,
1223         .write = ftrace_filter_write,
1224         .llseek = ftrace_regex_lseek,
1225         .release = ftrace_filter_release,
1226 };
1227
1228 static struct file_operations ftrace_notrace_fops = {
1229         .open = ftrace_notrace_open,
1230         .read = ftrace_regex_read,
1231         .write = ftrace_notrace_write,
1232         .llseek = ftrace_regex_lseek,
1233         .release = ftrace_notrace_release,
1234 };
1235
1236 static __init int ftrace_init_debugfs(void)
1237 {
1238         struct dentry *d_tracer;
1239         struct dentry *entry;
1240
1241         d_tracer = tracing_init_dentry();
1242
1243         entry = debugfs_create_file("available_filter_functions", 0444,
1244                                     d_tracer, NULL, &ftrace_avail_fops);
1245         if (!entry)
1246                 pr_warning("Could not create debugfs "
1247                            "'available_filter_functions' entry\n");
1248
1249         entry = debugfs_create_file("failures", 0444,
1250                                     d_tracer, NULL, &ftrace_failures_fops);
1251         if (!entry)
1252                 pr_warning("Could not create debugfs 'failures' entry\n");
1253
1254         entry = debugfs_create_file("set_ftrace_filter", 0644, d_tracer,
1255                                     NULL, &ftrace_filter_fops);
1256         if (!entry)
1257                 pr_warning("Could not create debugfs "
1258                            "'set_ftrace_filter' entry\n");
1259
1260         entry = debugfs_create_file("set_ftrace_notrace", 0644, d_tracer,
1261                                     NULL, &ftrace_notrace_fops);
1262         if (!entry)
1263                 pr_warning("Could not create debugfs "
1264                            "'set_ftrace_notrace' entry\n");
1265
1266         return 0;
1267 }
1268
1269 fs_initcall(ftrace_init_debugfs);
1270
1271 static int ftrace_convert_nops(unsigned long *start,
1272                                unsigned long *end)
1273 {
1274         unsigned long *p;
1275         unsigned long addr;
1276         unsigned long flags;
1277
1278         mutex_lock(&ftrace_start_lock);
1279         p = start;
1280         while (p < end) {
1281                 addr = ftrace_call_adjust(*p++);
1282                 ftrace_record_ip(addr);
1283         }
1284
1285         /* disable interrupts to prevent kstop machine */
1286         local_irq_save(flags);
1287         ftrace_update_code();
1288         local_irq_restore(flags);
1289         mutex_unlock(&ftrace_start_lock);
1290
1291         return 0;
1292 }
1293
1294 void ftrace_init_module(unsigned long *start, unsigned long *end)
1295 {
1296         if (ftrace_disabled || start == end)
1297                 return;
1298         ftrace_convert_nops(start, end);
1299 }
1300
1301 extern unsigned long __start_mcount_loc[];
1302 extern unsigned long __stop_mcount_loc[];
1303
1304 void __init ftrace_init(void)
1305 {
1306         unsigned long count, addr, flags;
1307         int ret;
1308
1309         /* Keep the ftrace pointer to the stub */
1310         addr = (unsigned long)ftrace_stub;
1311
1312         local_irq_save(flags);
1313         ftrace_dyn_arch_init(&addr);
1314         local_irq_restore(flags);
1315
1316         /* ftrace_dyn_arch_init places the return code in addr */
1317         if (addr)
1318                 goto failed;
1319
1320         count = __stop_mcount_loc - __start_mcount_loc;
1321
1322         ret = ftrace_dyn_table_alloc(count);
1323         if (ret)
1324                 goto failed;
1325
1326         last_ftrace_enabled = ftrace_enabled = 1;
1327
1328         ret = ftrace_convert_nops(__start_mcount_loc,
1329                                   __stop_mcount_loc);
1330
1331         return;
1332  failed:
1333         ftrace_disabled = 1;
1334 }
1335
1336 #else
1337
1338 static int __init ftrace_nodyn_init(void)
1339 {
1340         ftrace_enabled = 1;
1341         return 0;
1342 }
1343 device_initcall(ftrace_nodyn_init);
1344
1345 # define ftrace_startup()               do { } while (0)
1346 # define ftrace_shutdown()              do { } while (0)
1347 # define ftrace_startup_sysctl()        do { } while (0)
1348 # define ftrace_shutdown_sysctl()       do { } while (0)
1349 #endif /* CONFIG_DYNAMIC_FTRACE */
1350
1351 /**
1352  * ftrace_kill - kill ftrace
1353  *
1354  * This function should be used by panic code. It stops ftrace
1355  * but in a not so nice way. If you need to simply kill ftrace
1356  * from a non-atomic section, use ftrace_kill.
1357  */
1358 void ftrace_kill(void)
1359 {
1360         ftrace_disabled = 1;
1361         ftrace_enabled = 0;
1362         clear_ftrace_function();
1363 }
1364
1365 /**
1366  * register_ftrace_function - register a function for profiling
1367  * @ops - ops structure that holds the function for profiling.
1368  *
1369  * Register a function to be called by all functions in the
1370  * kernel.
1371  *
1372  * Note: @ops->func and all the functions it calls must be labeled
1373  *       with "notrace", otherwise it will go into a
1374  *       recursive loop.
1375  */
1376 int register_ftrace_function(struct ftrace_ops *ops)
1377 {
1378         int ret;
1379
1380         if (unlikely(ftrace_disabled))
1381                 return -1;
1382
1383         mutex_lock(&ftrace_sysctl_lock);
1384         ret = __register_ftrace_function(ops);
1385         ftrace_startup();
1386         mutex_unlock(&ftrace_sysctl_lock);
1387
1388         return ret;
1389 }
1390
1391 /**
1392  * unregister_ftrace_function - unresgister a function for profiling.
1393  * @ops - ops structure that holds the function to unregister
1394  *
1395  * Unregister a function that was added to be called by ftrace profiling.
1396  */
1397 int unregister_ftrace_function(struct ftrace_ops *ops)
1398 {
1399         int ret;
1400
1401         mutex_lock(&ftrace_sysctl_lock);
1402         ret = __unregister_ftrace_function(ops);
1403         ftrace_shutdown();
1404         mutex_unlock(&ftrace_sysctl_lock);
1405
1406         return ret;
1407 }
1408
1409 int
1410 ftrace_enable_sysctl(struct ctl_table *table, int write,
1411                      struct file *file, void __user *buffer, size_t *lenp,
1412                      loff_t *ppos)
1413 {
1414         int ret;
1415
1416         if (unlikely(ftrace_disabled))
1417                 return -ENODEV;
1418
1419         mutex_lock(&ftrace_sysctl_lock);
1420
1421         ret  = proc_dointvec(table, write, file, buffer, lenp, ppos);
1422
1423         if (ret || !write || (last_ftrace_enabled == ftrace_enabled))
1424                 goto out;
1425
1426         last_ftrace_enabled = ftrace_enabled;
1427
1428         if (ftrace_enabled) {
1429
1430                 ftrace_startup_sysctl();
1431
1432                 /* we are starting ftrace again */
1433                 if (ftrace_list != &ftrace_list_end) {
1434                         if (ftrace_list->next == &ftrace_list_end)
1435                                 ftrace_trace_function = ftrace_list->func;
1436                         else
1437                                 ftrace_trace_function = ftrace_list_func;
1438                 }
1439
1440         } else {
1441                 /* stopping ftrace calls (just send to ftrace_stub) */
1442                 ftrace_trace_function = ftrace_stub;
1443
1444                 ftrace_shutdown_sysctl();
1445         }
1446
1447  out:
1448         mutex_unlock(&ftrace_sysctl_lock);
1449         return ret;
1450 }
1451