472 lines
13 KiB
C
472 lines
13 KiB
C
/*
|
|
* Kernel Probes Jump Optimization (Optprobes)
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*
|
|
* Copyright (C) IBM Corporation, 2002, 2004
|
|
* Copyright (C) Hitachi Ltd., 2012
|
|
*/
|
|
#include <linux/kprobes.h>
|
|
#include <linux/ptrace.h>
|
|
#include <linux/string.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/hardirq.h>
|
|
#include <linux/preempt.h>
|
|
#include <linux/extable.h>
|
|
#include <linux/kdebug.h>
|
|
#include <linux/kallsyms.h>
|
|
#include <linux/ftrace.h>
|
|
#include <linux/frame.h>
|
|
|
|
#include <asm/text-patching.h>
|
|
#include <asm/cacheflush.h>
|
|
#include <asm/desc.h>
|
|
#include <asm/pgtable.h>
|
|
#include <linux/uaccess.h>
|
|
#include <asm/alternative.h>
|
|
#include <asm/insn.h>
|
|
#include <asm/debugreg.h>
|
|
#include <asm/set_memory.h>
|
|
#include <asm/sections.h>
|
|
|
|
#include "common.h"
|
|
|
|
unsigned long __recover_optprobed_insn(kprobe_opcode_t *buf, unsigned long addr)
|
|
{
|
|
struct optimized_kprobe *op;
|
|
struct kprobe *kp;
|
|
long offs;
|
|
int i;
|
|
|
|
for (i = 0; i < RELATIVEJUMP_SIZE; i++) {
|
|
kp = get_kprobe((void *)addr - i);
|
|
/* This function only handles jump-optimized kprobe */
|
|
if (kp && kprobe_optimized(kp)) {
|
|
op = container_of(kp, struct optimized_kprobe, kp);
|
|
/* If op->list is not empty, op is under optimizing */
|
|
if (list_empty(&op->list))
|
|
goto found;
|
|
}
|
|
}
|
|
|
|
return addr;
|
|
found:
|
|
/*
|
|
* If the kprobe can be optimized, original bytes which can be
|
|
* overwritten by jump destination address. In this case, original
|
|
* bytes must be recovered from op->optinsn.copied_insn buffer.
|
|
*/
|
|
if (probe_kernel_read(buf, (void *)addr,
|
|
MAX_INSN_SIZE * sizeof(kprobe_opcode_t)))
|
|
return 0UL;
|
|
|
|
if (addr == (unsigned long)kp->addr) {
|
|
buf[0] = kp->opcode;
|
|
memcpy(buf + 1, op->optinsn.copied_insn, RELATIVE_ADDR_SIZE);
|
|
} else {
|
|
offs = addr - (unsigned long)kp->addr - 1;
|
|
memcpy(buf, op->optinsn.copied_insn + offs, RELATIVE_ADDR_SIZE - offs);
|
|
}
|
|
|
|
return (unsigned long)buf;
|
|
}
|
|
|
|
/* Insert a move instruction which sets a pointer to eax/rdi (1st arg). */
|
|
static void synthesize_set_arg1(kprobe_opcode_t *addr, unsigned long val)
|
|
{
|
|
#ifdef CONFIG_X86_64
|
|
*addr++ = 0x48;
|
|
*addr++ = 0xbf;
|
|
#else
|
|
*addr++ = 0xb8;
|
|
#endif
|
|
*(unsigned long *)addr = val;
|
|
}
|
|
|
|
asm (
|
|
"optprobe_template_func:\n"
|
|
".global optprobe_template_entry\n"
|
|
"optprobe_template_entry:\n"
|
|
#ifdef CONFIG_X86_64
|
|
/* We don't bother saving the ss register */
|
|
" pushq %rsp\n"
|
|
" pushfq\n"
|
|
SAVE_REGS_STRING
|
|
" movq %rsp, %rsi\n"
|
|
".global optprobe_template_val\n"
|
|
"optprobe_template_val:\n"
|
|
ASM_NOP5
|
|
ASM_NOP5
|
|
".global optprobe_template_call\n"
|
|
"optprobe_template_call:\n"
|
|
ASM_NOP5
|
|
/* Move flags to rsp */
|
|
" movq 144(%rsp), %rdx\n"
|
|
" movq %rdx, 152(%rsp)\n"
|
|
RESTORE_REGS_STRING
|
|
/* Skip flags entry */
|
|
" addq $8, %rsp\n"
|
|
" popfq\n"
|
|
#else /* CONFIG_X86_32 */
|
|
" pushf\n"
|
|
SAVE_REGS_STRING
|
|
" movl %esp, %edx\n"
|
|
".global optprobe_template_val\n"
|
|
"optprobe_template_val:\n"
|
|
ASM_NOP5
|
|
".global optprobe_template_call\n"
|
|
"optprobe_template_call:\n"
|
|
ASM_NOP5
|
|
RESTORE_REGS_STRING
|
|
" addl $4, %esp\n" /* skip cs */
|
|
" popf\n"
|
|
#endif
|
|
".global optprobe_template_end\n"
|
|
"optprobe_template_end:\n"
|
|
".type optprobe_template_func, @function\n"
|
|
".size optprobe_template_func, .-optprobe_template_func\n");
|
|
|
|
void optprobe_template_func(void);
|
|
STACK_FRAME_NON_STANDARD(optprobe_template_func);
|
|
|
|
#define TMPL_MOVE_IDX \
|
|
((long)&optprobe_template_val - (long)&optprobe_template_entry)
|
|
#define TMPL_CALL_IDX \
|
|
((long)&optprobe_template_call - (long)&optprobe_template_entry)
|
|
#define TMPL_END_IDX \
|
|
((long)&optprobe_template_end - (long)&optprobe_template_entry)
|
|
|
|
#define INT3_SIZE sizeof(kprobe_opcode_t)
|
|
|
|
/* Optimized kprobe call back function: called from optinsn */
|
|
static void
|
|
optimized_callback(struct optimized_kprobe *op, struct pt_regs *regs)
|
|
{
|
|
struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
|
|
unsigned long flags;
|
|
|
|
/* This is possible if op is under delayed unoptimizing */
|
|
if (kprobe_disabled(&op->kp))
|
|
return;
|
|
|
|
local_irq_save(flags);
|
|
if (kprobe_running()) {
|
|
kprobes_inc_nmissed_count(&op->kp);
|
|
} else {
|
|
/* Save skipped registers */
|
|
#ifdef CONFIG_X86_64
|
|
regs->cs = __KERNEL_CS;
|
|
#else
|
|
regs->cs = __KERNEL_CS | get_kernel_rpl();
|
|
regs->gs = 0;
|
|
#endif
|
|
regs->ip = (unsigned long)op->kp.addr + INT3_SIZE;
|
|
regs->orig_ax = ~0UL;
|
|
|
|
__this_cpu_write(current_kprobe, &op->kp);
|
|
kcb->kprobe_status = KPROBE_HIT_ACTIVE;
|
|
opt_pre_handler(&op->kp, regs);
|
|
__this_cpu_write(current_kprobe, NULL);
|
|
}
|
|
local_irq_restore(flags);
|
|
}
|
|
NOKPROBE_SYMBOL(optimized_callback);
|
|
|
|
static int copy_optimized_instructions(u8 *dest, u8 *src)
|
|
{
|
|
struct insn insn;
|
|
int len = 0, ret;
|
|
|
|
while (len < RELATIVEJUMP_SIZE) {
|
|
ret = __copy_instruction(dest + len, src + len, &insn);
|
|
if (!ret || !can_boost(&insn, src + len))
|
|
return -EINVAL;
|
|
len += ret;
|
|
}
|
|
/* Check whether the address range is reserved */
|
|
if (ftrace_text_reserved(src, src + len - 1) ||
|
|
alternatives_text_reserved(src, src + len - 1) ||
|
|
jump_label_text_reserved(src, src + len - 1))
|
|
return -EBUSY;
|
|
|
|
return len;
|
|
}
|
|
|
|
/* Check whether insn is indirect jump */
|
|
static int insn_is_indirect_jump(struct insn *insn)
|
|
{
|
|
return ((insn->opcode.bytes[0] == 0xff &&
|
|
(X86_MODRM_REG(insn->modrm.value) & 6) == 4) || /* Jump */
|
|
insn->opcode.bytes[0] == 0xea); /* Segment based jump */
|
|
}
|
|
|
|
/* Check whether insn jumps into specified address range */
|
|
static int insn_jump_into_range(struct insn *insn, unsigned long start, int len)
|
|
{
|
|
unsigned long target = 0;
|
|
|
|
switch (insn->opcode.bytes[0]) {
|
|
case 0xe0: /* loopne */
|
|
case 0xe1: /* loope */
|
|
case 0xe2: /* loop */
|
|
case 0xe3: /* jcxz */
|
|
case 0xe9: /* near relative jump */
|
|
case 0xeb: /* short relative jump */
|
|
break;
|
|
case 0x0f:
|
|
if ((insn->opcode.bytes[1] & 0xf0) == 0x80) /* jcc near */
|
|
break;
|
|
return 0;
|
|
default:
|
|
if ((insn->opcode.bytes[0] & 0xf0) == 0x70) /* jcc short */
|
|
break;
|
|
return 0;
|
|
}
|
|
target = (unsigned long)insn->next_byte + insn->immediate.value;
|
|
|
|
return (start <= target && target <= start + len);
|
|
}
|
|
|
|
/* Decode whole function to ensure any instructions don't jump into target */
|
|
static int can_optimize(unsigned long paddr)
|
|
{
|
|
unsigned long addr, size = 0, offset = 0;
|
|
struct insn insn;
|
|
kprobe_opcode_t buf[MAX_INSN_SIZE];
|
|
|
|
/* Lookup symbol including addr */
|
|
if (!kallsyms_lookup_size_offset(paddr, &size, &offset))
|
|
return 0;
|
|
|
|
/*
|
|
* Do not optimize in the entry code due to the unstable
|
|
* stack handling and registers setup.
|
|
*/
|
|
if (((paddr >= (unsigned long)__entry_text_start) &&
|
|
(paddr < (unsigned long)__entry_text_end)) ||
|
|
((paddr >= (unsigned long)__irqentry_text_start) &&
|
|
(paddr < (unsigned long)__irqentry_text_end)))
|
|
return 0;
|
|
|
|
/* Check there is enough space for a relative jump. */
|
|
if (size - offset < RELATIVEJUMP_SIZE)
|
|
return 0;
|
|
|
|
/* Decode instructions */
|
|
addr = paddr - offset;
|
|
while (addr < paddr - offset + size) { /* Decode until function end */
|
|
unsigned long recovered_insn;
|
|
if (search_exception_tables(addr))
|
|
/*
|
|
* Since some fixup code will jumps into this function,
|
|
* we can't optimize kprobe in this function.
|
|
*/
|
|
return 0;
|
|
recovered_insn = recover_probed_instruction(buf, addr);
|
|
if (!recovered_insn)
|
|
return 0;
|
|
kernel_insn_init(&insn, (void *)recovered_insn, MAX_INSN_SIZE);
|
|
insn_get_length(&insn);
|
|
/* Another subsystem puts a breakpoint */
|
|
if (insn.opcode.bytes[0] == BREAKPOINT_INSTRUCTION)
|
|
return 0;
|
|
/* Recover address */
|
|
insn.kaddr = (void *)addr;
|
|
insn.next_byte = (void *)(addr + insn.length);
|
|
/* Check any instructions don't jump into target */
|
|
if (insn_is_indirect_jump(&insn) ||
|
|
insn_jump_into_range(&insn, paddr + INT3_SIZE,
|
|
RELATIVE_ADDR_SIZE))
|
|
return 0;
|
|
addr += insn.length;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Check optimized_kprobe can actually be optimized. */
|
|
int arch_check_optimized_kprobe(struct optimized_kprobe *op)
|
|
{
|
|
int i;
|
|
struct kprobe *p;
|
|
|
|
for (i = 1; i < op->optinsn.size; i++) {
|
|
p = get_kprobe(op->kp.addr + i);
|
|
if (p && !kprobe_disabled(p))
|
|
return -EEXIST;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Check the addr is within the optimized instructions. */
|
|
int arch_within_optimized_kprobe(struct optimized_kprobe *op,
|
|
unsigned long addr)
|
|
{
|
|
return ((unsigned long)op->kp.addr <= addr &&
|
|
(unsigned long)op->kp.addr + op->optinsn.size > addr);
|
|
}
|
|
|
|
/* Free optimized instruction slot */
|
|
static
|
|
void __arch_remove_optimized_kprobe(struct optimized_kprobe *op, int dirty)
|
|
{
|
|
if (op->optinsn.insn) {
|
|
free_optinsn_slot(op->optinsn.insn, dirty);
|
|
op->optinsn.insn = NULL;
|
|
op->optinsn.size = 0;
|
|
}
|
|
}
|
|
|
|
void arch_remove_optimized_kprobe(struct optimized_kprobe *op)
|
|
{
|
|
__arch_remove_optimized_kprobe(op, 1);
|
|
}
|
|
|
|
/*
|
|
* Copy replacing target instructions
|
|
* Target instructions MUST be relocatable (checked inside)
|
|
* This is called when new aggr(opt)probe is allocated or reused.
|
|
*/
|
|
int arch_prepare_optimized_kprobe(struct optimized_kprobe *op,
|
|
struct kprobe *__unused)
|
|
{
|
|
u8 *buf;
|
|
int ret;
|
|
long rel;
|
|
|
|
if (!can_optimize((unsigned long)op->kp.addr))
|
|
return -EILSEQ;
|
|
|
|
op->optinsn.insn = get_optinsn_slot();
|
|
if (!op->optinsn.insn)
|
|
return -ENOMEM;
|
|
|
|
/*
|
|
* Verify if the address gap is in 2GB range, because this uses
|
|
* a relative jump.
|
|
*/
|
|
rel = (long)op->optinsn.insn - (long)op->kp.addr + RELATIVEJUMP_SIZE;
|
|
if (abs(rel) > 0x7fffffff) {
|
|
__arch_remove_optimized_kprobe(op, 0);
|
|
return -ERANGE;
|
|
}
|
|
|
|
buf = (u8 *)op->optinsn.insn;
|
|
set_memory_rw((unsigned long)buf & PAGE_MASK, 1);
|
|
|
|
/* Copy instructions into the out-of-line buffer */
|
|
ret = copy_optimized_instructions(buf + TMPL_END_IDX, op->kp.addr);
|
|
if (ret < 0) {
|
|
__arch_remove_optimized_kprobe(op, 0);
|
|
return ret;
|
|
}
|
|
op->optinsn.size = ret;
|
|
|
|
/* Copy arch-dep-instance from template */
|
|
memcpy(buf, &optprobe_template_entry, TMPL_END_IDX);
|
|
|
|
/* Set probe information */
|
|
synthesize_set_arg1(buf + TMPL_MOVE_IDX, (unsigned long)op);
|
|
|
|
/* Set probe function call */
|
|
synthesize_relcall(buf + TMPL_CALL_IDX, optimized_callback);
|
|
|
|
/* Set returning jmp instruction at the tail of out-of-line buffer */
|
|
synthesize_reljump(buf + TMPL_END_IDX + op->optinsn.size,
|
|
(u8 *)op->kp.addr + op->optinsn.size);
|
|
|
|
set_memory_ro((unsigned long)buf & PAGE_MASK, 1);
|
|
|
|
flush_icache_range((unsigned long) buf,
|
|
(unsigned long) buf + TMPL_END_IDX +
|
|
op->optinsn.size + RELATIVEJUMP_SIZE);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Replace breakpoints (int3) with relative jumps.
|
|
* Caller must call with locking kprobe_mutex and text_mutex.
|
|
*/
|
|
void arch_optimize_kprobes(struct list_head *oplist)
|
|
{
|
|
struct optimized_kprobe *op, *tmp;
|
|
u8 insn_buf[RELATIVEJUMP_SIZE];
|
|
|
|
list_for_each_entry_safe(op, tmp, oplist, list) {
|
|
s32 rel = (s32)((long)op->optinsn.insn -
|
|
((long)op->kp.addr + RELATIVEJUMP_SIZE));
|
|
|
|
WARN_ON(kprobe_disabled(&op->kp));
|
|
|
|
/* Backup instructions which will be replaced by jump address */
|
|
memcpy(op->optinsn.copied_insn, op->kp.addr + INT3_SIZE,
|
|
RELATIVE_ADDR_SIZE);
|
|
|
|
insn_buf[0] = RELATIVEJUMP_OPCODE;
|
|
*(s32 *)(&insn_buf[1]) = rel;
|
|
|
|
text_poke_bp(op->kp.addr, insn_buf, RELATIVEJUMP_SIZE,
|
|
op->optinsn.insn);
|
|
|
|
list_del_init(&op->list);
|
|
}
|
|
}
|
|
|
|
/* Replace a relative jump with a breakpoint (int3). */
|
|
void arch_unoptimize_kprobe(struct optimized_kprobe *op)
|
|
{
|
|
u8 insn_buf[RELATIVEJUMP_SIZE];
|
|
|
|
/* Set int3 to first byte for kprobes */
|
|
insn_buf[0] = BREAKPOINT_INSTRUCTION;
|
|
memcpy(insn_buf + 1, op->optinsn.copied_insn, RELATIVE_ADDR_SIZE);
|
|
text_poke_bp(op->kp.addr, insn_buf, RELATIVEJUMP_SIZE,
|
|
op->optinsn.insn);
|
|
}
|
|
|
|
/*
|
|
* Recover original instructions and breakpoints from relative jumps.
|
|
* Caller must call with locking kprobe_mutex.
|
|
*/
|
|
extern void arch_unoptimize_kprobes(struct list_head *oplist,
|
|
struct list_head *done_list)
|
|
{
|
|
struct optimized_kprobe *op, *tmp;
|
|
|
|
list_for_each_entry_safe(op, tmp, oplist, list) {
|
|
arch_unoptimize_kprobe(op);
|
|
list_move(&op->list, done_list);
|
|
}
|
|
}
|
|
|
|
int setup_detour_execution(struct kprobe *p, struct pt_regs *regs, int reenter)
|
|
{
|
|
struct optimized_kprobe *op;
|
|
|
|
if (p->flags & KPROBE_FLAG_OPTIMIZED) {
|
|
/* This kprobe is really able to run optimized path. */
|
|
op = container_of(p, struct optimized_kprobe, kp);
|
|
/* Detour through copied instructions */
|
|
regs->ip = (unsigned long)op->optinsn.insn + TMPL_END_IDX;
|
|
if (!reenter)
|
|
reset_current_kprobe();
|
|
preempt_enable_no_resched();
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
NOKPROBE_SYMBOL(setup_detour_execution);
|