|  | /* | 
|  | * trace task wakeup timings | 
|  | * | 
|  | * Copyright (C) 2007-2008 Steven Rostedt <srostedt@redhat.com> | 
|  | * Copyright (C) 2008 Ingo Molnar <mingo@redhat.com> | 
|  | * | 
|  | * Based on code from the latency_tracer, that is: | 
|  | * | 
|  | *  Copyright (C) 2004-2006 Ingo Molnar | 
|  | *  Copyright (C) 2004 William Lee Irwin III | 
|  | */ | 
|  | #include <linux/module.h> | 
|  | #include <linux/fs.h> | 
|  | #include <linux/debugfs.h> | 
|  | #include <linux/kallsyms.h> | 
|  | #include <linux/uaccess.h> | 
|  | #include <linux/ftrace.h> | 
|  | #include <linux/marker.h> | 
|  |  | 
|  | #include "trace.h" | 
|  |  | 
|  | static struct trace_array	*wakeup_trace; | 
|  | static int __read_mostly	tracer_enabled; | 
|  |  | 
|  | static struct task_struct	*wakeup_task; | 
|  | static int			wakeup_cpu; | 
|  | static unsigned			wakeup_prio = -1; | 
|  |  | 
|  | static raw_spinlock_t wakeup_lock = | 
|  | (raw_spinlock_t)__RAW_SPIN_LOCK_UNLOCKED; | 
|  |  | 
|  | static void __wakeup_reset(struct trace_array *tr); | 
|  |  | 
|  | #ifdef CONFIG_FTRACE | 
|  | /* | 
|  | * irqsoff uses its own tracer function to keep the overhead down: | 
|  | */ | 
|  | static void | 
|  | wakeup_tracer_call(unsigned long ip, unsigned long parent_ip) | 
|  | { | 
|  | struct trace_array *tr = wakeup_trace; | 
|  | struct trace_array_cpu *data; | 
|  | unsigned long flags; | 
|  | long disabled; | 
|  | int resched; | 
|  | int cpu; | 
|  |  | 
|  | if (likely(!wakeup_task)) | 
|  | return; | 
|  |  | 
|  | resched = need_resched(); | 
|  | preempt_disable_notrace(); | 
|  |  | 
|  | cpu = raw_smp_processor_id(); | 
|  | data = tr->data[cpu]; | 
|  | disabled = atomic_inc_return(&data->disabled); | 
|  | if (unlikely(disabled != 1)) | 
|  | goto out; | 
|  |  | 
|  | local_irq_save(flags); | 
|  | __raw_spin_lock(&wakeup_lock); | 
|  |  | 
|  | if (unlikely(!wakeup_task)) | 
|  | goto unlock; | 
|  |  | 
|  | /* | 
|  | * The task can't disappear because it needs to | 
|  | * wake up first, and we have the wakeup_lock. | 
|  | */ | 
|  | if (task_cpu(wakeup_task) != cpu) | 
|  | goto unlock; | 
|  |  | 
|  | trace_function(tr, data, ip, parent_ip, flags); | 
|  |  | 
|  | unlock: | 
|  | __raw_spin_unlock(&wakeup_lock); | 
|  | local_irq_restore(flags); | 
|  |  | 
|  | out: | 
|  | atomic_dec(&data->disabled); | 
|  |  | 
|  | /* | 
|  | * To prevent recursion from the scheduler, if the | 
|  | * resched flag was set before we entered, then | 
|  | * don't reschedule. | 
|  | */ | 
|  | if (resched) | 
|  | preempt_enable_no_resched_notrace(); | 
|  | else | 
|  | preempt_enable_notrace(); | 
|  | } | 
|  |  | 
|  | static struct ftrace_ops trace_ops __read_mostly = | 
|  | { | 
|  | .func = wakeup_tracer_call, | 
|  | }; | 
|  | #endif /* CONFIG_FTRACE */ | 
|  |  | 
|  | /* | 
|  | * Should this new latency be reported/recorded? | 
|  | */ | 
|  | static int report_latency(cycle_t delta) | 
|  | { | 
|  | if (tracing_thresh) { | 
|  | if (delta < tracing_thresh) | 
|  | return 0; | 
|  | } else { | 
|  | if (delta <= tracing_max_latency) | 
|  | return 0; | 
|  | } | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static void notrace | 
|  | wakeup_sched_switch(void *private, void *rq, struct task_struct *prev, | 
|  | struct task_struct *next) | 
|  | { | 
|  | unsigned long latency = 0, t0 = 0, t1 = 0; | 
|  | struct trace_array **ptr = private; | 
|  | struct trace_array *tr = *ptr; | 
|  | struct trace_array_cpu *data; | 
|  | cycle_t T0, T1, delta; | 
|  | unsigned long flags; | 
|  | long disabled; | 
|  | int cpu; | 
|  |  | 
|  | if (unlikely(!tracer_enabled)) | 
|  | return; | 
|  |  | 
|  | /* | 
|  | * When we start a new trace, we set wakeup_task to NULL | 
|  | * and then set tracer_enabled = 1. We want to make sure | 
|  | * that another CPU does not see the tracer_enabled = 1 | 
|  | * and the wakeup_task with an older task, that might | 
|  | * actually be the same as next. | 
|  | */ | 
|  | smp_rmb(); | 
|  |  | 
|  | if (next != wakeup_task) | 
|  | return; | 
|  |  | 
|  | /* The task we are waiting for is waking up */ | 
|  | data = tr->data[wakeup_cpu]; | 
|  |  | 
|  | /* disable local data, not wakeup_cpu data */ | 
|  | cpu = raw_smp_processor_id(); | 
|  | disabled = atomic_inc_return(&tr->data[cpu]->disabled); | 
|  | if (likely(disabled != 1)) | 
|  | goto out; | 
|  |  | 
|  | local_irq_save(flags); | 
|  | __raw_spin_lock(&wakeup_lock); | 
|  |  | 
|  | /* We could race with grabbing wakeup_lock */ | 
|  | if (unlikely(!tracer_enabled || next != wakeup_task)) | 
|  | goto out_unlock; | 
|  |  | 
|  | trace_function(tr, data, CALLER_ADDR1, CALLER_ADDR2, flags); | 
|  |  | 
|  | /* | 
|  | * usecs conversion is slow so we try to delay the conversion | 
|  | * as long as possible: | 
|  | */ | 
|  | T0 = data->preempt_timestamp; | 
|  | T1 = ftrace_now(cpu); | 
|  | delta = T1-T0; | 
|  |  | 
|  | if (!report_latency(delta)) | 
|  | goto out_unlock; | 
|  |  | 
|  | latency = nsecs_to_usecs(delta); | 
|  |  | 
|  | tracing_max_latency = delta; | 
|  | t0 = nsecs_to_usecs(T0); | 
|  | t1 = nsecs_to_usecs(T1); | 
|  |  | 
|  | update_max_tr(tr, wakeup_task, wakeup_cpu); | 
|  |  | 
|  | out_unlock: | 
|  | __wakeup_reset(tr); | 
|  | __raw_spin_unlock(&wakeup_lock); | 
|  | local_irq_restore(flags); | 
|  | out: | 
|  | atomic_dec(&tr->data[cpu]->disabled); | 
|  | } | 
|  |  | 
|  | static notrace void | 
|  | sched_switch_callback(void *probe_data, void *call_data, | 
|  | const char *format, va_list *args) | 
|  | { | 
|  | struct task_struct *prev; | 
|  | struct task_struct *next; | 
|  | struct rq *__rq; | 
|  |  | 
|  | /* skip prev_pid %d next_pid %d prev_state %ld */ | 
|  | (void)va_arg(*args, int); | 
|  | (void)va_arg(*args, int); | 
|  | (void)va_arg(*args, long); | 
|  | __rq = va_arg(*args, typeof(__rq)); | 
|  | prev = va_arg(*args, typeof(prev)); | 
|  | next = va_arg(*args, typeof(next)); | 
|  |  | 
|  | tracing_record_cmdline(prev); | 
|  |  | 
|  | /* | 
|  | * If tracer_switch_func only points to the local | 
|  | * switch func, it still needs the ptr passed to it. | 
|  | */ | 
|  | wakeup_sched_switch(probe_data, __rq, prev, next); | 
|  | } | 
|  |  | 
|  | static void __wakeup_reset(struct trace_array *tr) | 
|  | { | 
|  | struct trace_array_cpu *data; | 
|  | int cpu; | 
|  |  | 
|  | for_each_possible_cpu(cpu) { | 
|  | data = tr->data[cpu]; | 
|  | tracing_reset(data); | 
|  | } | 
|  |  | 
|  | wakeup_cpu = -1; | 
|  | wakeup_prio = -1; | 
|  |  | 
|  | if (wakeup_task) | 
|  | put_task_struct(wakeup_task); | 
|  |  | 
|  | wakeup_task = NULL; | 
|  | } | 
|  |  | 
|  | static void wakeup_reset(struct trace_array *tr) | 
|  | { | 
|  | unsigned long flags; | 
|  |  | 
|  | local_irq_save(flags); | 
|  | __raw_spin_lock(&wakeup_lock); | 
|  | __wakeup_reset(tr); | 
|  | __raw_spin_unlock(&wakeup_lock); | 
|  | local_irq_restore(flags); | 
|  | } | 
|  |  | 
|  | static void | 
|  | wakeup_check_start(struct trace_array *tr, struct task_struct *p, | 
|  | struct task_struct *curr) | 
|  | { | 
|  | int cpu = smp_processor_id(); | 
|  | unsigned long flags; | 
|  | long disabled; | 
|  |  | 
|  | if (likely(!rt_task(p)) || | 
|  | p->prio >= wakeup_prio || | 
|  | p->prio >= curr->prio) | 
|  | return; | 
|  |  | 
|  | disabled = atomic_inc_return(&tr->data[cpu]->disabled); | 
|  | if (unlikely(disabled != 1)) | 
|  | goto out; | 
|  |  | 
|  | /* interrupts should be off from try_to_wake_up */ | 
|  | __raw_spin_lock(&wakeup_lock); | 
|  |  | 
|  | /* check for races. */ | 
|  | if (!tracer_enabled || p->prio >= wakeup_prio) | 
|  | goto out_locked; | 
|  |  | 
|  | /* reset the trace */ | 
|  | __wakeup_reset(tr); | 
|  |  | 
|  | wakeup_cpu = task_cpu(p); | 
|  | wakeup_prio = p->prio; | 
|  |  | 
|  | wakeup_task = p; | 
|  | get_task_struct(wakeup_task); | 
|  |  | 
|  | local_save_flags(flags); | 
|  |  | 
|  | tr->data[wakeup_cpu]->preempt_timestamp = ftrace_now(cpu); | 
|  | trace_function(tr, tr->data[wakeup_cpu], | 
|  | CALLER_ADDR1, CALLER_ADDR2, flags); | 
|  |  | 
|  | out_locked: | 
|  | __raw_spin_unlock(&wakeup_lock); | 
|  | out: | 
|  | atomic_dec(&tr->data[cpu]->disabled); | 
|  | } | 
|  |  | 
|  | static notrace void | 
|  | wake_up_callback(void *probe_data, void *call_data, | 
|  | const char *format, va_list *args) | 
|  | { | 
|  | struct trace_array **ptr = probe_data; | 
|  | struct trace_array *tr = *ptr; | 
|  | struct task_struct *curr; | 
|  | struct task_struct *task; | 
|  | struct rq *__rq; | 
|  |  | 
|  | if (likely(!tracer_enabled)) | 
|  | return; | 
|  |  | 
|  | /* Skip pid %d state %ld */ | 
|  | (void)va_arg(*args, int); | 
|  | (void)va_arg(*args, long); | 
|  | /* now get the meat: "rq %p task %p rq->curr %p" */ | 
|  | __rq = va_arg(*args, typeof(__rq)); | 
|  | task = va_arg(*args, typeof(task)); | 
|  | curr = va_arg(*args, typeof(curr)); | 
|  |  | 
|  | tracing_record_cmdline(task); | 
|  | tracing_record_cmdline(curr); | 
|  |  | 
|  | wakeup_check_start(tr, task, curr); | 
|  | } | 
|  |  | 
|  | static void start_wakeup_tracer(struct trace_array *tr) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = marker_probe_register("kernel_sched_wakeup", | 
|  | "pid %d state %ld ## rq %p task %p rq->curr %p", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | if (ret) { | 
|  | pr_info("wakeup trace: Couldn't add marker" | 
|  | " probe to kernel_sched_wakeup\n"); | 
|  | return; | 
|  | } | 
|  |  | 
|  | ret = marker_probe_register("kernel_sched_wakeup_new", | 
|  | "pid %d state %ld ## rq %p task %p rq->curr %p", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | if (ret) { | 
|  | pr_info("wakeup trace: Couldn't add marker" | 
|  | " probe to kernel_sched_wakeup_new\n"); | 
|  | goto fail_deprobe; | 
|  | } | 
|  |  | 
|  | ret = marker_probe_register("kernel_sched_schedule", | 
|  | "prev_pid %d next_pid %d prev_state %ld " | 
|  | "## rq %p prev %p next %p", | 
|  | sched_switch_callback, | 
|  | &wakeup_trace); | 
|  | if (ret) { | 
|  | pr_info("sched trace: Couldn't add marker" | 
|  | " probe to kernel_sched_schedule\n"); | 
|  | goto fail_deprobe_wake_new; | 
|  | } | 
|  |  | 
|  | wakeup_reset(tr); | 
|  |  | 
|  | /* | 
|  | * Don't let the tracer_enabled = 1 show up before | 
|  | * the wakeup_task is reset. This may be overkill since | 
|  | * wakeup_reset does a spin_unlock after setting the | 
|  | * wakeup_task to NULL, but I want to be safe. | 
|  | * This is a slow path anyway. | 
|  | */ | 
|  | smp_wmb(); | 
|  |  | 
|  | register_ftrace_function(&trace_ops); | 
|  |  | 
|  | tracer_enabled = 1; | 
|  |  | 
|  | return; | 
|  | fail_deprobe_wake_new: | 
|  | marker_probe_unregister("kernel_sched_wakeup_new", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | fail_deprobe: | 
|  | marker_probe_unregister("kernel_sched_wakeup", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | } | 
|  |  | 
|  | static void stop_wakeup_tracer(struct trace_array *tr) | 
|  | { | 
|  | tracer_enabled = 0; | 
|  | unregister_ftrace_function(&trace_ops); | 
|  | marker_probe_unregister("kernel_sched_schedule", | 
|  | sched_switch_callback, | 
|  | &wakeup_trace); | 
|  | marker_probe_unregister("kernel_sched_wakeup_new", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | marker_probe_unregister("kernel_sched_wakeup", | 
|  | wake_up_callback, | 
|  | &wakeup_trace); | 
|  | } | 
|  |  | 
|  | static void wakeup_tracer_init(struct trace_array *tr) | 
|  | { | 
|  | wakeup_trace = tr; | 
|  |  | 
|  | if (tr->ctrl) | 
|  | start_wakeup_tracer(tr); | 
|  | } | 
|  |  | 
|  | static void wakeup_tracer_reset(struct trace_array *tr) | 
|  | { | 
|  | if (tr->ctrl) { | 
|  | stop_wakeup_tracer(tr); | 
|  | /* make sure we put back any tasks we are tracing */ | 
|  | wakeup_reset(tr); | 
|  | } | 
|  | } | 
|  |  | 
|  | static void wakeup_tracer_ctrl_update(struct trace_array *tr) | 
|  | { | 
|  | if (tr->ctrl) | 
|  | start_wakeup_tracer(tr); | 
|  | else | 
|  | stop_wakeup_tracer(tr); | 
|  | } | 
|  |  | 
|  | static void wakeup_tracer_open(struct trace_iterator *iter) | 
|  | { | 
|  | /* stop the trace while dumping */ | 
|  | if (iter->tr->ctrl) | 
|  | stop_wakeup_tracer(iter->tr); | 
|  | } | 
|  |  | 
|  | static void wakeup_tracer_close(struct trace_iterator *iter) | 
|  | { | 
|  | /* forget about any processes we were recording */ | 
|  | if (iter->tr->ctrl) | 
|  | start_wakeup_tracer(iter->tr); | 
|  | } | 
|  |  | 
|  | static struct tracer wakeup_tracer __read_mostly = | 
|  | { | 
|  | .name		= "wakeup", | 
|  | .init		= wakeup_tracer_init, | 
|  | .reset		= wakeup_tracer_reset, | 
|  | .open		= wakeup_tracer_open, | 
|  | .close		= wakeup_tracer_close, | 
|  | .ctrl_update	= wakeup_tracer_ctrl_update, | 
|  | .print_max	= 1, | 
|  | #ifdef CONFIG_FTRACE_SELFTEST | 
|  | .selftest    = trace_selftest_startup_wakeup, | 
|  | #endif | 
|  | }; | 
|  |  | 
|  | __init static int init_wakeup_tracer(void) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = register_tracer(&wakeup_tracer); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | device_initcall(init_wakeup_tracer); |