Thomas Gleixner | 09c434b | 2019-05-19 13:08:20 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-only |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 2 | /* |
| 3 | * NOTE: This example is works on x86 and powerpc. |
| 4 | * Here's a sample kernel module showing the use of kprobes to dump a |
Christian Brauner | 25239fd | 2020-08-19 12:46:52 +0200 | [diff] [blame^] | 5 | * stack trace and selected registers when kernel_clone() is called. |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 6 | * |
| 7 | * For more information on theory of operation of kprobes, see |
Mauro Carvalho Chehab | 8e2a46a | 2020-06-15 08:50:25 +0200 | [diff] [blame] | 8 | * Documentation/staging/kprobes.rst |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 9 | * |
| 10 | * You will see the trace data in /var/log/messages and on the console |
Christian Brauner | 25239fd | 2020-08-19 12:46:52 +0200 | [diff] [blame^] | 11 | * whenever kernel_clone() is invoked to create a new process. |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 12 | */ |
| 13 | |
| 14 | #include <linux/kernel.h> |
| 15 | #include <linux/module.h> |
| 16 | #include <linux/kprobes.h> |
| 17 | |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 18 | #define MAX_SYMBOL_LEN 64 |
Christian Brauner | 25239fd | 2020-08-19 12:46:52 +0200 | [diff] [blame^] | 19 | static char symbol[MAX_SYMBOL_LEN] = "kernel_clone"; |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 20 | module_param_string(symbol, symbol, sizeof(symbol), 0644); |
| 21 | |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 22 | /* For each probe you need to allocate a kprobe structure */ |
| 23 | static struct kprobe kp = { |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 24 | .symbol_name = symbol, |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 25 | }; |
| 26 | |
| 27 | /* kprobe pre_handler: called just before the probed instruction is executed */ |
Masami Hiramatsu | d85eaa9 | 2020-03-26 23:50:11 +0900 | [diff] [blame] | 28 | static int __kprobes handler_pre(struct kprobe *p, struct pt_regs *regs) |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 29 | { |
| 30 | #ifdef CONFIG_X86 |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 31 | pr_info("<%s> pre_handler: p->addr = 0x%p, ip = %lx, flags = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 32 | p->symbol_name, p->addr, regs->ip, regs->flags); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 33 | #endif |
| 34 | #ifdef CONFIG_PPC |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 35 | pr_info("<%s> pre_handler: p->addr = 0x%p, nip = 0x%lx, msr = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 36 | p->symbol_name, p->addr, regs->nip, regs->msr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 37 | #endif |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 38 | #ifdef CONFIG_MIPS |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 39 | pr_info("<%s> pre_handler: p->addr = 0x%p, epc = 0x%lx, status = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 40 | p->symbol_name, p->addr, regs->cp0_epc, regs->cp0_status); |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 41 | #endif |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 42 | #ifdef CONFIG_ARM64 |
| 43 | pr_info("<%s> pre_handler: p->addr = 0x%p, pc = 0x%lx," |
| 44 | " pstate = 0x%lx\n", |
| 45 | p->symbol_name, p->addr, (long)regs->pc, (long)regs->pstate); |
| 46 | #endif |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 47 | #ifdef CONFIG_S390 |
| 48 | pr_info("<%s> pre_handler: p->addr, 0x%p, ip = 0x%lx, flags = 0x%lx\n", |
| 49 | p->symbol_name, p->addr, regs->psw.addr, regs->flags); |
| 50 | #endif |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 51 | |
| 52 | /* A dump_stack() here will give a stack backtrace */ |
| 53 | return 0; |
| 54 | } |
| 55 | |
| 56 | /* kprobe post_handler: called after the probed instruction is executed */ |
Masami Hiramatsu | d85eaa9 | 2020-03-26 23:50:11 +0900 | [diff] [blame] | 57 | static void __kprobes handler_post(struct kprobe *p, struct pt_regs *regs, |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 58 | unsigned long flags) |
| 59 | { |
| 60 | #ifdef CONFIG_X86 |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 61 | pr_info("<%s> post_handler: p->addr = 0x%p, flags = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 62 | p->symbol_name, p->addr, regs->flags); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 63 | #endif |
| 64 | #ifdef CONFIG_PPC |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 65 | pr_info("<%s> post_handler: p->addr = 0x%p, msr = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 66 | p->symbol_name, p->addr, regs->msr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 67 | #endif |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 68 | #ifdef CONFIG_MIPS |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 69 | pr_info("<%s> post_handler: p->addr = 0x%p, status = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 70 | p->symbol_name, p->addr, regs->cp0_status); |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 71 | #endif |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 72 | #ifdef CONFIG_ARM64 |
| 73 | pr_info("<%s> post_handler: p->addr = 0x%p, pstate = 0x%lx\n", |
| 74 | p->symbol_name, p->addr, (long)regs->pstate); |
| 75 | #endif |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 76 | #ifdef CONFIG_S390 |
| 77 | pr_info("<%s> pre_handler: p->addr, 0x%p, flags = 0x%lx\n", |
| 78 | p->symbol_name, p->addr, regs->flags); |
| 79 | #endif |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 80 | } |
| 81 | |
| 82 | /* |
| 83 | * fault_handler: this is called if an exception is generated for any |
| 84 | * instruction within the pre- or post-handler, or when Kprobes |
| 85 | * single-steps the probed instruction. |
| 86 | */ |
| 87 | static int handler_fault(struct kprobe *p, struct pt_regs *regs, int trapnr) |
| 88 | { |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 89 | pr_info("fault_handler: p->addr = 0x%p, trap #%dn", p->addr, trapnr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 90 | /* Return 0 because we don't handle the fault. */ |
| 91 | return 0; |
| 92 | } |
Masami Hiramatsu | d85eaa9 | 2020-03-26 23:50:11 +0900 | [diff] [blame] | 93 | /* NOKPROBE_SYMBOL() is also available */ |
| 94 | NOKPROBE_SYMBOL(handler_fault); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 95 | |
| 96 | static int __init kprobe_init(void) |
| 97 | { |
| 98 | int ret; |
| 99 | kp.pre_handler = handler_pre; |
| 100 | kp.post_handler = handler_post; |
| 101 | kp.fault_handler = handler_fault; |
| 102 | |
| 103 | ret = register_kprobe(&kp); |
| 104 | if (ret < 0) { |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 105 | pr_err("register_kprobe failed, returned %d\n", ret); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 106 | return ret; |
| 107 | } |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 108 | pr_info("Planted kprobe at %p\n", kp.addr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 109 | return 0; |
| 110 | } |
| 111 | |
| 112 | static void __exit kprobe_exit(void) |
| 113 | { |
| 114 | unregister_kprobe(&kp); |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 115 | pr_info("kprobe at %p unregistered\n", kp.addr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 116 | } |
| 117 | |
| 118 | module_init(kprobe_init) |
| 119 | module_exit(kprobe_exit) |
| 120 | MODULE_LICENSE("GPL"); |