| 
									
										
										
										
											2011-04-19 17:56:58 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * arch/arm/kernel/kprobes-thumb.c | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Copyright (C) 2011 Jon Medhurst <tixy@yxit.co.uk>. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 as | 
					
						
							|  |  |  |  * published by the Free Software Foundation. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:06:29 -05:00
										 |  |  | #include <linux/types.h>
 | 
					
						
							| 
									
										
										
										
											2011-04-19 17:56:58 +01:00
										 |  |  | #include <linux/kernel.h>
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:06:29 -05:00
										 |  |  | #include <linux/ptrace.h>
 | 
					
						
							| 
									
										
										
										
											2011-04-19 17:56:58 +01:00
										 |  |  | #include <linux/kprobes.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "kprobes.h"
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:06:29 -05:00
										 |  |  | #include "probes-thumb.h"
 | 
					
						
							| 
									
										
										
										
											2011-04-20 19:29:52 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | /* These emulation encodings are functionally equivalent... */ | 
					
						
							|  |  |  | #define t32_emulate_rd8rn16rm0ra12_noflags \
 | 
					
						
							|  |  |  | 		t32_emulate_rdlo12rdhi8rn16rm0_noflags | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:06:29 -05:00
										 |  |  | /* t32 thumb actions */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_simulate_table_branch(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:26:16 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:26:16 +01:00
										 |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 	int rm = insn & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	unsigned long rnv = (rn == 15) ? pc : regs->uregs[rn]; | 
					
						
							|  |  |  | 	unsigned long rmv = regs->uregs[rm]; | 
					
						
							|  |  |  | 	unsigned int halfwords; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 	if (insn & 0x10) /* TBH */ | 
					
						
							| 
									
										
										
										
											2011-07-03 14:26:16 +01:00
										 |  |  | 		halfwords = ((u16 *)rnv)[rmv]; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 	else /* TBB */ | 
					
						
							| 
									
										
										
										
											2011-07-03 14:26:16 +01:00
										 |  |  | 		halfwords = ((u8 *)rnv)[rmv]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->ARM_pc = pc + 2 * halfwords; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_simulate_mrs(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:52:18 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rd = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 	unsigned long mask = 0xf8ff03df; /* Mask out execution state */ | 
					
						
							|  |  |  | 	regs->uregs[rd] = regs->ARM_cpsr & mask; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_simulate_cond_branch(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	long offset = insn & 0x7ff;		/* imm11 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x003f0000) >> 5;	/* imm6 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x00002000) << 4;	/* J1 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x00000800) << 7;	/* J2 */ | 
					
						
							|  |  |  | 	offset -= (insn & 0x04000000) >> 7;	/* Apply sign bit */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->ARM_pc = pc + (offset * 2); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t32_decode_cond_branch(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int cc = (insn >> 22) & 0xf; | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | 	asi->insn_check_cc = probes_condition_checks[cc]; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 	asi->insn_handler = t32_simulate_cond_branch; | 
					
						
							|  |  |  | 	return INSN_GOOD_NO_SLOT; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_simulate_branch(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		    struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	long offset = insn & 0x7ff;		/* imm11 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x03ff0000) >> 5;	/* imm10 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x00002000) << 9;	/* J1 */ | 
					
						
							|  |  |  | 	offset += (insn & 0x00000800) << 10;	/* J2 */ | 
					
						
							|  |  |  | 	if (insn & 0x04000000) | 
					
						
							|  |  |  | 		offset -= 0x00800000; /* Apply sign bit */ | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		offset ^= 0x00600000; /* Invert J1 and J2 */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (insn & (1 << 14)) { | 
					
						
							|  |  |  | 		/* BL or BLX */ | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		regs->ARM_lr = regs->ARM_pc | 1; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:53:45 +01:00
										 |  |  | 		if (!(insn & (1 << 12))) { | 
					
						
							|  |  |  | 			/* BLX so switch to ARM mode */ | 
					
						
							|  |  |  | 			regs->ARM_cpsr &= ~PSR_T_BIT; | 
					
						
							|  |  |  | 			pc &= ~3; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->ARM_pc = pc + (offset * 2); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_simulate_ldr_literal(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 15:04:26 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long addr = regs->ARM_pc & ~3; | 
					
						
							| 
									
										
										
										
											2011-07-03 15:04:26 +01:00
										 |  |  | 	int rt = (insn >> 12) & 0xf; | 
					
						
							|  |  |  | 	unsigned long rtv; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	long offset = insn & 0xfff; | 
					
						
							|  |  |  | 	if (insn & 0x00800000) | 
					
						
							|  |  |  | 		addr += offset; | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		addr -= offset; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (insn & 0x00400000) { | 
					
						
							|  |  |  | 		/* LDR */ | 
					
						
							|  |  |  | 		rtv = *(unsigned long *)addr; | 
					
						
							|  |  |  | 		if (rt == 15) { | 
					
						
							|  |  |  | 			bx_write_pc(rtv, regs); | 
					
						
							|  |  |  | 			return; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else if (insn & 0x00200000) { | 
					
						
							|  |  |  | 		/* LDRH */ | 
					
						
							|  |  |  | 		if (insn & 0x01000000) | 
					
						
							|  |  |  | 			rtv = *(s16 *)addr; | 
					
						
							|  |  |  | 		else | 
					
						
							|  |  |  | 			rtv = *(u16 *)addr; | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		/* LDRB */ | 
					
						
							|  |  |  | 		if (insn & 0x01000000) | 
					
						
							|  |  |  | 			rtv = *(s8 *)addr; | 
					
						
							|  |  |  | 		else | 
					
						
							|  |  |  | 			rtv = *(u8 *)addr; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rt] = rtv; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t32_decode_ldmstm(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
										
											2011-07-07 08:59:32 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | 	enum probes_insn ret = kprobe_decode_ldmstm(insn, asi, d); | 
					
						
							| 
									
										
										
										
											2011-07-07 08:59:32 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Fixup modified instruction to have halfwords in correct order...*/ | 
					
						
							| 
									
										
										
										
											2013-11-08 18:29:25 +00:00
										 |  |  | 	insn = __mem_to_opcode_arm(asi->insn[0]); | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(insn >> 16); | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0xffff); | 
					
						
							| 
									
										
										
										
											2011-07-07 08:59:32 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_ldrdstrd(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:23:21 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc & ~3; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:23:21 +01:00
										 |  |  | 	int rt1 = (insn >> 12) & 0xf; | 
					
						
							|  |  |  | 	int rt2 = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rt1v asm("r0") = regs->uregs[rt1]; | 
					
						
							|  |  |  | 	register unsigned long rt2v asm("r1") = regs->uregs[rt2]; | 
					
						
							|  |  |  | 	register unsigned long rnv asm("r2") = (rn == 15) ? pc | 
					
						
							|  |  |  | 							  : regs->uregs[rn]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"blx    %[fn]" | 
					
						
							|  |  |  | 		: "=r" (rt1v), "=r" (rt2v), "=r" (rnv) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: "0" (rt1v), "1" (rt2v), "2" (rnv), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:23:21 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (rn != 15) | 
					
						
							|  |  |  | 		regs->uregs[rn] = rnv; /* Writeback base register */ | 
					
						
							|  |  |  | 	regs->uregs[rt1] = rt1v; | 
					
						
							|  |  |  | 	regs->uregs[rt2] = rt2v; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_ldrstr(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 15:04:26 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rt = (insn >> 12) & 0xf; | 
					
						
							|  |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 	int rm = insn & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rtv asm("r0") = regs->uregs[rt]; | 
					
						
							|  |  |  | 	register unsigned long rnv asm("r2") = regs->uregs[rn]; | 
					
						
							|  |  |  | 	register unsigned long rmv asm("r3") = regs->uregs[rm]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"blx    %[fn]" | 
					
						
							|  |  |  | 		: "=r" (rtv), "=r" (rnv) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: "0" (rtv), "1" (rnv), "r" (rmv), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 15:04:26 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rn] = rnv; /* Writeback base register */ | 
					
						
							|  |  |  | 	if (rt == 15) /* Can't be true for a STR as they aren't allowed */ | 
					
						
							|  |  |  | 		bx_write_pc(rtv, regs); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		regs->uregs[rt] = rtv; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_rd8rn16rm0_rwflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:31:58 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rd = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 	int rm = insn & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rdv asm("r1") = 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]			\n\t" | 
					
						
							|  |  |  | 		"mrs	%[cpsr], cpsr		\n\t" | 
					
						
							|  |  |  | 		: "=r" (rdv), [cpsr] "=r" (cpsr) | 
					
						
							|  |  |  | 		: "0" (rdv), "r" (rnv), "r" (rmv), | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		  "1" (cpsr), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:31:58 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rd] = rdv; | 
					
						
							|  |  |  | 	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_rd8pc16_noflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:40:26 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc; | 
					
						
							| 
									
										
										
										
											2011-07-03 14:40:26 +01:00
										 |  |  | 	int rd = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rdv asm("r1") = regs->uregs[rd]; | 
					
						
							|  |  |  | 	register unsigned long rnv asm("r2") = pc & ~3; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"blx    %[fn]" | 
					
						
							|  |  |  | 		: "=r" (rdv) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: "0" (rdv), "r" (rnv), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:40:26 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rd] = rdv; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_rd8rn16_noflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:40:26 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rd = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rdv asm("r1") = regs->uregs[rd]; | 
					
						
							|  |  |  | 	register unsigned long rnv asm("r2") = regs->uregs[rn]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"blx    %[fn]" | 
					
						
							|  |  |  | 		: "=r" (rdv) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: "0" (rdv), "r" (rnv), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 14:40:26 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rd] = rdv; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t32_emulate_rdlo12rdhi8rn16rm0_noflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-03 15:15:11 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rdlo = (insn >> 12) & 0xf; | 
					
						
							|  |  |  | 	int rdhi = (insn >> 8) & 0xf; | 
					
						
							|  |  |  | 	int rn = (insn >> 16) & 0xf; | 
					
						
							|  |  |  | 	int rm = insn & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rdlov asm("r0") = regs->uregs[rdlo]; | 
					
						
							|  |  |  | 	register unsigned long rdhiv asm("r1") = regs->uregs[rdhi]; | 
					
						
							|  |  |  | 	register unsigned long rnv asm("r2") = regs->uregs[rn]; | 
					
						
							|  |  |  | 	register unsigned long rmv asm("r3") = regs->uregs[rm]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"blx    %[fn]" | 
					
						
							|  |  |  | 		: "=r" (rdlov), "=r" (rdhiv) | 
					
						
							|  |  |  | 		: "0" (rdlov), "1" (rdhiv), "r" (rnv), "r" (rmv), | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		  [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-03 15:15:11 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rdlo] = rdlov; | 
					
						
							|  |  |  | 	regs->uregs[rdhi] = rdhiv; | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2014-03-05 21:06:29 -05:00
										 |  |  | /* t16 thumb actions */ | 
					
						
							| 
									
										
										
										
											2011-07-03 15:15:11 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_bxblx(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:51:03 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc + 2; | 
					
						
							| 
									
										
										
										
											2011-07-02 15:51:03 +01:00
										 |  |  | 	int rm = (insn >> 3) & 0xf; | 
					
						
							|  |  |  | 	unsigned long rmv = (rm == 15) ? pc : regs->uregs[rm]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (insn & (1 << 7)) /* BLX ? */ | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		regs->ARM_lr = regs->ARM_pc | 1; | 
					
						
							| 
									
										
										
										
											2011-07-02 15:51:03 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	bx_write_pc(rmv, regs); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_ldr_literal(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:00:09 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long *base = (unsigned long *)((regs->ARM_pc + 2) & ~3); | 
					
						
							| 
									
										
										
										
											2011-07-02 16:00:09 +01:00
										 |  |  | 	long index = insn & 0xff; | 
					
						
							|  |  |  | 	int rt = (insn >> 8) & 0x7; | 
					
						
							|  |  |  | 	regs->uregs[rt] = base[index]; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_ldrstr_sp_relative(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:00:09 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	unsigned long* base = (unsigned long *)regs->ARM_sp; | 
					
						
							|  |  |  | 	long index = insn & 0xff; | 
					
						
							|  |  |  | 	int rt = (insn >> 8) & 0x7; | 
					
						
							|  |  |  | 	if (insn & 0x800) /* LDR */ | 
					
						
							|  |  |  | 		regs->uregs[rt] = base[index]; | 
					
						
							|  |  |  | 	else /* STR */ | 
					
						
							|  |  |  | 		base[index] = regs->uregs[rt]; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_reladr(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:05:53 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	unsigned long base = (insn & 0x800) ? regs->ARM_sp | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 					    : ((regs->ARM_pc + 2) & ~3); | 
					
						
							| 
									
										
										
										
											2011-07-02 16:05:53 +01:00
										 |  |  | 	long offset = insn & 0xff; | 
					
						
							|  |  |  | 	int rt = (insn >> 8) & 0x7; | 
					
						
							|  |  |  | 	regs->uregs[rt] = base + offset * 4; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_add_sp_imm(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:05:53 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	long imm = insn & 0x7f; | 
					
						
							|  |  |  | 	if (insn & 0x80) /* SUB */ | 
					
						
							|  |  |  | 		regs->ARM_sp -= imm * 4; | 
					
						
							|  |  |  | 	else /* ADD */ | 
					
						
							|  |  |  | 		regs->ARM_sp += imm * 4; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_cbz(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:10:44 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int rn = insn & 0x7; | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | 	probes_opcode_t nonzero = regs->uregs[rn] ? insn : ~insn; | 
					
						
							| 
									
										
										
										
											2011-07-02 16:10:44 +01:00
										 |  |  | 	if (nonzero & 0x800) { | 
					
						
							|  |  |  | 		long i = insn & 0x200; | 
					
						
							|  |  |  | 		long imm5 = insn & 0xf8; | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		unsigned long pc = regs->ARM_pc + 2; | 
					
						
							| 
									
										
										
										
											2011-07-02 16:10:44 +01:00
										 |  |  | 		regs->ARM_pc = pc + (i >> 3) + (imm5 >> 2); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_it(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:16:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * The 8 IT state bits are split into two parts in CPSR: | 
					
						
							|  |  |  | 	 *	ITSTATE<1:0> are in CPSR<26:25> | 
					
						
							|  |  |  | 	 *	ITSTATE<7:2> are in CPSR<15:10> | 
					
						
							|  |  |  | 	 * The new IT state is in the lower byte of insn. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	unsigned long cpsr = regs->ARM_cpsr; | 
					
						
							|  |  |  | 	cpsr &= ~PSR_IT_MASK; | 
					
						
							|  |  |  | 	cpsr |= (insn & 0xfc) << 8; | 
					
						
							|  |  |  | 	cpsr |= (insn & 0x03) << 25; | 
					
						
							|  |  |  | 	regs->ARM_cpsr = cpsr; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_singlestep_it(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		  struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:16:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	regs->ARM_pc += 2; | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	t16_simulate_it(insn, asi, regs); | 
					
						
							| 
									
										
										
										
											2011-07-02 16:16:05 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t16_decode_it(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:16:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	asi->insn_singlestep = t16_singlestep_it; | 
					
						
							|  |  |  | 	return INSN_GOOD_NO_SLOT; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_cond_branch(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc + 2; | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | 	long offset = insn & 0x7f; | 
					
						
							|  |  |  | 	offset -= insn & 0x80; /* Apply sign bit */ | 
					
						
							|  |  |  | 	regs->ARM_pc = pc + (offset * 2); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t16_decode_cond_branch(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	int cc = (insn >> 8) & 0xf; | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | 	asi->insn_check_cc = probes_condition_checks[cc]; | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | 	asi->insn_handler = t16_simulate_cond_branch; | 
					
						
							|  |  |  | 	return INSN_GOOD_NO_SLOT; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_simulate_branch(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		   struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc + 2; | 
					
						
							| 
									
										
										
										
											2011-07-02 16:30:43 +01:00
										 |  |  | 	long offset = insn & 0x3ff; | 
					
						
							|  |  |  | 	offset -= insn & 0x400; /* Apply sign bit */ | 
					
						
							|  |  |  | 	regs->ARM_pc = pc + (offset * 2); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | static unsigned long __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_loregs(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		   struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	unsigned long oldcpsr = regs->ARM_cpsr; | 
					
						
							|  |  |  | 	unsigned long newcpsr; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"msr	cpsr_fs, %[oldcpsr]	\n\t" | 
					
						
							|  |  |  | 		"ldmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"blx	%[fn]			\n\t" | 
					
						
							|  |  |  | 		"stmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"mrs	%[newcpsr], cpsr	\n\t" | 
					
						
							|  |  |  | 		: [newcpsr] "=r" (newcpsr) | 
					
						
							|  |  |  | 		: [oldcpsr] "r" (oldcpsr), [regs] "r" (regs), | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		  [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | 		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", | 
					
						
							|  |  |  | 		  "lr", "memory", "cc" | 
					
						
							|  |  |  | 		); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return (oldcpsr & ~APSR_MASK) | (newcpsr & APSR_MASK); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_loregs_rwflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	regs->ARM_cpsr = t16_emulate_loregs(insn, asi, regs); | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_loregs_noitrwflags(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long cpsr = t16_emulate_loregs(insn, asi, regs); | 
					
						
							| 
									
										
										
										
											2011-07-02 15:46:05 +01:00
										 |  |  | 	if (!in_it_block(cpsr)) | 
					
						
							|  |  |  | 		regs->ARM_cpsr = cpsr; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_hiregs(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:54:57 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 	unsigned long pc = regs->ARM_pc + 2; | 
					
						
							| 
									
										
										
										
											2011-07-02 15:54:57 +01:00
										 |  |  | 	int rdn = (insn & 0x7) | ((insn & 0x80) >> 4); | 
					
						
							|  |  |  | 	int rm = (insn >> 3) & 0xf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	register unsigned long rdnv asm("r1"); | 
					
						
							|  |  |  | 	register unsigned long rmv asm("r0"); | 
					
						
							|  |  |  | 	unsigned long cpsr = regs->ARM_cpsr; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	rdnv = (rdn == 15) ? pc : regs->uregs[rdn]; | 
					
						
							|  |  |  | 	rmv = (rm == 15) ? pc : regs->uregs[rm]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"msr	cpsr_fs, %[cpsr]	\n\t" | 
					
						
							|  |  |  | 		"blx    %[fn]			\n\t" | 
					
						
							|  |  |  | 		"mrs	%[cpsr], cpsr		\n\t" | 
					
						
							|  |  |  | 		: "=r" (rdnv), [cpsr] "=r" (cpsr) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: "0" (rdnv), "r" (rmv), "1" (cpsr), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:54:57 +01:00
										 |  |  | 		: "lr", "memory", "cc" | 
					
						
							|  |  |  | 	); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (rdn == 15) | 
					
						
							|  |  |  | 		rdnv &= ~1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	regs->uregs[rdn] = rdnv; | 
					
						
							|  |  |  | 	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t16_decode_hiregs(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
										
											2011-07-02 15:54:57 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	insn &= ~0x00ff; | 
					
						
							|  |  |  | 	insn |= 0x001; /* Set Rdn = R1 and Rm = R0 */ | 
					
						
							| 
									
										
										
										
											2013-11-08 18:29:25 +00:00
										 |  |  | 	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(insn); | 
					
						
							| 
									
										
										
										
											2011-07-02 15:54:57 +01:00
										 |  |  | 	asi->insn_handler = t16_emulate_hiregs; | 
					
						
							|  |  |  | 	return INSN_GOOD; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_push(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"ldr	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		"ldr	r8, [%[regs], #14*4]	\n\t" | 
					
						
							|  |  |  | 		"ldmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"blx	%[fn]			\n\t" | 
					
						
							|  |  |  | 		"str	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		: | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: [regs] "r" (regs), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | 		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", | 
					
						
							|  |  |  | 		  "lr", "memory", "cc" | 
					
						
							|  |  |  | 		); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t16_decode_push(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * To simulate a PUSH we use a Thumb-2 "STMDB R9!, {registers}" | 
					
						
							|  |  |  | 	 * and call it with R9=SP and LR in the register list represented | 
					
						
							|  |  |  | 	 * by R8. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2013-11-08 18:29:25 +00:00
										 |  |  | 	/* 1st half STMDB R9!,{} */ | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(0xe929); | 
					
						
							|  |  |  | 	/* 2nd half (register list) */ | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0x1ff); | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | 	asi->insn_handler = t16_emulate_push; | 
					
						
							|  |  |  | 	return INSN_GOOD; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_pop_nopc(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"ldr	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		"ldmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"blx	%[fn]			\n\t" | 
					
						
							|  |  |  | 		"stmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"str	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		: | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: [regs] "r" (regs), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | 		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r9", | 
					
						
							|  |  |  | 		  "lr", "memory", "cc" | 
					
						
							|  |  |  | 		); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | static void __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:17:23 -05:00
										 |  |  | t16_emulate_pop_pc(probes_opcode_t insn, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | 		struct arch_probes_insn *asi, struct pt_regs *regs) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	register unsigned long pc asm("r8"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	__asm__ __volatile__ ( | 
					
						
							|  |  |  | 		"ldr	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		"ldmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"blx	%[fn]			\n\t" | 
					
						
							|  |  |  | 		"stmia	%[regs], {r0-r7}	\n\t" | 
					
						
							|  |  |  | 		"str	r9, [%[regs], #13*4]	\n\t" | 
					
						
							|  |  |  | 		: "=r" (pc) | 
					
						
							| 
									
										
										
										
											2014-03-07 11:19:32 -05:00
										 |  |  | 		: [regs] "r" (regs), [fn] "r" (asi->insn_fn) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | 		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r9", | 
					
						
							|  |  |  | 		  "lr", "memory", "cc" | 
					
						
							|  |  |  | 		); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	bx_write_pc(pc, regs); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-03-05 21:23:42 -05:00
										 |  |  | static enum probes_insn __kprobes | 
					
						
							| 
									
										
										
										
											2014-03-05 21:41:29 -05:00
										 |  |  | t16_decode_pop(probes_opcode_t insn, struct arch_probes_insn *asi, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 		const struct decode_header *d) | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | { | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * To simulate a POP we use a Thumb-2 "LDMDB R9!, {registers}" | 
					
						
							|  |  |  | 	 * and call it with R9=SP and PC in the register list represented | 
					
						
							|  |  |  | 	 * by R8. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2013-11-08 18:29:25 +00:00
										 |  |  | 	/* 1st half LDMIA R9!,{} */ | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(0xe8b9); | 
					
						
							|  |  |  | 	/* 2nd half (register list) */ | 
					
						
							|  |  |  | 	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0x1ff); | 
					
						
							| 
									
										
										
											
												ARM: kprobes: Decode 16-bit Thumb PUSH and POP instructions
These instructions are equivalent to
	stmdb sp!,{r0-r7,lr}
	ldmdb sp!,{r0-r7,pc}
and we emulate them by transforming them into the 32-bit Thumb
instructions
	stmdb r9!,{r0-r7,r8}
	ldmdb r9!,{r0-r7,r8}
This is simpler, and almost certainly executes faster, than writing
simulation functions.
Signed-off-by: Jon Medhurst <tixy@yxit.co.uk>
Acked-by: Nicolas Pitre <nicolas.pitre@linaro.org>
											
										 
											2011-07-02 16:13:29 +01:00
										 |  |  | 	asi->insn_handler = insn & 0x100 ? t16_emulate_pop_pc | 
					
						
							|  |  |  | 					 : t16_emulate_pop_nopc; | 
					
						
							|  |  |  | 	return INSN_GOOD; | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 
 | 
					
						
							|  |  |  | const union decode_action kprobes_t16_actions[NUM_PROBES_T16_ACTIONS] = { | 
					
						
							|  |  |  | 	[PROBES_T16_ADD_SP] = {.handler = t16_simulate_add_sp_imm}, | 
					
						
							|  |  |  | 	[PROBES_T16_CBZ] = {.handler = t16_simulate_cbz}, | 
					
						
							|  |  |  | 	[PROBES_T16_SIGN_EXTEND] = {.handler = t16_emulate_loregs_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_PUSH] = {.decoder = t16_decode_push}, | 
					
						
							|  |  |  | 	[PROBES_T16_POP] = {.decoder = t16_decode_pop}, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:20:25 -05:00
										 |  |  | 	[PROBES_T16_SEV] = {.handler = probes_emulate_none}, | 
					
						
							|  |  |  | 	[PROBES_T16_WFE] = {.handler = probes_simulate_nop}, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 	[PROBES_T16_IT] = {.decoder = t16_decode_it}, | 
					
						
							|  |  |  | 	[PROBES_T16_CMP] = {.handler = t16_emulate_loregs_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_ADDSUB] = {.handler = t16_emulate_loregs_noitrwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_LOGICAL] = {.handler = t16_emulate_loregs_noitrwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_LDR_LIT] = {.handler = t16_simulate_ldr_literal}, | 
					
						
							|  |  |  | 	[PROBES_T16_BLX] = {.handler = t16_simulate_bxblx}, | 
					
						
							|  |  |  | 	[PROBES_T16_HIREGOPS] = {.decoder = t16_decode_hiregs}, | 
					
						
							|  |  |  | 	[PROBES_T16_LDRHSTRH] = {.handler = t16_emulate_loregs_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_LDRSTR] = {.handler = t16_simulate_ldrstr_sp_relative}, | 
					
						
							|  |  |  | 	[PROBES_T16_ADR] = {.handler = t16_simulate_reladr}, | 
					
						
							|  |  |  | 	[PROBES_T16_LDMSTM] = {.handler = t16_emulate_loregs_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T16_BRANCH_COND] = {.decoder = t16_decode_cond_branch}, | 
					
						
							|  |  |  | 	[PROBES_T16_BRANCH] = {.handler = t16_simulate_branch}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | const union decode_action kprobes_t32_actions[NUM_PROBES_T32_ACTIONS] = { | 
					
						
							|  |  |  | 	[PROBES_T32_LDMSTM] = {.decoder = t32_decode_ldmstm}, | 
					
						
							|  |  |  | 	[PROBES_T32_LDRDSTRD] = {.handler = t32_emulate_ldrdstrd}, | 
					
						
							|  |  |  | 	[PROBES_T32_TABLE_BRANCH] = {.handler = t32_simulate_table_branch}, | 
					
						
							|  |  |  | 	[PROBES_T32_TST] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MOV] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_ADDSUB] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_LOGICAL] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_CMP] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_ADDWSUBW_PC] = {.handler = t32_emulate_rd8pc16_noflags,}, | 
					
						
							|  |  |  | 	[PROBES_T32_ADDWSUBW] = {.handler = t32_emulate_rd8rn16_noflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MOVW] = {.handler = t32_emulate_rd8rn16_noflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_SAT] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_BITFIELD] = {.handler = t32_emulate_rd8rn16_noflags}, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:20:25 -05:00
										 |  |  | 	[PROBES_T32_SEV] = {.handler = probes_emulate_none}, | 
					
						
							|  |  |  | 	[PROBES_T32_WFE] = {.handler = probes_simulate_nop}, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 	[PROBES_T32_MRS] = {.handler = t32_simulate_mrs}, | 
					
						
							|  |  |  | 	[PROBES_T32_BRANCH_COND] = {.decoder = t32_decode_cond_branch}, | 
					
						
							|  |  |  | 	[PROBES_T32_BRANCH] = {.handler = t32_simulate_branch}, | 
					
						
							| 
									
										
										
										
											2014-03-05 21:20:25 -05:00
										 |  |  | 	[PROBES_T32_PLDI] = {.handler = probes_simulate_nop}, | 
					
						
							| 
									
										
										
										
											2014-03-06 18:06:43 -05:00
										 |  |  | 	[PROBES_T32_LDR_LIT] = {.handler = t32_simulate_ldr_literal}, | 
					
						
							|  |  |  | 	[PROBES_T32_LDRSTR] = {.handler = t32_emulate_ldrstr}, | 
					
						
							|  |  |  | 	[PROBES_T32_SIGN_EXTEND] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MEDIA] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_REVERSE] = {.handler = t32_emulate_rd8rn16_noflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MUL_ADD] = {.handler = t32_emulate_rd8rn16rm0_rwflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MUL_ADD2] = {.handler = t32_emulate_rd8rn16rm0ra12_noflags}, | 
					
						
							|  |  |  | 	[PROBES_T32_MUL_ADD_LONG] = { | 
					
						
							|  |  |  | 		.handler = t32_emulate_rdlo12rdhi8rn16rm0_noflags}, | 
					
						
							|  |  |  | }; |