1 // SPDX-License-Identifier: GPL-2.0-only
3 * arch/arm/kernel/kprobes.c
7 * Abhishek Sagar <sagar.abhishek@gmail.com>
8 * Copyright (C) 2006, 2007 Motorola Inc.
10 * Nicolas Pitre <nico@marvell.com>
11 * Copyright (C) 2007 Marvell Ltd.
14 #define pr_fmt(fmt) "kprobes: " fmt
16 #include <linux/kernel.h>
17 #include <linux/kprobes.h>
18 #include <linux/module.h>
19 #include <linux/slab.h>
20 #include <linux/stop_machine.h>
21 #include <linux/sched/debug.h>
22 #include <linux/stringify.h>
23 #include <asm/traps.h>
24 #include <asm/opcodes.h>
25 #include <asm/cacheflush.h>
26 #include <linux/percpu.h>
27 #include <linux/bug.h>
28 #include <asm/patch.h>
29 #include <asm/sections.h>
31 #include "../decode-arm.h"
32 #include "../decode-thumb.h"
35 #define MIN_STACK_SIZE(addr) \
36 min((unsigned long)MAX_STACK_SIZE, \
37 (unsigned long)current_thread_info() + THREAD_START_SP - (addr))
39 #define flush_insns(addr, size) \
40 flush_icache_range((unsigned long)(addr), \
41 (unsigned long)(addr) + \
44 DEFINE_PER_CPU(struct kprobe *, current_kprobe) = NULL;
45 DEFINE_PER_CPU(struct kprobe_ctlblk, kprobe_ctlblk);
48 int __kprobes arch_prepare_kprobe(struct kprobe *p)
51 kprobe_opcode_t tmp_insn[MAX_INSN_SIZE];
52 unsigned long addr = (unsigned long)p->addr;
54 kprobe_decode_insn_t *decode_insn;
55 const union decode_action *actions;
57 const struct decode_checker **checkers;
59 #ifdef CONFIG_THUMB2_KERNEL
61 addr &= ~1; /* Bit 0 would normally be set to indicate Thumb code */
62 insn = __mem_to_opcode_thumb16(((u16 *)addr)[0]);
63 if (is_wide_instruction(insn)) {
64 u16 inst2 = __mem_to_opcode_thumb16(((u16 *)addr)[1]);
65 insn = __opcode_thumb32_compose(insn, inst2);
66 decode_insn = thumb32_probes_decode_insn;
67 actions = kprobes_t32_actions;
68 checkers = kprobes_t32_checkers;
70 decode_insn = thumb16_probes_decode_insn;
71 actions = kprobes_t16_actions;
72 checkers = kprobes_t16_checkers;
74 #else /* !CONFIG_THUMB2_KERNEL */
78 insn = __mem_to_opcode_arm(*p->addr);
79 decode_insn = arm_probes_decode_insn;
80 actions = kprobes_arm_actions;
81 checkers = kprobes_arm_checkers;
85 p->ainsn.insn = tmp_insn;
87 switch ((*decode_insn)(insn, &p->ainsn, true, actions, checkers)) {
88 case INSN_REJECTED: /* not supported */
91 case INSN_GOOD: /* instruction uses slot */
92 p->ainsn.insn = get_insn_slot();
95 for (is = 0; is < MAX_INSN_SIZE; ++is)
96 p->ainsn.insn[is] = tmp_insn[is];
97 flush_insns(p->ainsn.insn,
98 sizeof(p->ainsn.insn[0]) * MAX_INSN_SIZE);
99 p->ainsn.insn_fn = (probes_insn_fn_t *)
100 ((uintptr_t)p->ainsn.insn | thumb);
103 case INSN_GOOD_NO_SLOT: /* instruction doesn't need insn slot */
104 p->ainsn.insn = NULL;
109 * Never instrument insn like 'str r0, [sp, +/-r1]'. Also, insn likes
110 * 'str r0, [sp, #-68]' should also be prohibited.
113 if ((p->ainsn.stack_space < 0) ||
114 (p->ainsn.stack_space > MAX_STACK_SIZE))
120 void __kprobes arch_arm_kprobe(struct kprobe *p)
125 if (IS_ENABLED(CONFIG_THUMB2_KERNEL)) {
126 /* Remove any Thumb flag */
127 addr = (void *)((uintptr_t)p->addr & ~1);
129 if (is_wide_instruction(p->opcode))
130 brkp = KPROBE_THUMB32_BREAKPOINT_INSTRUCTION;
132 brkp = KPROBE_THUMB16_BREAKPOINT_INSTRUCTION;
134 kprobe_opcode_t insn = p->opcode;
137 brkp = KPROBE_ARM_BREAKPOINT_INSTRUCTION;
139 if (insn >= 0xe0000000)
140 brkp |= 0xe0000000; /* Unconditional instruction */
142 brkp |= insn & 0xf0000000; /* Copy condition from insn */
145 patch_text(addr, brkp);
149 * The actual disarming is done here on each CPU and synchronized using
150 * stop_machine. This synchronization is necessary on SMP to avoid removing
151 * a probe between the moment the 'Undefined Instruction' exception is raised
152 * and the moment the exception handler reads the faulting instruction from
153 * memory. It is also needed to atomically set the two half-words of a 32-bit
161 static int __kprobes_remove_breakpoint(void *data)
163 struct patch *p = data;
164 __patch_text(p->addr, p->insn);
168 void __kprobes kprobes_remove_breakpoint(void *addr, unsigned int insn)
174 stop_machine_cpuslocked(__kprobes_remove_breakpoint, &p,
178 void __kprobes arch_disarm_kprobe(struct kprobe *p)
180 kprobes_remove_breakpoint((void *)((uintptr_t)p->addr & ~1),
184 void __kprobes arch_remove_kprobe(struct kprobe *p)
187 free_insn_slot(p->ainsn.insn, 0);
188 p->ainsn.insn = NULL;
192 static void __kprobes save_previous_kprobe(struct kprobe_ctlblk *kcb)
194 kcb->prev_kprobe.kp = kprobe_running();
195 kcb->prev_kprobe.status = kcb->kprobe_status;
198 static void __kprobes restore_previous_kprobe(struct kprobe_ctlblk *kcb)
200 __this_cpu_write(current_kprobe, kcb->prev_kprobe.kp);
201 kcb->kprobe_status = kcb->prev_kprobe.status;
204 static void __kprobes set_current_kprobe(struct kprobe *p)
206 __this_cpu_write(current_kprobe, p);
209 static void __kprobes
210 singlestep_skip(struct kprobe *p, struct pt_regs *regs)
212 #ifdef CONFIG_THUMB2_KERNEL
213 regs->ARM_cpsr = it_advance(regs->ARM_cpsr);
214 if (is_wide_instruction(p->opcode))
223 static inline void __kprobes
224 singlestep(struct kprobe *p, struct pt_regs *regs, struct kprobe_ctlblk *kcb)
226 p->ainsn.insn_singlestep(p->opcode, &p->ainsn, regs);
230 * Called with IRQs disabled. IRQs must remain disabled from that point
231 * all the way until processing this kprobe is complete. The current
232 * kprobes implementation cannot process more than one nested level of
233 * kprobe, and that level is reserved for user kprobe handlers, so we can't
234 * risk encountering a new kprobe in an interrupt handler.
236 void __kprobes kprobe_handler(struct pt_regs *regs)
238 struct kprobe *p, *cur;
239 struct kprobe_ctlblk *kcb;
241 kcb = get_kprobe_ctlblk();
242 cur = kprobe_running();
244 #ifdef CONFIG_THUMB2_KERNEL
246 * First look for a probe which was registered using an address with
247 * bit 0 set, this is the usual situation for pointers to Thumb code.
248 * If not found, fallback to looking for one with bit 0 clear.
250 p = get_kprobe((kprobe_opcode_t *)(regs->ARM_pc | 1));
252 p = get_kprobe((kprobe_opcode_t *)regs->ARM_pc);
254 #else /* ! CONFIG_THUMB2_KERNEL */
255 p = get_kprobe((kprobe_opcode_t *)regs->ARM_pc);
259 if (!p->ainsn.insn_check_cc(regs->ARM_cpsr)) {
261 * Probe hit but conditional execution check failed,
262 * so just skip the instruction and continue as if
263 * nothing had happened.
264 * In this case, we can skip recursing check too.
266 singlestep_skip(p, regs);
268 /* Kprobe is pending, so we're recursing. */
269 switch (kcb->kprobe_status) {
270 case KPROBE_HIT_ACTIVE:
271 case KPROBE_HIT_SSDONE:
273 /* A pre- or post-handler probe got us here. */
274 kprobes_inc_nmissed_count(p);
275 save_previous_kprobe(kcb);
276 set_current_kprobe(p);
277 kcb->kprobe_status = KPROBE_REENTER;
278 singlestep(p, regs, kcb);
279 restore_previous_kprobe(kcb);
282 /* A nested probe was hit in FIQ, it is a BUG */
283 pr_warn("Failed to recover from reentered kprobes.\n");
287 /* impossible cases */
291 /* Probe hit and conditional execution check ok. */
292 set_current_kprobe(p);
293 kcb->kprobe_status = KPROBE_HIT_ACTIVE;
296 * If we have no pre-handler or it returned 0, we
297 * continue with normal processing. If we have a
298 * pre-handler and it returned non-zero, it will
299 * modify the execution path and no need to single
300 * stepping. Let's just reset current kprobe and exit.
302 if (!p->pre_handler || !p->pre_handler(p, regs)) {
303 kcb->kprobe_status = KPROBE_HIT_SS;
304 singlestep(p, regs, kcb);
305 if (p->post_handler) {
306 kcb->kprobe_status = KPROBE_HIT_SSDONE;
307 p->post_handler(p, regs, 0);
310 reset_current_kprobe();
314 * The probe was removed and a race is in progress.
315 * There is nothing we can do about it. Let's restart
316 * the instruction. By the time we can restart, the
317 * real instruction will be there.
322 static int __kprobes kprobe_trap_handler(struct pt_regs *regs, unsigned int instr)
325 local_irq_save(flags);
326 kprobe_handler(regs);
327 local_irq_restore(flags);
331 int __kprobes kprobe_fault_handler(struct pt_regs *regs, unsigned int fsr)
333 struct kprobe *cur = kprobe_running();
334 struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
336 switch (kcb->kprobe_status) {
340 * We are here because the instruction being single
341 * stepped caused a page fault. We reset the current
342 * kprobe and the PC to point back to the probe address
343 * and allow the page fault handler to continue as a
346 regs->ARM_pc = (long)cur->addr;
347 if (kcb->kprobe_status == KPROBE_REENTER) {
348 restore_previous_kprobe(kcb);
350 reset_current_kprobe();
358 int __kprobes kprobe_exceptions_notify(struct notifier_block *self,
359 unsigned long val, void *data)
362 * notify_die() is currently never called on ARM,
363 * so this callback is currently empty.
369 * When a retprobed function returns, trampoline_handler() is called,
370 * calling the kretprobe's handler. We construct a struct pt_regs to
371 * give a view of registers r0-r11, sp, lr, and pc to the user
372 * return-handler. This is not a complete pt_regs structure, but that
373 * should be enough for stacktrace from the return handler with or
376 void __naked __kprobes __kretprobe_trampoline(void)
378 __asm__ __volatile__ (
379 #ifdef CONFIG_FRAME_POINTER
380 "ldr lr, =__kretprobe_trampoline \n\t"
381 /* __kretprobe_trampoline makes a framepointer on pt_regs. */
382 #ifdef CONFIG_CC_IS_CLANG
383 "stmdb sp, {sp, lr, pc} \n\t"
384 "sub sp, sp, #12 \n\t"
385 /* In clang case, pt_regs->ip = lr. */
386 "stmdb sp!, {r0 - r11, lr} \n\t"
387 /* fp points regs->r11 (fp) */
388 "add fp, sp, #44 \n\t"
389 #else /* !CONFIG_CC_IS_CLANG */
390 /* In gcc case, pt_regs->ip = fp. */
391 "stmdb sp, {fp, sp, lr, pc} \n\t"
392 "sub sp, sp, #16 \n\t"
393 "stmdb sp!, {r0 - r11} \n\t"
394 /* fp points regs->r15 (pc) */
395 "add fp, sp, #60 \n\t"
396 #endif /* CONFIG_CC_IS_CLANG */
397 #else /* !CONFIG_FRAME_POINTER */
398 "sub sp, sp, #16 \n\t"
399 "stmdb sp!, {r0 - r11} \n\t"
400 #endif /* CONFIG_FRAME_POINTER */
402 "bl trampoline_handler \n\t"
404 "ldmia sp!, {r0 - r11} \n\t"
405 "add sp, sp, #16 \n\t"
406 #ifdef CONFIG_THUMB2_KERNEL
414 /* Called from __kretprobe_trampoline */
415 static __used __kprobes void *trampoline_handler(struct pt_regs *regs)
417 return (void *)kretprobe_trampoline_handler(regs, (void *)regs->ARM_fp);
420 void __kprobes arch_prepare_kretprobe(struct kretprobe_instance *ri,
421 struct pt_regs *regs)
423 ri->ret_addr = (kprobe_opcode_t *)regs->ARM_lr;
424 ri->fp = (void *)regs->ARM_fp;
426 /* Replace the return addr with trampoline addr. */
427 regs->ARM_lr = (unsigned long)&__kretprobe_trampoline;
430 int __kprobes arch_trampoline_kprobe(struct kprobe *p)
435 #ifdef CONFIG_THUMB2_KERNEL
437 static struct undef_hook kprobes_thumb16_break_hook = {
438 .instr_mask = 0xffff,
439 .instr_val = KPROBE_THUMB16_BREAKPOINT_INSTRUCTION,
440 .cpsr_mask = MODE_MASK,
441 .cpsr_val = SVC_MODE,
442 .fn = kprobe_trap_handler,
445 static struct undef_hook kprobes_thumb32_break_hook = {
446 .instr_mask = 0xffffffff,
447 .instr_val = KPROBE_THUMB32_BREAKPOINT_INSTRUCTION,
448 .cpsr_mask = MODE_MASK,
449 .cpsr_val = SVC_MODE,
450 .fn = kprobe_trap_handler,
453 #else /* !CONFIG_THUMB2_KERNEL */
455 static struct undef_hook kprobes_arm_break_hook = {
456 .instr_mask = 0x0fffffff,
457 .instr_val = KPROBE_ARM_BREAKPOINT_INSTRUCTION,
458 .cpsr_mask = MODE_MASK,
459 .cpsr_val = SVC_MODE,
460 .fn = kprobe_trap_handler,
463 #endif /* !CONFIG_THUMB2_KERNEL */
465 int __init arch_init_kprobes(void)
467 arm_probes_decode_init();
468 #ifdef CONFIG_THUMB2_KERNEL
469 register_undef_hook(&kprobes_thumb16_break_hook);
470 register_undef_hook(&kprobes_thumb32_break_hook);
472 register_undef_hook(&kprobes_arm_break_hook);
477 bool arch_within_kprobe_blacklist(unsigned long addr)
479 void *a = (void *)addr;
481 return __in_irqentry_text(addr) ||
482 in_entry_text(addr) ||
483 in_idmap_text(addr) ||
484 memory_contains(__kprobes_text_start, __kprobes_text_end, a, 1);