162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * arch/arm/probes/kprobes/actions-thumb.c
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2011 Jon Medhurst <tixy@yxit.co.uk>.
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/types.h>
962306a36Sopenharmony_ci#include <linux/kernel.h>
1062306a36Sopenharmony_ci#include <linux/ptrace.h>
1162306a36Sopenharmony_ci#include <linux/kprobes.h>
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include "../decode-thumb.h"
1462306a36Sopenharmony_ci#include "core.h"
1562306a36Sopenharmony_ci#include "checkers.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci/* These emulation encodings are functionally equivalent... */
1862306a36Sopenharmony_ci#define t32_emulate_rd8rn16rm0ra12_noflags \
1962306a36Sopenharmony_ci		t32_emulate_rdlo12rdhi8rn16rm0_noflags
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci/* t32 thumb actions */
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic void __kprobes
2462306a36Sopenharmony_cit32_simulate_table_branch(probes_opcode_t insn,
2562306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc;
2862306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
2962306a36Sopenharmony_ci	int rm = insn & 0xf;
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci	unsigned long rnv = (rn == 15) ? pc : regs->uregs[rn];
3262306a36Sopenharmony_ci	unsigned long rmv = regs->uregs[rm];
3362306a36Sopenharmony_ci	unsigned int halfwords;
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	if (insn & 0x10) /* TBH */
3662306a36Sopenharmony_ci		halfwords = ((u16 *)rnv)[rmv];
3762306a36Sopenharmony_ci	else /* TBB */
3862306a36Sopenharmony_ci		halfwords = ((u8 *)rnv)[rmv];
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ci	regs->ARM_pc = pc + 2 * halfwords;
4162306a36Sopenharmony_ci}
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic void __kprobes
4462306a36Sopenharmony_cit32_simulate_mrs(probes_opcode_t insn,
4562306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
4662306a36Sopenharmony_ci{
4762306a36Sopenharmony_ci	int rd = (insn >> 8) & 0xf;
4862306a36Sopenharmony_ci	unsigned long mask = 0xf8ff03df; /* Mask out execution state */
4962306a36Sopenharmony_ci	regs->uregs[rd] = regs->ARM_cpsr & mask;
5062306a36Sopenharmony_ci}
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_cistatic void __kprobes
5362306a36Sopenharmony_cit32_simulate_cond_branch(probes_opcode_t insn,
5462306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
5562306a36Sopenharmony_ci{
5662306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc;
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci	long offset = insn & 0x7ff;		/* imm11 */
5962306a36Sopenharmony_ci	offset += (insn & 0x003f0000) >> 5;	/* imm6 */
6062306a36Sopenharmony_ci	offset += (insn & 0x00002000) << 4;	/* J1 */
6162306a36Sopenharmony_ci	offset += (insn & 0x00000800) << 7;	/* J2 */
6262306a36Sopenharmony_ci	offset -= (insn & 0x04000000) >> 7;	/* Apply sign bit */
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	regs->ARM_pc = pc + (offset * 2);
6562306a36Sopenharmony_ci}
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_cistatic enum probes_insn __kprobes
6862306a36Sopenharmony_cit32_decode_cond_branch(probes_opcode_t insn, struct arch_probes_insn *asi,
6962306a36Sopenharmony_ci		const struct decode_header *d)
7062306a36Sopenharmony_ci{
7162306a36Sopenharmony_ci	int cc = (insn >> 22) & 0xf;
7262306a36Sopenharmony_ci	asi->insn_check_cc = probes_condition_checks[cc];
7362306a36Sopenharmony_ci	asi->insn_handler = t32_simulate_cond_branch;
7462306a36Sopenharmony_ci	return INSN_GOOD_NO_SLOT;
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_cistatic void __kprobes
7862306a36Sopenharmony_cit32_simulate_branch(probes_opcode_t insn,
7962306a36Sopenharmony_ci		    struct arch_probes_insn *asi, struct pt_regs *regs)
8062306a36Sopenharmony_ci{
8162306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	long offset = insn & 0x7ff;		/* imm11 */
8462306a36Sopenharmony_ci	offset += (insn & 0x03ff0000) >> 5;	/* imm10 */
8562306a36Sopenharmony_ci	offset += (insn & 0x00002000) << 9;	/* J1 */
8662306a36Sopenharmony_ci	offset += (insn & 0x00000800) << 10;	/* J2 */
8762306a36Sopenharmony_ci	if (insn & 0x04000000)
8862306a36Sopenharmony_ci		offset -= 0x00800000; /* Apply sign bit */
8962306a36Sopenharmony_ci	else
9062306a36Sopenharmony_ci		offset ^= 0x00600000; /* Invert J1 and J2 */
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci	if (insn & (1 << 14)) {
9362306a36Sopenharmony_ci		/* BL or BLX */
9462306a36Sopenharmony_ci		regs->ARM_lr = regs->ARM_pc | 1;
9562306a36Sopenharmony_ci		if (!(insn & (1 << 12))) {
9662306a36Sopenharmony_ci			/* BLX so switch to ARM mode */
9762306a36Sopenharmony_ci			regs->ARM_cpsr &= ~PSR_T_BIT;
9862306a36Sopenharmony_ci			pc &= ~3;
9962306a36Sopenharmony_ci		}
10062306a36Sopenharmony_ci	}
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_ci	regs->ARM_pc = pc + (offset * 2);
10362306a36Sopenharmony_ci}
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_cistatic void __kprobes
10662306a36Sopenharmony_cit32_simulate_ldr_literal(probes_opcode_t insn,
10762306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
10862306a36Sopenharmony_ci{
10962306a36Sopenharmony_ci	unsigned long addr = regs->ARM_pc & ~3;
11062306a36Sopenharmony_ci	int rt = (insn >> 12) & 0xf;
11162306a36Sopenharmony_ci	unsigned long rtv;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	long offset = insn & 0xfff;
11462306a36Sopenharmony_ci	if (insn & 0x00800000)
11562306a36Sopenharmony_ci		addr += offset;
11662306a36Sopenharmony_ci	else
11762306a36Sopenharmony_ci		addr -= offset;
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	if (insn & 0x00400000) {
12062306a36Sopenharmony_ci		/* LDR */
12162306a36Sopenharmony_ci		rtv = *(unsigned long *)addr;
12262306a36Sopenharmony_ci		if (rt == 15) {
12362306a36Sopenharmony_ci			bx_write_pc(rtv, regs);
12462306a36Sopenharmony_ci			return;
12562306a36Sopenharmony_ci		}
12662306a36Sopenharmony_ci	} else if (insn & 0x00200000) {
12762306a36Sopenharmony_ci		/* LDRH */
12862306a36Sopenharmony_ci		if (insn & 0x01000000)
12962306a36Sopenharmony_ci			rtv = *(s16 *)addr;
13062306a36Sopenharmony_ci		else
13162306a36Sopenharmony_ci			rtv = *(u16 *)addr;
13262306a36Sopenharmony_ci	} else {
13362306a36Sopenharmony_ci		/* LDRB */
13462306a36Sopenharmony_ci		if (insn & 0x01000000)
13562306a36Sopenharmony_ci			rtv = *(s8 *)addr;
13662306a36Sopenharmony_ci		else
13762306a36Sopenharmony_ci			rtv = *(u8 *)addr;
13862306a36Sopenharmony_ci	}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	regs->uregs[rt] = rtv;
14162306a36Sopenharmony_ci}
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_cistatic enum probes_insn __kprobes
14462306a36Sopenharmony_cit32_decode_ldmstm(probes_opcode_t insn, struct arch_probes_insn *asi,
14562306a36Sopenharmony_ci		const struct decode_header *d)
14662306a36Sopenharmony_ci{
14762306a36Sopenharmony_ci	enum probes_insn ret = kprobe_decode_ldmstm(insn, asi, d);
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci	/* Fixup modified instruction to have halfwords in correct order...*/
15062306a36Sopenharmony_ci	insn = __mem_to_opcode_arm(asi->insn[0]);
15162306a36Sopenharmony_ci	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(insn >> 16);
15262306a36Sopenharmony_ci	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0xffff);
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci	return ret;
15562306a36Sopenharmony_ci}
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_cistatic void __kprobes
15862306a36Sopenharmony_cit32_emulate_ldrdstrd(probes_opcode_t insn,
15962306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
16062306a36Sopenharmony_ci{
16162306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc & ~3;
16262306a36Sopenharmony_ci	int rt1 = (insn >> 12) & 0xf;
16362306a36Sopenharmony_ci	int rt2 = (insn >> 8) & 0xf;
16462306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	register unsigned long rt1v asm("r0") = regs->uregs[rt1];
16762306a36Sopenharmony_ci	register unsigned long rt2v asm("r1") = regs->uregs[rt2];
16862306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = (rn == 15) ? pc
16962306a36Sopenharmony_ci							  : regs->uregs[rn];
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	__asm__ __volatile__ (
17262306a36Sopenharmony_ci		"blx    %[fn]"
17362306a36Sopenharmony_ci		: "=r" (rt1v), "=r" (rt2v), "=r" (rnv)
17462306a36Sopenharmony_ci		: "0" (rt1v), "1" (rt2v), "2" (rnv), [fn] "r" (asi->insn_fn)
17562306a36Sopenharmony_ci		: "lr", "memory", "cc"
17662306a36Sopenharmony_ci	);
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	if (rn != 15)
17962306a36Sopenharmony_ci		regs->uregs[rn] = rnv; /* Writeback base register */
18062306a36Sopenharmony_ci	regs->uregs[rt1] = rt1v;
18162306a36Sopenharmony_ci	regs->uregs[rt2] = rt2v;
18262306a36Sopenharmony_ci}
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_cistatic void __kprobes
18562306a36Sopenharmony_cit32_emulate_ldrstr(probes_opcode_t insn,
18662306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
18762306a36Sopenharmony_ci{
18862306a36Sopenharmony_ci	int rt = (insn >> 12) & 0xf;
18962306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
19062306a36Sopenharmony_ci	int rm = insn & 0xf;
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	register unsigned long rtv asm("r0") = regs->uregs[rt];
19362306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = regs->uregs[rn];
19462306a36Sopenharmony_ci	register unsigned long rmv asm("r3") = regs->uregs[rm];
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	__asm__ __volatile__ (
19762306a36Sopenharmony_ci		"blx    %[fn]"
19862306a36Sopenharmony_ci		: "=r" (rtv), "=r" (rnv)
19962306a36Sopenharmony_ci		: "0" (rtv), "1" (rnv), "r" (rmv), [fn] "r" (asi->insn_fn)
20062306a36Sopenharmony_ci		: "lr", "memory", "cc"
20162306a36Sopenharmony_ci	);
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	regs->uregs[rn] = rnv; /* Writeback base register */
20462306a36Sopenharmony_ci	if (rt == 15) /* Can't be true for a STR as they aren't allowed */
20562306a36Sopenharmony_ci		bx_write_pc(rtv, regs);
20662306a36Sopenharmony_ci	else
20762306a36Sopenharmony_ci		regs->uregs[rt] = rtv;
20862306a36Sopenharmony_ci}
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_cistatic void __kprobes
21162306a36Sopenharmony_cit32_emulate_rd8rn16rm0_rwflags(probes_opcode_t insn,
21262306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
21362306a36Sopenharmony_ci{
21462306a36Sopenharmony_ci	int rd = (insn >> 8) & 0xf;
21562306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
21662306a36Sopenharmony_ci	int rm = insn & 0xf;
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_ci	register unsigned long rdv asm("r1") = regs->uregs[rd];
21962306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = regs->uregs[rn];
22062306a36Sopenharmony_ci	register unsigned long rmv asm("r3") = regs->uregs[rm];
22162306a36Sopenharmony_ci	unsigned long cpsr = regs->ARM_cpsr;
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	__asm__ __volatile__ (
22462306a36Sopenharmony_ci		"msr	cpsr_fs, %[cpsr]	\n\t"
22562306a36Sopenharmony_ci		"blx    %[fn]			\n\t"
22662306a36Sopenharmony_ci		"mrs	%[cpsr], cpsr		\n\t"
22762306a36Sopenharmony_ci		: "=r" (rdv), [cpsr] "=r" (cpsr)
22862306a36Sopenharmony_ci		: "0" (rdv), "r" (rnv), "r" (rmv),
22962306a36Sopenharmony_ci		  "1" (cpsr), [fn] "r" (asi->insn_fn)
23062306a36Sopenharmony_ci		: "lr", "memory", "cc"
23162306a36Sopenharmony_ci	);
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci	regs->uregs[rd] = rdv;
23462306a36Sopenharmony_ci	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
23562306a36Sopenharmony_ci}
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_cistatic void __kprobes
23862306a36Sopenharmony_cit32_emulate_rd8pc16_noflags(probes_opcode_t insn,
23962306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
24062306a36Sopenharmony_ci{
24162306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc;
24262306a36Sopenharmony_ci	int rd = (insn >> 8) & 0xf;
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	register unsigned long rdv asm("r1") = regs->uregs[rd];
24562306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = pc & ~3;
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	__asm__ __volatile__ (
24862306a36Sopenharmony_ci		"blx    %[fn]"
24962306a36Sopenharmony_ci		: "=r" (rdv)
25062306a36Sopenharmony_ci		: "0" (rdv), "r" (rnv), [fn] "r" (asi->insn_fn)
25162306a36Sopenharmony_ci		: "lr", "memory", "cc"
25262306a36Sopenharmony_ci	);
25362306a36Sopenharmony_ci
25462306a36Sopenharmony_ci	regs->uregs[rd] = rdv;
25562306a36Sopenharmony_ci}
25662306a36Sopenharmony_ci
25762306a36Sopenharmony_cistatic void __kprobes
25862306a36Sopenharmony_cit32_emulate_rd8rn16_noflags(probes_opcode_t insn,
25962306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
26062306a36Sopenharmony_ci{
26162306a36Sopenharmony_ci	int rd = (insn >> 8) & 0xf;
26262306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	register unsigned long rdv asm("r1") = regs->uregs[rd];
26562306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = regs->uregs[rn];
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	__asm__ __volatile__ (
26862306a36Sopenharmony_ci		"blx    %[fn]"
26962306a36Sopenharmony_ci		: "=r" (rdv)
27062306a36Sopenharmony_ci		: "0" (rdv), "r" (rnv), [fn] "r" (asi->insn_fn)
27162306a36Sopenharmony_ci		: "lr", "memory", "cc"
27262306a36Sopenharmony_ci	);
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci	regs->uregs[rd] = rdv;
27562306a36Sopenharmony_ci}
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_cistatic void __kprobes
27862306a36Sopenharmony_cit32_emulate_rdlo12rdhi8rn16rm0_noflags(probes_opcode_t insn,
27962306a36Sopenharmony_ci		struct arch_probes_insn *asi,
28062306a36Sopenharmony_ci		struct pt_regs *regs)
28162306a36Sopenharmony_ci{
28262306a36Sopenharmony_ci	int rdlo = (insn >> 12) & 0xf;
28362306a36Sopenharmony_ci	int rdhi = (insn >> 8) & 0xf;
28462306a36Sopenharmony_ci	int rn = (insn >> 16) & 0xf;
28562306a36Sopenharmony_ci	int rm = insn & 0xf;
28662306a36Sopenharmony_ci
28762306a36Sopenharmony_ci	register unsigned long rdlov asm("r0") = regs->uregs[rdlo];
28862306a36Sopenharmony_ci	register unsigned long rdhiv asm("r1") = regs->uregs[rdhi];
28962306a36Sopenharmony_ci	register unsigned long rnv asm("r2") = regs->uregs[rn];
29062306a36Sopenharmony_ci	register unsigned long rmv asm("r3") = regs->uregs[rm];
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_ci	__asm__ __volatile__ (
29362306a36Sopenharmony_ci		"blx    %[fn]"
29462306a36Sopenharmony_ci		: "=r" (rdlov), "=r" (rdhiv)
29562306a36Sopenharmony_ci		: "0" (rdlov), "1" (rdhiv), "r" (rnv), "r" (rmv),
29662306a36Sopenharmony_ci		  [fn] "r" (asi->insn_fn)
29762306a36Sopenharmony_ci		: "lr", "memory", "cc"
29862306a36Sopenharmony_ci	);
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	regs->uregs[rdlo] = rdlov;
30162306a36Sopenharmony_ci	regs->uregs[rdhi] = rdhiv;
30262306a36Sopenharmony_ci}
30362306a36Sopenharmony_ci/* t16 thumb actions */
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_cistatic void __kprobes
30662306a36Sopenharmony_cit16_simulate_bxblx(probes_opcode_t insn,
30762306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
30862306a36Sopenharmony_ci{
30962306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc + 2;
31062306a36Sopenharmony_ci	int rm = (insn >> 3) & 0xf;
31162306a36Sopenharmony_ci	unsigned long rmv = (rm == 15) ? pc : regs->uregs[rm];
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ci	if (insn & (1 << 7)) /* BLX ? */
31462306a36Sopenharmony_ci		regs->ARM_lr = regs->ARM_pc | 1;
31562306a36Sopenharmony_ci
31662306a36Sopenharmony_ci	bx_write_pc(rmv, regs);
31762306a36Sopenharmony_ci}
31862306a36Sopenharmony_ci
31962306a36Sopenharmony_cistatic void __kprobes
32062306a36Sopenharmony_cit16_simulate_ldr_literal(probes_opcode_t insn,
32162306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
32262306a36Sopenharmony_ci{
32362306a36Sopenharmony_ci	unsigned long *base = (unsigned long *)((regs->ARM_pc + 2) & ~3);
32462306a36Sopenharmony_ci	long index = insn & 0xff;
32562306a36Sopenharmony_ci	int rt = (insn >> 8) & 0x7;
32662306a36Sopenharmony_ci	regs->uregs[rt] = base[index];
32762306a36Sopenharmony_ci}
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_cistatic void __kprobes
33062306a36Sopenharmony_cit16_simulate_ldrstr_sp_relative(probes_opcode_t insn,
33162306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
33262306a36Sopenharmony_ci{
33362306a36Sopenharmony_ci	unsigned long* base = (unsigned long *)regs->ARM_sp;
33462306a36Sopenharmony_ci	long index = insn & 0xff;
33562306a36Sopenharmony_ci	int rt = (insn >> 8) & 0x7;
33662306a36Sopenharmony_ci	if (insn & 0x800) /* LDR */
33762306a36Sopenharmony_ci		regs->uregs[rt] = base[index];
33862306a36Sopenharmony_ci	else /* STR */
33962306a36Sopenharmony_ci		base[index] = regs->uregs[rt];
34062306a36Sopenharmony_ci}
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_cistatic void __kprobes
34362306a36Sopenharmony_cit16_simulate_reladr(probes_opcode_t insn,
34462306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
34562306a36Sopenharmony_ci{
34662306a36Sopenharmony_ci	unsigned long base = (insn & 0x800) ? regs->ARM_sp
34762306a36Sopenharmony_ci					    : ((regs->ARM_pc + 2) & ~3);
34862306a36Sopenharmony_ci	long offset = insn & 0xff;
34962306a36Sopenharmony_ci	int rt = (insn >> 8) & 0x7;
35062306a36Sopenharmony_ci	regs->uregs[rt] = base + offset * 4;
35162306a36Sopenharmony_ci}
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_cistatic void __kprobes
35462306a36Sopenharmony_cit16_simulate_add_sp_imm(probes_opcode_t insn,
35562306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
35662306a36Sopenharmony_ci{
35762306a36Sopenharmony_ci	long imm = insn & 0x7f;
35862306a36Sopenharmony_ci	if (insn & 0x80) /* SUB */
35962306a36Sopenharmony_ci		regs->ARM_sp -= imm * 4;
36062306a36Sopenharmony_ci	else /* ADD */
36162306a36Sopenharmony_ci		regs->ARM_sp += imm * 4;
36262306a36Sopenharmony_ci}
36362306a36Sopenharmony_ci
36462306a36Sopenharmony_cistatic void __kprobes
36562306a36Sopenharmony_cit16_simulate_cbz(probes_opcode_t insn,
36662306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
36762306a36Sopenharmony_ci{
36862306a36Sopenharmony_ci	int rn = insn & 0x7;
36962306a36Sopenharmony_ci	probes_opcode_t nonzero = regs->uregs[rn] ? insn : ~insn;
37062306a36Sopenharmony_ci	if (nonzero & 0x800) {
37162306a36Sopenharmony_ci		long i = insn & 0x200;
37262306a36Sopenharmony_ci		long imm5 = insn & 0xf8;
37362306a36Sopenharmony_ci		unsigned long pc = regs->ARM_pc + 2;
37462306a36Sopenharmony_ci		regs->ARM_pc = pc + (i >> 3) + (imm5 >> 2);
37562306a36Sopenharmony_ci	}
37662306a36Sopenharmony_ci}
37762306a36Sopenharmony_ci
37862306a36Sopenharmony_cistatic void __kprobes
37962306a36Sopenharmony_cit16_simulate_it(probes_opcode_t insn,
38062306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
38162306a36Sopenharmony_ci{
38262306a36Sopenharmony_ci	/*
38362306a36Sopenharmony_ci	 * The 8 IT state bits are split into two parts in CPSR:
38462306a36Sopenharmony_ci	 *	ITSTATE<1:0> are in CPSR<26:25>
38562306a36Sopenharmony_ci	 *	ITSTATE<7:2> are in CPSR<15:10>
38662306a36Sopenharmony_ci	 * The new IT state is in the lower byte of insn.
38762306a36Sopenharmony_ci	 */
38862306a36Sopenharmony_ci	unsigned long cpsr = regs->ARM_cpsr;
38962306a36Sopenharmony_ci	cpsr &= ~PSR_IT_MASK;
39062306a36Sopenharmony_ci	cpsr |= (insn & 0xfc) << 8;
39162306a36Sopenharmony_ci	cpsr |= (insn & 0x03) << 25;
39262306a36Sopenharmony_ci	regs->ARM_cpsr = cpsr;
39362306a36Sopenharmony_ci}
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_cistatic void __kprobes
39662306a36Sopenharmony_cit16_singlestep_it(probes_opcode_t insn,
39762306a36Sopenharmony_ci		  struct arch_probes_insn *asi, struct pt_regs *regs)
39862306a36Sopenharmony_ci{
39962306a36Sopenharmony_ci	regs->ARM_pc += 2;
40062306a36Sopenharmony_ci	t16_simulate_it(insn, asi, regs);
40162306a36Sopenharmony_ci}
40262306a36Sopenharmony_ci
40362306a36Sopenharmony_cistatic enum probes_insn __kprobes
40462306a36Sopenharmony_cit16_decode_it(probes_opcode_t insn, struct arch_probes_insn *asi,
40562306a36Sopenharmony_ci		const struct decode_header *d)
40662306a36Sopenharmony_ci{
40762306a36Sopenharmony_ci	asi->insn_singlestep = t16_singlestep_it;
40862306a36Sopenharmony_ci	return INSN_GOOD_NO_SLOT;
40962306a36Sopenharmony_ci}
41062306a36Sopenharmony_ci
41162306a36Sopenharmony_cistatic void __kprobes
41262306a36Sopenharmony_cit16_simulate_cond_branch(probes_opcode_t insn,
41362306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
41462306a36Sopenharmony_ci{
41562306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc + 2;
41662306a36Sopenharmony_ci	long offset = insn & 0x7f;
41762306a36Sopenharmony_ci	offset -= insn & 0x80; /* Apply sign bit */
41862306a36Sopenharmony_ci	regs->ARM_pc = pc + (offset * 2);
41962306a36Sopenharmony_ci}
42062306a36Sopenharmony_ci
42162306a36Sopenharmony_cistatic enum probes_insn __kprobes
42262306a36Sopenharmony_cit16_decode_cond_branch(probes_opcode_t insn, struct arch_probes_insn *asi,
42362306a36Sopenharmony_ci		const struct decode_header *d)
42462306a36Sopenharmony_ci{
42562306a36Sopenharmony_ci	int cc = (insn >> 8) & 0xf;
42662306a36Sopenharmony_ci	asi->insn_check_cc = probes_condition_checks[cc];
42762306a36Sopenharmony_ci	asi->insn_handler = t16_simulate_cond_branch;
42862306a36Sopenharmony_ci	return INSN_GOOD_NO_SLOT;
42962306a36Sopenharmony_ci}
43062306a36Sopenharmony_ci
43162306a36Sopenharmony_cistatic void __kprobes
43262306a36Sopenharmony_cit16_simulate_branch(probes_opcode_t insn,
43362306a36Sopenharmony_ci		   struct arch_probes_insn *asi, struct pt_regs *regs)
43462306a36Sopenharmony_ci{
43562306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc + 2;
43662306a36Sopenharmony_ci	long offset = insn & 0x3ff;
43762306a36Sopenharmony_ci	offset -= insn & 0x400; /* Apply sign bit */
43862306a36Sopenharmony_ci	regs->ARM_pc = pc + (offset * 2);
43962306a36Sopenharmony_ci}
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_cistatic unsigned long __kprobes
44262306a36Sopenharmony_cit16_emulate_loregs(probes_opcode_t insn,
44362306a36Sopenharmony_ci		   struct arch_probes_insn *asi, struct pt_regs *regs)
44462306a36Sopenharmony_ci{
44562306a36Sopenharmony_ci	unsigned long oldcpsr = regs->ARM_cpsr;
44662306a36Sopenharmony_ci	unsigned long newcpsr;
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_ci	__asm__ __volatile__ (
44962306a36Sopenharmony_ci		"msr	cpsr_fs, %[oldcpsr]	\n\t"
45062306a36Sopenharmony_ci		"mov	r11, r7			\n\t"
45162306a36Sopenharmony_ci		"ldmia	%[regs], {r0-r7}	\n\t"
45262306a36Sopenharmony_ci		"blx	%[fn]			\n\t"
45362306a36Sopenharmony_ci		"stmia	%[regs], {r0-r7}	\n\t"
45462306a36Sopenharmony_ci		"mov	r7, r11			\n\t"
45562306a36Sopenharmony_ci		"mrs	%[newcpsr], cpsr	\n\t"
45662306a36Sopenharmony_ci		: [newcpsr] "=r" (newcpsr)
45762306a36Sopenharmony_ci		: [oldcpsr] "r" (oldcpsr), [regs] "r" (regs),
45862306a36Sopenharmony_ci		  [fn] "r" (asi->insn_fn)
45962306a36Sopenharmony_ci		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r11",
46062306a36Sopenharmony_ci		  "lr", "memory", "cc"
46162306a36Sopenharmony_ci		);
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci	return (oldcpsr & ~APSR_MASK) | (newcpsr & APSR_MASK);
46462306a36Sopenharmony_ci}
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_cistatic void __kprobes
46762306a36Sopenharmony_cit16_emulate_loregs_rwflags(probes_opcode_t insn,
46862306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
46962306a36Sopenharmony_ci{
47062306a36Sopenharmony_ci	regs->ARM_cpsr = t16_emulate_loregs(insn, asi, regs);
47162306a36Sopenharmony_ci}
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_cistatic void __kprobes
47462306a36Sopenharmony_cit16_emulate_loregs_noitrwflags(probes_opcode_t insn,
47562306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
47662306a36Sopenharmony_ci{
47762306a36Sopenharmony_ci	unsigned long cpsr = t16_emulate_loregs(insn, asi, regs);
47862306a36Sopenharmony_ci	if (!in_it_block(cpsr))
47962306a36Sopenharmony_ci		regs->ARM_cpsr = cpsr;
48062306a36Sopenharmony_ci}
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_cistatic void __kprobes
48362306a36Sopenharmony_cit16_emulate_hiregs(probes_opcode_t insn,
48462306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
48562306a36Sopenharmony_ci{
48662306a36Sopenharmony_ci	unsigned long pc = regs->ARM_pc + 2;
48762306a36Sopenharmony_ci	int rdn = (insn & 0x7) | ((insn & 0x80) >> 4);
48862306a36Sopenharmony_ci	int rm = (insn >> 3) & 0xf;
48962306a36Sopenharmony_ci
49062306a36Sopenharmony_ci	register unsigned long rdnv asm("r1");
49162306a36Sopenharmony_ci	register unsigned long rmv asm("r0");
49262306a36Sopenharmony_ci	unsigned long cpsr = regs->ARM_cpsr;
49362306a36Sopenharmony_ci
49462306a36Sopenharmony_ci	rdnv = (rdn == 15) ? pc : regs->uregs[rdn];
49562306a36Sopenharmony_ci	rmv = (rm == 15) ? pc : regs->uregs[rm];
49662306a36Sopenharmony_ci
49762306a36Sopenharmony_ci	__asm__ __volatile__ (
49862306a36Sopenharmony_ci		"msr	cpsr_fs, %[cpsr]	\n\t"
49962306a36Sopenharmony_ci		"blx    %[fn]			\n\t"
50062306a36Sopenharmony_ci		"mrs	%[cpsr], cpsr		\n\t"
50162306a36Sopenharmony_ci		: "=r" (rdnv), [cpsr] "=r" (cpsr)
50262306a36Sopenharmony_ci		: "0" (rdnv), "r" (rmv), "1" (cpsr), [fn] "r" (asi->insn_fn)
50362306a36Sopenharmony_ci		: "lr", "memory", "cc"
50462306a36Sopenharmony_ci	);
50562306a36Sopenharmony_ci
50662306a36Sopenharmony_ci	if (rdn == 15)
50762306a36Sopenharmony_ci		rdnv &= ~1;
50862306a36Sopenharmony_ci
50962306a36Sopenharmony_ci	regs->uregs[rdn] = rdnv;
51062306a36Sopenharmony_ci	regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
51162306a36Sopenharmony_ci}
51262306a36Sopenharmony_ci
51362306a36Sopenharmony_cistatic enum probes_insn __kprobes
51462306a36Sopenharmony_cit16_decode_hiregs(probes_opcode_t insn, struct arch_probes_insn *asi,
51562306a36Sopenharmony_ci		const struct decode_header *d)
51662306a36Sopenharmony_ci{
51762306a36Sopenharmony_ci	insn &= ~0x00ff;
51862306a36Sopenharmony_ci	insn |= 0x001; /* Set Rdn = R1 and Rm = R0 */
51962306a36Sopenharmony_ci	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(insn);
52062306a36Sopenharmony_ci	asi->insn_handler = t16_emulate_hiregs;
52162306a36Sopenharmony_ci	return INSN_GOOD;
52262306a36Sopenharmony_ci}
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_cistatic void __kprobes
52562306a36Sopenharmony_cit16_emulate_push(probes_opcode_t insn,
52662306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
52762306a36Sopenharmony_ci{
52862306a36Sopenharmony_ci	__asm__ __volatile__ (
52962306a36Sopenharmony_ci		"mov	r11, r7			\n\t"
53062306a36Sopenharmony_ci		"ldr	r9, [%[regs], #13*4]	\n\t"
53162306a36Sopenharmony_ci		"ldr	r8, [%[regs], #14*4]	\n\t"
53262306a36Sopenharmony_ci		"ldmia	%[regs], {r0-r7}	\n\t"
53362306a36Sopenharmony_ci		"blx	%[fn]			\n\t"
53462306a36Sopenharmony_ci		"str	r9, [%[regs], #13*4]	\n\t"
53562306a36Sopenharmony_ci		"mov	r7, r11			\n\t"
53662306a36Sopenharmony_ci		:
53762306a36Sopenharmony_ci		: [regs] "r" (regs), [fn] "r" (asi->insn_fn)
53862306a36Sopenharmony_ci		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r8", "r9", "r11",
53962306a36Sopenharmony_ci		  "lr", "memory", "cc"
54062306a36Sopenharmony_ci		);
54162306a36Sopenharmony_ci}
54262306a36Sopenharmony_ci
54362306a36Sopenharmony_cistatic enum probes_insn __kprobes
54462306a36Sopenharmony_cit16_decode_push(probes_opcode_t insn, struct arch_probes_insn *asi,
54562306a36Sopenharmony_ci		const struct decode_header *d)
54662306a36Sopenharmony_ci{
54762306a36Sopenharmony_ci	/*
54862306a36Sopenharmony_ci	 * To simulate a PUSH we use a Thumb-2 "STMDB R9!, {registers}"
54962306a36Sopenharmony_ci	 * and call it with R9=SP and LR in the register list represented
55062306a36Sopenharmony_ci	 * by R8.
55162306a36Sopenharmony_ci	 */
55262306a36Sopenharmony_ci	/* 1st half STMDB R9!,{} */
55362306a36Sopenharmony_ci	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(0xe929);
55462306a36Sopenharmony_ci	/* 2nd half (register list) */
55562306a36Sopenharmony_ci	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0x1ff);
55662306a36Sopenharmony_ci	asi->insn_handler = t16_emulate_push;
55762306a36Sopenharmony_ci	return INSN_GOOD;
55862306a36Sopenharmony_ci}
55962306a36Sopenharmony_ci
56062306a36Sopenharmony_cistatic void __kprobes
56162306a36Sopenharmony_cit16_emulate_pop_nopc(probes_opcode_t insn,
56262306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
56362306a36Sopenharmony_ci{
56462306a36Sopenharmony_ci	__asm__ __volatile__ (
56562306a36Sopenharmony_ci		"mov	r11, r7			\n\t"
56662306a36Sopenharmony_ci		"ldr	r9, [%[regs], #13*4]	\n\t"
56762306a36Sopenharmony_ci		"ldmia	%[regs], {r0-r7}	\n\t"
56862306a36Sopenharmony_ci		"blx	%[fn]			\n\t"
56962306a36Sopenharmony_ci		"stmia	%[regs], {r0-r7}	\n\t"
57062306a36Sopenharmony_ci		"str	r9, [%[regs], #13*4]	\n\t"
57162306a36Sopenharmony_ci		"mov	r7, r11			\n\t"
57262306a36Sopenharmony_ci		:
57362306a36Sopenharmony_ci		: [regs] "r" (regs), [fn] "r" (asi->insn_fn)
57462306a36Sopenharmony_ci		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r9", "r11",
57562306a36Sopenharmony_ci		  "lr", "memory", "cc"
57662306a36Sopenharmony_ci		);
57762306a36Sopenharmony_ci}
57862306a36Sopenharmony_ci
57962306a36Sopenharmony_cistatic void __kprobes
58062306a36Sopenharmony_cit16_emulate_pop_pc(probes_opcode_t insn,
58162306a36Sopenharmony_ci		struct arch_probes_insn *asi, struct pt_regs *regs)
58262306a36Sopenharmony_ci{
58362306a36Sopenharmony_ci	register unsigned long pc asm("r8");
58462306a36Sopenharmony_ci
58562306a36Sopenharmony_ci	__asm__ __volatile__ (
58662306a36Sopenharmony_ci		"mov	r11, r7			\n\t"
58762306a36Sopenharmony_ci		"ldr	r9, [%[regs], #13*4]	\n\t"
58862306a36Sopenharmony_ci		"ldmia	%[regs], {r0-r7}	\n\t"
58962306a36Sopenharmony_ci		"blx	%[fn]			\n\t"
59062306a36Sopenharmony_ci		"stmia	%[regs], {r0-r7}	\n\t"
59162306a36Sopenharmony_ci		"str	r9, [%[regs], #13*4]	\n\t"
59262306a36Sopenharmony_ci		"mov	r7, r11			\n\t"
59362306a36Sopenharmony_ci		: "=r" (pc)
59462306a36Sopenharmony_ci		: [regs] "r" (regs), [fn] "r" (asi->insn_fn)
59562306a36Sopenharmony_ci		: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r9", "r11",
59662306a36Sopenharmony_ci		  "lr", "memory", "cc"
59762306a36Sopenharmony_ci		);
59862306a36Sopenharmony_ci
59962306a36Sopenharmony_ci	bx_write_pc(pc, regs);
60062306a36Sopenharmony_ci}
60162306a36Sopenharmony_ci
60262306a36Sopenharmony_cistatic enum probes_insn __kprobes
60362306a36Sopenharmony_cit16_decode_pop(probes_opcode_t insn, struct arch_probes_insn *asi,
60462306a36Sopenharmony_ci		const struct decode_header *d)
60562306a36Sopenharmony_ci{
60662306a36Sopenharmony_ci	/*
60762306a36Sopenharmony_ci	 * To simulate a POP we use a Thumb-2 "LDMDB R9!, {registers}"
60862306a36Sopenharmony_ci	 * and call it with R9=SP and PC in the register list represented
60962306a36Sopenharmony_ci	 * by R8.
61062306a36Sopenharmony_ci	 */
61162306a36Sopenharmony_ci	/* 1st half LDMIA R9!,{} */
61262306a36Sopenharmony_ci	((u16 *)asi->insn)[0] = __opcode_to_mem_thumb16(0xe8b9);
61362306a36Sopenharmony_ci	/* 2nd half (register list) */
61462306a36Sopenharmony_ci	((u16 *)asi->insn)[1] = __opcode_to_mem_thumb16(insn & 0x1ff);
61562306a36Sopenharmony_ci	asi->insn_handler = insn & 0x100 ? t16_emulate_pop_pc
61662306a36Sopenharmony_ci					 : t16_emulate_pop_nopc;
61762306a36Sopenharmony_ci	return INSN_GOOD;
61862306a36Sopenharmony_ci}
61962306a36Sopenharmony_ci
62062306a36Sopenharmony_ciconst union decode_action kprobes_t16_actions[NUM_PROBES_T16_ACTIONS] = {
62162306a36Sopenharmony_ci	[PROBES_T16_ADD_SP] = {.handler = t16_simulate_add_sp_imm},
62262306a36Sopenharmony_ci	[PROBES_T16_CBZ] = {.handler = t16_simulate_cbz},
62362306a36Sopenharmony_ci	[PROBES_T16_SIGN_EXTEND] = {.handler = t16_emulate_loregs_rwflags},
62462306a36Sopenharmony_ci	[PROBES_T16_PUSH] = {.decoder = t16_decode_push},
62562306a36Sopenharmony_ci	[PROBES_T16_POP] = {.decoder = t16_decode_pop},
62662306a36Sopenharmony_ci	[PROBES_T16_SEV] = {.handler = probes_emulate_none},
62762306a36Sopenharmony_ci	[PROBES_T16_WFE] = {.handler = probes_simulate_nop},
62862306a36Sopenharmony_ci	[PROBES_T16_IT] = {.decoder = t16_decode_it},
62962306a36Sopenharmony_ci	[PROBES_T16_CMP] = {.handler = t16_emulate_loregs_rwflags},
63062306a36Sopenharmony_ci	[PROBES_T16_ADDSUB] = {.handler = t16_emulate_loregs_noitrwflags},
63162306a36Sopenharmony_ci	[PROBES_T16_LOGICAL] = {.handler = t16_emulate_loregs_noitrwflags},
63262306a36Sopenharmony_ci	[PROBES_T16_LDR_LIT] = {.handler = t16_simulate_ldr_literal},
63362306a36Sopenharmony_ci	[PROBES_T16_BLX] = {.handler = t16_simulate_bxblx},
63462306a36Sopenharmony_ci	[PROBES_T16_HIREGOPS] = {.decoder = t16_decode_hiregs},
63562306a36Sopenharmony_ci	[PROBES_T16_LDRHSTRH] = {.handler = t16_emulate_loregs_rwflags},
63662306a36Sopenharmony_ci	[PROBES_T16_LDRSTR] = {.handler = t16_simulate_ldrstr_sp_relative},
63762306a36Sopenharmony_ci	[PROBES_T16_ADR] = {.handler = t16_simulate_reladr},
63862306a36Sopenharmony_ci	[PROBES_T16_LDMSTM] = {.handler = t16_emulate_loregs_rwflags},
63962306a36Sopenharmony_ci	[PROBES_T16_BRANCH_COND] = {.decoder = t16_decode_cond_branch},
64062306a36Sopenharmony_ci	[PROBES_T16_BRANCH] = {.handler = t16_simulate_branch},
64162306a36Sopenharmony_ci};
64262306a36Sopenharmony_ci
64362306a36Sopenharmony_ciconst union decode_action kprobes_t32_actions[NUM_PROBES_T32_ACTIONS] = {
64462306a36Sopenharmony_ci	[PROBES_T32_LDMSTM] = {.decoder = t32_decode_ldmstm},
64562306a36Sopenharmony_ci	[PROBES_T32_LDRDSTRD] = {.handler = t32_emulate_ldrdstrd},
64662306a36Sopenharmony_ci	[PROBES_T32_TABLE_BRANCH] = {.handler = t32_simulate_table_branch},
64762306a36Sopenharmony_ci	[PROBES_T32_TST] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
64862306a36Sopenharmony_ci	[PROBES_T32_MOV] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
64962306a36Sopenharmony_ci	[PROBES_T32_ADDSUB] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
65062306a36Sopenharmony_ci	[PROBES_T32_LOGICAL] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
65162306a36Sopenharmony_ci	[PROBES_T32_CMP] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
65262306a36Sopenharmony_ci	[PROBES_T32_ADDWSUBW_PC] = {.handler = t32_emulate_rd8pc16_noflags,},
65362306a36Sopenharmony_ci	[PROBES_T32_ADDWSUBW] = {.handler = t32_emulate_rd8rn16_noflags},
65462306a36Sopenharmony_ci	[PROBES_T32_MOVW] = {.handler = t32_emulate_rd8rn16_noflags},
65562306a36Sopenharmony_ci	[PROBES_T32_SAT] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
65662306a36Sopenharmony_ci	[PROBES_T32_BITFIELD] = {.handler = t32_emulate_rd8rn16_noflags},
65762306a36Sopenharmony_ci	[PROBES_T32_SEV] = {.handler = probes_emulate_none},
65862306a36Sopenharmony_ci	[PROBES_T32_WFE] = {.handler = probes_simulate_nop},
65962306a36Sopenharmony_ci	[PROBES_T32_MRS] = {.handler = t32_simulate_mrs},
66062306a36Sopenharmony_ci	[PROBES_T32_BRANCH_COND] = {.decoder = t32_decode_cond_branch},
66162306a36Sopenharmony_ci	[PROBES_T32_BRANCH] = {.handler = t32_simulate_branch},
66262306a36Sopenharmony_ci	[PROBES_T32_PLDI] = {.handler = probes_simulate_nop},
66362306a36Sopenharmony_ci	[PROBES_T32_LDR_LIT] = {.handler = t32_simulate_ldr_literal},
66462306a36Sopenharmony_ci	[PROBES_T32_LDRSTR] = {.handler = t32_emulate_ldrstr},
66562306a36Sopenharmony_ci	[PROBES_T32_SIGN_EXTEND] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
66662306a36Sopenharmony_ci	[PROBES_T32_MEDIA] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
66762306a36Sopenharmony_ci	[PROBES_T32_REVERSE] = {.handler = t32_emulate_rd8rn16_noflags},
66862306a36Sopenharmony_ci	[PROBES_T32_MUL_ADD] = {.handler = t32_emulate_rd8rn16rm0_rwflags},
66962306a36Sopenharmony_ci	[PROBES_T32_MUL_ADD2] = {.handler = t32_emulate_rd8rn16rm0ra12_noflags},
67062306a36Sopenharmony_ci	[PROBES_T32_MUL_ADD_LONG] = {
67162306a36Sopenharmony_ci		.handler = t32_emulate_rdlo12rdhi8rn16rm0_noflags},
67262306a36Sopenharmony_ci};
67362306a36Sopenharmony_ci
67462306a36Sopenharmony_ciconst struct decode_checker *kprobes_t32_checkers[] = {t32_stack_checker, NULL};
67562306a36Sopenharmony_ciconst struct decode_checker *kprobes_t16_checkers[] = {t16_stack_checker, NULL};
676