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

Commit 8f2ffa00 authored by Jon Medhurst's avatar Jon Medhurst Committed by Tixy
Browse files

ARM: kprobes: Remove now unused code 



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

arch/arm/kernel/kprobes-arm.c

+0 −738
Original line number Diff line number Diff line
@@ -74,300 +74,6 @@ 
			"mov	pc, "reg"	\n\t"

#endif



#define is_r15(insn, bitpos) (((insn) & (0xf << bitpos)) == (0xf << bitpos))



#define PSR_fs	(PSR_f|PSR_s)



#define KPROBE_RETURN_INSTRUCTION	0xe1a0f00e	/* mov pc, lr */



typedef long (insn_0arg_fn_t)(void);

typedef long (insn_1arg_fn_t)(long);

typedef long (insn_2arg_fn_t)(long, long);

typedef long (insn_3arg_fn_t)(long, long, long);

typedef long (insn_4arg_fn_t)(long, long, long, long);

typedef long long (insn_llret_0arg_fn_t)(void);

typedef long long (insn_llret_3arg_fn_t)(long, long, long);

typedef long long (insn_llret_4arg_fn_t)(long, long, long, long);



union reg_pair {

	long long	dr;

#ifdef __LITTLE_ENDIAN

	struct { long	r0, r1; };

#else

	struct { long	r1, r0; };

#endif

};



/*

 * The insnslot_?arg_r[w]flags() functions below are to keep the

 * msr -> *fn -> mrs instruction sequences indivisible so that

 * the state of the CPSR flags aren't inadvertently modified

 * just before or just after the call.

 */



static inline long __kprobes

insnslot_0arg_rflags(long cpsr, insn_0arg_fn_t *fn)

{

	register long ret asm("r0");



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret)

		: [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	return ret;

}



static inline long long __kprobes

insnslot_llret_0arg_rflags(long cpsr, insn_llret_0arg_fn_t *fn)

{

	register long ret0 asm("r0");

	register long ret1 asm("r1");

	union reg_pair fnr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret0), "=r" (ret1)

		: [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	fnr.r0 = ret0;

	fnr.r1 = ret1;

	return fnr.dr;

}



static inline long __kprobes

insnslot_1arg_rflags(long r0, long cpsr, insn_1arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long ret asm("r0");



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret)

		: "0" (rr0), [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	return ret;

}



static inline long __kprobes

insnslot_2arg_rflags(long r0, long r1, long cpsr, insn_2arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long ret asm("r0");



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret)

		: "0" (rr0), "r" (rr1),

		  [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	return ret;

}



static inline long __kprobes

insnslot_3arg_rflags(long r0, long r1, long r2, long cpsr, insn_3arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long ret asm("r0");



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret)

		: "0" (rr0), "r" (rr1), "r" (rr2),

		  [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	return ret;

}



static inline long long __kprobes

insnslot_llret_3arg_rflags(long r0, long r1, long r2, long cpsr,

			   insn_llret_3arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long ret0 asm("r0");

	register long ret1 asm("r1");

	union reg_pair fnr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret0), "=r" (ret1)

		: "0" (rr0), "r" (rr1), "r" (rr2),

		  [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	fnr.r0 = ret0;

	fnr.r1 = ret1;

	return fnr.dr;

}



static inline long __kprobes

