diff options
| author | Srikar Dronamraju <srikar@linux.vnet.ibm.com> | 2012-04-09 05:11:44 -0400 |
|---|---|---|
| committer | Ingo Molnar <mingo@kernel.org> | 2012-05-07 08:29:57 -0400 |
| commit | 8ab83f56475ec9151645a888dfe1941f4a92091d (patch) | |
| tree | 91f33bc65e6d24c0db020195f560a19d140a3145 /kernel/trace | |
| parent | 3a6b76661da8e92124a813b43607f5bec1a618de (diff) | |
tracing: Extract out common code for kprobes/uprobes trace events
Move parts of trace_kprobe.c that can be shared with upcoming
trace_uprobe.c. Common code to kernel/trace/trace_probe.h and
kernel/trace/trace_probe.c. There are no functional changes.
Signed-off-by: Srikar Dronamraju <srikar@linux.vnet.ibm.com>
Acked-by: Steven Rostedt <rostedt@goodmis.org>
Acked-by: Masami Hiramatsu <masami.hiramatsu.pt@hitachi.com>
Cc: Linus Torvalds <torvalds@linux-foundation.org>
Cc: Ananth N Mavinakayanahalli <ananth@in.ibm.com>
Cc: Jim Keniston <jkenisto@linux.vnet.ibm.com>
Cc: Linux-mm <linux-mm@kvack.org>
Cc: Oleg Nesterov <oleg@redhat.com>
Cc: Andi Kleen <andi@firstfloor.org>
Cc: Christoph Hellwig <hch@infradead.org>
Cc: Arnaldo Carvalho de Melo <acme@infradead.org>
Cc: Anton Arapov <anton@redhat.com>
Cc: Peter Zijlstra <peterz@infradead.org>
Link: http://lkml.kernel.org/r/20120409091144.8343.76218.sendpatchset@srdronam.in.ibm.com
Signed-off-by: Ingo Molnar <mingo@kernel.org>
Diffstat (limited to 'kernel/trace')
| -rw-r--r-- | kernel/trace/Kconfig | 4 | ||||
| -rw-r--r-- | kernel/trace/Makefile | 1 | ||||
| -rw-r--r-- | kernel/trace/trace_kprobe.c | 889 | ||||
| -rw-r--r-- | kernel/trace/trace_probe.c | 833 | ||||
| -rw-r--r-- | kernel/trace/trace_probe.h | 160 |
5 files changed, 1016 insertions, 871 deletions
diff --git a/kernel/trace/Kconfig b/kernel/trace/Kconfig index a1d2849f2473..ce5a5c54ac8f 100644 --- a/kernel/trace/Kconfig +++ b/kernel/trace/Kconfig | |||
| @@ -373,6 +373,7 @@ config KPROBE_EVENT | |||
| 373 | depends on HAVE_REGS_AND_STACK_ACCESS_API | 373 | depends on HAVE_REGS_AND_STACK_ACCESS_API |
| 374 | bool "Enable kprobes-based dynamic events" | 374 | bool "Enable kprobes-based dynamic events" |
| 375 | select TRACING | 375 | select TRACING |
| 376 | select PROBE_EVENTS | ||
| 376 | default y | 377 | default y |
| 377 | help | 378 | help |
| 378 | This allows the user to add tracing events (similar to tracepoints) | 379 | This allows the user to add tracing events (similar to tracepoints) |
| @@ -385,6 +386,9 @@ config KPROBE_EVENT | |||
| 385 | This option is also required by perf-probe subcommand of perf tools. | 386 | This option is also required by perf-probe subcommand of perf tools. |
| 386 | If you want to use perf tools, this option is strongly recommended. | 387 | If you want to use perf tools, this option is strongly recommended. |
| 387 | 388 | ||
| 389 | config PROBE_EVENTS | ||
| 390 | def_bool n | ||
| 391 | |||
| 388 | config DYNAMIC_FTRACE | 392 | config DYNAMIC_FTRACE |
| 389 | bool "enable/disable ftrace tracepoints dynamically" | 393 | bool "enable/disable ftrace tracepoints dynamically" |
| 390 | depends on FUNCTION_TRACER | 394 | depends on FUNCTION_TRACER |
diff --git a/kernel/trace/Makefile b/kernel/trace/Makefile index 5f39a07fe5ea..fa10d5ca5ab1 100644 --- a/kernel/trace/Makefile +++ b/kernel/trace/Makefile | |||
| @@ -61,5 +61,6 @@ endif | |||
| 61 | ifeq ($(CONFIG_TRACING),y) | 61 | ifeq ($(CONFIG_TRACING),y) |
| 62 | obj-$(CONFIG_KGDB_KDB) += trace_kdb.o | 62 | obj-$(CONFIG_KGDB_KDB) += trace_kdb.o |
| 63 | endif | 63 | endif |
| 64 | obj-$(CONFIG_PROBE_EVENTS) += trace_probe.o | ||
| 64 | 65 | ||
| 65 | libftrace-y := ftrace.o | 66 | libftrace-y := ftrace.o |
diff --git a/kernel/trace/trace_kprobe.c b/kernel/trace/trace_kprobe.c index 4f935f83cd46..f8b777367d8e 100644 --- a/kernel/trace/trace_kprobe.c +++ b/kernel/trace/trace_kprobe.c | |||
| @@ -19,547 +19,15 @@ | |||
| 19 | 19 | ||
| 20 | #include <linux/module.h> | 20 | #include <linux/module.h> |
| 21 | #include <linux/uaccess.h> | 21 | #include <linux/uaccess.h> |
| 22 | #include <linux/kprobes.h> | ||
| 23 | #include <linux/seq_file.h> | ||
| 24 | #include <linux/slab.h> | ||
| 25 | #include <linux/smp.h> | ||
| 26 | #include <linux/debugfs.h> | ||
| 27 | #include <linux/types.h> | ||
| 28 | #include <linux/string.h> | ||
| 29 | #include <linux/ctype.h> | ||
| 30 | #include <linux/ptrace.h> | ||
| 31 | #include <linux/perf_event.h> | ||
| 32 | #include <linux/stringify.h> | ||
| 33 | #include <linux/limits.h> | ||
| 34 | #include <asm/bitsperlong.h> | ||
| 35 | |||
| 36 | #include "trace.h" | ||
| 37 | #include "trace_output.h" | ||
| 38 | |||
| 39 | #define MAX_TRACE_ARGS 128 | ||
| 40 | #define MAX_ARGSTR_LEN 63 | ||
| 41 | #define MAX_EVENT_NAME_LEN 64 | ||
| 42 | #define MAX_STRING_SIZE PATH_MAX | ||
| 43 | #define KPROBE_EVENT_SYSTEM "kprobes" | ||
| 44 | |||
| 45 | /* Reserved field names */ | ||
| 46 | #define FIELD_STRING_IP "__probe_ip" | ||
| 47 | #define FIELD_STRING_RETIP "__probe_ret_ip" | ||
| 48 | #define FIELD_STRING_FUNC "__probe_func" | ||
| 49 | |||
| 50 | const char *reserved_field_names[] = { | ||
| 51 | "common_type", | ||
| 52 | "common_flags", | ||
| 53 | "common_preempt_count", | ||
| 54 | "common_pid", | ||
| 55 | "common_tgid", | ||
| 56 | FIELD_STRING_IP, | ||
| 57 | FIELD_STRING_RETIP, | ||
| 58 | FIELD_STRING_FUNC, | ||
| 59 | }; | ||
| 60 | |||
| 61 | /* Printing function type */ | ||
| 62 | typedef int (*print_type_func_t)(struct trace_seq *, const char *, void *, | ||
| 63 | void *); | ||
| 64 | #define PRINT_TYPE_FUNC_NAME(type) print_type_##type | ||
| 65 | #define PRINT_TYPE_FMT_NAME(type) print_type_format_##type | ||
| 66 | |||
| 67 | /* Printing in basic type function template */ | ||
| 68 | #define DEFINE_BASIC_PRINT_TYPE_FUNC(type, fmt, cast) \ | ||
| 69 | static __kprobes int PRINT_TYPE_FUNC_NAME(type)(struct trace_seq *s, \ | ||
| 70 | const char *name, \ | ||
| 71 | void *data, void *ent)\ | ||
| 72 | { \ | ||
| 73 | return trace_seq_printf(s, " %s=" fmt, name, (cast)*(type *)data);\ | ||
| 74 | } \ | ||
| 75 | static const char PRINT_TYPE_FMT_NAME(type)[] = fmt; | ||
| 76 | |||
| 77 | DEFINE_BASIC_PRINT_TYPE_FUNC(u8, "%x", unsigned int) | ||
| 78 | DEFINE_BASIC_PRINT_TYPE_FUNC(u16, "%x", unsigned int) | ||
| 79 | DEFINE_BASIC_PRINT_TYPE_FUNC(u32, "%lx", unsigned long) | ||
| 80 | DEFINE_BASIC_PRINT_TYPE_FUNC(u64, "%llx", unsigned long long) | ||
| 81 | DEFINE_BASIC_PRINT_TYPE_FUNC(s8, "%d", int) | ||
| 82 | DEFINE_BASIC_PRINT_TYPE_FUNC(s16, "%d", int) | ||
| 83 | DEFINE_BASIC_PRINT_TYPE_FUNC(s32, "%ld", long) | ||
| 84 | DEFINE_BASIC_PRINT_TYPE_FUNC(s64, "%lld", long long) | ||
| 85 | |||
| 86 | /* data_rloc: data relative location, compatible with u32 */ | ||
| 87 | #define make_data_rloc(len, roffs) \ | ||
| 88 | (((u32)(len) << 16) | ((u32)(roffs) & 0xffff)) | ||
| 89 | #define get_rloc_len(dl) ((u32)(dl) >> 16) | ||
| 90 | #define get_rloc_offs(dl) ((u32)(dl) & 0xffff) | ||
| 91 | |||
| 92 | static inline void *get_rloc_data(u32 *dl) | ||
| 93 | { | ||
| 94 | return (u8 *)dl + get_rloc_offs(*dl); | ||
| 95 | } | ||
| 96 | |||
| 97 | /* For data_loc conversion */ | ||
| 98 | static inline void *get_loc_data(u32 *dl, void *ent) | ||
| 99 | { | ||
| 100 | return (u8 *)ent + get_rloc_offs(*dl); | ||
| 101 | } | ||
| 102 | |||
| 103 | /* | ||
| 104 | * Convert data_rloc to data_loc: | ||
| 105 | * data_rloc stores the offset from data_rloc itself, but data_loc | ||
| 106 | * stores the offset from event entry. | ||
| 107 | */ | ||
| 108 | #define convert_rloc_to_loc(dl, offs) ((u32)(dl) + (offs)) | ||
| 109 | |||
| 110 | /* For defining macros, define string/string_size types */ | ||
| 111 | typedef u32 string; | ||
| 112 | typedef u32 string_size; | ||
| 113 | |||
| 114 | /* Print type function for string type */ | ||
| 115 | static __kprobes int PRINT_TYPE_FUNC_NAME(string)(struct trace_seq *s, | ||
| 116 | const char *name, | ||
| 117 | void *data, void *ent) | ||
| 118 | { | ||
| 119 | int len = *(u32 *)data >> 16; | ||
| 120 | |||
| 121 | if (!len) | ||
| 122 | return trace_seq_printf(s, " %s=(fault)", name); | ||
| 123 | else | ||
| 124 | return trace_seq_printf(s, " %s=\"%s\"", name, | ||
| 125 | (const char *)get_loc_data(data, ent)); | ||
| 126 | } | ||
| 127 | static const char PRINT_TYPE_FMT_NAME(string)[] = "\\\"%s\\\""; | ||
| 128 | |||
| 129 | /* Data fetch function type */ | ||
| 130 | typedef void (*fetch_func_t)(struct pt_regs *, void *, void *); | ||
| 131 | |||
| 132 | struct fetch_param { | ||
| 133 | fetch_func_t fn; | ||
| 134 | void *data; | ||
| 135 | }; | ||
| 136 | |||
| 137 | static __kprobes void call_fetch(struct fetch_param *fprm, | ||
| 138 | struct pt_regs *regs, void *dest) | ||
| 139 | { | ||
| 140 | return fprm->fn(regs, fprm->data, dest); | ||
| 141 | } | ||
| 142 | |||
| 143 | #define FETCH_FUNC_NAME(method, type) fetch_##method##_##type | ||
| 144 | /* | ||
| 145 | * Define macro for basic types - we don't need to define s* types, because | ||
| 146 | * we have to care only about bitwidth at recording time. | ||
| 147 | */ | ||
| 148 | #define DEFINE_BASIC_FETCH_FUNCS(method) \ | ||
| 149 | DEFINE_FETCH_##method(u8) \ | ||
| 150 | DEFINE_FETCH_##method(u16) \ | ||
| 151 | DEFINE_FETCH_##method(u32) \ | ||
| 152 | DEFINE_FETCH_##method(u64) | ||
| 153 | |||
| 154 | #define CHECK_FETCH_FUNCS(method, fn) \ | ||
| 155 | (((FETCH_FUNC_NAME(method, u8) == fn) || \ | ||
| 156 | (FETCH_FUNC_NAME(method, u16) == fn) || \ | ||
| 157 | (FETCH_FUNC_NAME(method, u32) == fn) || \ | ||
| 158 | (FETCH_FUNC_NAME(method, u64) == fn) || \ | ||
| 159 | (FETCH_FUNC_NAME(method, string) == fn) || \ | ||
| 160 | (FETCH_FUNC_NAME(method, string_size) == fn)) \ | ||
| 161 | && (fn != NULL)) | ||
| 162 | |||
| 163 | /* Data fetch function templates */ | ||
| 164 | #define DEFINE_FETCH_reg(type) \ | ||
| 165 | static __kprobes void FETCH_FUNC_NAME(reg, type)(struct pt_regs *regs, \ | ||
| 166 | void *offset, void *dest) \ | ||
| 167 | { \ | ||
| 168 | *(type *)dest = (type)regs_get_register(regs, \ | ||
| 169 | (unsigned int)((unsigned long)offset)); \ | ||
| 170 | } | ||
| 171 | DEFINE_BASIC_FETCH_FUNCS(reg) | ||
| 172 | /* No string on the register */ | ||
| 173 | #define fetch_reg_string NULL | ||
| 174 | #define fetch_reg_string_size NULL | ||
| 175 | |||
| 176 | #define DEFINE_FETCH_stack(type) \ | ||
| 177 | static __kprobes void FETCH_FUNC_NAME(stack, type)(struct pt_regs *regs,\ | ||
| 178 | void *offset, void *dest) \ | ||
| 179 | { \ | ||
| 180 | *(type *)dest = (type)regs_get_kernel_stack_nth(regs, \ | ||
| 181 | (unsigned int)((unsigned long)offset)); \ | ||
| 182 | } | ||
| 183 | DEFINE_BASIC_FETCH_FUNCS(stack) | ||
| 184 | /* No string on the stack entry */ | ||
| 185 | #define fetch_stack_string NULL | ||
| 186 | #define fetch_stack_string_size NULL | ||
| 187 | |||
| 188 | #define DEFINE_FETCH_retval(type) \ | ||
| 189 | static __kprobes void FETCH_FUNC_NAME(retval, type)(struct pt_regs *regs,\ | ||
| 190 | void *dummy, void *dest) \ | ||
| 191 | { \ | ||
| 192 | *(type *)dest = (type)regs_return_value(regs); \ | ||
| 193 | } | ||
| 194 | DEFINE_BASIC_FETCH_FUNCS(retval) | ||
| 195 | /* No string on the retval */ | ||
| 196 | #define fetch_retval_string NULL | ||
| 197 | #define fetch_retval_string_size NULL | ||
| 198 | |||
| 199 | #define DEFINE_FETCH_memory(type) \ | ||
| 200 | static __kprobes void FETCH_FUNC_NAME(memory, type)(struct pt_regs *regs,\ | ||
| 201 | void *addr, void *dest) \ | ||
| 202 | { \ | ||
| 203 | type retval; \ | ||
| 204 | if (probe_kernel_address(addr, retval)) \ | ||
| 205 | *(type *)dest = 0; \ | ||
| 206 | else \ | ||
| 207 | *(type *)dest = retval; \ | ||
| 208 | } | ||
| 209 | DEFINE_BASIC_FETCH_FUNCS(memory) | ||
| 210 | /* | ||
| 211 | * Fetch a null-terminated string. Caller MUST set *(u32 *)dest with max | ||
| 212 | * length and relative data location. | ||
| 213 | */ | ||
| 214 | static __kprobes void FETCH_FUNC_NAME(memory, string)(struct pt_regs *regs, | ||
| 215 | void *addr, void *dest) | ||
| 216 | { | ||
| 217 | long ret; | ||
| 218 | int maxlen = get_rloc_len(*(u32 *)dest); | ||
| 219 | u8 *dst = get_rloc_data(dest); | ||
| 220 | u8 *src = addr; | ||
| 221 | mm_segment_t old_fs = get_fs(); | ||
| 222 | if (!maxlen) | ||
| 223 | return; | ||
| 224 | /* | ||
| 225 | * Try to get string again, since the string can be changed while | ||
| 226 | * probing. | ||
| 227 | */ | ||
| 228 | set_fs(KERNEL_DS); | ||
| 229 | pagefault_disable(); | ||
| 230 | do | ||
| 231 | ret = __copy_from_user_inatomic(dst++, src++, 1); | ||
| 232 | while (dst[-1] && ret == 0 && src - (u8 *)addr < maxlen); | ||
| 233 | dst[-1] = '\0'; | ||
| 234 | pagefault_enable(); | ||
| 235 | set_fs(old_fs); | ||
| 236 | |||
| 237 | if (ret < 0) { /* Failed to fetch string */ | ||
| 238 | ((u8 *)get_rloc_data(dest))[0] = '\0'; | ||
| 239 | *(u32 *)dest = make_data_rloc(0, get_rloc_offs(*(u32 *)dest)); | ||
| 240 | } else | ||
| 241 | *(u32 *)dest = make_data_rloc(src - (u8 *)addr, | ||
| 242 | get_rloc_offs(*(u32 *)dest)); | ||
| 243 | } | ||
| 244 | /* Return the length of string -- including null terminal byte */ | ||
| 245 | static __kprobes void FETCH_FUNC_NAME(memory, string_size)(struct pt_regs *regs, | ||
| 246 | void *addr, void *dest) | ||
| 247 | { | ||
| 248 | int ret, len = 0; | ||
| 249 | u8 c; | ||
| 250 | mm_segment_t old_fs = get_fs(); | ||
| 251 | |||
| 252 | set_fs(KERNEL_DS); | ||
| 253 | pagefault_disable(); | ||
| 254 | do { | ||
| 255 | ret = __copy_from_user_inatomic(&c, (u8 *)addr + len, 1); | ||
| 256 | len++; | ||
| 257 | } while (c && ret == 0 && len < MAX_STRING_SIZE); | ||
| 258 | pagefault_enable(); | ||
| 259 | set_fs(old_fs); | ||
| 260 | |||
| 261 | if (ret < 0) /* Failed to check the length */ | ||
| 262 | *(u32 *)dest = 0; | ||
| 263 | else | ||
| 264 | *(u32 *)dest = len; | ||
| 265 | } | ||
| 266 | |||
| 267 | /* Memory fetching by symbol */ | ||
| 268 | struct symbol_cache { | ||
| 269 | char *symbol; | ||
| 270 | long offset; | ||
| 271 | unsigned long addr; | ||
| 272 | }; | ||
| 273 | |||
| 274 | static unsigned long update_symbol_cache(struct symbol_cache *sc) | ||
| 275 | { | ||
| 276 | sc->addr = (unsigned long)kallsyms_lookup_name(sc->symbol); | ||
| 277 | if (sc->addr) | ||
| 278 | sc->addr += sc->offset; | ||
| 279 | return sc->addr; | ||
| 280 | } | ||
| 281 | |||
| 282 | static void free_symbol_cache(struct symbol_cache *sc) | ||
| 283 | { | ||
| 284 | kfree(sc->symbol); | ||
| 285 | kfree(sc); | ||
| 286 | } | ||
| 287 | |||
| 288 | static struct symbol_cache *alloc_symbol_cache(const char *sym, long offset) | ||
| 289 | { | ||
| 290 | struct symbol_cache *sc; | ||
| 291 | |||
| 292 | if (!sym || strlen(sym) == 0) | ||
| 293 | return NULL; | ||
| 294 | sc = kzalloc(sizeof(struct symbol_cache), GFP_KERNEL); | ||
| 295 | if (!sc) | ||
| 296 | return NULL; | ||
| 297 | |||
| 298 | sc->symbol = kstrdup(sym, GFP_KERNEL); | ||
| 299 | if (!sc->symbol) { | ||
| 300 | kfree(sc); | ||
| 301 | return NULL; | ||
| 302 | } | ||
| 303 | sc->offset = offset; | ||
| 304 | 22 | ||
| 305 | update_symbol_cache(sc); | 23 | #include "trace_probe.h" |
| 306 | return sc; | ||
| 307 | } | ||
| 308 | |||
| 309 | #define DEFINE_FETCH_symbol(type) \ | ||
| 310 | static __kprobes void FETCH_FUNC_NAME(symbol, type)(struct pt_regs *regs,\ | ||
| 311 | void *data, void *dest) \ | ||
| 312 | { \ | ||
| 313 | struct symbol_cache *sc = data; \ | ||
| 314 | if (sc->addr) \ | ||
| 315 | fetch_memory_##type(regs, (void *)sc->addr, dest); \ | ||
| 316 | else \ | ||
| 317 | *(type *)dest = 0; \ | ||
| 318 | } | ||
| 319 | DEFINE_BASIC_FETCH_FUNCS(symbol) | ||
| 320 | DEFINE_FETCH_symbol(string) | ||
| 321 | DEFINE_FETCH_symbol(string_size) | ||
| 322 | |||
| 323 | /* Dereference memory access function */ | ||
| 324 | struct deref_fetch_param { | ||
| 325 | struct fetch_param orig; | ||
| 326 | long offset; | ||
| 327 | }; | ||
| 328 | |||
| 329 | #define DEFINE_FETCH_deref(type) \ | ||
| 330 | static __kprobes void FETCH_FUNC_NAME(deref, type)(struct pt_regs *regs,\ | ||
| 331 | void *data, void *dest) \ | ||
| 332 | { \ | ||
| 333 | struct deref_fetch_param *dprm = data; \ | ||
| 334 | unsigned long addr; \ | ||
| 335 | call_fetch(&dprm->orig, regs, &addr); \ | ||
| 336 | if (addr) { \ | ||
| 337 | addr += dprm->offset; \ | ||
| 338 | fetch_memory_##type(regs, (void *)addr, dest); \ | ||
| 339 | } else \ | ||
| 340 | *(type *)dest = 0; \ | ||
| 341 | } | ||
| 342 | DEFINE_BASIC_FETCH_FUNCS(deref) | ||
| 343 | DEFINE_FETCH_deref(string) | ||
| 344 | DEFINE_FETCH_deref(string_size) | ||
| 345 | |||
| 346 | static __kprobes void update_deref_fetch_param(struct deref_fetch_param *data) | ||
| 347 | { | ||
| 348 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 349 | update_deref_fetch_param(data->orig.data); | ||
| 350 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 351 | update_symbol_cache(data->orig.data); | ||
| 352 | } | ||
| 353 | |||
| 354 | static __kprobes void free_deref_fetch_param(struct deref_fetch_param *data) | ||
| 355 | { | ||
| 356 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 357 | free_deref_fetch_param(data->orig.data); | ||
| 358 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 359 | free_symbol_cache(data->orig.data); | ||
| 360 | kfree(data); | ||
| 361 | } | ||
| 362 | |||
| 363 | /* Bitfield fetch function */ | ||
| 364 | struct bitfield_fetch_param { | ||
| 365 | struct fetch_param orig; | ||
| 366 | unsigned char hi_shift; | ||
| 367 | unsigned char low_shift; | ||
| 368 | }; | ||
| 369 | 24 | ||
| 370 | #define DEFINE_FETCH_bitfield(type) \ | 25 | #define KPROBE_EVENT_SYSTEM "kprobes" |
| 371 | static __kprobes void FETCH_FUNC_NAME(bitfield, type)(struct pt_regs *regs,\ | ||
| 372 | void *data, void *dest) \ | ||
| 373 | { \ | ||
| 374 | struct bitfield_fetch_param *bprm = data; \ | ||
| 375 | type buf = 0; \ | ||
| 376 | call_fetch(&bprm->orig, regs, &buf); \ | ||
| 377 | if (buf) { \ | ||
| 378 | buf <<= bprm->hi_shift; \ | ||
| 379 | buf >>= bprm->low_shift; \ | ||
| 380 | } \ | ||
| 381 | *(type *)dest = buf; \ | ||
| 382 | } | ||
| 383 | DEFINE_BASIC_FETCH_FUNCS(bitfield) | ||
| 384 | #define fetch_bitfield_string NULL | ||
| 385 | #define fetch_bitfield_string_size NULL | ||
| 386 | |||
| 387 | static __kprobes void | ||
| 388 | update_bitfield_fetch_param(struct bitfield_fetch_param *data) | ||
| 389 | { | ||
| 390 | /* | ||
| 391 | * Don't check the bitfield itself, because this must be the | ||
| 392 | * last fetch function. | ||
| 393 | */ | ||
| 394 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 395 | update_deref_fetch_param(data->orig.data); | ||
| 396 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 397 | update_symbol_cache(data->orig.data); | ||
| 398 | } | ||
| 399 | |||
| 400 | static __kprobes void | ||
| 401 | free_bitfield_fetch_param(struct bitfield_fetch_param *data) | ||
| 402 | { | ||
| 403 | /* | ||
| 404 | * Don't check the bitfield itself, because this must be the | ||
| 405 | * last fetch function. | ||
| 406 | */ | ||
| 407 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 408 | free_deref_fetch_param(data->orig.data); | ||
| 409 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 410 | free_symbol_cache(data->orig.data); | ||
| 411 | kfree(data); | ||
| 412 | } | ||
| 413 | |||
| 414 | /* Default (unsigned long) fetch type */ | ||
| 415 | #define __DEFAULT_FETCH_TYPE(t) u##t | ||
| 416 | #define _DEFAULT_FETCH_TYPE(t) __DEFAULT_FETCH_TYPE(t) | ||
| 417 | #define DEFAULT_FETCH_TYPE _DEFAULT_FETCH_TYPE(BITS_PER_LONG) | ||
| 418 | #define DEFAULT_FETCH_TYPE_STR __stringify(DEFAULT_FETCH_TYPE) | ||
| 419 | |||
| 420 | /* Fetch types */ | ||
| 421 | enum { | ||
| 422 | FETCH_MTD_reg = 0, | ||
| 423 | FETCH_MTD_stack, | ||
| 424 | FETCH_MTD_retval, | ||
| 425 | FETCH_MTD_memory, | ||
| 426 | FETCH_MTD_symbol, | ||
| 427 | FETCH_MTD_deref, | ||
| 428 | FETCH_MTD_bitfield, | ||
| 429 | FETCH_MTD_END, | ||
| 430 | }; | ||
| 431 | |||
| 432 | #define ASSIGN_FETCH_FUNC(method, type) \ | ||
| 433 | [FETCH_MTD_##method] = FETCH_FUNC_NAME(method, type) | ||
| 434 | |||
| 435 | #define __ASSIGN_FETCH_TYPE(_name, ptype, ftype, _size, sign, _fmttype) \ | ||
| 436 | {.name = _name, \ | ||
| 437 | .size = _size, \ | ||
| 438 | .is_signed = sign, \ | ||
| 439 | .print = PRINT_TYPE_FUNC_NAME(ptype), \ | ||
| 440 | .fmt = PRINT_TYPE_FMT_NAME(ptype), \ | ||
| 441 | .fmttype = _fmttype, \ | ||
| 442 | .fetch = { \ | ||
| 443 | ASSIGN_FETCH_FUNC(reg, ftype), \ | ||
| 444 | ASSIGN_FETCH_FUNC(stack, ftype), \ | ||
| 445 | ASSIGN_FETCH_FUNC(retval, ftype), \ | ||
| 446 | ASSIGN_FETCH_FUNC(memory, ftype), \ | ||
| 447 | ASSIGN_FETCH_FUNC(symbol, ftype), \ | ||
| 448 | ASSIGN_FETCH_FUNC(deref, ftype), \ | ||
| 449 | ASSIGN_FETCH_FUNC(bitfield, ftype), \ | ||
| 450 | } \ | ||
| 451 | } | ||
| 452 | |||
| 453 | #define ASSIGN_FETCH_TYPE(ptype, ftype, sign) \ | ||
| 454 | __ASSIGN_FETCH_TYPE(#ptype, ptype, ftype, sizeof(ftype), sign, #ptype) | ||
| 455 | |||
| 456 | #define FETCH_TYPE_STRING 0 | ||
| 457 | #define FETCH_TYPE_STRSIZE 1 | ||
| 458 | |||
| 459 | /* Fetch type information table */ | ||
| 460 | static const struct fetch_type { | ||
| 461 | const char *name; /* Name of type */ | ||
| 462 | size_t size; /* Byte size of type */ | ||
| 463 | int is_signed; /* Signed flag */ | ||
| 464 | print_type_func_t print; /* Print functions */ | ||
| 465 | const char *fmt; /* Fromat string */ | ||
| 466 | const char *fmttype; /* Name in format file */ | ||
| 467 | /* Fetch functions */ | ||
| 468 | fetch_func_t fetch[FETCH_MTD_END]; | ||
| 469 | } fetch_type_table[] = { | ||
| 470 | /* Special types */ | ||
| 471 | [FETCH_TYPE_STRING] = __ASSIGN_FETCH_TYPE("string", string, string, | ||
| 472 | sizeof(u32), 1, "__data_loc char[]"), | ||
| 473 | [FETCH_TYPE_STRSIZE] = __ASSIGN_FETCH_TYPE("string_size", u32, | ||
| 474 | string_size, sizeof(u32), 0, "u32"), | ||
| 475 | /* Basic types */ | ||
| 476 | ASSIGN_FETCH_TYPE(u8, u8, 0), | ||
| 477 | ASSIGN_FETCH_TYPE(u16, u16, 0), | ||
| 478 | ASSIGN_FETCH_TYPE(u32, u32, 0), | ||
| 479 | ASSIGN_FETCH_TYPE(u64, u64, 0), | ||
| 480 | ASSIGN_FETCH_TYPE(s8, u8, 1), | ||
| 481 | ASSIGN_FETCH_TYPE(s16, u16, 1), | ||
| 482 | ASSIGN_FETCH_TYPE(s32, u32, 1), | ||
| 483 | ASSIGN_FETCH_TYPE(s64, u64, 1), | ||
| 484 | }; | ||
| 485 | |||
| 486 | static const struct fetch_type *find_fetch_type(const char *type) | ||
| 487 | { | ||
| 488 | int i; | ||
| 489 | |||
| 490 | if (!type) | ||
| 491 | type = DEFAULT_FETCH_TYPE_STR; | ||
| 492 | |||
| 493 | /* Special case: bitfield */ | ||
| 494 | if (*type == 'b') { | ||
| 495 | unsigned long bs; | ||
| 496 | type = strchr(type, '/'); | ||
| 497 | if (!type) | ||
| 498 | goto fail; | ||
| 499 | type++; | ||
| 500 | if (strict_strtoul(type, 0, &bs)) | ||
| 501 | goto fail; | ||
| 502 | switch (bs) { | ||
| 503 | case 8: | ||
| 504 | return find_fetch_type("u8"); | ||
| 505 | case 16: | ||
| 506 | return find_fetch_type("u16"); | ||
| 507 | case 32: | ||
| 508 | return find_fetch_type("u32"); | ||
| 509 | case 64: | ||
| 510 | return find_fetch_type("u64"); | ||
| 511 | default: | ||
| 512 | goto fail; | ||
| 513 | } | ||
| 514 | } | ||
| 515 | |||
| 516 | for (i = 0; i < ARRAY_SIZE(fetch_type_table); i++) | ||
| 517 | if (strcmp(type, fetch_type_table[i].name) == 0) | ||
| 518 | return &fetch_type_table[i]; | ||
| 519 | fail: | ||
| 520 | return NULL; | ||
| 521 | } | ||
| 522 | |||
| 523 | /* Special function : only accept unsigned long */ | ||
| 524 | static __kprobes void fetch_stack_address(struct pt_regs *regs, | ||
| 525 | void *dummy, void *dest) | ||
| 526 | { | ||
| 527 | *(unsigned long *)dest = kernel_stack_pointer(regs); | ||
| 528 | } | ||
| 529 | |||
| 530 | static fetch_func_t get_fetch_size_function(const struct fetch_type *type, | ||
| 531 | fetch_func_t orig_fn) | ||
| 532 | { | ||
| 533 | int i; | ||
| 534 | |||
| 535 | if (type != &fetch_type_table[FETCH_TYPE_STRING]) | ||
| 536 | return NULL; /* Only string type needs size function */ | ||
| 537 | for (i = 0; i < FETCH_MTD_END; i++) | ||
| 538 | if (type->fetch[i] == orig_fn) | ||
| 539 | return fetch_type_table[FETCH_TYPE_STRSIZE].fetch[i]; | ||
| 540 | |||
| 541 | WARN_ON(1); /* This should not happen */ | ||
| 542 | return NULL; | ||
| 543 | } | ||
| 544 | 26 | ||
| 545 | /** | 27 | /** |
| 546 | * Kprobe event core functions | 28 | * Kprobe event core functions |
| 547 | */ | 29 | */ |
| 548 | 30 | ||
| 549 | struct probe_arg { | ||
| 550 | struct fetch_param fetch; | ||
| 551 | struct fetch_param fetch_size; | ||
| 552 | unsigned int offset; /* Offset from argument entry */ | ||
| 553 | const char *name; /* Name of this argument */ | ||
| 554 | const char *comm; /* Command of this argument */ | ||
| 555 | const struct fetch_type *type; /* Type of this argument */ | ||
| 556 | }; | ||
| 557 | |||
| 558 | /* Flags for trace_probe */ | ||
| 559 | #define TP_FLAG_TRACE 1 | ||
| 560 | #define TP_FLAG_PROFILE 2 | ||
| 561 | #define TP_FLAG_REGISTERED 4 | ||
| 562 | |||
| 563 | struct trace_probe { | 31 | struct trace_probe { |
| 564 | struct list_head list; | 32 | struct list_head list; |
| 565 | struct kretprobe rp; /* Use rp.kp for kprobe use */ | 33 | struct kretprobe rp; /* Use rp.kp for kprobe use */ |
| @@ -631,18 +99,6 @@ static int kprobe_dispatcher(struct kprobe *kp, struct pt_regs *regs); | |||
| 631 | static int kretprobe_dispatcher(struct kretprobe_instance *ri, | 99 | static int kretprobe_dispatcher(struct kretprobe_instance *ri, |
| 632 | struct pt_regs *regs); | 100 | struct pt_regs *regs); |
| 633 | 101 | ||
| 634 | /* Check the name is good for event/group/fields */ | ||
| 635 | static int is_good_name(const char *name) | ||
| 636 | { | ||
| 637 | if (!isalpha(*name) && *name != '_') | ||
| 638 | return 0; | ||
| 639 | while (*++name != '\0') { | ||
| 640 | if (!isalpha(*name) && !isdigit(*name) && *name != '_') | ||
| 641 | return 0; | ||
| 642 | } | ||
| 643 | return 1; | ||
| 644 | } | ||
| 645 | |||
| 646 | /* | 102 | /* |
| 647 | * Allocate new trace_probe and initialize it (including kprobes). | 103 | * Allocate new trace_probe and initialize it (including kprobes). |
| 648 | */ | 104 | */ |
| @@ -702,34 +158,12 @@ error: | |||
| 702 | return ERR_PTR(ret); | 158 | return ERR_PTR(ret); |
| 703 | } | 159 | } |
| 704 | 160 | ||
| 705 | static void update_probe_arg(struct probe_arg *arg) | ||
| 706 | { | ||
| 707 | if (CHECK_FETCH_FUNCS(bitfield, arg->fetch.fn)) | ||
| 708 | update_bitfield_fetch_param(arg->fetch.data); | ||
| 709 | else if (CHECK_FETCH_FUNCS(deref, arg->fetch.fn)) | ||
| 710 | update_deref_fetch_param(arg->fetch.data); | ||
| 711 | else if (CHECK_FETCH_FUNCS(symbol, arg->fetch.fn)) | ||
| 712 | update_symbol_cache(arg->fetch.data); | ||
| 713 | } | ||
| 714 | |||
| 715 | static void free_probe_arg(struct probe_arg *arg) | ||
| 716 | { | ||
| 717 | if (CHECK_FETCH_FUNCS(bitfield, arg->fetch.fn)) | ||
| 718 | free_bitfield_fetch_param(arg->fetch.data); | ||
| 719 | else if (CHECK_FETCH_FUNCS(deref, arg->fetch.fn)) | ||
| 720 | free_deref_fetch_param(arg->fetch.data); | ||
| 721 | else if (CHECK_FETCH_FUNCS(symbol, arg->fetch.fn)) | ||
| 722 | free_symbol_cache(arg->fetch.data); | ||
| 723 | kfree(arg->name); | ||
| 724 | kfree(arg->comm); | ||
| 725 | } | ||
| 726 | |||
| 727 | static void free_trace_probe(struct trace_probe *tp) | 161 | static void free_trace_probe(struct trace_probe *tp) |
| 728 | { | 162 | { |
| 729 | int i; | 163 | int i; |
| 730 | 164 | ||
| 731 | for (i = 0; i < tp->nr_args; i++) | 165 | for (i = 0; i < tp->nr_args; i++) |
| 732 | free_probe_arg(&tp->args[i]); | 166 | traceprobe_free_probe_arg(&tp->args[i]); |
| 733 | 167 | ||
| 734 | kfree(tp->call.class->system); | 168 | kfree(tp->call.class->system); |
| 735 | kfree(tp->call.name); | 169 | kfree(tp->call.name); |
| @@ -787,7 +221,7 @@ static int __register_trace_probe(struct trace_probe *tp) | |||
| 787 | return -EINVAL; | 221 | return -EINVAL; |
| 788 | 222 | ||
| 789 | for (i = 0; i < tp->nr_args; i++) | 223 | for (i = 0; i < tp->nr_args; i++) |
| 790 | update_probe_arg(&tp->args[i]); | 224 | traceprobe_update_arg(&tp->args[i]); |
| 791 | 225 | ||
| 792 | /* Set/clear disabled flag according to tp->flag */ | 226 | /* Set/clear disabled flag according to tp->flag */ |
| 793 | if (trace_probe_is_enabled(tp)) | 227 | if (trace_probe_is_enabled(tp)) |
| @@ -919,227 +353,6 @@ static struct notifier_block trace_probe_module_nb = { | |||
| 919 | .priority = 1 /* Invoked after kprobe module callback */ | 353 | .priority = 1 /* Invoked after kprobe module callback */ |
| 920 | }; | 354 | }; |
| 921 | 355 | ||
| 922 | /* Split symbol and offset. */ | ||
| 923 | static int split_symbol_offset(char *symbol, unsigned long *offset) | ||
| 924 | { | ||
| 925 | char *tmp; | ||
| 926 | int ret; | ||
| 927 | |||
| 928 | if (!offset) | ||
| 929 | return -EINVAL; | ||
| 930 | |||
| 931 | tmp = strchr(symbol, '+'); | ||
| 932 | if (tmp) { | ||
| 933 | /* skip sign because strict_strtol doesn't accept '+' */ | ||
| 934 | ret = strict_strtoul(tmp + 1, 0, offset); | ||
| 935 | if (ret) | ||
| 936 | return ret; | ||
| 937 | *tmp = '\0'; | ||
| 938 | } else | ||
| 939 | *offset = 0; | ||
| 940 | return 0; | ||
| 941 | } | ||
| 942 | |||
| 943 | #define PARAM_MAX_ARGS 16 | ||
| 944 | #define PARAM_MAX_STACK (THREAD_SIZE / sizeof(unsigned long)) | ||
| 945 | |||
| 946 | static int parse_probe_vars(char *arg, const struct fetch_type *t, | ||
| 947 | struct fetch_param *f, bool is_return) | ||
| 948 | { | ||
| 949 | int ret = 0; | ||
| 950 | unsigned long param; | ||
| 951 | |||
| 952 | if (strcmp(arg, "retval") == 0) { | ||
| 953 | if (is_return) | ||
| 954 | f->fn = t->fetch[FETCH_MTD_retval]; | ||
| 955 | else | ||
| 956 | ret = -EINVAL; | ||
| 957 | } else if (strncmp(arg, "stack", 5) == 0) { | ||
| 958 | if (arg[5] == '\0') { | ||
| 959 | if (strcmp(t->name, DEFAULT_FETCH_TYPE_STR) == 0) | ||
| 960 | f->fn = fetch_stack_address; | ||
| 961 | else | ||
| 962 | ret = -EINVAL; | ||
| 963 | } else if (isdigit(arg[5])) { | ||
| 964 | ret = strict_strtoul(arg + 5, 10, ¶m); | ||
| 965 | if (ret || param > PARAM_MAX_STACK) | ||
| 966 | ret = -EINVAL; | ||
| 967 | else { | ||
| 968 | f->fn = t->fetch[FETCH_MTD_stack]; | ||
| 969 | f->data = (void *)param; | ||
| 970 | } | ||
| 971 | } else | ||
| 972 | ret = -EINVAL; | ||
| 973 | } else | ||
| 974 | ret = -EINVAL; | ||
| 975 | return ret; | ||
| 976 | } | ||
| 977 | |||
| 978 | /* Recursive argument parser */ | ||
| 979 | static int __parse_probe_arg(char *arg, const struct fetch_type *t, | ||
| 980 | struct fetch_param *f, bool is_return) | ||
| 981 | { | ||
| 982 | int ret = 0; | ||
| 983 | unsigned long param; | ||
| 984 | long offset; | ||
| 985 | char *tmp; | ||
| 986 | |||
| 987 | switch (arg[0]) { | ||
| 988 | case '$': | ||
| 989 | ret = parse_probe_vars(arg + 1, t, f, is_return); | ||
| 990 | break; | ||
| 991 | case '%': /* named register */ | ||
| 992 | ret = regs_query_register_offset(arg + 1); | ||
| 993 | if (ret >= 0) { | ||
| 994 | f->fn = t->fetch[FETCH_MTD_reg]; | ||
| 995 | f->data = (void *)(unsigned long)ret; | ||
| 996 | ret = 0; | ||
| 997 | } | ||
| 998 | break; | ||
| 999 | case '@': /* memory or symbol */ | ||
| 1000 | if (isdigit(arg[1])) { | ||
| 1001 | ret = strict_strtoul(arg + 1, 0, ¶m); | ||
| 1002 | if (ret) | ||
| 1003 | break; | ||
| 1004 | f->fn = t->fetch[FETCH_MTD_memory]; | ||
| 1005 | f->data = (void *)param; | ||
| 1006 | } else { | ||
| 1007 | ret = split_symbol_offset(arg + 1, &offset); | ||
| 1008 | if (ret) | ||
| 1009 | break; | ||
| 1010 | f->data = alloc_symbol_cache(arg + 1, offset); | ||
| 1011 | if (f->data) | ||
| 1012 | f->fn = t->fetch[FETCH_MTD_symbol]; | ||
| 1013 | } | ||
| 1014 | break; | ||
| 1015 | case '+': /* deref memory */ | ||
| 1016 | arg++; /* Skip '+', because strict_strtol() rejects it. */ | ||
| 1017 | case '-': | ||
| 1018 | tmp = strchr(arg, '('); | ||
| 1019 | if (!tmp) | ||
| 1020 | break; | ||
| 1021 | *tmp = '\0'; | ||
| 1022 | ret = strict_strtol(arg, 0, &offset); | ||
| 1023 | if (ret) | ||
| 1024 | break; | ||
| 1025 | arg = tmp + 1; | ||
| 1026 | tmp = strrchr(arg, ')'); | ||
| 1027 | if (tmp) { | ||
| 1028 | struct deref_fetch_param *dprm; | ||
| 1029 | const struct fetch_type *t2 = find_fetch_type(NULL); | ||
| 1030 | *tmp = '\0'; | ||
| 1031 | dprm = kzalloc(sizeof(struct deref_fetch_param), | ||
| 1032 | GFP_KERNEL); | ||
| 1033 | if (!dprm) | ||
| 1034 | return -ENOMEM; | ||
| 1035 | dprm->offset = offset; | ||
| 1036 | ret = __parse_probe_arg(arg, t2, &dprm->orig, | ||
| 1037 | is_return); | ||
| 1038 | if (ret) | ||
| 1039 | kfree(dprm); | ||
| 1040 | else { | ||
| 1041 | f->fn = t->fetch[FETCH_MTD_deref]; | ||
| 1042 | f->data = (void *)dprm; | ||
| 1043 | } | ||
| 1044 | } | ||
| 1045 | break; | ||
| 1046 | } | ||
| 1047 | if (!ret && !f->fn) { /* Parsed, but do not find fetch method */ | ||
| 1048 | pr_info("%s type has no corresponding fetch method.\n", | ||
| 1049 | t->name); | ||
| 1050 | ret = -EINVAL; | ||
| 1051 | } | ||
| 1052 | return ret; | ||
| 1053 | } | ||
| 1054 | |||
| 1055 | #define BYTES_TO_BITS(nb) ((BITS_PER_LONG * (nb)) / sizeof(long)) | ||
| 1056 | |||
| 1057 | /* Bitfield type needs to be parsed into a fetch function */ | ||
| 1058 | static int __parse_bitfield_probe_arg(const char *bf, | ||
| 1059 | const struct fetch_type *t, | ||
| 1060 | struct fetch_param *f) | ||
| 1061 | { | ||
| 1062 | struct bitfield_fetch_param *bprm; | ||
| 1063 | unsigned long bw, bo; | ||
| 1064 | char *tail; | ||
| 1065 | |||
| 1066 | if (*bf != 'b') | ||
| 1067 | return 0; | ||
| 1068 | |||
| 1069 | bprm = kzalloc(sizeof(*bprm), GFP_KERNEL); | ||
| 1070 | if (!bprm) | ||
| 1071 | return -ENOMEM; | ||
| 1072 | bprm->orig = *f; | ||
| 1073 | f->fn = t->fetch[FETCH_MTD_bitfield]; | ||
| 1074 | f->data = (void *)bprm; | ||
| 1075 | |||
| 1076 | bw = simple_strtoul(bf + 1, &tail, 0); /* Use simple one */ | ||
| 1077 | if (bw == 0 || *tail != '@') | ||
| 1078 | return -EINVAL; | ||
| 1079 | |||
| 1080 | bf = tail + 1; | ||
| 1081 | bo = simple_strtoul(bf, &tail, 0); | ||
| 1082 | if (tail == bf || *tail != '/') | ||
| 1083 | return -EINVAL; | ||
| 1084 | |||
| 1085 | bprm->hi_shift = BYTES_TO_BITS(t->size) - (bw + bo); | ||
| 1086 | bprm->low_shift = bprm->hi_shift + bo; | ||
| 1087 | return (BYTES_TO_BITS(t->size) < (bw + bo)) ? -EINVAL : 0; | ||
| 1088 | } | ||
| 1089 | |||
| 1090 | /* String length checking wrapper */ | ||
| 1091 | static int parse_probe_arg(char *arg, struct trace_probe *tp, | ||
| 1092 | struct probe_arg *parg, bool is_return) | ||
| 1093 | { | ||
| 1094 | const char *t; | ||
| 1095 | int ret; | ||
| 1096 | |||
| 1097 | if (strlen(arg) > MAX_ARGSTR_LEN) { | ||
| 1098 | pr_info("Argument is too long.: %s\n", arg); | ||
| 1099 | return -ENOSPC; | ||
| 1100 | } | ||
| 1101 | parg->comm = kstrdup(arg, GFP_KERNEL); | ||
| 1102 | if (!parg->comm) { | ||
| 1103 | pr_info("Failed to allocate memory for command '%s'.\n", arg); | ||
| 1104 | return -ENOMEM; | ||
| 1105 | } | ||
| 1106 | t = strchr(parg->comm, ':'); | ||
| 1107 | if (t) { | ||
| 1108 | arg[t - parg->comm] = '\0'; | ||
| 1109 | t++; | ||
| 1110 | } | ||
| 1111 | parg->type = find_fetch_type(t); | ||
| 1112 | if (!parg->type) { | ||
| 1113 | pr_info("Unsupported type: %s\n", t); | ||
| 1114 | return -EINVAL; | ||
| 1115 | } | ||
| 1116 | parg->offset = tp->size; | ||
| 1117 | tp->size += parg->type->size; | ||
| 1118 | ret = __parse_probe_arg(arg, parg->type, &parg->fetch, is_return); | ||
| 1119 | if (ret >= 0 && t != NULL) | ||
| 1120 | ret = __parse_bitfield_probe_arg(t, parg->type, &parg->fetch); | ||
| 1121 | if (ret >= 0) { | ||
| 1122 | parg->fetch_size.fn = get_fetch_size_function(parg->type, | ||
| 1123 | parg->fetch.fn); | ||
| 1124 | parg->fetch_size.data = parg->fetch.data; | ||
| 1125 | } | ||
| 1126 | return ret; | ||
| 1127 | } | ||
| 1128 | |||
| 1129 | /* Return 1 if name is reserved or already used by another argument */ | ||
| 1130 | static int conflict_field_name(const char *name, | ||
| 1131 | struct probe_arg *args, int narg) | ||
| 1132 | { | ||
| 1133 | int i; | ||
| 1134 | for (i = 0; i < ARRAY_SIZE(reserved_field_names); i++) | ||
| 1135 | if (strcmp(reserved_field_names[i], name) == 0) | ||
| 1136 | return 1; | ||
| 1137 | for (i = 0; i < narg; i++) | ||
| 1138 | if (strcmp(args[i].name, name) == 0) | ||
| 1139 | return 1; | ||
| 1140 | return 0; | ||
| 1141 | } | ||
| 1142 | |||
| 1143 | static int create_trace_probe(int argc, char **argv) | 356 | static int create_trace_probe(int argc, char **argv) |
| 1144 | { | 357 | { |
| 1145 | /* | 358 | /* |
| @@ -1240,7 +453,7 @@ static int create_trace_probe(int argc, char **argv) | |||
| 1240 | /* a symbol specified */ | 453 | /* a symbol specified */ |
| 1241 | symbol = argv[1]; | 454 | symbol = argv[1]; |
| 1242 | /* TODO: support .init module functions */ | 455 | /* TODO: support .init module functions */ |
| 1243 | ret = split_symbol_offset(symbol, &offset); | 456 | ret = traceprobe_split_symbol_offset(symbol, &offset); |
| 1244 | if (ret) { | 457 | if (ret) { |
| 1245 | pr_info("Failed to parse symbol.\n"); | 458 | pr_info("Failed to parse symbol.\n"); |
| 1246 | return ret; | 459 | return ret; |
| @@ -1302,7 +515,8 @@ static int create_trace_probe(int argc, char **argv) | |||
| 1302 | goto error; | 515 | goto error; |
| 1303 | } | 516 | } |
| 1304 | 517 | ||
| 1305 | if (conflict_field_name(tp->args[i].name, tp->args, i)) { | 518 | if (traceprobe_conflict_field_name(tp->args[i].name, |
| 519 | tp->args, i)) { | ||
| 1306 | pr_info("Argument[%d] name '%s' conflicts with " | 520 | pr_info("Argument[%d] name '%s' conflicts with " |
| 1307 | "another field.\n", i, argv[i]); | 521 | "another field.\n", i, argv[i]); |
| 1308 | ret = -EINVAL; | 522 | ret = -EINVAL; |
| @@ -1310,7 +524,8 @@ static int create_trace_probe(int argc, char **argv) | |||
| 1310 | } | 524 | } |
| 1311 | 525 | ||
| 1312 | /* Parse fetch argument */ | 526 | /* Parse fetch argument */ |
| 1313 | ret = parse_probe_arg(arg, tp, &tp->args[i], is_return); | 527 | ret = traceprobe_parse_probe_arg(arg, &tp->size, &tp->args[i], |
| 528 | is_return); | ||
| 1314 | if (ret) { | 529 | if (ret) { |
| 1315 | pr_info("Parse error at argument[%d]. (%d)\n", i, ret); | 530 | pr_info("Parse error at argument[%d]. (%d)\n", i, ret); |
| 1316 | goto error; | 531 | goto error; |
| @@ -1412,70 +627,11 @@ static int probes_open(struct inode *inode, struct file *file) | |||
| 1412 | return seq_open(file, &probes_seq_op); | 627 | return seq_open(file, &probes_seq_op); |
| 1413 | } | 628 | } |
| 1414 | 629 | ||
| 1415 | static int command_trace_probe(const char *buf) | ||
| 1416 | { | ||
| 1417 | char **argv; | ||
| 1418 | int argc = 0, ret = 0; | ||
| 1419 | |||
| 1420 | argv = argv_split(GFP_KERNEL, buf, &argc); | ||
| 1421 | if (!argv) | ||
| 1422 | return -ENOMEM; | ||
| 1423 | |||
| 1424 | if (argc) | ||
| 1425 | ret = create_trace_probe(argc, argv); | ||
| 1426 | |||
| 1427 | argv_free(argv); | ||
| 1428 | return ret; | ||
| 1429 | } | ||
| 1430 | |||
| 1431 | #define WRITE_BUFSIZE 4096 | ||
| 1432 | |||
| 1433 | static ssize_t probes_write(struct file *file, const char __user *buffer, | 630 | static ssize_t probes_write(struct file *file, const char __user *buffer, |
| 1434 | size_t count, loff_t *ppos) | 631 | size_t count, loff_t *ppos) |
| 1435 | { | 632 | { |
| 1436 | char *kbuf, *tmp; | 633 | return traceprobe_probes_write(file, buffer, count, ppos, |
| 1437 | int ret; | 634 | create_trace_probe); |
| 1438 | size_t done; | ||
| 1439 | size_t size; | ||
| 1440 | |||
| 1441 | kbuf = kmalloc(WRITE_BUFSIZE, GFP_KERNEL); | ||
| 1442 | if (!kbuf) | ||
| 1443 | return -ENOMEM; | ||
| 1444 | |||
| 1445 | ret = done = 0; | ||
| 1446 | while (done < count) { | ||
| 1447 | size = count - done; | ||
| 1448 | if (size >= WRITE_BUFSIZE) | ||
| 1449 | size = WRITE_BUFSIZE - 1; | ||
| 1450 | if (copy_from_user(kbuf, buffer + done, size)) { | ||
| 1451 | ret = -EFAULT; | ||
| 1452 | goto out; | ||
| 1453 | } | ||
| 1454 | kbuf[size] = '\0'; | ||
| 1455 | tmp = strchr(kbuf, '\n'); | ||
| 1456 | if (tmp) { | ||
| 1457 | *tmp = '\0'; | ||
| 1458 | size = tmp - kbuf + 1; | ||
| 1459 | } else if (done + size < count) { | ||
| 1460 | pr_warning("Line length is too long: " | ||
| 1461 | "Should be less than %d.", WRITE_BUFSIZE); | ||
| 1462 | ret = -EINVAL; | ||
| 1463 | goto out; | ||
| 1464 | } | ||
| 1465 | done += size; | ||
| 1466 | /* Remove comments */ | ||
| 1467 | tmp = strchr(kbuf, '#'); | ||
| 1468 | if (tmp) | ||
| 1469 | *tmp = '\0'; | ||
| 1470 | |||
| 1471 | ret = command_trace_probe(kbuf); | ||
| 1472 | if (ret) | ||
| 1473 | goto out; | ||
| 1474 | } | ||
| 1475 | ret = done; | ||
| 1476 | out: | ||
| 1477 | kfree(kbuf); | ||
| 1478 | return ret; | ||
| 1479 | } | 635 | } |
| 1480 | 636 | ||
| 1481 | static const struct file_operations kprobe_events_ops = { | 637 | static const struct file_operations kprobe_events_ops = { |
| @@ -1711,16 +867,6 @@ partial: | |||
| 1711 | return TRACE_TYPE_PARTIAL_LINE; | 867 | return TRACE_TYPE_PARTIAL_LINE; |
| 1712 | } | 868 | } |
| 1713 | 869 | ||
| 1714 | #undef DEFINE_FIELD | ||
| 1715 | #define DEFINE_FIELD(type, item, name, is_signed) \ | ||
| 1716 | do { \ | ||
| 1717 | ret = trace_define_field(event_call, #type, name, \ | ||
| 1718 | offsetof(typeof(field), item), \ | ||
| 1719 | sizeof(field.item), is_signed, \ | ||
| 1720 | FILTER_OTHER); \ | ||
| 1721 | if (ret) \ | ||
| 1722 | return ret; \ | ||
| 1723 | } while (0) | ||
| 1724 | 870 | ||
| 1725 | static int kprobe_event_define_fields(struct ftrace_event_call *event_call) | 871 | static int kprobe_event_define_fields(struct ftrace_event_call *event_call) |
| 1726 | { | 872 | { |
| @@ -2051,8 +1197,9 @@ static __init int kprobe_trace_self_tests_init(void) | |||
| 2051 | 1197 | ||
| 2052 | pr_info("Testing kprobe tracing: "); | 1198 | pr_info("Testing kprobe tracing: "); |
| 2053 | 1199 | ||
| 2054 | ret = command_trace_probe("p:testprobe kprobe_trace_selftest_target " | 1200 | ret = traceprobe_command("p:testprobe kprobe_trace_selftest_target " |
| 2055 | "$stack $stack0 +0($stack)"); | 1201 | "$stack $stack0 +0($stack)", |
| 1202 | create_trace_probe); | ||
| 2056 | if (WARN_ON_ONCE(ret)) { | 1203 | if (WARN_ON_ONCE(ret)) { |
| 2057 | pr_warning("error on probing function entry.\n"); | 1204 | pr_warning("error on probing function entry.\n"); |
| 2058 | warn++; | 1205 | warn++; |
| @@ -2066,8 +1213,8 @@ static __init int kprobe_trace_self_tests_init(void) | |||
| 2066 | enable_trace_probe(tp, TP_FLAG_TRACE); | 1213 | enable_trace_probe(tp, TP_FLAG_TRACE); |
| 2067 | } | 1214 | } |
| 2068 | 1215 | ||
| 2069 | ret = command_trace_probe("r:testprobe2 kprobe_trace_selftest_target " | 1216 | ret = traceprobe_command("r:testprobe2 kprobe_trace_selftest_target " |
| 2070 | "$retval"); | 1217 | "$retval", create_trace_probe); |
| 2071 | if (WARN_ON_ONCE(ret)) { | 1218 | if (WARN_ON_ONCE(ret)) { |
| 2072 | pr_warning("error on probing function return.\n"); | 1219 | pr_warning("error on probing function return.\n"); |
| 2073 | warn++; | 1220 | warn++; |
| @@ -2101,13 +1248,13 @@ static __init int kprobe_trace_self_tests_init(void) | |||
| 2101 | } else | 1248 | } else |
| 2102 | disable_trace_probe(tp, TP_FLAG_TRACE); | 1249 | disable_trace_probe(tp, TP_FLAG_TRACE); |
| 2103 | 1250 | ||
| 2104 | ret = command_trace_probe("-:testprobe"); | 1251 | ret = traceprobe_command("-:testprobe", create_trace_probe); |
| 2105 | if (WARN_ON_ONCE(ret)) { | 1252 | if (WARN_ON_ONCE(ret)) { |
| 2106 | pr_warning("error on deleting a probe.\n"); | 1253 | pr_warning("error on deleting a probe.\n"); |
| 2107 | warn++; | 1254 | warn++; |
| 2108 | } | 1255 | } |
| 2109 | 1256 | ||
| 2110 | ret = command_trace_probe("-:testprobe2"); | 1257 | ret = traceprobe_command("-:testprobe2", create_trace_probe); |
| 2111 | if (WARN_ON_ONCE(ret)) { | 1258 | if (WARN_ON_ONCE(ret)) { |
| 2112 | pr_warning("error on deleting a probe.\n"); | 1259 | pr_warning("error on deleting a probe.\n"); |
| 2113 | warn++; | 1260 | warn++; |
diff --git a/kernel/trace/trace_probe.c b/kernel/trace/trace_probe.c new file mode 100644 index 000000000000..8e526b9286e9 --- /dev/null +++ b/kernel/trace/trace_probe.c | |||
| @@ -0,0 +1,833 @@ | |||
| 1 | /* | ||
| 2 | * Common code for probe-based Dynamic events. | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or modify | ||
| 5 | * it under the terms of the GNU General Public License version 2 as | ||
| 6 | * published by the Free Software Foundation. | ||
| 7 | * | ||
| 8 | * This program is distributed in the hope that it will be useful, | ||
| 9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 11 | * GNU General Public License for more details. | ||
| 12 | * | ||
| 13 | * You should have received a copy of the GNU General Public License | ||
| 14 | * along with this program; if not, write to the Free Software | ||
| 15 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 16 | * | ||
| 17 | * This code was copied from kernel/trace/trace_kprobe.c written by | ||
| 18 | * Masami Hiramatsu <masami.hiramatsu.pt@hitachi.com> | ||
| 19 | * | ||
| 20 | * Updates to make this generic: | ||
| 21 | * Copyright (C) IBM Corporation, 2010-2011 | ||
| 22 | * Author: Srikar Dronamraju | ||
| 23 | */ | ||
| 24 | |||
| 25 | #include "trace_probe.h" | ||
| 26 | |||
| 27 | const char *reserved_field_names[] = { | ||
| 28 | "common_type", | ||
| 29 | "common_flags", | ||
| 30 | "common_preempt_count", | ||
| 31 | "common_pid", | ||
| 32 | "common_tgid", | ||
| 33 | FIELD_STRING_IP, | ||
| 34 | FIELD_STRING_RETIP, | ||
| 35 | FIELD_STRING_FUNC, | ||
| 36 | }; | ||
| 37 | |||
| 38 | /* Printing function type */ | ||
| 39 | #define PRINT_TYPE_FUNC_NAME(type) print_type_##type | ||
| 40 | #define PRINT_TYPE_FMT_NAME(type) print_type_format_##type | ||
| 41 | |||
| 42 | /* Printing in basic type function template */ | ||
| 43 | #define DEFINE_BASIC_PRINT_TYPE_FUNC(type, fmt, cast) \ | ||
| 44 | static __kprobes int PRINT_TYPE_FUNC_NAME(type)(struct trace_seq *s, \ | ||
| 45 | const char *name, \ | ||
| 46 | void *data, void *ent)\ | ||
| 47 | { \ | ||
| 48 | return trace_seq_printf(s, " %s=" fmt, name, (cast)*(type *)data);\ | ||
| 49 | } \ | ||
| 50 | static const char PRINT_TYPE_FMT_NAME(type)[] = fmt; | ||
| 51 | |||
| 52 | DEFINE_BASIC_PRINT_TYPE_FUNC(u8, "%x", unsigned int) | ||
| 53 | DEFINE_BASIC_PRINT_TYPE_FUNC(u16, "%x", unsigned int) | ||
| 54 | DEFINE_BASIC_PRINT_TYPE_FUNC(u32, "%lx", unsigned long) | ||
| 55 | DEFINE_BASIC_PRINT_TYPE_FUNC(u64, "%llx", unsigned long long) | ||
| 56 | DEFINE_BASIC_PRINT_TYPE_FUNC(s8, "%d", int) | ||
| 57 | DEFINE_BASIC_PRINT_TYPE_FUNC(s16, "%d", int) | ||
| 58 | DEFINE_BASIC_PRINT_TYPE_FUNC(s32, "%ld", long) | ||
| 59 | DEFINE_BASIC_PRINT_TYPE_FUNC(s64, "%lld", long long) | ||
| 60 | |||
| 61 | static inline void *get_rloc_data(u32 *dl) | ||
| 62 | { | ||
| 63 | return (u8 *)dl + get_rloc_offs(*dl); | ||
| 64 | } | ||
| 65 | |||
| 66 | /* For data_loc conversion */ | ||
| 67 | static inline void *get_loc_data(u32 *dl, void *ent) | ||
| 68 | { | ||
| 69 | return (u8 *)ent + get_rloc_offs(*dl); | ||
| 70 | } | ||
| 71 | |||
| 72 | /* For defining macros, define string/string_size types */ | ||
| 73 | typedef u32 string; | ||
| 74 | typedef u32 string_size; | ||
| 75 | |||
| 76 | /* Print type function for string type */ | ||
| 77 | static __kprobes int PRINT_TYPE_FUNC_NAME(string)(struct trace_seq *s, | ||
| 78 | const char *name, | ||
| 79 | void *data, void *ent) | ||
| 80 | { | ||
| 81 | int len = *(u32 *)data >> 16; | ||
| 82 | |||
| 83 | if (!len) | ||
| 84 | return trace_seq_printf(s, " %s=(fault)", name); | ||
| 85 | else | ||
| 86 | return trace_seq_printf(s, " %s=\"%s\"", name, | ||
| 87 | (const char *)get_loc_data(data, ent)); | ||
| 88 | } | ||
| 89 | |||
| 90 | static const char PRINT_TYPE_FMT_NAME(string)[] = "\\\"%s\\\""; | ||
| 91 | |||
| 92 | #define FETCH_FUNC_NAME(method, type) fetch_##method##_##type | ||
| 93 | /* | ||
| 94 | * Define macro for basic types - we don't need to define s* types, because | ||
| 95 | * we have to care only about bitwidth at recording time. | ||
| 96 | */ | ||
| 97 | #define DEFINE_BASIC_FETCH_FUNCS(method) \ | ||
| 98 | DEFINE_FETCH_##method(u8) \ | ||
| 99 | DEFINE_FETCH_##method(u16) \ | ||
| 100 | DEFINE_FETCH_##method(u32) \ | ||
| 101 | DEFINE_FETCH_##method(u64) | ||
| 102 | |||
| 103 | #define CHECK_FETCH_FUNCS(method, fn) \ | ||
| 104 | (((FETCH_FUNC_NAME(method, u8) == fn) || \ | ||
| 105 | (FETCH_FUNC_NAME(method, u16) == fn) || \ | ||
| 106 | (FETCH_FUNC_NAME(method, u32) == fn) || \ | ||
| 107 | (FETCH_FUNC_NAME(method, u64) == fn) || \ | ||
| 108 | (FETCH_FUNC_NAME(method, string) == fn) || \ | ||
| 109 | (FETCH_FUNC_NAME(method, string_size) == fn)) \ | ||
| 110 | && (fn != NULL)) | ||
| 111 | |||
| 112 | /* Data fetch function templates */ | ||
| 113 | #define DEFINE_FETCH_reg(type) \ | ||
| 114 | static __kprobes void FETCH_FUNC_NAME(reg, type)(struct pt_regs *regs, \ | ||
| 115 | void *offset, void *dest) \ | ||
| 116 | { \ | ||
| 117 | *(type *)dest = (type)regs_get_register(regs, \ | ||
| 118 | (unsigned int)((unsigned long)offset)); \ | ||
| 119 | } | ||
| 120 | DEFINE_BASIC_FETCH_FUNCS(reg) | ||
| 121 | /* No string on the register */ | ||
| 122 | #define fetch_reg_string NULL | ||
| 123 | #define fetch_reg_string_size NULL | ||
| 124 | |||
| 125 | #define DEFINE_FETCH_stack(type) \ | ||
| 126 | static __kprobes void FETCH_FUNC_NAME(stack, type)(struct pt_regs *regs,\ | ||
| 127 | void *offset, void *dest) \ | ||
| 128 | { \ | ||
| 129 | *(type *)dest = (type)regs_get_kernel_stack_nth(regs, \ | ||
| 130 | (unsigned int)((unsigned long)offset)); \ | ||
| 131 | } | ||
| 132 | DEFINE_BASIC_FETCH_FUNCS(stack) | ||
| 133 | /* No string on the stack entry */ | ||
| 134 | #define fetch_stack_string NULL | ||
| 135 | #define fetch_stack_string_size NULL | ||
| 136 | |||
| 137 | #define DEFINE_FETCH_retval(type) \ | ||
| 138 | static __kprobes void FETCH_FUNC_NAME(retval, type)(struct pt_regs *regs,\ | ||
| 139 | void *dummy, void *dest) \ | ||
| 140 | { \ | ||
| 141 | *(type *)dest = (type)regs_return_value(regs); \ | ||
| 142 | } | ||
| 143 | DEFINE_BASIC_FETCH_FUNCS(retval) | ||
| 144 | /* No string on the retval */ | ||
| 145 | #define fetch_retval_string NULL | ||
| 146 | #define fetch_retval_string_size NULL | ||
| 147 | |||
| 148 | #define DEFINE_FETCH_memory(type) \ | ||
| 149 | static __kprobes void FETCH_FUNC_NAME(memory, type)(struct pt_regs *regs,\ | ||
| 150 | void *addr, void *dest) \ | ||
| 151 | { \ | ||
| 152 | type retval; \ | ||
| 153 | if (probe_kernel_address(addr, retval)) \ | ||
| 154 | *(type *)dest = 0; \ | ||
| 155 | else \ | ||
| 156 | *(type *)dest = retval; \ | ||
| 157 | } | ||
| 158 | DEFINE_BASIC_FETCH_FUNCS(memory) | ||
| 159 | /* | ||
| 160 | * Fetch a null-terminated string. Caller MUST set *(u32 *)dest with max | ||
| 161 | * length and relative data location. | ||
| 162 | */ | ||
| 163 | static __kprobes void FETCH_FUNC_NAME(memory, string)(struct pt_regs *regs, | ||
| 164 | void *addr, void *dest) | ||
| 165 | { | ||
| 166 | long ret; | ||
| 167 | int maxlen = get_rloc_len(*(u32 *)dest); | ||
| 168 | u8 *dst = get_rloc_data(dest); | ||
| 169 | u8 *src = addr; | ||
| 170 | mm_segment_t old_fs = get_fs(); | ||
| 171 | |||
| 172 | if (!maxlen) | ||
| 173 | return; | ||
| 174 | |||
| 175 | /* | ||
| 176 | * Try to get string again, since the string can be changed while | ||
| 177 | * probing. | ||
| 178 | */ | ||
| 179 | set_fs(KERNEL_DS); | ||
| 180 | pagefault_disable(); | ||
| 181 | |||
| 182 | do | ||
| 183 | ret = __copy_from_user_inatomic(dst++, src++, 1); | ||
| 184 | while (dst[-1] && ret == 0 && src - (u8 *)addr < maxlen); | ||
| 185 | |||
| 186 | dst[-1] = '\0'; | ||
| 187 | pagefault_enable(); | ||
| 188 | set_fs(old_fs); | ||
| 189 | |||
| 190 | if (ret < 0) { /* Failed to fetch string */ | ||
| 191 | ((u8 *)get_rloc_data(dest))[0] = '\0'; | ||
| 192 | *(u32 *)dest = make_data_rloc(0, get_rloc_offs(*(u32 *)dest)); | ||
| 193 | } else { | ||
| 194 | *(u32 *)dest = make_data_rloc(src - (u8 *)addr, | ||
| 195 | get_rloc_offs(*(u32 *)dest)); | ||
| 196 | } | ||
| 197 | } | ||
| 198 | |||
| 199 | /* Return the length of string -- including null terminal byte */ | ||
| 200 | static __kprobes void FETCH_FUNC_NAME(memory, string_size)(struct pt_regs *regs, | ||
| 201 | void *addr, void *dest) | ||
| 202 | { | ||
| 203 | mm_segment_t old_fs; | ||
| 204 | int ret, len = 0; | ||
| 205 | u8 c; | ||
| 206 | |||
| 207 | old_fs = get_fs(); | ||
| 208 | set_fs(KERNEL_DS); | ||
| 209 | pagefault_disable(); | ||
| 210 | |||
| 211 | do { | ||
| 212 | ret = __copy_from_user_inatomic(&c, (u8 *)addr + len, 1); | ||
| 213 | len++; | ||
| 214 | } while (c && ret == 0 && len < MAX_STRING_SIZE); | ||
| 215 | |||
| 216 | pagefault_enable(); | ||
| 217 | set_fs(old_fs); | ||
| 218 | |||
| 219 | if (ret < 0) /* Failed to check the length */ | ||
| 220 | *(u32 *)dest = 0; | ||
| 221 | else | ||
| 222 | *(u32 *)dest = len; | ||
| 223 | } | ||
| 224 | |||
| 225 | /* Memory fetching by symbol */ | ||
| 226 | struct symbol_cache { | ||
| 227 | char *symbol; | ||
| 228 | long offset; | ||
| 229 | unsigned long addr; | ||
| 230 | }; | ||
| 231 | |||
| 232 | static unsigned long update_symbol_cache(struct symbol_cache *sc) | ||
| 233 | { | ||
| 234 | sc->addr = (unsigned long)kallsyms_lookup_name(sc->symbol); | ||
| 235 | |||
| 236 | if (sc->addr) | ||
| 237 | sc->addr += sc->offset; | ||
| 238 | |||
| 239 | return sc->addr; | ||
| 240 | } | ||
| 241 | |||
| 242 | static void free_symbol_cache(struct symbol_cache *sc) | ||
| 243 | { | ||
| 244 | kfree(sc->symbol); | ||
| 245 | kfree(sc); | ||
| 246 | } | ||
| 247 | |||
| 248 | static struct symbol_cache *alloc_symbol_cache(const char *sym, long offset) | ||
| 249 | { | ||
| 250 | struct symbol_cache *sc; | ||
| 251 | |||
| 252 | if (!sym || strlen(sym) == 0) | ||
| 253 | return NULL; | ||
| 254 | |||
| 255 | sc = kzalloc(sizeof(struct symbol_cache), GFP_KERNEL); | ||
| 256 | if (!sc) | ||
| 257 | return NULL; | ||
| 258 | |||
| 259 | sc->symbol = kstrdup(sym, GFP_KERNEL); | ||
| 260 | if (!sc->symbol) { | ||
| 261 | kfree(sc); | ||
| 262 | return NULL; | ||
| 263 | } | ||
| 264 | sc->offset = offset; | ||
| 265 | update_symbol_cache(sc); | ||
| 266 | |||
| 267 | return sc; | ||
| 268 | } | ||
| 269 | |||
| 270 | #define DEFINE_FETCH_symbol(type) \ | ||
| 271 | static __kprobes void FETCH_FUNC_NAME(symbol, type)(struct pt_regs *regs,\ | ||
| 272 | void *data, void *dest) \ | ||
| 273 | { \ | ||
| 274 | struct symbol_cache *sc = data; \ | ||
| 275 | if (sc->addr) \ | ||
| 276 | fetch_memory_##type(regs, (void *)sc->addr, dest); \ | ||
| 277 | else \ | ||
| 278 | *(type *)dest = 0; \ | ||
| 279 | } | ||
| 280 | DEFINE_BASIC_FETCH_FUNCS(symbol) | ||
| 281 | DEFINE_FETCH_symbol(string) | ||
| 282 | DEFINE_FETCH_symbol(string_size) | ||
| 283 | |||
| 284 | /* Dereference memory access function */ | ||
| 285 | struct deref_fetch_param { | ||
| 286 | struct fetch_param orig; | ||
| 287 | long offset; | ||
| 288 | }; | ||
| 289 | |||
| 290 | #define DEFINE_FETCH_deref(type) \ | ||
| 291 | static __kprobes void FETCH_FUNC_NAME(deref, type)(struct pt_regs *regs,\ | ||
| 292 | void *data, void *dest) \ | ||
| 293 | { \ | ||
| 294 | struct deref_fetch_param *dprm = data; \ | ||
| 295 | unsigned long addr; \ | ||
| 296 | call_fetch(&dprm->orig, regs, &addr); \ | ||
| 297 | if (addr) { \ | ||
| 298 | addr += dprm->offset; \ | ||
| 299 | fetch_memory_##type(regs, (void *)addr, dest); \ | ||
| 300 | } else \ | ||
| 301 | *(type *)dest = 0; \ | ||
| 302 | } | ||
| 303 | DEFINE_BASIC_FETCH_FUNCS(deref) | ||
| 304 | DEFINE_FETCH_deref(string) | ||
| 305 | DEFINE_FETCH_deref(string_size) | ||
| 306 | |||
| 307 | static __kprobes void update_deref_fetch_param(struct deref_fetch_param *data) | ||
| 308 | { | ||
| 309 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 310 | update_deref_fetch_param(data->orig.data); | ||
| 311 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 312 | update_symbol_cache(data->orig.data); | ||
| 313 | } | ||
| 314 | |||
| 315 | static __kprobes void free_deref_fetch_param(struct deref_fetch_param *data) | ||
| 316 | { | ||
| 317 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 318 | free_deref_fetch_param(data->orig.data); | ||
| 319 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 320 | free_symbol_cache(data->orig.data); | ||
| 321 | kfree(data); | ||
| 322 | } | ||
| 323 | |||
| 324 | /* Bitfield fetch function */ | ||
| 325 | struct bitfield_fetch_param { | ||
| 326 | struct fetch_param orig; | ||
| 327 | unsigned char hi_shift; | ||
| 328 | unsigned char low_shift; | ||
| 329 | }; | ||
| 330 | |||
| 331 | #define DEFINE_FETCH_bitfield(type) \ | ||
| 332 | static __kprobes void FETCH_FUNC_NAME(bitfield, type)(struct pt_regs *regs,\ | ||
| 333 | void *data, void *dest) \ | ||
| 334 | { \ | ||
| 335 | struct bitfield_fetch_param *bprm = data; \ | ||
| 336 | type buf = 0; \ | ||
| 337 | call_fetch(&bprm->orig, regs, &buf); \ | ||
| 338 | if (buf) { \ | ||
| 339 | buf <<= bprm->hi_shift; \ | ||
| 340 | buf >>= bprm->low_shift; \ | ||
| 341 | } \ | ||
| 342 | *(type *)dest = buf; \ | ||
| 343 | } | ||
| 344 | |||
| 345 | DEFINE_BASIC_FETCH_FUNCS(bitfield) | ||
| 346 | #define fetch_bitfield_string NULL | ||
| 347 | #define fetch_bitfield_string_size NULL | ||
| 348 | |||
| 349 | static __kprobes void | ||
| 350 | update_bitfield_fetch_param(struct bitfield_fetch_param *data) | ||
| 351 | { | ||
| 352 | /* | ||
| 353 | * Don't check the bitfield itself, because this must be the | ||
| 354 | * last fetch function. | ||
| 355 | */ | ||
| 356 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 357 | update_deref_fetch_param(data->orig.data); | ||
| 358 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 359 | update_symbol_cache(data->orig.data); | ||
| 360 | } | ||
| 361 | |||
| 362 | static __kprobes void | ||
| 363 | free_bitfield_fetch_param(struct bitfield_fetch_param *data) | ||
| 364 | { | ||
| 365 | /* | ||
| 366 | * Don't check the bitfield itself, because this must be the | ||
| 367 | * last fetch function. | ||
| 368 | */ | ||
| 369 | if (CHECK_FETCH_FUNCS(deref, data->orig.fn)) | ||
| 370 | free_deref_fetch_param(data->orig.data); | ||
| 371 | else if (CHECK_FETCH_FUNCS(symbol, data->orig.fn)) | ||
| 372 | free_symbol_cache(data->orig.data); | ||
| 373 | |||
| 374 | kfree(data); | ||
| 375 | } | ||
| 376 | |||
| 377 | /* Default (unsigned long) fetch type */ | ||
| 378 | #define __DEFAULT_FETCH_TYPE(t) u##t | ||
| 379 | #define _DEFAULT_FETCH_TYPE(t) __DEFAULT_FETCH_TYPE(t) | ||
| 380 | #define DEFAULT_FETCH_TYPE _DEFAULT_FETCH_TYPE(BITS_PER_LONG) | ||
| 381 | #define DEFAULT_FETCH_TYPE_STR __stringify(DEFAULT_FETCH_TYPE) | ||
| 382 | |||
| 383 | #define ASSIGN_FETCH_FUNC(method, type) \ | ||
| 384 | [FETCH_MTD_##method] = FETCH_FUNC_NAME(method, type) | ||
| 385 | |||
| 386 | #define __ASSIGN_FETCH_TYPE(_name, ptype, ftype, _size, sign, _fmttype) \ | ||
| 387 | {.name = _name, \ | ||
| 388 | .size = _size, \ | ||
| 389 | .is_signed = sign, \ | ||
| 390 | .print = PRINT_TYPE_FUNC_NAME(ptype), \ | ||
| 391 | .fmt = PRINT_TYPE_FMT_NAME(ptype), \ | ||
| 392 | .fmttype = _fmttype, \ | ||
| 393 | .fetch = { \ | ||
| 394 | ASSIGN_FETCH_FUNC(reg, ftype), \ | ||
| 395 | ASSIGN_FETCH_FUNC(stack, ftype), \ | ||
| 396 | ASSIGN_FETCH_FUNC(retval, ftype), \ | ||
| 397 | ASSIGN_FETCH_FUNC(memory, ftype), \ | ||
| 398 | ASSIGN_FETCH_FUNC(symbol, ftype), \ | ||
| 399 | ASSIGN_FETCH_FUNC(deref, ftype), \ | ||
| 400 | ASSIGN_FETCH_FUNC(bitfield, ftype), \ | ||
| 401 | } \ | ||
| 402 | } | ||
| 403 | |||
| 404 | #define ASSIGN_FETCH_TYPE(ptype, ftype, sign) \ | ||
| 405 | __ASSIGN_FETCH_TYPE(#ptype, ptype, ftype, sizeof(ftype), sign, #ptype) | ||
| 406 | |||
| 407 | #define FETCH_TYPE_STRING 0 | ||
| 408 | #define FETCH_TYPE_STRSIZE 1 | ||
| 409 | |||
| 410 | /* Fetch type information table */ | ||
| 411 | static const struct fetch_type fetch_type_table[] = { | ||
| 412 | /* Special types */ | ||
| 413 | [FETCH_TYPE_STRING] = __ASSIGN_FETCH_TYPE("string", string, string, | ||
| 414 | sizeof(u32), 1, "__data_loc char[]"), | ||
| 415 | [FETCH_TYPE_STRSIZE] = __ASSIGN_FETCH_TYPE("string_size", u32, | ||
| 416 | string_size, sizeof(u32), 0, "u32"), | ||
| 417 | /* Basic types */ | ||
| 418 | ASSIGN_FETCH_TYPE(u8, u8, 0), | ||
| 419 | ASSIGN_FETCH_TYPE(u16, u16, 0), | ||
| 420 | ASSIGN_FETCH_TYPE(u32, u32, 0), | ||
| 421 | ASSIGN_FETCH_TYPE(u64, u64, 0), | ||
| 422 | ASSIGN_FETCH_TYPE(s8, u8, 1), | ||
| 423 | ASSIGN_FETCH_TYPE(s16, u16, 1), | ||
| 424 | ASSIGN_FETCH_TYPE(s32, u32, 1), | ||
| 425 | ASSIGN_FETCH_TYPE(s64, u64, 1), | ||
| 426 | }; | ||
| 427 | |||
| 428 | static const struct fetch_type *find_fetch_type(const char *type) | ||
| 429 | { | ||
| 430 | int i; | ||
| 431 | |||
| 432 | if (!type) | ||
| 433 | type = DEFAULT_FETCH_TYPE_STR; | ||
| 434 | |||
| 435 | /* Special case: bitfield */ | ||
| 436 | if (*type == 'b') { | ||
| 437 | unsigned long bs; | ||
| 438 | |||
| 439 | type = strchr(type, '/'); | ||
| 440 | if (!type) | ||
| 441 | goto fail; | ||
| 442 | |||
| 443 | type++; | ||
| 444 | if (strict_strtoul(type, 0, &bs)) | ||
| 445 | goto fail; | ||
| 446 | |||
| 447 | switch (bs) { | ||
| 448 | case 8: | ||
| 449 | return find_fetch_type("u8"); | ||
| 450 | case 16: | ||
| 451 | return find_fetch_type("u16"); | ||
| 452 | case 32: | ||
| 453 | return find_fetch_type("u32"); | ||
| 454 | case 64: | ||
| 455 | return find_fetch_type("u64"); | ||
| 456 | default: | ||
| 457 | goto fail; | ||
| 458 | } | ||
| 459 | } | ||
| 460 | |||
| 461 | for (i = 0; i < ARRAY_SIZE(fetch_type_table); i++) | ||
| 462 | if (strcmp(type, fetch_type_table[i].name) == 0) | ||
| 463 | return &fetch_type_table[i]; | ||
| 464 | |||
| 465 | fail: | ||
| 466 | return NULL; | ||
| 467 | } | ||
| 468 | |||
| 469 | /* Special function : only accept unsigned long */ | ||
| 470 | static __kprobes void fetch_stack_address(struct pt_regs *regs, | ||
| 471 | void *dummy, void *dest) | ||
| 472 | { | ||
| 473 | *(unsigned long *)dest = kernel_stack_pointer(regs); | ||
| 474 | } | ||
| 475 | |||
| 476 | static fetch_func_t get_fetch_size_function(const struct fetch_type *type, | ||
| 477 | fetch_func_t orig_fn) | ||
| 478 | { | ||
| 479 | int i; | ||
| 480 | |||
| 481 | if (type != &fetch_type_table[FETCH_TYPE_STRING]) | ||
| 482 | return NULL; /* Only string type needs size function */ | ||
| 483 | |||
| 484 | for (i = 0; i < FETCH_MTD_END; i++) | ||
| 485 | if (type->fetch[i] == orig_fn) | ||
| 486 | return fetch_type_table[FETCH_TYPE_STRSIZE].fetch[i]; | ||
| 487 | |||
| 488 | WARN_ON(1); /* This should not happen */ | ||
| 489 | |||
| 490 | return NULL; | ||
| 491 | } | ||
| 492 | |||
| 493 | /* Split symbol and offset. */ | ||
| 494 | int traceprobe_split_symbol_offset(char *symbol, unsigned long *offset) | ||
| 495 | { | ||
| 496 | char *tmp; | ||
| 497 | int ret; | ||
| 498 | |||
| 499 | if (!offset) | ||
| 500 | return -EINVAL; | ||
| 501 | |||
| 502 | tmp = strchr(symbol, '+'); | ||
| 503 | if (tmp) { | ||
| 504 | /* skip sign because strict_strtol doesn't accept '+' */ | ||
| 505 | ret = strict_strtoul(tmp + 1, 0, offset); | ||
| 506 | if (ret) | ||
| 507 | return ret; | ||
| 508 | |||
| 509 | *tmp = '\0'; | ||
| 510 | } else | ||
| 511 | *offset = 0; | ||
| 512 | |||
| 513 | return 0; | ||
| 514 | } | ||
| 515 | |||
| 516 | #define PARAM_MAX_STACK (THREAD_SIZE / sizeof(unsigned long)) | ||
| 517 | |||
| 518 | static int parse_probe_vars(char *arg, const struct fetch_type *t, | ||
| 519 | struct fetch_param *f, bool is_return) | ||
| 520 | { | ||
| 521 | int ret = 0; | ||
| 522 | unsigned long param; | ||
| 523 | |||
| 524 | if (strcmp(arg, "retval") == 0) { | ||
| 525 | if (is_return) | ||
| 526 | f->fn = t->fetch[FETCH_MTD_retval]; | ||
| 527 | else | ||
| 528 | ret = -EINVAL; | ||
| 529 | } else if (strncmp(arg, "stack", 5) == 0) { | ||
| 530 | if (arg[5] == '\0') { | ||
| 531 | if (strcmp(t->name, DEFAULT_FETCH_TYPE_STR) == 0) | ||
| 532 | f->fn = fetch_stack_address; | ||
| 533 | else | ||
| 534 | ret = -EINVAL; | ||
| 535 | } else if (isdigit(arg[5])) { | ||
| 536 | ret = strict_strtoul(arg + 5, 10, ¶m); | ||
| 537 | if (ret || param > PARAM_MAX_STACK) | ||
| 538 | ret = -EINVAL; | ||
| 539 | else { | ||
| 540 | f->fn = t->fetch[FETCH_MTD_stack]; | ||
| 541 | f->data = (void *)param; | ||
| 542 | } | ||
| 543 | } else | ||
| 544 | ret = -EINVAL; | ||
| 545 | } else | ||
| 546 | ret = -EINVAL; | ||
| 547 | |||
| 548 | return ret; | ||
| 549 | } | ||
| 550 | |||
| 551 | /* Recursive argument parser */ | ||
| 552 | static int parse_probe_arg(char *arg, const struct fetch_type *t, | ||
| 553 | struct fetch_param *f, bool is_return) | ||
| 554 | { | ||
| 555 | unsigned long param; | ||
| 556 | long offset; | ||
| 557 | char *tmp; | ||
| 558 | int ret; | ||
| 559 | |||
| 560 | ret = 0; | ||
| 561 | switch (arg[0]) { | ||
| 562 | case '$': | ||
| 563 | ret = parse_probe_vars(arg + 1, t, f, is_return); | ||
| 564 | break; | ||
| 565 | |||
| 566 | case '%': /* named register */ | ||
| 567 | ret = regs_query_register_offset(arg + 1); | ||
| 568 | if (ret >= 0) { | ||
| 569 | f->fn = t->fetch[FETCH_MTD_reg]; | ||
| 570 | f->data = (void *)(unsigned long)ret; | ||
| 571 | ret = 0; | ||
| 572 | } | ||
| 573 | break; | ||
| 574 | |||
| 575 | case '@': /* memory or symbol */ | ||
| 576 | if (isdigit(arg[1])) { | ||
| 577 | ret = strict_strtoul(arg + 1, 0, ¶m); | ||
| 578 | if (ret) | ||
| 579 | break; | ||
| 580 | |||
| 581 | f->fn = t->fetch[FETCH_MTD_memory]; | ||
| 582 | f->data = (void *)param; | ||
| 583 | } else { | ||
| 584 | ret = traceprobe_split_symbol_offset(arg + 1, &offset); | ||
| 585 | if (ret) | ||
| 586 | break; | ||
| 587 | |||
| 588 | f->data = alloc_symbol_cache(arg + 1, offset); | ||
| 589 | if (f->data) | ||
| 590 | f->fn = t->fetch[FETCH_MTD_symbol]; | ||
| 591 | } | ||
| 592 | break; | ||
| 593 | |||
| 594 | case '+': /* deref memory */ | ||
| 595 | arg++; /* Skip '+', because strict_strtol() rejects it. */ | ||
| 596 | case '-': | ||
| 597 | tmp = strchr(arg, '('); | ||
| 598 | if (!tmp) | ||
| 599 | break; | ||
| 600 | |||
| 601 | *tmp = '\0'; | ||
| 602 | ret = strict_strtol(arg, 0, &offset); | ||
| 603 | |||
| 604 | if (ret) | ||
| 605 | break; | ||
| 606 | |||
| 607 | arg = tmp + 1; | ||
| 608 | tmp = strrchr(arg, ')'); | ||
| 609 | |||
| 610 | if (tmp) { | ||
| 611 | struct deref_fetch_param *dprm; | ||
| 612 | const struct fetch_type *t2; | ||
| 613 | |||
| 614 | t2 = find_fetch_type(NULL); | ||
| 615 | *tmp = '\0'; | ||
| 616 | dprm = kzalloc(sizeof(struct deref_fetch_param), GFP_KERNEL); | ||
| 617 | |||
| 618 | if (!dprm) | ||
| 619 | return -ENOMEM; | ||
| 620 | |||
| 621 | dprm->offset = offset; | ||
| 622 | ret = parse_probe_arg(arg, t2, &dprm->orig, is_return); | ||
| 623 | if (ret) | ||
| 624 | kfree(dprm); | ||
| 625 | else { | ||
| 626 | f->fn = t->fetch[FETCH_MTD_deref]; | ||
| 627 | f->data = (void *)dprm; | ||
| 628 | } | ||
| 629 | } | ||
| 630 | break; | ||
| 631 | } | ||
| 632 | if (!ret && !f->fn) { /* Parsed, but do not find fetch method */ | ||
| 633 | pr_info("%s type has no corresponding fetch method.\n", t->name); | ||
| 634 | ret = -EINVAL; | ||
| 635 | } | ||
| 636 | |||
| 637 | return ret; | ||
| 638 | } | ||
| 639 | |||
| 640 | #define BYTES_TO_BITS(nb) ((BITS_PER_LONG * (nb)) / sizeof(long)) | ||
| 641 | |||
| 642 | /* Bitfield type needs to be parsed into a fetch function */ | ||
| 643 | static int __parse_bitfield_probe_arg(const char *bf, | ||
| 644 | const struct fetch_type *t, | ||
| 645 | struct fetch_param *f) | ||
| 646 | { | ||
| 647 | struct bitfield_fetch_param *bprm; | ||
| 648 | unsigned long bw, bo; | ||
| 649 | char *tail; | ||
| 650 | |||
| 651 | if (*bf != 'b') | ||
| 652 | return 0; | ||
| 653 | |||
| 654 | bprm = kzalloc(sizeof(*bprm), GFP_KERNEL); | ||
| 655 | if (!bprm) | ||
| 656 | return -ENOMEM; | ||
| 657 | |||
| 658 | bprm->orig = *f; | ||
| 659 | f->fn = t->fetch[FETCH_MTD_bitfield]; | ||
| 660 | f->data = (void *)bprm; | ||
| 661 | bw = simple_strtoul(bf + 1, &tail, 0); /* Use simple one */ | ||
| 662 | |||
| 663 | if (bw == 0 || *tail != '@') | ||
| 664 | return -EINVAL; | ||
| 665 | |||
| 666 | bf = tail + 1; | ||
| 667 | bo = simple_strtoul(bf, &tail, 0); | ||
| 668 | |||
| 669 | if (tail == bf || *tail != '/') | ||
| 670 | return -EINVAL; | ||
| 671 | |||
| 672 | bprm->hi_shift = BYTES_TO_BITS(t->size) - (bw + bo); | ||
| 673 | bprm->low_shift = bprm->hi_shift + bo; | ||
| 674 | |||
| 675 | return (BYTES_TO_BITS(t->size) < (bw + bo)) ? -EINVAL : 0; | ||
| 676 | } | ||
| 677 | |||
| 678 | /* String length checking wrapper */ | ||
| 679 | int traceprobe_parse_probe_arg(char *arg, ssize_t *size, | ||
| 680 | struct probe_arg *parg, bool is_return) | ||
| 681 | { | ||
| 682 | const char *t; | ||
| 683 | int ret; | ||
| 684 | |||
| 685 | if (strlen(arg) > MAX_ARGSTR_LEN) { | ||
| 686 | pr_info("Argument is too long.: %s\n", arg); | ||
| 687 | return -ENOSPC; | ||
| 688 | } | ||
| 689 | parg->comm = kstrdup(arg, GFP_KERNEL); | ||
| 690 | if (!parg->comm) { | ||
| 691 | pr_info("Failed to allocate memory for command '%s'.\n", arg); | ||
| 692 | return -ENOMEM; | ||
| 693 | } | ||
| 694 | t = strchr(parg->comm, ':'); | ||
| 695 | if (t) { | ||
| 696 | arg[t - parg->comm] = '\0'; | ||
| 697 | t++; | ||
| 698 | } | ||
| 699 | parg->type = find_fetch_type(t); | ||
| 700 | if (!parg->type) { | ||
| 701 | pr_info("Unsupported type: %s\n", t); | ||
| 702 | return -EINVAL; | ||
| 703 | } | ||
| 704 | parg->offset = *size; | ||
| 705 | *size += parg->type->size; | ||
| 706 | ret = parse_probe_arg(arg, parg->type, &parg->fetch, is_return); | ||
| 707 | |||
| 708 | if (ret >= 0 && t != NULL) | ||
| 709 | ret = __parse_bitfield_probe_arg(t, parg->type, &parg->fetch); | ||
| 710 | |||
| 711 | if (ret >= 0) { | ||
| 712 | parg->fetch_size.fn = get_fetch_size_function(parg->type, | ||
| 713 | parg->fetch.fn); | ||
| 714 | parg->fetch_size.data = parg->fetch.data; | ||
| 715 | } | ||
| 716 | |||
| 717 | return ret; | ||
| 718 | } | ||
| 719 | |||
| 720 | /* Return 1 if name is reserved or already used by another argument */ | ||
| 721 | int traceprobe_conflict_field_name(const char *name, | ||
| 722 | struct probe_arg *args, int narg) | ||
| 723 | { | ||
| 724 | int i; | ||
| 725 | |||
| 726 | for (i = 0; i < ARRAY_SIZE(reserved_field_names); i++) | ||
| 727 | if (strcmp(reserved_field_names[i], name) == 0) | ||
| 728 | return 1; | ||
| 729 | |||
| 730 | for (i = 0; i < narg; i++) | ||
| 731 | if (strcmp(args[i].name, name) == 0) | ||
| 732 | return 1; | ||
| 733 | |||
| 734 | return 0; | ||
| 735 | } | ||
| 736 | |||
| 737 | void traceprobe_update_arg(struct probe_arg *arg) | ||
| 738 | { | ||
| 739 | if (CHECK_FETCH_FUNCS(bitfield, arg->fetch.fn)) | ||
| 740 | update_bitfield_fetch_param(arg->fetch.data); | ||
| 741 | else if (CHECK_FETCH_FUNCS(deref, arg->fetch.fn)) | ||
| 742 | update_deref_fetch_param(arg->fetch.data); | ||
| 743 | else if (CHECK_FETCH_FUNCS(symbol, arg->fetch.fn)) | ||
| 744 | update_symbol_cache(arg->fetch.data); | ||
| 745 | } | ||
| 746 | |||
| 747 | void traceprobe_free_probe_arg(struct probe_arg *arg) | ||
| 748 | { | ||
| 749 | if (CHECK_FETCH_FUNCS(bitfield, arg->fetch.fn)) | ||
| 750 | free_bitfield_fetch_param(arg->fetch.data); | ||
| 751 | else if (CHECK_FETCH_FUNCS(deref, arg->fetch.fn)) | ||
| 752 | free_deref_fetch_param(arg->fetch.data); | ||
| 753 | else if (CHECK_FETCH_FUNCS(symbol, arg->fetch.fn)) | ||
| 754 | free_symbol_cache(arg->fetch.data); | ||
| 755 | |||
| 756 | kfree(arg->name); | ||
| 757 | kfree(arg->comm); | ||
| 758 | } | ||
| 759 | |||
| 760 | int traceprobe_command(const char *buf, int (*createfn)(int, char **)) | ||
| 761 | { | ||
| 762 | char **argv; | ||
| 763 | int argc, ret; | ||
| 764 | |||
| 765 | argc = 0; | ||
| 766 | ret = 0; | ||
| 767 | argv = argv_split(GFP_KERNEL, buf, &argc); | ||
| 768 | if (!argv) | ||
| 769 | return -ENOMEM; | ||
| 770 | |||
| 771 | if (argc) | ||
| 772 | ret = createfn(argc, argv); | ||
| 773 | |||
| 774 | argv_free(argv); | ||
| 775 | |||
| 776 | return ret; | ||
| 777 | } | ||
| 778 | |||
| 779 | #define WRITE_BUFSIZE 4096 | ||
| 780 | |||
| 781 | ssize_t traceprobe_probes_write(struct file *file, const char __user *buffer, | ||
| 782 | size_t count, loff_t *ppos, | ||
| 783 | int (*createfn)(int, char **)) | ||
| 784 | { | ||
| 785 | char *kbuf, *tmp; | ||
| 786 | int ret = 0; | ||
| 787 | size_t done = 0; | ||
| 788 | size_t size; | ||
| 789 | |||
| 790 | kbuf = kmalloc(WRITE_BUFSIZE, GFP_KERNEL); | ||
| 791 | if (!kbuf) | ||
| 792 | return -ENOMEM; | ||
| 793 | |||
| 794 | while (done < count) { | ||
| 795 | size = count - done; | ||
| 796 | |||
| 797 | if (size >= WRITE_BUFSIZE) | ||
| 798 | size = WRITE_BUFSIZE - 1; | ||
| 799 | |||
| 800 | if (copy_from_user(kbuf, buffer + done, size)) { | ||
| 801 | ret = -EFAULT; | ||
| 802 | goto out; | ||
| 803 | } | ||
| 804 | kbuf[size] = '\0'; | ||
| 805 | tmp = strchr(kbuf, '\n'); | ||
| 806 | |||
| 807 | if (tmp) { | ||
| 808 | *tmp = '\0'; | ||
| 809 | size = tmp - kbuf + 1; | ||
| 810 | } else if (done + size < count) { | ||
| 811 | pr_warning("Line length is too long: " | ||
| 812 | "Should be less than %d.", WRITE_BUFSIZE); | ||
| 813 | ret = -EINVAL; | ||
| 814 | goto out; | ||
| 815 | } | ||
| 816 | done += size; | ||
| 817 | /* Remove comments */ | ||
| 818 | tmp = strchr(kbuf, '#'); | ||
| 819 | |||
| 820 | if (tmp) | ||
| 821 | *tmp = '\0'; | ||
| 822 | |||
| 823 | ret = traceprobe_command(kbuf, createfn); | ||
| 824 | if (ret) | ||
| 825 | goto out; | ||
| 826 | } | ||
| 827 | ret = done; | ||
| 828 | |||
| 829 | out: | ||
| 830 | kfree(kbuf); | ||
| 831 | |||
| 832 | return ret; | ||
| 833 | } | ||
diff --git a/kernel/trace/trace_probe.h b/kernel/trace/trace_probe.h new file mode 100644 index 000000000000..2df9a18e0252 --- /dev/null +++ b/kernel/trace/trace_probe.h | |||
| @@ -0,0 +1,160 @@ | |||
| 1 | /* | ||
| 2 | * Common header file for probe-based Dynamic events. | ||
| 3 | * | ||
| 4 | * This program is free software; you can redistribute it and/or modify | ||
| 5 | * it under the terms of the GNU General Public License version 2 as | ||
| 6 | * published by the Free Software Foundation. | ||
| 7 | * | ||
| 8 | * This program is distributed in the hope that it will be useful, | ||
| 9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 11 | * GNU General Public License for more details. | ||
| 12 | * | ||
| 13 | * You should have received a copy of the GNU General Public License | ||
| 14 | * along with this program; if not, write to the Free Software | ||
| 15 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 16 | * | ||
| 17 | * This code was copied from kernel/trace/trace_kprobe.h written by | ||
| 18 | * Masami Hiramatsu <masami.hiramatsu.pt@hitachi.com> | ||
| 19 | * | ||
| 20 | * Updates to make this generic: | ||
| 21 | * Copyright (C) IBM Corporation, 2010-2011 | ||
| 22 | * Author: Srikar Dronamraju | ||
| 23 | */ | ||
| 24 | |||
| 25 | #include <linux/seq_file.h> | ||
| 26 | #include <linux/slab.h> | ||
| 27 | #include <linux/smp.h> | ||
| 28 | #include <linux/debugfs.h> | ||
| 29 | #include <linux/types.h> | ||
| 30 | #include <linux/string.h> | ||
| 31 | #include <linux/ctype.h> | ||
| 32 | #include <linux/ptrace.h> | ||
| 33 | #include <linux/perf_event.h> | ||
| 34 | #include <linux/kprobes.h> | ||
| 35 | #include <linux/stringify.h> | ||
| 36 | #include <linux/limits.h> | ||
| 37 | #include <linux/uaccess.h> | ||
| 38 | #include <asm/bitsperlong.h> | ||
| 39 | |||
| 40 | #include "trace.h" | ||
| 41 | #include "trace_output.h" | ||
| 42 | |||
| 43 | #define MAX_TRACE_ARGS 128 | ||
| 44 | #define MAX_ARGSTR_LEN 63 | ||
| 45 | #define MAX_EVENT_NAME_LEN 64 | ||
| 46 | #define MAX_STRING_SIZE PATH_MAX | ||
| 47 | |||
| 48 | /* Reserved field names */ | ||
| 49 | #define FIELD_STRING_IP "__probe_ip" | ||
| 50 | #define FIELD_STRING_RETIP "__probe_ret_ip" | ||
| 51 | #define FIELD_STRING_FUNC "__probe_func" | ||
| 52 | |||
| 53 | #undef DEFINE_FIELD | ||
| 54 | #define DEFINE_FIELD(type, item, name, is_signed) \ | ||
| 55 | do { \ | ||
| 56 | ret = trace_define_field(event_call, #type, name, \ | ||
| 57 | offsetof(typeof(field), item), \ | ||
| 58 | sizeof(field.item), is_signed, \ | ||
| 59 | FILTER_OTHER); \ | ||
| 60 | if (ret) \ | ||
| 61 | return ret; \ | ||
| 62 | } while (0) | ||
| 63 | |||
| 64 | |||
| 65 | /* Flags for trace_probe */ | ||
| 66 | #define TP_FLAG_TRACE 1 | ||
| 67 | #define TP_FLAG_PROFILE 2 | ||
| 68 | #define TP_FLAG_REGISTERED 4 | ||
| 69 | |||
| 70 | |||
| 71 | /* data_rloc: data relative location, compatible with u32 */ | ||
| 72 | #define make_data_rloc(len, roffs) \ | ||
| 73 | (((u32)(len) << 16) | ((u32)(roffs) & 0xffff)) | ||
| 74 | #define get_rloc_len(dl) ((u32)(dl) >> 16) | ||
| 75 | #define get_rloc_offs(dl) ((u32)(dl) & 0xffff) | ||
| 76 | |||
| 77 | /* | ||
| 78 | * Convert data_rloc to data_loc: | ||
| 79 | * data_rloc stores the offset from data_rloc itself, but data_loc | ||
| 80 | * stores the offset from event entry. | ||
| 81 | */ | ||
| 82 | #define convert_rloc_to_loc(dl, offs) ((u32)(dl) + (offs)) | ||
| 83 | |||
| 84 | /* Data fetch function type */ | ||
| 85 | typedef void (*fetch_func_t)(struct pt_regs *, void *, void *); | ||
| 86 | /* Printing function type */ | ||
| 87 | typedef int (*print_type_func_t)(struct trace_seq *, const char *, void *, void *); | ||
| 88 | |||
| 89 | /* Fetch types */ | ||
| 90 | enum { | ||
| 91 | FETCH_MTD_reg = 0, | ||
| 92 | FETCH_MTD_stack, | ||
| 93 | FETCH_MTD_retval, | ||
| 94 | FETCH_MTD_memory, | ||
| 95 | FETCH_MTD_symbol, | ||
| 96 | FETCH_MTD_deref, | ||
| 97 | FETCH_MTD_bitfield, | ||
| 98 | FETCH_MTD_END, | ||
| 99 | }; | ||
| 100 | |||
| 101 | /* Fetch type information table */ | ||
| 102 | struct fetch_type { | ||
| 103 | const char *name; /* Name of type */ | ||
| 104 | size_t size; /* Byte size of type */ | ||
| 105 | int is_signed; /* Signed flag */ | ||
| 106 | print_type_func_t print; /* Print functions */ | ||
| 107 | const char *fmt; /* Fromat string */ | ||
| 108 | const char *fmttype; /* Name in format file */ | ||
| 109 | /* Fetch functions */ | ||
| 110 | fetch_func_t fetch[FETCH_MTD_END]; | ||
| 111 | }; | ||
| 112 | |||
| 113 | struct fetch_param { | ||
| 114 | fetch_func_t fn; | ||
| 115 | void *data; | ||
| 116 | }; | ||
| 117 | |||
| 118 | struct probe_arg { | ||
| 119 | struct fetch_param fetch; | ||
| 120 | struct fetch_param fetch_size; | ||
| 121 | unsigned int offset; /* Offset from argument entry */ | ||
| 122 | const char *name; /* Name of this argument */ | ||
| 123 | const char *comm; /* Command of this argument */ | ||
| 124 | const struct fetch_type *type; /* Type of this argument */ | ||
| 125 | }; | ||
| 126 | |||
| 127 | static inline __kprobes void call_fetch(struct fetch_param *fprm, | ||
| 128 | struct pt_regs *regs, void *dest) | ||
| 129 | { | ||
| 130 | return fprm->fn(regs, fprm->data, dest); | ||
| 131 | } | ||
| 132 | |||
| 133 | /* Check the name is good for event/group/fields */ | ||
| 134 | static inline int is_good_name(const char *name) | ||
| 135 | { | ||
| 136 | if (!isalpha(*name) && *name != '_') | ||
| 137 | return 0; | ||
| 138 | while (*++name != '\0') { | ||
| 139 | if (!isalpha(*name) && !isdigit(*name) && *name != '_') | ||
| 140 | return 0; | ||
| 141 | } | ||
| 142 | return 1; | ||
| 143 | } | ||
| 144 | |||
| 145 | extern int traceprobe_parse_probe_arg(char *arg, ssize_t *size, | ||
| 146 | struct probe_arg *parg, bool is_return); | ||
| 147 | |||
| 148 | extern int traceprobe_conflict_field_name(const char *name, | ||
| 149 | struct probe_arg *args, int narg); | ||
| 150 | |||
| 151 | extern void traceprobe_update_arg(struct probe_arg *arg); | ||
| 152 | extern void traceprobe_free_probe_arg(struct probe_arg *arg); | ||
| 153 | |||
| 154 | extern int traceprobe_split_symbol_offset(char *symbol, unsigned long *offset); | ||
| 155 | |||
| 156 | extern ssize_t traceprobe_probes_write(struct file *file, | ||
| 157 | const char __user *buffer, size_t count, loff_t *ppos, | ||
| 158 | int (*createfn)(int, char**)); | ||
| 159 | |||
| 160 | extern int traceprobe_command(const char *buf, int (*createfn)(int, char**)); | ||
