| 1 |
#include <linux/kernel.h> |
| 2 |
#include <linux/module.h> |
| 3 |
#include <linux/kprobes.h> |
| 4 |
|
| 5 |
struct kp_data { |
| 6 |
struct kprobe kp; |
| 7 |
atomic_t use_count; |
| 8 |
}; |
| 9 |
|
| 10 |
static int handler_pre(struct kprobe *p, struct pt_regs *regs); |
| 11 |
|
| 12 |
#include "kprobe_defs.h" |
| 13 |
|
| 14 |
|
| 15 |
/* kprobe pre_handler: called just before the probed instruction is executed */ |
| 16 |
static int handler_pre(struct kprobe *p, struct pt_regs *regs) |
| 17 |
{ |
| 18 |
struct kp_data *k = container_of(p, struct kp_data, kp); |
| 19 |
atomic_inc(&k->use_count); |
| 20 |
return 0; |
| 21 |
} |
| 22 |
|
| 23 |
static int __init kprobe_init(void) |
| 24 |
{ |
| 25 |
int ret; |
| 26 |
int probes_registered = 0; |
| 27 |
int i; |
| 28 |
|
| 29 |
for (i = 0; i < ARRAY_SIZE(kp_data); i++) { |
| 30 |
ret = register_kprobe(&kp_data[i].kp); |
| 31 |
if (ret != 0) |
| 32 |
atomic_set(&kp_data[i].use_count, -1); |
| 33 |
else |
| 34 |
probes_registered++; |
| 35 |
} |
| 36 |
if (probes_registered == 0) { |
| 37 |
for (i = 0; i < ARRAY_SIZE(kp_data); i++) { |
| 38 |
printk(KERN_INFO "-1 %s\n", kp_data[i].kp.symbol_name); |
| 39 |
} |
| 40 |
printk(KERN_INFO "kprobe_module unloaded\n"); |
| 41 |
return ret; |
| 42 |
} |
| 43 |
printk(KERN_INFO "Planted kprobes\n"); |
| 44 |
return 0; |
| 45 |
} |
| 46 |
|
| 47 |
static void __exit kprobe_exit(void) |
| 48 |
{ |
| 49 |
int i; |
| 50 |
|
| 51 |
for (i = 0; i < ARRAY_SIZE(kp_data); i++) { |
| 52 |
if (atomic_read(&kp_data[i].use_count) != -1) |
| 53 |
unregister_kprobe(&kp_data[i].kp); |
| 54 |
} |
| 55 |
printk(KERN_INFO "kprobes unregistered\n"); |
| 56 |
for (i = 0; i < ARRAY_SIZE(kp_data); i++) { |
| 57 |
printk(KERN_INFO "%d %s\n", atomic_read(&kp_data[i].use_count), |
| 58 |
kp_data[i].kp.symbol_name); |
| 59 |
} |
| 60 |
printk(KERN_INFO "kprobe_module unloaded\n"); |
| 61 |
} |
| 62 |
|
| 63 |
module_init(kprobe_init) |
| 64 |
module_exit(kprobe_exit) |
| 65 |
MODULE_LICENSE("GPL"); |