insnslot_4arg_rflags(long r0, long r1, long r2, long r3, long cpsr,

		     insn_4arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long rr3 asm("r3") = r3;

	register long ret asm("r0");



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

		: "=r" (ret)

		: "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),

		  [cpsr] "r" (cpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	return ret;

}



static inline long __kprobes

insnslot_1arg_rwflags(long r0, long *cpsr, insn_1arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long ret asm("r0");

	long oldcpsr = *cpsr;

	long newcpsr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

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

		: "=r" (ret), [newcpsr] "=r" (newcpsr)

		: "0" (rr0), [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	*cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);

	return ret;

}



static inline long __kprobes

insnslot_2arg_rwflags(long r0, long r1, long *cpsr, insn_2arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long ret asm("r0");

	long oldcpsr = *cpsr;

	long newcpsr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

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

		: "=r" (ret), [newcpsr] "=r" (newcpsr)

		: "0" (rr0), "r" (rr1), [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	*cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);

	return ret;

}



static inline long __kprobes

insnslot_3arg_rwflags(long r0, long r1, long r2, long *cpsr,

		      insn_3arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long ret asm("r0");

	long oldcpsr = *cpsr;

	long newcpsr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

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

		: "=r" (ret), [newcpsr] "=r" (newcpsr)

		: "0" (rr0), "r" (rr1), "r" (rr2),

		  [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	*cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);

	return ret;

}



static inline long __kprobes

insnslot_4arg_rwflags(long r0, long r1, long r2, long r3, long *cpsr,

		      insn_4arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long rr3 asm("r3") = r3;

	register long ret asm("r0");

	long oldcpsr = *cpsr;

	long newcpsr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

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

		: "=r" (ret), [newcpsr] "=r" (newcpsr)

		: "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),

		  [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	*cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);

	return ret;

}



static inline long long __kprobes

insnslot_llret_4arg_rwflags(long r0, long r1, long r2, long r3, long *cpsr,

			    insn_llret_4arg_fn_t *fn)

{

	register long rr0 asm("r0") = r0;

	register long rr1 asm("r1") = r1;

	register long rr2 asm("r2") = r2;

	register long rr3 asm("r3") = r3;

	register long ret0 asm("r0");

	register long ret1 asm("r1");

	long oldcpsr = *cpsr;

	long newcpsr;

	union reg_pair fnr;



	__asm__ __volatile__ (

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

		"mov	lr, pc			\n\t"

		"mov	pc, %[fn]		\n\t"

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

		: "=r" (ret0), "=r" (ret1), [newcpsr] "=r" (newcpsr)

		: "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),

		  [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)

		: "lr", "cc"

	);

	*cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);

	fnr.r0 = ret0;

	fnr.r1 = ret1;

	return fnr.dr;

}



/*

 * To avoid the complications of mimicing single-stepping on a

 * processor without a Next-PC or a single-step mode, and to
@@ -449,450 +155,6 @@ static void __kprobes simulate_mov_ipsp(struct kprobe *p, struct pt_regs *regs) 
	regs->uregs[12] = regs->uregs[13];

}



static void __kprobes emulate_ldrd(struct kprobe *p, struct pt_regs *regs)

{

	insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

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

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

	int rm = insn & 0xf;  /* rm may be invalid, don't care. */

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];



	/* Not following the C calling convention here, so need asm(). */

	__asm__ __volatile__ (

		"ldr	r0, %[rn]	\n\t"

		"ldr	r1, %[rm]	\n\t"

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

		"mov	lr, pc		\n\t"

		"mov	pc, %[i_fn]	\n\t"

		"str	r0, %[rn]	\n\t"	/* in case of writeback */

		"str	r2, %[rd0]	\n\t"

		"str	r3, %[rd1]	\n\t"

		: [rn]  "+m" (rnv),

		  [rd0] "=m" (regs->uregs[rd]),

		  [rd1] "=m" (regs->uregs[rd+1])

		: [rm]   "m" (rmv),

		  [cpsr] "r" (regs->ARM_cpsr),

		  [i_fn] "r" (i_fn)

		: "r0", "r1", "r2", "r3", "lr", "cc"

	);

	if (is_writeback(insn))

		regs->uregs[rn] = rnv;

}



static void __kprobes emulate_strd(struct kprobe *p, struct pt_regs *regs)

{

	insn_4arg_fn_t *i_fn = (insn_4arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

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

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

	int rm  = insn & 0xf;

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];

	/* rm/rmv may be invalid, don't care. */

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long rnv_wb;



	rnv_wb = insnslot_4arg_rflags(rnv, rmv, regs->uregs[rd],

					       regs->uregs[rd+1],

					       regs->ARM_cpsr, i_fn);

	if (is_writeback(insn))

		regs->uregs[rn] = rnv_wb;

}



static void __kprobes emulate_ldr_old(struct kprobe *p, struct pt_regs *regs)

