xref: /linux/samples/kprobes/kprobe_example.c (revision e16c5dd5157efeddaad7492b920192fea0e7e4ec)
1804defeaSAnanth N Mavinakayanahalli /*
2804defeaSAnanth N Mavinakayanahalli  * NOTE: This example is works on x86 and powerpc.
3804defeaSAnanth N Mavinakayanahalli  * Here's a sample kernel module showing the use of kprobes to dump a
454aea454SPetr Mladek  * stack trace and selected registers when _do_fork() is called.
5804defeaSAnanth N Mavinakayanahalli  *
6804defeaSAnanth N Mavinakayanahalli  * For more information on theory of operation of kprobes, see
7804defeaSAnanth N Mavinakayanahalli  * Documentation/kprobes.txt
8804defeaSAnanth N Mavinakayanahalli  *
9804defeaSAnanth N Mavinakayanahalli  * You will see the trace data in /var/log/messages and on the console
1054aea454SPetr Mladek  * whenever _do_fork() is invoked to create a new process.
11804defeaSAnanth N Mavinakayanahalli  */
12804defeaSAnanth N Mavinakayanahalli 
13804defeaSAnanth N Mavinakayanahalli #include <linux/kernel.h>
14804defeaSAnanth N Mavinakayanahalli #include <linux/module.h>
15804defeaSAnanth N Mavinakayanahalli #include <linux/kprobes.h>
16804defeaSAnanth N Mavinakayanahalli 
17d04659acSHuang Shijie #define MAX_SYMBOL_LEN	64
18d04659acSHuang Shijie static char symbol[MAX_SYMBOL_LEN] = "_do_fork";
19d04659acSHuang Shijie module_param_string(symbol, symbol, sizeof(symbol), 0644);
20d04659acSHuang Shijie 
21804defeaSAnanth N Mavinakayanahalli /* For each probe you need to allocate a kprobe structure */
22804defeaSAnanth N Mavinakayanahalli static struct kprobe kp = {
23d04659acSHuang Shijie 	.symbol_name	= symbol,
24804defeaSAnanth N Mavinakayanahalli };
25804defeaSAnanth N Mavinakayanahalli 
26804defeaSAnanth N Mavinakayanahalli /* kprobe pre_handler: called just before the probed instruction is executed */
27804defeaSAnanth N Mavinakayanahalli static int handler_pre(struct kprobe *p, struct pt_regs *regs)
28804defeaSAnanth N Mavinakayanahalli {
29804defeaSAnanth N Mavinakayanahalli #ifdef CONFIG_X86
30e708c148SHuang Shijie 	pr_info("<%s> pre_handler: p->addr = 0x%p, ip = %lx, flags = 0x%lx\n",
31ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->ip, regs->flags);
32804defeaSAnanth N Mavinakayanahalli #endif
33804defeaSAnanth N Mavinakayanahalli #ifdef CONFIG_PPC
34e708c148SHuang Shijie 	pr_info("<%s> pre_handler: p->addr = 0x%p, nip = 0x%lx, msr = 0x%lx\n",
35ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->nip, regs->msr);
36804defeaSAnanth N Mavinakayanahalli #endif
378a149237SDavid Daney #ifdef CONFIG_MIPS
38e708c148SHuang Shijie 	pr_info("<%s> pre_handler: p->addr = 0x%p, epc = 0x%lx, status = 0x%lx\n",
39ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->cp0_epc, regs->cp0_status);
408a149237SDavid Daney #endif
413fa17c39STony Lu #ifdef CONFIG_TILEGX
42e708c148SHuang Shijie 	pr_info("<%s> pre_handler: p->addr = 0x%p, pc = 0x%lx, ex1 = 0x%lx\n",
43ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->pc, regs->ex1);
443fa17c39STony Lu #endif
45af78cedeSSandeepa Prabhu #ifdef CONFIG_ARM64
46af78cedeSSandeepa Prabhu 	pr_info("<%s> pre_handler: p->addr = 0x%p, pc = 0x%lx,"
47af78cedeSSandeepa Prabhu 			" pstate = 0x%lx\n",
48af78cedeSSandeepa Prabhu 		p->symbol_name, p->addr, (long)regs->pc, (long)regs->pstate);
49af78cedeSSandeepa Prabhu #endif
50*e16c5dd5SJohannes Thumshirn #ifdef CONFIG_S390
51*e16c5dd5SJohannes Thumshirn 	pr_info("<%s> pre_handler: p->addr, 0x%p, ip = 0x%lx, flags = 0x%lx\n",
52*e16c5dd5SJohannes Thumshirn 		p->symbol_name, p->addr, regs->psw.addr, regs->flags);
53*e16c5dd5SJohannes Thumshirn #endif
54804defeaSAnanth N Mavinakayanahalli 
55804defeaSAnanth N Mavinakayanahalli 	/* A dump_stack() here will give a stack backtrace */
56804defeaSAnanth N Mavinakayanahalli 	return 0;
57804defeaSAnanth N Mavinakayanahalli }
58804defeaSAnanth N Mavinakayanahalli 
59804defeaSAnanth N Mavinakayanahalli /* kprobe post_handler: called after the probed instruction is executed */
60804defeaSAnanth N Mavinakayanahalli static void handler_post(struct kprobe *p, struct pt_regs *regs,
61804defeaSAnanth N Mavinakayanahalli 				unsigned long flags)
62804defeaSAnanth N Mavinakayanahalli {
63804defeaSAnanth N Mavinakayanahalli #ifdef CONFIG_X86
64e708c148SHuang Shijie 	pr_info("<%s> post_handler: p->addr = 0x%p, flags = 0x%lx\n",
65ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->flags);
66804defeaSAnanth N Mavinakayanahalli #endif
67804defeaSAnanth N Mavinakayanahalli #ifdef CONFIG_PPC
68e708c148SHuang Shijie 	pr_info("<%s> post_handler: p->addr = 0x%p, msr = 0x%lx\n",
69ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->msr);
70804defeaSAnanth N Mavinakayanahalli #endif
718a149237SDavid Daney #ifdef CONFIG_MIPS
72e708c148SHuang Shijie 	pr_info("<%s> post_handler: p->addr = 0x%p, status = 0x%lx\n",
73ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->cp0_status);
748a149237SDavid Daney #endif
753fa17c39STony Lu #ifdef CONFIG_TILEGX
76e708c148SHuang Shijie 	pr_info("<%s> post_handler: p->addr = 0x%p, ex1 = 0x%lx\n",
77ea9b5013SHuang Shijie 		p->symbol_name, p->addr, regs->ex1);
783fa17c39STony Lu #endif
79af78cedeSSandeepa Prabhu #ifdef CONFIG_ARM64
80af78cedeSSandeepa Prabhu 	pr_info("<%s> post_handler: p->addr = 0x%p, pstate = 0x%lx\n",
81af78cedeSSandeepa Prabhu 		p->symbol_name, p->addr, (long)regs->pstate);
82af78cedeSSandeepa Prabhu #endif
83*e16c5dd5SJohannes Thumshirn #ifdef CONFIG_S390
84*e16c5dd5SJohannes Thumshirn 	pr_info("<%s> pre_handler: p->addr, 0x%p, flags = 0x%lx\n",
85*e16c5dd5SJohannes Thumshirn 		p->symbol_name, p->addr, regs->flags);
86*e16c5dd5SJohannes Thumshirn #endif
87804defeaSAnanth N Mavinakayanahalli }
88804defeaSAnanth N Mavinakayanahalli 
89804defeaSAnanth N Mavinakayanahalli /*
90804defeaSAnanth N Mavinakayanahalli  * fault_handler: this is called if an exception is generated for any
91804defeaSAnanth N Mavinakayanahalli  * instruction within the pre- or post-handler, or when Kprobes
92804defeaSAnanth N Mavinakayanahalli  * single-steps the probed instruction.
93804defeaSAnanth N Mavinakayanahalli  */
94804defeaSAnanth N Mavinakayanahalli static int handler_fault(struct kprobe *p, struct pt_regs *regs, int trapnr)
95804defeaSAnanth N Mavinakayanahalli {
96e708c148SHuang Shijie 	pr_info("fault_handler: p->addr = 0x%p, trap #%dn", p->addr, trapnr);
97804defeaSAnanth N Mavinakayanahalli 	/* Return 0 because we don't handle the fault. */
98804defeaSAnanth N Mavinakayanahalli 	return 0;
99804defeaSAnanth N Mavinakayanahalli }
100804defeaSAnanth N Mavinakayanahalli 
101804defeaSAnanth N Mavinakayanahalli static int __init kprobe_init(void)
102804defeaSAnanth N Mavinakayanahalli {
103804defeaSAnanth N Mavinakayanahalli 	int ret;
104804defeaSAnanth N Mavinakayanahalli 	kp.pre_handler = handler_pre;
105804defeaSAnanth N Mavinakayanahalli 	kp.post_handler = handler_post;
106804defeaSAnanth N Mavinakayanahalli 	kp.fault_handler = handler_fault;
107804defeaSAnanth N Mavinakayanahalli 
108804defeaSAnanth N Mavinakayanahalli 	ret = register_kprobe(&kp);
109804defeaSAnanth N Mavinakayanahalli 	if (ret < 0) {
110e708c148SHuang Shijie 		pr_err("register_kprobe failed, returned %d\n", ret);
111804defeaSAnanth N Mavinakayanahalli 		return ret;
112804defeaSAnanth N Mavinakayanahalli 	}
113e708c148SHuang Shijie 	pr_info("Planted kprobe at %p\n", kp.addr);
114804defeaSAnanth N Mavinakayanahalli 	return 0;
115804defeaSAnanth N Mavinakayanahalli }
116804defeaSAnanth N Mavinakayanahalli 
117804defeaSAnanth N Mavinakayanahalli static void __exit kprobe_exit(void)
118804defeaSAnanth N Mavinakayanahalli {
119804defeaSAnanth N Mavinakayanahalli 	unregister_kprobe(&kp);
120e708c148SHuang Shijie 	pr_info("kprobe at %p unregistered\n", kp.addr);
121804defeaSAnanth N Mavinakayanahalli }
122804defeaSAnanth N Mavinakayanahalli 
123804defeaSAnanth N Mavinakayanahalli module_init(kprobe_init)
124804defeaSAnanth N Mavinakayanahalli module_exit(kprobe_exit)
125804defeaSAnanth N Mavinakayanahalli MODULE_LICENSE("GPL");
126