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 | /* |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 3 | * 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] | 4 | * stack trace and selected registers when kernel_clone() is called. |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 5 | * |
| 6 | * For more information on theory of operation of kprobes, see |
Mauro Carvalho Chehab | 7f9a235 | 2020-09-09 16:10:37 +0200 | [diff] [blame] | 7 | * Documentation/trace/kprobes.rst |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 8 | * |
| 9 | * 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] | 10 | * whenever kernel_clone() is invoked to create a new process. |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 11 | */ |
| 12 | |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 13 | #define pr_fmt(fmt) "%s: " fmt, __func__ |
| 14 | |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 15 | #include <linux/kernel.h> |
| 16 | #include <linux/module.h> |
| 17 | #include <linux/kprobes.h> |
| 18 | |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 19 | #define MAX_SYMBOL_LEN 64 |
Christian Brauner | 25239fd | 2020-08-19 12:46:52 +0200 | [diff] [blame] | 20 | static char symbol[MAX_SYMBOL_LEN] = "kernel_clone"; |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 21 | module_param_string(symbol, symbol, sizeof(symbol), 0644); |
| 22 | |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 23 | /* For each probe you need to allocate a kprobe structure */ |
| 24 | static struct kprobe kp = { |
Huang Shijie | d04659a | 2016-05-20 17:04:33 -0700 | [diff] [blame] | 25 | .symbol_name = symbol, |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 26 | }; |
| 27 | |
| 28 | /* kprobe pre_handler: called just before the probed instruction is executed */ |
Masami Hiramatsu | d85eaa9 | 2020-03-26 23:50:11 +0900 | [diff] [blame] | 29 | 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] | 30 | { |
| 31 | #ifdef CONFIG_X86 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 32 | pr_info("<%s> p->addr = 0x%p, ip = %lx, flags = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 33 | p->symbol_name, p->addr, regs->ip, regs->flags); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 34 | #endif |
| 35 | #ifdef CONFIG_PPC |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 36 | pr_info("<%s> p->addr = 0x%p, nip = 0x%lx, msr = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 37 | p->symbol_name, p->addr, regs->nip, regs->msr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 38 | #endif |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 39 | #ifdef CONFIG_MIPS |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 40 | pr_info("<%s> p->addr = 0x%p, epc = 0x%lx, status = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 41 | p->symbol_name, p->addr, regs->cp0_epc, regs->cp0_status); |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 42 | #endif |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 43 | #ifdef CONFIG_ARM64 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 44 | pr_info("<%s> p->addr = 0x%p, pc = 0x%lx, pstate = 0x%lx\n", |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 45 | p->symbol_name, p->addr, (long)regs->pc, (long)regs->pstate); |
| 46 | #endif |
Marc Koderer | 6970613 | 2021-01-12 16:40:54 +0100 | [diff] [blame] | 47 | #ifdef CONFIG_ARM |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 48 | pr_info("<%s> p->addr = 0x%p, pc = 0x%lx, cpsr = 0x%lx\n", |
Marc Koderer | 6970613 | 2021-01-12 16:40:54 +0100 | [diff] [blame] | 49 | p->symbol_name, p->addr, (long)regs->ARM_pc, (long)regs->ARM_cpsr); |
| 50 | #endif |
Jisheng Zhang | 8a07ac3 | 2021-03-30 02:04:16 +0800 | [diff] [blame] | 51 | #ifdef CONFIG_RISCV |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 52 | pr_info("<%s> p->addr = 0x%p, pc = 0x%lx, status = 0x%lx\n", |
Jisheng Zhang | 8a07ac3 | 2021-03-30 02:04:16 +0800 | [diff] [blame] | 53 | p->symbol_name, p->addr, regs->epc, regs->status); |
| 54 | #endif |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 55 | #ifdef CONFIG_S390 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 56 | pr_info("<%s> p->addr, 0x%p, ip = 0x%lx, flags = 0x%lx\n", |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 57 | p->symbol_name, p->addr, regs->psw.addr, regs->flags); |
| 58 | #endif |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 59 | |
| 60 | /* A dump_stack() here will give a stack backtrace */ |
| 61 | return 0; |
| 62 | } |
| 63 | |
| 64 | /* kprobe post_handler: called after the probed instruction is executed */ |
Masami Hiramatsu | d85eaa9 | 2020-03-26 23:50:11 +0900 | [diff] [blame] | 65 | 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] | 66 | unsigned long flags) |
| 67 | { |
| 68 | #ifdef CONFIG_X86 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 69 | pr_info("<%s> p->addr = 0x%p, flags = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 70 | p->symbol_name, p->addr, regs->flags); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 71 | #endif |
| 72 | #ifdef CONFIG_PPC |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 73 | pr_info("<%s> p->addr = 0x%p, msr = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 74 | p->symbol_name, p->addr, regs->msr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 75 | #endif |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 76 | #ifdef CONFIG_MIPS |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 77 | pr_info("<%s> p->addr = 0x%p, status = 0x%lx\n", |
Huang Shijie | ea9b501 | 2016-05-20 17:04:36 -0700 | [diff] [blame] | 78 | p->symbol_name, p->addr, regs->cp0_status); |
David Daney | 8a14923 | 2010-08-03 11:22:21 -0700 | [diff] [blame] | 79 | #endif |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 80 | #ifdef CONFIG_ARM64 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 81 | pr_info("<%s> p->addr = 0x%p, pstate = 0x%lx\n", |
Sandeepa Prabhu | af78ced | 2016-07-08 12:35:54 -0400 | [diff] [blame] | 82 | p->symbol_name, p->addr, (long)regs->pstate); |
| 83 | #endif |
Marc Koderer | 6970613 | 2021-01-12 16:40:54 +0100 | [diff] [blame] | 84 | #ifdef CONFIG_ARM |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 85 | pr_info("<%s> p->addr = 0x%p, cpsr = 0x%lx\n", |
Marc Koderer | 6970613 | 2021-01-12 16:40:54 +0100 | [diff] [blame] | 86 | p->symbol_name, p->addr, (long)regs->ARM_cpsr); |
| 87 | #endif |
Jisheng Zhang | 8a07ac3 | 2021-03-30 02:04:16 +0800 | [diff] [blame] | 88 | #ifdef CONFIG_RISCV |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 89 | pr_info("<%s> p->addr = 0x%p, status = 0x%lx\n", |
Jisheng Zhang | 8a07ac3 | 2021-03-30 02:04:16 +0800 | [diff] [blame] | 90 | p->symbol_name, p->addr, regs->status); |
| 91 | #endif |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 92 | #ifdef CONFIG_S390 |
Tiezhu Yang | db1ea66 | 2021-05-17 10:21:23 +0800 | [diff] [blame] | 93 | pr_info("<%s> p->addr, 0x%p, flags = 0x%lx\n", |
Johannes Thumshirn | e16c5dd | 2017-09-14 14:11:15 +0200 | [diff] [blame] | 94 | p->symbol_name, p->addr, regs->flags); |
| 95 | #endif |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 96 | } |
| 97 | |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 98 | static int __init kprobe_init(void) |
| 99 | { |
| 100 | int ret; |
| 101 | kp.pre_handler = handler_pre; |
| 102 | kp.post_handler = handler_post; |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 103 | |
| 104 | ret = register_kprobe(&kp); |
| 105 | if (ret < 0) { |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 106 | pr_err("register_kprobe failed, returned %d\n", ret); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 107 | return ret; |
| 108 | } |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 109 | pr_info("Planted kprobe at %p\n", kp.addr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 110 | return 0; |
| 111 | } |
| 112 | |
| 113 | static void __exit kprobe_exit(void) |
| 114 | { |
| 115 | unregister_kprobe(&kp); |
Huang Shijie | e708c14 | 2016-08-03 13:46:03 -0700 | [diff] [blame] | 116 | pr_info("kprobe at %p unregistered\n", kp.addr); |
Ananth N Mavinakayanahalli | 804defe | 2008-03-04 14:28:38 -0800 | [diff] [blame] | 117 | } |
| 118 | |
| 119 | module_init(kprobe_init) |
| 120 | module_exit(kprobe_exit) |
| 121 | MODULE_LICENSE("GPL"); |