{

	insn_llret_3arg_fn_t *i_fn = (insn_llret_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

	union reg_pair fnr;

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

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

	int rm = insn & 0xf;

	long rdv;

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long cpsr = regs->ARM_cpsr;



	fnr.dr = insnslot_llret_3arg_rflags(rnv, 0, rmv, cpsr, i_fn);

	if (rn != 15)

		regs->uregs[rn] = fnr.r0;  /* Save Rn in case of writeback. */

	rdv = fnr.r1;



	if (rd == 15) {

#if __LINUX_ARM_ARCH__ >= 5

		cpsr &= ~PSR_T_BIT;

		if (rdv & 0x1)

			cpsr |= PSR_T_BIT;

		regs->ARM_cpsr = cpsr;

		rdv &= ~0x1;

#else

		rdv &= ~0x2;

#endif

	}

	regs->uregs[rd] = rdv;

}



static void __kprobes emulate_str_old(struct kprobe *p, struct pt_regs *regs)

{

	insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long iaddr = (long)p->addr;

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

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

	int rm = insn & 0xf;

	long rdv = (rd == 15) ? iaddr + str_pc_offset : regs->uregs[rd];

	long rnv = (rn == 15) ? iaddr +  8 : regs->uregs[rn];

	long rmv = regs->uregs[rm];  /* rm/rmv may be invalid, don't care. */

	long rnv_wb;



	rnv_wb = insnslot_3arg_rflags(rnv, rdv, rmv, regs->ARM_cpsr, i_fn);

	if (rn != 15)

		regs->uregs[rn] = rnv_wb;  /* Save Rn in case of writeback. */

}



static void __kprobes emulate_sat(struct kprobe *p, struct pt_regs *regs)

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	int rm = insn & 0xf;

	long rmv = regs->uregs[rm];



	/* Writes Q flag */

	regs->uregs[rd] = insnslot_1arg_rwflags(rmv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes emulate_sel(struct kprobe *p, struct pt_regs *regs)

{

	insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

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

	int rm = insn & 0xf;

	long rnv = regs->uregs[rn];

	long rmv = regs->uregs[rm];



	/* Reads GE bits */

	regs->uregs[rd] = insnslot_2arg_rflags(rnv, rmv, regs->ARM_cpsr, i_fn);

}



static void __kprobes emulate_none(struct kprobe *p, struct pt_regs *regs)

{

	insn_0arg_fn_t *i_fn = (insn_0arg_fn_t *)&p->ainsn.insn[0];



	insnslot_0arg_rflags(regs->ARM_cpsr, i_fn);

}



static void __kprobes emulate_nop(struct kprobe *p, struct pt_regs *regs)

{

}



static void __kprobes

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

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	long rdv = regs->uregs[rd];



	regs->uregs[rd] = insnslot_1arg_rflags(rdv, regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	int rn = insn & 0xf;

	long rdv = regs->uregs[rd];

	long rnv = regs->uregs[rn];



	regs->uregs[rd] = insnslot_2arg_rflags(rdv, rnv, regs->ARM_cpsr, i_fn);

}



static void __kprobes emulate_rd12rm0(struct kprobe *p, struct pt_regs *regs)

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	int rm = insn & 0xf;

	long rmv = regs->uregs[rm];



	regs->uregs[rd] = insnslot_1arg_rflags(rmv, regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

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

	int rm = insn & 0xf;

	long rnv = regs->uregs[rn];

	long rmv = regs->uregs[rm];



	regs->uregs[rd] =

		insnslot_2arg_rwflags(rnv, rmv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

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

	int rs = (insn >> 8) & 0xf;

	int rm = insn & 0xf;

	long rnv = regs->uregs[rn];

	long rsv = regs->uregs[rs];

	long rmv = regs->uregs[rm];



	regs->uregs[rd] =

		insnslot_3arg_rwflags(rnv, rsv, rmv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	int rs = (insn >> 8) & 0xf;

	int rm = insn & 0xf;

	long rsv = regs->uregs[rs];

	long rmv = regs->uregs[rm];



	regs->uregs[rd] =

		insnslot_2arg_rwflags(rsv, rmv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_llret_4arg_fn_t *i_fn = (insn_llret_4arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	union reg_pair fnr;

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

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

	int rs   = (insn >> 8) & 0xf;

	int rm   = insn & 0xf;

	long rsv = regs->uregs[rs];

	long rmv = regs->uregs[rm];



	fnr.dr = insnslot_llret_4arg_rwflags(regs->uregs[rdhi],

					     regs->uregs[rdlo], rsv, rmv,

					     &regs->ARM_cpsr, i_fn);

	regs->uregs[rdhi] = fnr.r0;

	regs->uregs[rdlo] = fnr.r1;

}



static void __kprobes

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

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

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

	long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];



	regs->uregs[rd] = insnslot_1arg_rflags(rnv, regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

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

	long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];



	regs->uregs[rd] = insnslot_1arg_rwflags(rnv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

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

	long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];



	insnslot_1arg_rwflags(rnv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

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

	int rn = (insn >> 16) & 0xf;	/* rn/rnv/rs/rsv may be */

	int rs = (insn >> 8) & 0xf;	/* invalid, don't care. */

	int rm = insn & 0xf;

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long rsv = regs->uregs[rs];



	regs->uregs[rd] =

		insnslot_3arg_rflags(rnv, rmv, rsv, regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

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

	int rn = (insn >> 16) & 0xf;	/* rn/rnv/rs/rsv may be */

	int rs = (insn >> 8) & 0xf;	/* invalid, don't care. */

	int rm = insn & 0xf;

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long rsv = regs->uregs[rs];



	regs->uregs[rd] =

		insnslot_3arg_rwflags(rnv, rmv, rsv, &regs->ARM_cpsr, i_fn);

}



static void __kprobes

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

{

	insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];

	kprobe_opcode_t insn = p->opcode;

	long ppc = (long)p->addr + 8;

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

	int rs = (insn >> 8) & 0xf;	/* rs/rsv may be invalid, don't care. */

	int rm = insn & 0xf;

	long rnv = (rn == 15) ? ppc : regs->uregs[rn];

	long rmv = (rm == 15) ? ppc : regs->uregs[rm];

	long rsv = regs->uregs[rs];



	insnslot_3arg_rwflags(rnv, rmv, rsv, &regs->ARM_cpsr, i_fn);

}



static enum kprobe_insn __kprobes

prep_emulate_ldr_str(kprobe_opcode_t insn, struct arch_specific_insn *asi)

{

	int not_imm = (insn & (1 << 26)) ? (insn & (1 << 25))

					 : (~insn & (1 << 22));



	if (is_writeback(insn) && is_r15(insn, 16))

		return INSN_REJECTED;	/* Writeback to PC */



	insn &= 0xfff00fff;

	insn |= 0x00001000;	/* Rn = r0, Rd = r1 */

	if (not_imm) {

		insn &= ~0xf;

		insn |= 2;	/* Rm = r2 */

	}

	asi->insn[0] = insn;

	asi->insn_handler = (insn & (1 << 20)) ? emulate_ldr_old : emulate_str_old;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd12_modify(kprobe_opcode_t insn, struct arch_specific_insn *asi)

{

	if (is_r15(insn, 12))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xffff0fff;	/* Rd = r0 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd12_modify;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd12rn0_modify(kprobe_opcode_t insn,

			    struct arch_specific_insn *asi)

{

	if (is_r15(insn, 12))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xffff0ff0;	/* Rd = r0 */

	insn |= 0x00000001;	/* Rn = r1 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd12rn0_modify;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd12rm0(kprobe_opcode_t insn, struct arch_specific_insn *asi)

{

	if (is_r15(insn, 12))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xffff0ff0;	/* Rd = r0, Rm = r0 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd12rm0;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd12rn16rm0_wflags(kprobe_opcode_t insn,

				struct arch_specific_insn *asi)

{

	if (is_r15(insn, 12))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xfff00ff0;	/* Rd = r0, Rn = r0 */

	insn |= 0x00000001;	/* Rm = r1 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd12rn16rm0_rwflags;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd16rs8rm0_wflags(kprobe_opcode_t insn,

			       struct arch_specific_insn *asi)

{

	if (is_r15(insn, 16))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xfff0f0f0;	/* Rd = r0, Rs = r0 */

	insn |= 0x00000001;	/* Rm = r1          */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd16rs8rm0_rwflags;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rd16rn12rs8rm0_wflags(kprobe_opcode_t insn,

				   struct arch_specific_insn *asi)

{

	if (is_r15(insn, 16))

		return INSN_REJECTED;	/* Rd is PC */



	insn &= 0xfff000f0;	/* Rd = r0, Rn = r0 */

	insn |= 0x00000102;	/* Rs = r1, Rm = r2 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rd16rn12rs8rm0_rwflags;

	return INSN_GOOD;

}



static enum kprobe_insn __kprobes

prep_emulate_rdhi16rdlo12rs8rm0_wflags(kprobe_opcode_t insn,

				       struct arch_specific_insn *asi)

{

	if (is_r15(insn, 16) || is_r15(insn, 12))

		return INSN_REJECTED;	/* RdHi or RdLo is PC */



	insn &= 0xfff000f0;	/* RdHi = r0, RdLo = r1 */

	insn |= 0x00001203;	/* Rs = r2, Rm = r3 */

	asi->insn[0] = insn;

	asi->insn_handler = emulate_rdhi16rdlo12rs8rm0_rwflags;

	return INSN_GOOD;

}



static void __kprobes

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

{