Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 0e44e9a0 authored by Jon Medhurst's avatar Jon Medhurst Committed by Tixy
Browse files

ARM: kprobes: Add emulate_rd12rn16rm0_rwflags_nopc() 



This is the emulation function for the instruction format used by the
ARM media instructions.

Signed-off-by: default avatarJon Medhurst <tixy@yxit.co.uk>
Acked-by: default avatarNicolas Pitre <nicolas.pitre@linaro.org>
parent c038f3af

arch/arm/kernel/kprobes-arm.c

+27 −0
Original line number Diff line number Diff line
@@ -957,6 +957,33 @@ emulate_rd12rn16rm0rs8_rwflags(struct kprobe *p, struct pt_regs *regs) 
	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);

}



static void __kprobes

emulate_rd12rn16rm0_rwflags_nopc(struct kprobe *p, struct pt_regs *regs)

{

	kprobe_opcode_t insn = p->opcode;

	int rd = (insn >> 12) & 0xf;

	int rn = (insn >> 16) & 0xf;

	int rm = insn & 0xf;



	register unsigned long rdv asm("r0") = regs->uregs[rd];

	register unsigned long rnv asm("r2") = regs->uregs[rn];

	register unsigned long rmv asm("r3") = regs->uregs[rm];

	unsigned long cpsr = regs->ARM_cpsr;



	__asm__ __volatile__ (

		"msr	cpsr_fs, %[cpsr]	\n\t"

		BLX("%[fn]")

		"mrs	%[cpsr], cpsr		\n\t"

		: "=r" (rdv), [cpsr] "=r" (cpsr)

		: "0" (rdv), "r" (rnv), "r" (rmv),

		  "1" (cpsr), [fn] "r" (p->ainsn.insn_fn)

		: "lr", "memory", "cc"

	);



	regs->uregs[rd] = rdv;

	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);

}



/*

 * For the instruction masking and comparisons in all the "space_*"

 * functions below, Do _not_ rearrange the order of tests unless