blob: 70e540b7c53b7328fea67a5fae7f011c32122b54 [file] [log] [blame]
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001/*
2 * arch/arm/kernel/kprobes-decode.c
3 *
4 * Copyright (C) 2006, 2007 Motorola Inc.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 */
15
16/*
17 * We do not have hardware single-stepping on ARM, This
18 * effort is further complicated by the ARM not having a
19 * "next PC" register. Instructions that change the PC
20 * can't be safely single-stepped in a MP environment, so
21 * we have a lot of work to do:
22 *
23 * In the prepare phase:
24 * *) If it is an instruction that does anything
25 * with the CPU mode, we reject it for a kprobe.
26 * (This is out of laziness rather than need. The
27 * instructions could be simulated.)
28 *
29 * *) Otherwise, decode the instruction rewriting its
30 * registers to take fixed, ordered registers and
31 * setting a handler for it to run the instruction.
32 *
33 * In the execution phase by an instruction's handler:
34 *
35 * *) If the PC is written to by the instruction, the
36 * instruction must be fully simulated in software.
Quentin Barnes35aa1df2007-06-11 22:20:10 +000037 *
38 * *) Otherwise, a modified form of the instruction is
39 * directly executed. Its handler calls the
40 * instruction in insn[0]. In insn[1] is a
41 * "mov pc, lr" to return.
42 *
43 * Before calling, load up the reordered registers
44 * from the original instruction's registers. If one
45 * of the original input registers is the PC, compute
46 * and adjust the appropriate input register.
47 *
48 * After call completes, copy the output registers to
49 * the original instruction's original registers.
50 *
51 * We don't use a real breakpoint instruction since that
52 * would have us in the kernel go from SVC mode to SVC
53 * mode losing the link register. Instead we use an
54 * undefined instruction. To simplify processing, the
55 * undefined instruction used for kprobes must be reserved
56 * exclusively for kprobes use.
57 *
58 * TODO: ifdef out some instruction decoding based on architecture.
59 */
60
61#include <linux/kernel.h>
62#include <linux/kprobes.h>
63
Jon Medhurst221bf152011-04-20 10:52:38 +010064#include "kprobes.h"
65
Quentin Barnes35aa1df2007-06-11 22:20:10 +000066#define sign_extend(x, signbit) ((x) | (0 - ((x) & (1 << (signbit)))))
67
68#define branch_displacement(insn) sign_extend(((insn) & 0xffffff) << 2, 25)
69
Jon Medhurst7be7ee22011-07-07 14:03:08 +010070#if __LINUX_ARM_ARCH__ >= 6
71#define BLX(reg) "blx "reg" \n\t"
72#else
73#define BLX(reg) "mov lr, pc \n\t" \
74 "mov pc, "reg" \n\t"
75#endif
76
Jon Medhurst983ebd92011-04-07 13:25:17 +010077#define is_r15(insn, bitpos) (((insn) & (0xf << bitpos)) == (0xf << bitpos))
78
Quentin Barnes35aa1df2007-06-11 22:20:10 +000079#define PSR_fs (PSR_f|PSR_s)
80
81#define KPROBE_RETURN_INSTRUCTION 0xe1a0f00e /* mov pc, lr */
Quentin Barnes35aa1df2007-06-11 22:20:10 +000082
83typedef long (insn_0arg_fn_t)(void);
84typedef long (insn_1arg_fn_t)(long);
85typedef long (insn_2arg_fn_t)(long, long);
86typedef long (insn_3arg_fn_t)(long, long, long);
87typedef long (insn_4arg_fn_t)(long, long, long, long);
88typedef long long (insn_llret_0arg_fn_t)(void);
89typedef long long (insn_llret_3arg_fn_t)(long, long, long);
90typedef long long (insn_llret_4arg_fn_t)(long, long, long, long);
91
92union reg_pair {
93 long long dr;
94#ifdef __LITTLE_ENDIAN
95 struct { long r0, r1; };
96#else
97 struct { long r1, r0; };
98#endif
99};
100
101/*
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000102 * The insnslot_?arg_r[w]flags() functions below are to keep the
103 * msr -> *fn -> mrs instruction sequences indivisible so that
104 * the state of the CPSR flags aren't inadvertently modified
105 * just before or just after the call.
106 */
107
108static inline long __kprobes
109insnslot_0arg_rflags(long cpsr, insn_0arg_fn_t *fn)
110{
111 register long ret asm("r0");
112
113 __asm__ __volatile__ (
114 "msr cpsr_fs, %[cpsr] \n\t"
115 "mov lr, pc \n\t"
116 "mov pc, %[fn] \n\t"
117 : "=r" (ret)
118 : [cpsr] "r" (cpsr), [fn] "r" (fn)
119 : "lr", "cc"
120 );
121 return ret;
122}
123
124static inline long long __kprobes
125insnslot_llret_0arg_rflags(long cpsr, insn_llret_0arg_fn_t *fn)
126{
127 register long ret0 asm("r0");
128 register long ret1 asm("r1");
129 union reg_pair fnr;
130
131 __asm__ __volatile__ (
132 "msr cpsr_fs, %[cpsr] \n\t"
133 "mov lr, pc \n\t"
134 "mov pc, %[fn] \n\t"
135 : "=r" (ret0), "=r" (ret1)
136 : [cpsr] "r" (cpsr), [fn] "r" (fn)
137 : "lr", "cc"
138 );
139 fnr.r0 = ret0;
140 fnr.r1 = ret1;
141 return fnr.dr;
142}
143
144static inline long __kprobes
145insnslot_1arg_rflags(long r0, long cpsr, insn_1arg_fn_t *fn)
146{
147 register long rr0 asm("r0") = r0;
148 register long ret asm("r0");
149
150 __asm__ __volatile__ (
151 "msr cpsr_fs, %[cpsr] \n\t"
152 "mov lr, pc \n\t"
153 "mov pc, %[fn] \n\t"
154 : "=r" (ret)
155 : "0" (rr0), [cpsr] "r" (cpsr), [fn] "r" (fn)
156 : "lr", "cc"
157 );
158 return ret;
159}
160
161static inline long __kprobes
162insnslot_2arg_rflags(long r0, long r1, long cpsr, insn_2arg_fn_t *fn)
163{
164 register long rr0 asm("r0") = r0;
165 register long rr1 asm("r1") = r1;
166 register long ret asm("r0");
167
168 __asm__ __volatile__ (
169 "msr cpsr_fs, %[cpsr] \n\t"
170 "mov lr, pc \n\t"
171 "mov pc, %[fn] \n\t"
172 : "=r" (ret)
173 : "0" (rr0), "r" (rr1),
174 [cpsr] "r" (cpsr), [fn] "r" (fn)
175 : "lr", "cc"
176 );
177 return ret;
178}
179
180static inline long __kprobes
181insnslot_3arg_rflags(long r0, long r1, long r2, long cpsr, insn_3arg_fn_t *fn)
182{
183 register long rr0 asm("r0") = r0;
184 register long rr1 asm("r1") = r1;
185 register long rr2 asm("r2") = r2;
186 register long ret asm("r0");
187
188 __asm__ __volatile__ (
189 "msr cpsr_fs, %[cpsr] \n\t"
190 "mov lr, pc \n\t"
191 "mov pc, %[fn] \n\t"
192 : "=r" (ret)
193 : "0" (rr0), "r" (rr1), "r" (rr2),
194 [cpsr] "r" (cpsr), [fn] "r" (fn)
195 : "lr", "cc"
196 );
197 return ret;
198}
199
200static inline long long __kprobes
201insnslot_llret_3arg_rflags(long r0, long r1, long r2, long cpsr,
202 insn_llret_3arg_fn_t *fn)
203{
204 register long rr0 asm("r0") = r0;
205 register long rr1 asm("r1") = r1;
206 register long rr2 asm("r2") = r2;
207 register long ret0 asm("r0");
208 register long ret1 asm("r1");
209 union reg_pair fnr;
210
211 __asm__ __volatile__ (
212 "msr cpsr_fs, %[cpsr] \n\t"
213 "mov lr, pc \n\t"
214 "mov pc, %[fn] \n\t"
215 : "=r" (ret0), "=r" (ret1)
216 : "0" (rr0), "r" (rr1), "r" (rr2),
217 [cpsr] "r" (cpsr), [fn] "r" (fn)
218 : "lr", "cc"
219 );
220 fnr.r0 = ret0;
221 fnr.r1 = ret1;
222 return fnr.dr;
223}
224
225static inline long __kprobes
226insnslot_4arg_rflags(long r0, long r1, long r2, long r3, long cpsr,
227 insn_4arg_fn_t *fn)
228{
229 register long rr0 asm("r0") = r0;
230 register long rr1 asm("r1") = r1;
231 register long rr2 asm("r2") = r2;
232 register long rr3 asm("r3") = r3;
233 register long ret asm("r0");
234
235 __asm__ __volatile__ (
236 "msr cpsr_fs, %[cpsr] \n\t"
237 "mov lr, pc \n\t"
238 "mov pc, %[fn] \n\t"
239 : "=r" (ret)
240 : "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),
241 [cpsr] "r" (cpsr), [fn] "r" (fn)
242 : "lr", "cc"
243 );
244 return ret;
245}
246
247static inline long __kprobes
248insnslot_1arg_rwflags(long r0, long *cpsr, insn_1arg_fn_t *fn)
249{
250 register long rr0 asm("r0") = r0;
251 register long ret asm("r0");
252 long oldcpsr = *cpsr;
253 long newcpsr;
254
255 __asm__ __volatile__ (
256 "msr cpsr_fs, %[oldcpsr] \n\t"
257 "mov lr, pc \n\t"
258 "mov pc, %[fn] \n\t"
259 "mrs %[newcpsr], cpsr \n\t"
260 : "=r" (ret), [newcpsr] "=r" (newcpsr)
261 : "0" (rr0), [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)
262 : "lr", "cc"
263 );
264 *cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);
265 return ret;
266}
267
268static inline long __kprobes
269insnslot_2arg_rwflags(long r0, long r1, long *cpsr, insn_2arg_fn_t *fn)
270{
271 register long rr0 asm("r0") = r0;
272 register long rr1 asm("r1") = r1;
273 register long ret asm("r0");
274 long oldcpsr = *cpsr;
275 long newcpsr;
276
277 __asm__ __volatile__ (
278 "msr cpsr_fs, %[oldcpsr] \n\t"
279 "mov lr, pc \n\t"
280 "mov pc, %[fn] \n\t"
281 "mrs %[newcpsr], cpsr \n\t"
282 : "=r" (ret), [newcpsr] "=r" (newcpsr)
283 : "0" (rr0), "r" (rr1), [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)
284 : "lr", "cc"
285 );
286 *cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);
287 return ret;
288}
289
290static inline long __kprobes
291insnslot_3arg_rwflags(long r0, long r1, long r2, long *cpsr,
292 insn_3arg_fn_t *fn)
293{
294 register long rr0 asm("r0") = r0;
295 register long rr1 asm("r1") = r1;
296 register long rr2 asm("r2") = r2;
297 register long ret asm("r0");
298 long oldcpsr = *cpsr;
299 long newcpsr;
300
301 __asm__ __volatile__ (
302 "msr cpsr_fs, %[oldcpsr] \n\t"
303 "mov lr, pc \n\t"
304 "mov pc, %[fn] \n\t"
305 "mrs %[newcpsr], cpsr \n\t"
306 : "=r" (ret), [newcpsr] "=r" (newcpsr)
307 : "0" (rr0), "r" (rr1), "r" (rr2),
308 [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)
309 : "lr", "cc"
310 );
311 *cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);
312 return ret;
313}
314
315static inline long __kprobes
316insnslot_4arg_rwflags(long r0, long r1, long r2, long r3, long *cpsr,
317 insn_4arg_fn_t *fn)
318{
319 register long rr0 asm("r0") = r0;
320 register long rr1 asm("r1") = r1;
321 register long rr2 asm("r2") = r2;
322 register long rr3 asm("r3") = r3;
323 register long ret asm("r0");
324 long oldcpsr = *cpsr;
325 long newcpsr;
326
327 __asm__ __volatile__ (
328 "msr cpsr_fs, %[oldcpsr] \n\t"
329 "mov lr, pc \n\t"
330 "mov pc, %[fn] \n\t"
331 "mrs %[newcpsr], cpsr \n\t"
332 : "=r" (ret), [newcpsr] "=r" (newcpsr)
333 : "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),
334 [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)
335 : "lr", "cc"
336 );
337 *cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);
338 return ret;
339}
340
341static inline long long __kprobes
342insnslot_llret_4arg_rwflags(long r0, long r1, long r2, long r3, long *cpsr,
343 insn_llret_4arg_fn_t *fn)
344{
345 register long rr0 asm("r0") = r0;
346 register long rr1 asm("r1") = r1;
347 register long rr2 asm("r2") = r2;
348 register long rr3 asm("r3") = r3;
349 register long ret0 asm("r0");
350 register long ret1 asm("r1");
351 long oldcpsr = *cpsr;
352 long newcpsr;
353 union reg_pair fnr;
354
355 __asm__ __volatile__ (
356 "msr cpsr_fs, %[oldcpsr] \n\t"
357 "mov lr, pc \n\t"
358 "mov pc, %[fn] \n\t"
359 "mrs %[newcpsr], cpsr \n\t"
360 : "=r" (ret0), "=r" (ret1), [newcpsr] "=r" (newcpsr)
361 : "0" (rr0), "r" (rr1), "r" (rr2), "r" (rr3),
362 [oldcpsr] "r" (oldcpsr), [fn] "r" (fn)
363 : "lr", "cc"
364 );
365 *cpsr = (oldcpsr & ~PSR_fs) | (newcpsr & PSR_fs);
366 fnr.r0 = ret0;
367 fnr.r1 = ret1;
368 return fnr.dr;
369}
370
371/*
372 * To avoid the complications of mimicing single-stepping on a
373 * processor without a Next-PC or a single-step mode, and to
374 * avoid having to deal with the side-effects of boosting, we
375 * simulate or emulate (almost) all ARM instructions.
376 *
377 * "Simulation" is where the instruction's behavior is duplicated in
378 * C code. "Emulation" is where the original instruction is rewritten
379 * and executed, often by altering its registers.
380 *
381 * By having all behavior of the kprobe'd instruction completed before
382 * returning from the kprobe_handler(), all locks (scheduler and
383 * interrupt) can safely be released. There is no need for secondary
384 * breakpoints, no race with MP or preemptable kernels, nor having to
385 * clean up resources counts at a later time impacting overall system
386 * performance. By rewriting the instruction, only the minimum registers
387 * need to be loaded and saved back optimizing performance.
388 *
389 * Calling the insnslot_*_rwflags version of a function doesn't hurt
390 * anything even when the CPSR flags aren't updated by the
391 * instruction. It's just a little slower in return for saving
392 * a little space by not having a duplicate function that doesn't
393 * update the flags. (The same optimization can be said for
394 * instructions that do or don't perform register writeback)
395 * Also, instructions can either read the flags, only write the
396 * flags, or read and write the flags. To save combinations
397 * rather than for sheer performance, flag functions just assume
398 * read and write of flags.
399 */
400
401static void __kprobes simulate_bbl(struct kprobe *p, struct pt_regs *regs)
402{
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000403 kprobe_opcode_t insn = p->opcode;
404 long iaddr = (long)p->addr;
405 int disp = branch_displacement(insn);
406
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000407 if (insn & (1 << 24))
408 regs->ARM_lr = iaddr + 4;
409
410 regs->ARM_pc = iaddr + 8 + disp;
411}
412
413static void __kprobes simulate_blx1(struct kprobe *p, struct pt_regs *regs)
414{
415 kprobe_opcode_t insn = p->opcode;
416 long iaddr = (long)p->addr;
417 int disp = branch_displacement(insn);
418
419 regs->ARM_lr = iaddr + 4;
420 regs->ARM_pc = iaddr + 8 + disp + ((insn >> 23) & 0x2);
421 regs->ARM_cpsr |= PSR_T_BIT;
422}
423
424static void __kprobes simulate_blx2bx(struct kprobe *p, struct pt_regs *regs)
425{
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000426 kprobe_opcode_t insn = p->opcode;
427 int rm = insn & 0xf;
428 long rmv = regs->uregs[rm];
429
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000430 if (insn & (1 << 5))
431 regs->ARM_lr = (long)p->addr + 4;
432
433 regs->ARM_pc = rmv & ~0x1;
434 regs->ARM_cpsr &= ~PSR_T_BIT;
435 if (rmv & 0x1)
436 regs->ARM_cpsr |= PSR_T_BIT;
437}
438
Jon Medhurstc412aba2011-04-07 13:25:16 +0100439static void __kprobes simulate_mrs(struct kprobe *p, struct pt_regs *regs)
440{
441 kprobe_opcode_t insn = p->opcode;
442 int rd = (insn >> 12) & 0xf;
443 unsigned long mask = 0xf8ff03df; /* Mask out execution state */
444 regs->uregs[rd] = regs->ARM_cpsr & mask;
445}
446
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000447static void __kprobes simulate_mov_ipsp(struct kprobe *p, struct pt_regs *regs)
448{
449 regs->uregs[12] = regs->uregs[13];
450}
451
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000452static void __kprobes emulate_ldrd(struct kprobe *p, struct pt_regs *regs)
453{
454 insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];
455 kprobe_opcode_t insn = p->opcode;
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300456 long ppc = (long)p->addr + 8;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000457 int rd = (insn >> 12) & 0xf;
458 int rn = (insn >> 16) & 0xf;
459 int rm = insn & 0xf; /* rm may be invalid, don't care. */
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300460 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
461 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000462
463 /* Not following the C calling convention here, so need asm(). */
464 __asm__ __volatile__ (
465 "ldr r0, %[rn] \n\t"
466 "ldr r1, %[rm] \n\t"
467 "msr cpsr_fs, %[cpsr]\n\t"
468 "mov lr, pc \n\t"
469 "mov pc, %[i_fn] \n\t"
470 "str r0, %[rn] \n\t" /* in case of writeback */
471 "str r2, %[rd0] \n\t"
472 "str r3, %[rd1] \n\t"
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300473 : [rn] "+m" (rnv),
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000474 [rd0] "=m" (regs->uregs[rd]),
475 [rd1] "=m" (regs->uregs[rd+1])
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300476 : [rm] "m" (rmv),
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000477 [cpsr] "r" (regs->ARM_cpsr),
478 [i_fn] "r" (i_fn)
479 : "r0", "r1", "r2", "r3", "lr", "cc"
480 );
Jon Medhurst5c6b76f2011-04-08 15:32:56 +0100481 if (is_writeback(insn))
482 regs->uregs[rn] = rnv;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000483}
484
485static void __kprobes emulate_strd(struct kprobe *p, struct pt_regs *regs)
486{
487 insn_4arg_fn_t *i_fn = (insn_4arg_fn_t *)&p->ainsn.insn[0];
488 kprobe_opcode_t insn = p->opcode;
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300489 long ppc = (long)p->addr + 8;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000490 int rd = (insn >> 12) & 0xf;
491 int rn = (insn >> 16) & 0xf;
492 int rm = insn & 0xf;
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300493 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
494 /* rm/rmv may be invalid, don't care. */
495 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
496 long rnv_wb;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000497
Viktor Rosendahlcf3cc1a2011-03-28 18:56:05 +0300498 rnv_wb = insnslot_4arg_rflags(rnv, rmv, regs->uregs[rd],
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000499 regs->uregs[rd+1],
500 regs->ARM_cpsr, i_fn);
Jon Medhurst5c6b76f2011-04-08 15:32:56 +0100501 if (is_writeback(insn))
502 regs->uregs[rn] = rnv_wb;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000503}
504
Jon Medhurst3c48fbb2011-06-11 13:10:49 +0100505static void __kprobes emulate_ldr_old(struct kprobe *p, struct pt_regs *regs)
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000506{
507 insn_llret_3arg_fn_t *i_fn = (insn_llret_3arg_fn_t *)&p->ainsn.insn[0];
508 kprobe_opcode_t insn = p->opcode;
Nicolas Pitre0ebe25f2010-07-14 05:21:22 +0100509 long ppc = (long)p->addr + 8;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000510 union reg_pair fnr;
511 int rd = (insn >> 12) & 0xf;
512 int rn = (insn >> 16) & 0xf;
513 int rm = insn & 0xf;
514 long rdv;
Nicolas Pitre0ebe25f2010-07-14 05:21:22 +0100515 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
516 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000517 long cpsr = regs->ARM_cpsr;
518
519 fnr.dr = insnslot_llret_3arg_rflags(rnv, 0, rmv, cpsr, i_fn);
Viktor Rosendahl0652f062011-03-26 18:11:01 +0100520 if (rn != 15)
521 regs->uregs[rn] = fnr.r0; /* Save Rn in case of writeback. */
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000522 rdv = fnr.r1;
523
524 if (rd == 15) {
525#if __LINUX_ARM_ARCH__ >= 5
526 cpsr &= ~PSR_T_BIT;
527 if (rdv & 0x1)
528 cpsr |= PSR_T_BIT;
529 regs->ARM_cpsr = cpsr;
530 rdv &= ~0x1;
531#else
532 rdv &= ~0x2;
533#endif
534 }
535 regs->uregs[rd] = rdv;
536}
537
Jon Medhurst3c48fbb2011-06-11 13:10:49 +0100538static void __kprobes emulate_str_old(struct kprobe *p, struct pt_regs *regs)
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000539{
540 insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];
541 kprobe_opcode_t insn = p->opcode;
542 long iaddr = (long)p->addr;
543 int rd = (insn >> 12) & 0xf;
544 int rn = (insn >> 16) & 0xf;
545 int rm = insn & 0xf;
546 long rdv = (rd == 15) ? iaddr + str_pc_offset : regs->uregs[rd];
547 long rnv = (rn == 15) ? iaddr + 8 : regs->uregs[rn];
548 long rmv = regs->uregs[rm]; /* rm/rmv may be invalid, don't care. */
Viktor Rosendahl0652f062011-03-26 18:11:01 +0100549 long rnv_wb;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000550
Viktor Rosendahl0652f062011-03-26 18:11:01 +0100551 rnv_wb = insnslot_3arg_rflags(rnv, rdv, rmv, regs->ARM_cpsr, i_fn);
552 if (rn != 15)
553 regs->uregs[rn] = rnv_wb; /* Save Rn in case of writeback. */
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000554}
555
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000556static void __kprobes emulate_sat(struct kprobe *p, struct pt_regs *regs)
557{
558 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
559 kprobe_opcode_t insn = p->opcode;
560 int rd = (insn >> 12) & 0xf;
561 int rm = insn & 0xf;
562 long rmv = regs->uregs[rm];
563
564 /* Writes Q flag */
565 regs->uregs[rd] = insnslot_1arg_rwflags(rmv, &regs->ARM_cpsr, i_fn);
566}
567
568static void __kprobes emulate_sel(struct kprobe *p, struct pt_regs *regs)
569{
570 insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];
571 kprobe_opcode_t insn = p->opcode;
572 int rd = (insn >> 12) & 0xf;
573 int rn = (insn >> 16) & 0xf;
574 int rm = insn & 0xf;
575 long rnv = regs->uregs[rn];
576 long rmv = regs->uregs[rm];
577
578 /* Reads GE bits */
579 regs->uregs[rd] = insnslot_2arg_rflags(rnv, rmv, regs->ARM_cpsr, i_fn);
580}
581
582static void __kprobes emulate_none(struct kprobe *p, struct pt_regs *regs)
583{
584 insn_0arg_fn_t *i_fn = (insn_0arg_fn_t *)&p->ainsn.insn[0];
585
586 insnslot_0arg_rflags(regs->ARM_cpsr, i_fn);
587}
588
Jon Medhurst41713d12011-04-18 08:53:57 +0100589static void __kprobes emulate_nop(struct kprobe *p, struct pt_regs *regs)
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000590{
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000591}
592
Jon Medhurstc9836772011-04-19 10:52:17 +0100593static void __kprobes
594emulate_rd12_modify(struct kprobe *p, struct pt_regs *regs)
595{
596 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
597 kprobe_opcode_t insn = p->opcode;
598 int rd = (insn >> 12) & 0xf;
599 long rdv = regs->uregs[rd];
600
601 regs->uregs[rd] = insnslot_1arg_rflags(rdv, regs->ARM_cpsr, i_fn);
602}
603
Jon Medhurst20e81552011-04-19 10:52:18 +0100604static void __kprobes
605emulate_rd12rn0_modify(struct kprobe *p, struct pt_regs *regs)
606{
607 insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];
608 kprobe_opcode_t insn = p->opcode;
609 int rd = (insn >> 12) & 0xf;
610 int rn = insn & 0xf;
611 long rdv = regs->uregs[rd];
612 long rnv = regs->uregs[rn];
613
614 regs->uregs[rd] = insnslot_2arg_rflags(rdv, rnv, regs->ARM_cpsr, i_fn);
615}
616
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000617static void __kprobes emulate_rd12rm0(struct kprobe *p, struct pt_regs *regs)
618{
619 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
620 kprobe_opcode_t insn = p->opcode;
621 int rd = (insn >> 12) & 0xf;
622 int rm = insn & 0xf;
623 long rmv = regs->uregs[rm];
624
625 regs->uregs[rd] = insnslot_1arg_rflags(rmv, regs->ARM_cpsr, i_fn);
626}
627
628static void __kprobes
629emulate_rd12rn16rm0_rwflags(struct kprobe *p, struct pt_regs *regs)
630{
631 insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];
632 kprobe_opcode_t insn = p->opcode;
633 int rd = (insn >> 12) & 0xf;
634 int rn = (insn >> 16) & 0xf;
635 int rm = insn & 0xf;
636 long rnv = regs->uregs[rn];
637 long rmv = regs->uregs[rm];
638
639 regs->uregs[rd] =
640 insnslot_2arg_rwflags(rnv, rmv, &regs->ARM_cpsr, i_fn);
641}
642
643static void __kprobes
644emulate_rd16rn12rs8rm0_rwflags(struct kprobe *p, struct pt_regs *regs)
645{
646 insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];
647 kprobe_opcode_t insn = p->opcode;
648 int rd = (insn >> 16) & 0xf;
649 int rn = (insn >> 12) & 0xf;
650 int rs = (insn >> 8) & 0xf;
651 int rm = insn & 0xf;
652 long rnv = regs->uregs[rn];
653 long rsv = regs->uregs[rs];
654 long rmv = regs->uregs[rm];
655
656 regs->uregs[rd] =
657 insnslot_3arg_rwflags(rnv, rsv, rmv, &regs->ARM_cpsr, i_fn);
658}
659
660static void __kprobes
661emulate_rd16rs8rm0_rwflags(struct kprobe *p, struct pt_regs *regs)
662{
663 insn_2arg_fn_t *i_fn = (insn_2arg_fn_t *)&p->ainsn.insn[0];
664 kprobe_opcode_t insn = p->opcode;
665 int rd = (insn >> 16) & 0xf;
666 int rs = (insn >> 8) & 0xf;
667 int rm = insn & 0xf;
668 long rsv = regs->uregs[rs];
669 long rmv = regs->uregs[rm];
670
671 regs->uregs[rd] =
672 insnslot_2arg_rwflags(rsv, rmv, &regs->ARM_cpsr, i_fn);
673}
674
675static void __kprobes
676emulate_rdhi16rdlo12rs8rm0_rwflags(struct kprobe *p, struct pt_regs *regs)
677{
678 insn_llret_4arg_fn_t *i_fn = (insn_llret_4arg_fn_t *)&p->ainsn.insn[0];
679 kprobe_opcode_t insn = p->opcode;
680 union reg_pair fnr;
681 int rdhi = (insn >> 16) & 0xf;
682 int rdlo = (insn >> 12) & 0xf;
683 int rs = (insn >> 8) & 0xf;
684 int rm = insn & 0xf;
685 long rsv = regs->uregs[rs];
686 long rmv = regs->uregs[rm];
687
688 fnr.dr = insnslot_llret_4arg_rwflags(regs->uregs[rdhi],
689 regs->uregs[rdlo], rsv, rmv,
690 &regs->ARM_cpsr, i_fn);
691 regs->uregs[rdhi] = fnr.r0;
692 regs->uregs[rdlo] = fnr.r1;
693}
694
695static void __kprobes
696emulate_alu_imm_rflags(struct kprobe *p, struct pt_regs *regs)
697{
698 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
699 kprobe_opcode_t insn = p->opcode;
700 int rd = (insn >> 12) & 0xf;
701 int rn = (insn >> 16) & 0xf;
702 long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];
703
704 regs->uregs[rd] = insnslot_1arg_rflags(rnv, regs->ARM_cpsr, i_fn);
705}
706
707static void __kprobes
708emulate_alu_imm_rwflags(struct kprobe *p, struct pt_regs *regs)
709{
710 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
711 kprobe_opcode_t insn = p->opcode;
712 int rd = (insn >> 12) & 0xf;
713 int rn = (insn >> 16) & 0xf;
714 long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];
715
716 regs->uregs[rd] = insnslot_1arg_rwflags(rnv, &regs->ARM_cpsr, i_fn);
717}
718
719static void __kprobes
Jon Medhurstad111ce2011-04-06 11:17:11 +0100720emulate_alu_tests_imm(struct kprobe *p, struct pt_regs *regs)
721{
722 insn_1arg_fn_t *i_fn = (insn_1arg_fn_t *)&p->ainsn.insn[0];
723 kprobe_opcode_t insn = p->opcode;
724 int rn = (insn >> 16) & 0xf;
725 long rnv = (rn == 15) ? (long)p->addr + 8 : regs->uregs[rn];
726
727 insnslot_1arg_rwflags(rnv, &regs->ARM_cpsr, i_fn);
728}
729
730static void __kprobes
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000731emulate_alu_rflags(struct kprobe *p, struct pt_regs *regs)
732{
733 insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];
734 kprobe_opcode_t insn = p->opcode;
735 long ppc = (long)p->addr + 8;
736 int rd = (insn >> 12) & 0xf;
737 int rn = (insn >> 16) & 0xf; /* rn/rnv/rs/rsv may be */
738 int rs = (insn >> 8) & 0xf; /* invalid, don't care. */
739 int rm = insn & 0xf;
740 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
741 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
742 long rsv = regs->uregs[rs];
743
744 regs->uregs[rd] =
745 insnslot_3arg_rflags(rnv, rmv, rsv, regs->ARM_cpsr, i_fn);
746}
747
748static void __kprobes
749emulate_alu_rwflags(struct kprobe *p, struct pt_regs *regs)
750{
751 insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];
752 kprobe_opcode_t insn = p->opcode;
753 long ppc = (long)p->addr + 8;
754 int rd = (insn >> 12) & 0xf;
755 int rn = (insn >> 16) & 0xf; /* rn/rnv/rs/rsv may be */
756 int rs = (insn >> 8) & 0xf; /* invalid, don't care. */
757 int rm = insn & 0xf;
758 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
759 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
760 long rsv = regs->uregs[rs];
761
762 regs->uregs[rd] =
763 insnslot_3arg_rwflags(rnv, rmv, rsv, &regs->ARM_cpsr, i_fn);
764}
765
Jon Medhurstad111ce2011-04-06 11:17:11 +0100766static void __kprobes
767emulate_alu_tests(struct kprobe *p, struct pt_regs *regs)
768{
769 insn_3arg_fn_t *i_fn = (insn_3arg_fn_t *)&p->ainsn.insn[0];
770 kprobe_opcode_t insn = p->opcode;
771 long ppc = (long)p->addr + 8;
772 int rn = (insn >> 16) & 0xf;
773 int rs = (insn >> 8) & 0xf; /* rs/rsv may be invalid, don't care. */
774 int rm = insn & 0xf;
775 long rnv = (rn == 15) ? ppc : regs->uregs[rn];
776 long rmv = (rm == 15) ? ppc : regs->uregs[rm];
777 long rsv = regs->uregs[rs];
778
779 insnslot_3arg_rwflags(rnv, rmv, rsv, &regs->ARM_cpsr, i_fn);
780}
781
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000782static enum kprobe_insn __kprobes
783prep_emulate_ldr_str(kprobe_opcode_t insn, struct arch_specific_insn *asi)
784{
Jon Medhurst6823fc82011-04-08 15:32:54 +0100785 int not_imm = (insn & (1 << 26)) ? (insn & (1 << 25))
786 : (~insn & (1 << 22));
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000787
Jon Medhurst54823ac2011-04-08 15:32:55 +0100788 if (is_writeback(insn) && is_r15(insn, 16))
789 return INSN_REJECTED; /* Writeback to PC */
790
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000791 insn &= 0xfff00fff;
792 insn |= 0x00001000; /* Rn = r0, Rd = r1 */
Jon Medhurst6823fc82011-04-08 15:32:54 +0100793 if (not_imm) {
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000794 insn &= ~0xf;
795 insn |= 2; /* Rm = r2 */
796 }
797 asi->insn[0] = insn;
Jon Medhurst3c48fbb2011-06-11 13:10:49 +0100798 asi->insn_handler = (insn & (1 << 20)) ? emulate_ldr_old : emulate_str_old;
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000799 return INSN_GOOD;
800}
801
802static enum kprobe_insn __kprobes
Jon Medhurstc9836772011-04-19 10:52:17 +0100803prep_emulate_rd12_modify(kprobe_opcode_t insn, struct arch_specific_insn *asi)
804{
805 if (is_r15(insn, 12))
806 return INSN_REJECTED; /* Rd is PC */
807
808 insn &= 0xffff0fff; /* Rd = r0 */
809 asi->insn[0] = insn;
810 asi->insn_handler = emulate_rd12_modify;
811 return INSN_GOOD;
812}
813
814static enum kprobe_insn __kprobes
Jon Medhurst20e81552011-04-19 10:52:18 +0100815prep_emulate_rd12rn0_modify(kprobe_opcode_t insn,
816 struct arch_specific_insn *asi)
817{
818 if (is_r15(insn, 12))
819 return INSN_REJECTED; /* Rd is PC */
820
821 insn &= 0xffff0ff0; /* Rd = r0 */
822 insn |= 0x00000001; /* Rn = r1 */
823 asi->insn[0] = insn;
824 asi->insn_handler = emulate_rd12rn0_modify;
825 return INSN_GOOD;
826}
827
828static enum kprobe_insn __kprobes
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000829prep_emulate_rd12rm0(kprobe_opcode_t insn, struct arch_specific_insn *asi)
830{
Jon Medhurst983ebd92011-04-07 13:25:17 +0100831 if (is_r15(insn, 12))
832 return INSN_REJECTED; /* Rd is PC */
833
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000834 insn &= 0xffff0ff0; /* Rd = r0, Rm = r0 */
835 asi->insn[0] = insn;
836 asi->insn_handler = emulate_rd12rm0;
837 return INSN_GOOD;
838}
839
840static enum kprobe_insn __kprobes
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000841prep_emulate_rd12rn16rm0_wflags(kprobe_opcode_t insn,
842 struct arch_specific_insn *asi)
843{
Jon Medhurst983ebd92011-04-07 13:25:17 +0100844 if (is_r15(insn, 12))
845 return INSN_REJECTED; /* Rd is PC */
846
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000847 insn &= 0xfff00ff0; /* Rd = r0, Rn = r0 */
848 insn |= 0x00000001; /* Rm = r1 */
849 asi->insn[0] = insn;
850 asi->insn_handler = emulate_rd12rn16rm0_rwflags;
851 return INSN_GOOD;
852}
853
854static enum kprobe_insn __kprobes
855prep_emulate_rd16rs8rm0_wflags(kprobe_opcode_t insn,
856 struct arch_specific_insn *asi)
857{
Jon Medhurst983ebd92011-04-07 13:25:17 +0100858 if (is_r15(insn, 16))
859 return INSN_REJECTED; /* Rd is PC */
860
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000861 insn &= 0xfff0f0f0; /* Rd = r0, Rs = r0 */
862 insn |= 0x00000001; /* Rm = r1 */
863 asi->insn[0] = insn;
864 asi->insn_handler = emulate_rd16rs8rm0_rwflags;
865 return INSN_GOOD;
866}
867
868static enum kprobe_insn __kprobes
869prep_emulate_rd16rn12rs8rm0_wflags(kprobe_opcode_t insn,
870 struct arch_specific_insn *asi)
871{
Jon Medhurst983ebd92011-04-07 13:25:17 +0100872 if (is_r15(insn, 16))
873 return INSN_REJECTED; /* Rd is PC */
874
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000875 insn &= 0xfff000f0; /* Rd = r0, Rn = r0 */
876 insn |= 0x00000102; /* Rs = r1, Rm = r2 */
877 asi->insn[0] = insn;
878 asi->insn_handler = emulate_rd16rn12rs8rm0_rwflags;
879 return INSN_GOOD;
880}
881
882static enum kprobe_insn __kprobes
883prep_emulate_rdhi16rdlo12rs8rm0_wflags(kprobe_opcode_t insn,
884 struct arch_specific_insn *asi)
885{
Jon Medhurst983ebd92011-04-07 13:25:17 +0100886 if (is_r15(insn, 16) || is_r15(insn, 12))
887 return INSN_REJECTED; /* RdHi or RdLo is PC */
888
Quentin Barnes35aa1df2007-06-11 22:20:10 +0000889 insn &= 0xfff000f0; /* RdHi = r0, RdLo = r1 */
890 insn |= 0x00001203; /* Rs = r2, Rm = r3 */
891 asi->insn[0] = insn;
892 asi->insn_handler = emulate_rdhi16rdlo12rs8rm0_rwflags;
893 return INSN_GOOD;
894}
895
Jon Medhurst9f596e52011-06-09 17:35:36 +0100896static void __kprobes
Jon Medhurst87239422011-06-09 17:39:42 +0100897emulate_ldrdstrd(struct kprobe *p, struct pt_regs *regs)
898{
899 kprobe_opcode_t insn = p->opcode;
900 unsigned long pc = (unsigned long)p->addr + 8;
901 int rt = (insn >> 12) & 0xf;
902 int rn = (insn >> 16) & 0xf;
903 int rm = insn & 0xf;
904
905 register unsigned long rtv asm("r0") = regs->uregs[rt];
906 register unsigned long rt2v asm("r1") = regs->uregs[rt+1];
907 register unsigned long rnv asm("r2") = (rn == 15) ? pc
908 : regs->uregs[rn];
909 register unsigned long rmv asm("r3") = regs->uregs[rm];
910
911 __asm__ __volatile__ (
912 BLX("%[fn]")
913 : "=r" (rtv), "=r" (rt2v), "=r" (rnv)
914 : "0" (rtv), "1" (rt2v), "2" (rnv), "r" (rmv),
915 [fn] "r" (p->ainsn.insn_fn)
916 : "lr", "memory", "cc"
917 );
918
919 regs->uregs[rt] = rtv;
920 regs->uregs[rt+1] = rt2v;
921 if (is_writeback(insn))
922 regs->uregs[rn] = rnv;
923}
924
925static void __kprobes
Jon Medhurst3c48fbb2011-06-11 13:10:49 +0100926emulate_ldr(struct kprobe *p, struct pt_regs *regs)
927{
928 kprobe_opcode_t insn = p->opcode;
929 unsigned long pc = (unsigned long)p->addr + 8;
930 int rt = (insn >> 12) & 0xf;
931 int rn = (insn >> 16) & 0xf;
932 int rm = insn & 0xf;
933
934 register unsigned long rtv asm("r0");
935 register unsigned long rnv asm("r2") = (rn == 15) ? pc
936 : regs->uregs[rn];
937 register unsigned long rmv asm("r3") = regs->uregs[rm];
938
939 __asm__ __volatile__ (
940 BLX("%[fn]")
941 : "=r" (rtv), "=r" (rnv)
942 : "1" (rnv), "r" (rmv), [fn] "r" (p->ainsn.insn_fn)
943 : "lr", "memory", "cc"
944 );
945
946 if (rt == 15)
947 load_write_pc(rtv, regs);
948 else
949 regs->uregs[rt] = rtv;
950
951 if (is_writeback(insn))
952 regs->uregs[rn] = rnv;
953}
954
955static void __kprobes
956emulate_str(struct kprobe *p, struct pt_regs *regs)
957{
958 kprobe_opcode_t insn = p->opcode;
959 unsigned long rtpc = (unsigned long)p->addr + str_pc_offset;
960 unsigned long rnpc = (unsigned long)p->addr + 8;
961 int rt = (insn >> 12) & 0xf;
962 int rn = (insn >> 16) & 0xf;
963 int rm = insn & 0xf;
964
965 register unsigned long rtv asm("r0") = (rt == 15) ? rtpc
966 : regs->uregs[rt];
967 register unsigned long rnv asm("r2") = (rn == 15) ? rnpc
968 : regs->uregs[rn];
969 register unsigned long rmv asm("r3") = regs->uregs[rm];
970
971 __asm__ __volatile__ (
972 BLX("%[fn]")
973 : "=r" (rnv)
974 : "r" (rtv), "0" (rnv), "r" (rmv), [fn] "r" (p->ainsn.insn_fn)
975 : "lr", "memory", "cc"
976 );
977
978 if (is_writeback(insn))
979 regs->uregs[rn] = rnv;
980}
981
982static void __kprobes
Jon Medhurst9f596e52011-06-09 17:35:36 +0100983emulate_rd12rn16rm0rs8_rwflags(struct kprobe *p, struct pt_regs *regs)
984{
985 kprobe_opcode_t insn = p->opcode;
986 unsigned long pc = (unsigned long)p->addr + 8;
987 int rd = (insn >> 12) & 0xf;
988 int rn = (insn >> 16) & 0xf;
989 int rm = insn & 0xf;
990 int rs = (insn >> 8) & 0xf;
991
992 register unsigned long rdv asm("r0") = regs->uregs[rd];
993 register unsigned long rnv asm("r2") = (rn == 15) ? pc
994 : regs->uregs[rn];
995 register unsigned long rmv asm("r3") = (rm == 15) ? pc
996 : regs->uregs[rm];
997 register unsigned long rsv asm("r1") = regs->uregs[rs];
998 unsigned long cpsr = regs->ARM_cpsr;
999
1000 __asm__ __volatile__ (
1001 "msr cpsr_fs, %[cpsr] \n\t"
1002 BLX("%[fn]")
1003 "mrs %[cpsr], cpsr \n\t"
1004 : "=r" (rdv), [cpsr] "=r" (cpsr)
1005 : "0" (rdv), "r" (rnv), "r" (rmv), "r" (rsv),
1006 "1" (cpsr), [fn] "r" (p->ainsn.insn_fn)
1007 : "lr", "memory", "cc"
1008 );
1009
1010 if (rd == 15)
1011 alu_write_pc(rdv, regs);
1012 else
1013 regs->uregs[rd] = rdv;
1014 regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
1015}
1016
Jon Medhurst0e44e9a2011-06-09 17:23:50 +01001017static void __kprobes
1018emulate_rd12rn16rm0_rwflags_nopc(struct kprobe *p, struct pt_regs *regs)
1019{
1020 kprobe_opcode_t insn = p->opcode;
1021 int rd = (insn >> 12) & 0xf;
1022 int rn = (insn >> 16) & 0xf;
1023 int rm = insn & 0xf;
1024
1025 register unsigned long rdv asm("r0") = regs->uregs[rd];
1026 register unsigned long rnv asm("r2") = regs->uregs[rn];
1027 register unsigned long rmv asm("r3") = regs->uregs[rm];
1028 unsigned long cpsr = regs->ARM_cpsr;
1029
1030 __asm__ __volatile__ (
1031 "msr cpsr_fs, %[cpsr] \n\t"
1032 BLX("%[fn]")
1033 "mrs %[cpsr], cpsr \n\t"
1034 : "=r" (rdv), [cpsr] "=r" (cpsr)
1035 : "0" (rdv), "r" (rnv), "r" (rmv),
1036 "1" (cpsr), [fn] "r" (p->ainsn.insn_fn)
1037 : "lr", "memory", "cc"
1038 );
1039
1040 regs->uregs[rd] = rdv;
1041 regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
1042}
1043
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001044static void __kprobes
1045emulate_rd16rn12rm0rs8_rwflags_nopc(struct kprobe *p, struct pt_regs *regs)
1046{
1047 kprobe_opcode_t insn = p->opcode;
1048 int rd = (insn >> 16) & 0xf;
1049 int rn = (insn >> 12) & 0xf;
1050 int rm = insn & 0xf;
1051 int rs = (insn >> 8) & 0xf;
1052
1053 register unsigned long rdv asm("r2") = regs->uregs[rd];
1054 register unsigned long rnv asm("r0") = regs->uregs[rn];
1055 register unsigned long rmv asm("r3") = regs->uregs[rm];
1056 register unsigned long rsv asm("r1") = regs->uregs[rs];
1057 unsigned long cpsr = regs->ARM_cpsr;
1058
1059 __asm__ __volatile__ (
1060 "msr cpsr_fs, %[cpsr] \n\t"
1061 BLX("%[fn]")
1062 "mrs %[cpsr], cpsr \n\t"
1063 : "=r" (rdv), [cpsr] "=r" (cpsr)
1064 : "0" (rdv), "r" (rnv), "r" (rmv), "r" (rsv),
1065 "1" (cpsr), [fn] "r" (p->ainsn.insn_fn)
1066 : "lr", "memory", "cc"
1067 );
1068
1069 regs->uregs[rd] = rdv;
1070 regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
1071}
1072
Jon Medhurstc82584e2011-06-10 18:10:36 +01001073static void __kprobes
1074emulate_rd12rm0_noflags_nopc(struct kprobe *p, struct pt_regs *regs)
1075{
1076 kprobe_opcode_t insn = p->opcode;
1077 int rd = (insn >> 12) & 0xf;
1078 int rm = insn & 0xf;
1079
1080 register unsigned long rdv asm("r0") = regs->uregs[rd];
1081 register unsigned long rmv asm("r3") = regs->uregs[rm];
1082
1083 __asm__ __volatile__ (
1084 BLX("%[fn]")
1085 : "=r" (rdv)
1086 : "0" (rdv), "r" (rmv), [fn] "r" (p->ainsn.insn_fn)
1087 : "lr", "memory", "cc"
1088 );
1089
1090 regs->uregs[rd] = rdv;
1091}
1092
Jon Medhurst12ce5d32011-06-10 18:32:15 +01001093static void __kprobes
1094emulate_rdlo12rdhi16rn0rm8_rwflags_nopc(struct kprobe *p, struct pt_regs *regs)
1095{
1096 kprobe_opcode_t insn = p->opcode;
1097 int rdlo = (insn >> 12) & 0xf;
1098 int rdhi = (insn >> 16) & 0xf;
1099 int rn = insn & 0xf;
1100 int rm = (insn >> 8) & 0xf;
1101
1102 register unsigned long rdlov asm("r0") = regs->uregs[rdlo];
1103 register unsigned long rdhiv asm("r2") = regs->uregs[rdhi];
1104 register unsigned long rnv asm("r3") = regs->uregs[rn];
1105 register unsigned long rmv asm("r1") = regs->uregs[rm];
1106 unsigned long cpsr = regs->ARM_cpsr;
1107
1108 __asm__ __volatile__ (
1109 "msr cpsr_fs, %[cpsr] \n\t"
1110 BLX("%[fn]")
1111 "mrs %[cpsr], cpsr \n\t"
1112 : "=r" (rdlov), "=r" (rdhiv), [cpsr] "=r" (cpsr)
1113 : "0" (rdlov), "1" (rdhiv), "r" (rnv), "r" (rmv),
1114 "2" (cpsr), [fn] "r" (p->ainsn.insn_fn)
1115 : "lr", "memory", "cc"
1116 );
1117
1118 regs->uregs[rdlo] = rdlov;
1119 regs->uregs[rdhi] = rdhiv;
1120 regs->ARM_cpsr = (regs->ARM_cpsr & ~APSR_MASK) | (cpsr & APSR_MASK);
1121}
1122
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001123/*
1124 * For the instruction masking and comparisons in all the "space_*"
1125 * functions below, Do _not_ rearrange the order of tests unless
1126 * you're very, very sure of what you are doing. For the sake of
1127 * efficiency, the masks for some tests sometimes assume other test
1128 * have been done prior to them so the number of patterns to test
1129 * for an instruction set can be as broad as possible to reduce the
1130 * number of tests needed.
1131 */
1132
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001133static const union decode_item arm_1111_table[] = {
1134 /* Unconditional instructions */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001135
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001136 /* memory hint 1111 0100 x001 xxxx xxxx xxxx xxxx xxxx */
1137 /* PLDI (immediate) 1111 0100 x101 xxxx xxxx xxxx xxxx xxxx */
1138 /* PLDW (immediate) 1111 0101 x001 xxxx xxxx xxxx xxxx xxxx */
1139 /* PLD (immediate) 1111 0101 x101 xxxx xxxx xxxx xxxx xxxx */
1140 DECODE_SIMULATE (0xfe300000, 0xf4100000, kprobe_simulate_nop),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001141
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001142 /* BLX (immediate) 1111 101x xxxx xxxx xxxx xxxx xxxx xxxx */
1143 DECODE_SIMULATE (0xfe000000, 0xfa000000, simulate_blx1),
Jon Medhurst72c2bab2011-04-18 08:53:58 +01001144
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001145 /* CPS 1111 0001 0000 xxx0 xxxx xxxx xx0x xxxx */
1146 /* SETEND 1111 0001 0000 0001 xxxx xxxx 0000 xxxx */
1147 /* SRS 1111 100x x1x0 xxxx xxxx xxxx xxxx xxxx */
1148 /* RFE 1111 100x x0x1 xxxx xxxx xxxx xxxx xxxx */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001149
Jon Medhurstfa1a03b2011-04-18 08:53:54 +01001150 /* Coprocessor instructions... */
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001151 /* MCRR2 1111 1100 0100 xxxx xxxx xxxx xxxx xxxx */
1152 /* MRRC2 1111 1100 0101 xxxx xxxx xxxx xxxx xxxx */
1153 /* LDC2 1111 110x xxx1 xxxx xxxx xxxx xxxx xxxx */
1154 /* STC2 1111 110x xxx0 xxxx xxxx xxxx xxxx xxxx */
1155 /* CDP2 1111 1110 xxxx xxxx xxxx xxxx xxx0 xxxx */
1156 /* MCR2 1111 1110 xxx0 xxxx xxxx xxxx xxx1 xxxx */
1157 /* MRC2 1111 1110 xxx1 xxxx xxxx xxxx xxx1 xxxx */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001158
Jon Medhurst9a5c1282011-06-06 12:20:25 +01001159 /* Other unallocated instructions... */
1160 DECODE_END
1161};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001162
Jon Medhurst75f115c2011-06-07 09:58:11 +01001163static const union decode_item arm_cccc_0001_0xx0____0xxx_table[] = {
1164 /* Miscellaneous instructions */
1165
1166 /* MRS cpsr cccc 0001 0000 xxxx xxxx xxxx 0000 xxxx */
1167 DECODE_SIMULATEX(0x0ff000f0, 0x01000000, simulate_mrs,
1168 REGS(0, NOPC, 0, 0, 0)),
1169
1170 /* BX cccc 0001 0010 xxxx xxxx xxxx 0001 xxxx */
1171 DECODE_SIMULATE (0x0ff000f0, 0x01200010, simulate_blx2bx),
1172
1173 /* BLX (register) cccc 0001 0010 xxxx xxxx xxxx 0011 xxxx */
1174 DECODE_SIMULATEX(0x0ff000f0, 0x01200030, simulate_blx2bx,
1175 REGS(0, 0, 0, 0, NOPC)),
1176
1177 /* CLZ cccc 0001 0110 xxxx xxxx xxxx 0001 xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001178 DECODE_EMULATEX (0x0ff000f0, 0x01600010, emulate_rd12rm0_noflags_nopc,
1179 REGS(0, NOPC, 0, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001180
1181 /* QADD cccc 0001 0000 xxxx xxxx xxxx 0101 xxxx */
1182 /* QSUB cccc 0001 0010 xxxx xxxx xxxx 0101 xxxx */
1183 /* QDADD cccc 0001 0100 xxxx xxxx xxxx 0101 xxxx */
1184 /* QDSUB cccc 0001 0110 xxxx xxxx xxxx 0101 xxxx */
Jon Medhurst35fab772011-06-10 17:55:10 +01001185 DECODE_EMULATEX (0x0f9000f0, 0x01000050, emulate_rd12rn16rm0_rwflags_nopc,
1186 REGS(NOPC, NOPC, 0, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001187
1188 /* BXJ cccc 0001 0010 xxxx xxxx xxxx 0010 xxxx */
1189 /* MSR cccc 0001 0x10 xxxx xxxx xxxx 0000 xxxx */
1190 /* MRS spsr cccc 0001 0100 xxxx xxxx xxxx 0000 xxxx */
1191 /* BKPT 1110 0001 0010 xxxx xxxx xxxx 0111 xxxx */
1192 /* SMC cccc 0001 0110 xxxx xxxx xxxx 0111 xxxx */
1193 /* And unallocated instructions... */
1194 DECODE_END
1195};
1196
1197static const union decode_item arm_cccc_0001_0xx0____1xx0_table[] = {
1198 /* Halfword multiply and multiply-accumulate */
1199
1200 /* SMLALxy cccc 0001 0100 xxxx xxxx xxxx 1xx0 xxxx */
Jon Medhurst12ce5d32011-06-10 18:32:15 +01001201 DECODE_EMULATEX (0x0ff00090, 0x01400080, emulate_rdlo12rdhi16rn0rm8_rwflags_nopc,
1202 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001203
1204 /* SMULWy cccc 0001 0010 xxxx xxxx xxxx 1x10 xxxx */
1205 DECODE_OR (0x0ff000b0, 0x012000a0),
1206 /* SMULxy cccc 0001 0110 xxxx xxxx xxxx 1xx0 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001207 DECODE_EMULATEX (0x0ff00090, 0x01600080, emulate_rd16rn12rm0rs8_rwflags_nopc,
1208 REGS(NOPC, 0, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001209
1210 /* SMLAxy cccc 0001 0000 xxxx xxxx xxxx 1xx0 xxxx */
1211 DECODE_OR (0x0ff00090, 0x01000080),
1212 /* SMLAWy cccc 0001 0010 xxxx xxxx xxxx 1x00 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001213 DECODE_EMULATEX (0x0ff000b0, 0x01200080, emulate_rd16rn12rm0rs8_rwflags_nopc,
1214 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001215
1216 DECODE_END
1217};
1218
1219static const union decode_item arm_cccc_0000_____1001_table[] = {
1220 /* Multiply and multiply-accumulate */
1221
1222 /* MUL cccc 0000 0000 xxxx xxxx xxxx 1001 xxxx */
1223 /* MULS cccc 0000 0001 xxxx xxxx xxxx 1001 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001224 DECODE_EMULATEX (0x0fe000f0, 0x00000090, emulate_rd16rn12rm0rs8_rwflags_nopc,
1225 REGS(NOPC, 0, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001226
1227 /* MLA cccc 0000 0010 xxxx xxxx xxxx 1001 xxxx */
1228 /* MLAS cccc 0000 0011 xxxx xxxx xxxx 1001 xxxx */
1229 DECODE_OR (0x0fe000f0, 0x00200090),
1230 /* MLS cccc 0000 0110 xxxx xxxx xxxx 1001 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001231 DECODE_EMULATEX (0x0ff000f0, 0x00600090, emulate_rd16rn12rm0rs8_rwflags_nopc,
1232 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001233
1234 /* UMAAL cccc 0000 0100 xxxx xxxx xxxx 1001 xxxx */
1235 DECODE_OR (0x0ff000f0, 0x00400090),
1236 /* UMULL cccc 0000 1000 xxxx xxxx xxxx 1001 xxxx */
1237 /* UMULLS cccc 0000 1001 xxxx xxxx xxxx 1001 xxxx */
1238 /* UMLAL cccc 0000 1010 xxxx xxxx xxxx 1001 xxxx */
1239 /* UMLALS cccc 0000 1011 xxxx xxxx xxxx 1001 xxxx */
1240 /* SMULL cccc 0000 1100 xxxx xxxx xxxx 1001 xxxx */
1241 /* SMULLS cccc 0000 1101 xxxx xxxx xxxx 1001 xxxx */
1242 /* SMLAL cccc 0000 1110 xxxx xxxx xxxx 1001 xxxx */
1243 /* SMLALS cccc 0000 1111 xxxx xxxx xxxx 1001 xxxx */
Jon Medhurst12ce5d32011-06-10 18:32:15 +01001244 DECODE_EMULATEX (0x0f8000f0, 0x00800090, emulate_rdlo12rdhi16rn0rm8_rwflags_nopc,
1245 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001246
1247 DECODE_END
1248};
1249
1250static const union decode_item arm_cccc_0001_____1001_table[] = {
1251 /* Synchronization primitives */
1252
1253 /* SMP/SWPB cccc 0001 0x00 xxxx xxxx xxxx 1001 xxxx */
Jon Medhurst35fab772011-06-10 17:55:10 +01001254 DECODE_EMULATEX (0x0fb000f0, 0x01000090, emulate_rd12rn16rm0_rwflags_nopc,
1255 REGS(NOPC, NOPC, 0, 0, NOPC)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001256
1257 /* LDREX/STREX{,D,B,H} cccc 0001 1xxx xxxx xxxx xxxx 1001 xxxx */
1258 /* And unallocated instructions... */
1259 DECODE_END
1260};
1261
Jon Medhurst6c8a1922011-06-06 15:07:42 +01001262static const union decode_item arm_cccc_000x_____1xx1_table[] = {
Jon Medhurst75f115c2011-06-07 09:58:11 +01001263 /* Extra load/store instructions */
1264
Jon Medhurst465f1ea2011-06-11 15:16:41 +01001265 /* STRHT cccc 0000 xx10 xxxx xxxx xxxx 1011 xxxx */
1266 /* ??? cccc 0000 xx10 xxxx xxxx xxxx 11x1 xxxx */
1267 /* LDRHT cccc 0000 xx11 xxxx xxxx xxxx 1011 xxxx */
1268 /* LDRSBT cccc 0000 xx11 xxxx xxxx xxxx 1101 xxxx */
1269 /* LDRSHT cccc 0000 xx11 xxxx xxxx xxxx 1111 xxxx */
1270 DECODE_REJECT (0x0f200090, 0x00200090),
1271
Jon Medhurst6c8a1922011-06-06 15:07:42 +01001272 /* LDRD/STRD lr,pc,{... cccc 000x x0x0 xxxx 111x xxxx 1101 xxxx */
1273 DECODE_REJECT (0x0e10e0d0, 0x0000e0d0),
1274
1275 /* LDRD (register) cccc 000x x0x0 xxxx xxxx xxxx 1101 xxxx */
1276 /* STRD (register) cccc 000x x0x0 xxxx xxxx xxxx 1111 xxxx */
1277 DECODE_EMULATEX (0x0e5000d0, 0x000000d0, emulate_ldrdstrd,
1278 REGS(NOPCWB, NOPCX, 0, 0, NOPC)),
1279
1280 /* LDRD (immediate) cccc 000x x1x0 xxxx xxxx xxxx 1101 xxxx */
1281 /* STRD (immediate) cccc 000x x1x0 xxxx xxxx xxxx 1111 xxxx */
1282 DECODE_EMULATEX (0x0e5000d0, 0x004000d0, emulate_ldrdstrd,
1283 REGS(NOPCWB, NOPCX, 0, 0, 0)),
1284
Jon Medhurst75f115c2011-06-07 09:58:11 +01001285 /* STRH (register) cccc 000x x0x0 xxxx xxxx xxxx 1011 xxxx */
Jon Medhurst711bf102011-06-11 15:08:24 +01001286 DECODE_EMULATEX (0x0e5000f0, 0x000000b0, emulate_str,
1287 REGS(NOPCWB, NOPC, 0, 0, NOPC)),
1288
Jon Medhurst75f115c2011-06-07 09:58:11 +01001289 /* LDRH (register) cccc 000x x0x1 xxxx xxxx xxxx 1011 xxxx */
1290 /* LDRSB (register) cccc 000x x0x1 xxxx xxxx xxxx 1101 xxxx */
1291 /* LDRSH (register) cccc 000x x0x1 xxxx xxxx xxxx 1111 xxxx */
Jon Medhurst711bf102011-06-11 15:08:24 +01001292 DECODE_EMULATEX (0x0e500090, 0x00100090, emulate_ldr,
1293 REGS(NOPCWB, NOPC, 0, 0, NOPC)),
1294
Jon Medhurst75f115c2011-06-07 09:58:11 +01001295 /* STRH (immediate) cccc 000x x1x0 xxxx xxxx xxxx 1011 xxxx */
Jon Medhurst711bf102011-06-11 15:08:24 +01001296 DECODE_EMULATEX (0x0e5000f0, 0x004000b0, emulate_str,
1297 REGS(NOPCWB, NOPC, 0, 0, 0)),
1298
Jon Medhurst75f115c2011-06-07 09:58:11 +01001299 /* LDRH (immediate) cccc 000x x1x1 xxxx xxxx xxxx 1011 xxxx */
1300 /* LDRSB (immediate) cccc 000x x1x1 xxxx xxxx xxxx 1101 xxxx */
1301 /* LDRSH (immediate) cccc 000x x1x1 xxxx xxxx xxxx 1111 xxxx */
Jon Medhurst711bf102011-06-11 15:08:24 +01001302 DECODE_EMULATEX (0x0e500090, 0x00500090, emulate_ldr,
1303 REGS(NOPCWB, NOPC, 0, 0, 0)),
Jon Medhurst75f115c2011-06-07 09:58:11 +01001304
Jon Medhurst6c8a1922011-06-06 15:07:42 +01001305 DECODE_END
1306};
1307
Jon Medhurst3535a892011-06-06 16:52:50 +01001308static const union decode_item arm_cccc_000x_table[] = {
1309 /* Data-processing (register) */
1310
1311 /* <op>S PC, ... cccc 000x xxx1 xxxx 1111 xxxx xxxx xxxx */
1312 DECODE_REJECT (0x0e10f000, 0x0010f000),
1313
1314 /* MOV IP, SP 1110 0001 1010 0000 1100 0000 0000 1101 */
1315 DECODE_SIMULATE (0xffffffff, 0xe1a0c00d, simulate_mov_ipsp),
1316
1317 /* TST (register) cccc 0001 0001 xxxx xxxx xxxx xxx0 xxxx */
1318 /* TEQ (register) cccc 0001 0011 xxxx xxxx xxxx xxx0 xxxx */
1319 /* CMP (register) cccc 0001 0101 xxxx xxxx xxxx xxx0 xxxx */
1320 /* CMN (register) cccc 0001 0111 xxxx xxxx xxxx xxx0 xxxx */
1321 DECODE_EMULATEX (0x0f900010, 0x01100000, emulate_rd12rn16rm0rs8_rwflags,
1322 REGS(ANY, 0, 0, 0, ANY)),
1323
1324 /* MOV (register) cccc 0001 101x xxxx xxxx xxxx xxx0 xxxx */
1325 /* MVN (register) cccc 0001 111x xxxx xxxx xxxx xxx0 xxxx */
1326 DECODE_EMULATEX (0x0fa00010, 0x01a00000, emulate_rd12rn16rm0rs8_rwflags,
1327 REGS(0, ANY, 0, 0, ANY)),
1328
1329 /* AND (register) cccc 0000 000x xxxx xxxx xxxx xxx0 xxxx */
1330 /* EOR (register) cccc 0000 001x xxxx xxxx xxxx xxx0 xxxx */
1331 /* SUB (register) cccc 0000 010x xxxx xxxx xxxx xxx0 xxxx */
1332 /* RSB (register) cccc 0000 011x xxxx xxxx xxxx xxx0 xxxx */
1333 /* ADD (register) cccc 0000 100x xxxx xxxx xxxx xxx0 xxxx */
1334 /* ADC (register) cccc 0000 101x xxxx xxxx xxxx xxx0 xxxx */
1335 /* SBC (register) cccc 0000 110x xxxx xxxx xxxx xxx0 xxxx */
1336 /* RSC (register) cccc 0000 111x xxxx xxxx xxxx xxx0 xxxx */
1337 /* ORR (register) cccc 0001 100x xxxx xxxx xxxx xxx0 xxxx */
1338 /* BIC (register) cccc 0001 110x xxxx xxxx xxxx xxx0 xxxx */
1339 DECODE_EMULATEX (0x0e000010, 0x00000000, emulate_rd12rn16rm0rs8_rwflags,
1340 REGS(ANY, ANY, 0, 0, ANY)),
1341
1342 /* TST (reg-shift reg) cccc 0001 0001 xxxx xxxx xxxx 0xx1 xxxx */
1343 /* TEQ (reg-shift reg) cccc 0001 0011 xxxx xxxx xxxx 0xx1 xxxx */
1344 /* CMP (reg-shift reg) cccc 0001 0101 xxxx xxxx xxxx 0xx1 xxxx */
1345 /* CMN (reg-shift reg) cccc 0001 0111 xxxx xxxx xxxx 0xx1 xxxx */
1346 DECODE_EMULATEX (0x0f900090, 0x01100010, emulate_rd12rn16rm0rs8_rwflags,
1347 REGS(ANY, 0, NOPC, 0, ANY)),
1348
1349 /* MOV (reg-shift reg) cccc 0001 101x xxxx xxxx xxxx 0xx1 xxxx */
1350 /* MVN (reg-shift reg) cccc 0001 111x xxxx xxxx xxxx 0xx1 xxxx */
1351 DECODE_EMULATEX (0x0fa00090, 0x01a00010, emulate_rd12rn16rm0rs8_rwflags,
1352 REGS(0, ANY, NOPC, 0, ANY)),
1353
1354 /* AND (reg-shift reg) cccc 0000 000x xxxx xxxx xxxx 0xx1 xxxx */
1355 /* EOR (reg-shift reg) cccc 0000 001x xxxx xxxx xxxx 0xx1 xxxx */
1356 /* SUB (reg-shift reg) cccc 0000 010x xxxx xxxx xxxx 0xx1 xxxx */
1357 /* RSB (reg-shift reg) cccc 0000 011x xxxx xxxx xxxx 0xx1 xxxx */
1358 /* ADD (reg-shift reg) cccc 0000 100x xxxx xxxx xxxx 0xx1 xxxx */
1359 /* ADC (reg-shift reg) cccc 0000 101x xxxx xxxx xxxx 0xx1 xxxx */
1360 /* SBC (reg-shift reg) cccc 0000 110x xxxx xxxx xxxx 0xx1 xxxx */
1361 /* RSC (reg-shift reg) cccc 0000 111x xxxx xxxx xxxx 0xx1 xxxx */
1362 /* ORR (reg-shift reg) cccc 0001 100x xxxx xxxx xxxx 0xx1 xxxx */
1363 /* BIC (reg-shift reg) cccc 0001 110x xxxx xxxx xxxx 0xx1 xxxx */
1364 DECODE_EMULATEX (0x0e000090, 0x00000010, emulate_rd12rn16rm0rs8_rwflags,
1365 REGS(ANY, ANY, NOPC, 0, ANY)),
1366
1367 DECODE_END
1368};
1369
Jon Medhurstc038f3a2011-06-08 14:39:11 +01001370static const union decode_item arm_cccc_001x_table[] = {
1371 /* Data-processing (immediate) */
Jon Medhurstc9836772011-04-19 10:52:17 +01001372
Jon Medhurstc038f3a2011-06-08 14:39:11 +01001373 /* MOVW cccc 0011 0000 xxxx xxxx xxxx xxxx xxxx */
1374 /* MOVT cccc 0011 0100 xxxx xxxx xxxx xxxx xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001375 DECODE_EMULATEX (0x0fb00000, 0x03000000, emulate_rd12rm0_noflags_nopc,
1376 REGS(0, NOPC, 0, 0, 0)),
Jon Medhurst94254932011-04-19 10:52:19 +01001377
Jon Medhurstc038f3a2011-06-08 14:39:11 +01001378 /* YIELD cccc 0011 0010 0000 xxxx xxxx 0000 0001 */
1379 DECODE_OR (0x0fff00ff, 0x03200001),
1380 /* SEV cccc 0011 0010 0000 xxxx xxxx 0000 0100 */
1381 DECODE_EMULATE (0x0fff00ff, 0x03200004, kprobe_emulate_none),
1382 /* NOP cccc 0011 0010 0000 xxxx xxxx 0000 0000 */
1383 /* WFE cccc 0011 0010 0000 xxxx xxxx 0000 0010 */
1384 /* WFI cccc 0011 0010 0000 xxxx xxxx 0000 0011 */
1385 DECODE_SIMULATE (0x0fff00fc, 0x03200000, kprobe_simulate_nop),
1386 /* DBG cccc 0011 0010 0000 xxxx xxxx ffff xxxx */
1387 /* unallocated hints cccc 0011 0010 0000 xxxx xxxx xxxx xxxx */
1388 /* MSR (immediate) cccc 0011 0x10 xxxx xxxx xxxx xxxx xxxx */
1389 DECODE_REJECT (0x0fb00000, 0x03200000),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001390
Jon Medhurstc038f3a2011-06-08 14:39:11 +01001391 /* <op>S PC, ... cccc 001x xxx1 xxxx 1111 xxxx xxxx xxxx */
1392 DECODE_REJECT (0x0e10f000, 0x0210f000),
Jon Medhurstad111ce2011-04-06 11:17:11 +01001393
Jon Medhurstc038f3a2011-06-08 14:39:11 +01001394 /* TST (immediate) cccc 0011 0001 xxxx xxxx xxxx xxxx xxxx */
1395 /* TEQ (immediate) cccc 0011 0011 xxxx xxxx xxxx xxxx xxxx */
1396 /* CMP (immediate) cccc 0011 0101 xxxx xxxx xxxx xxxx xxxx */
1397 /* CMN (immediate) cccc 0011 0111 xxxx xxxx xxxx xxxx xxxx */
1398 DECODE_EMULATEX (0x0f900000, 0x03100000, emulate_rd12rn16rm0rs8_rwflags,
1399 REGS(ANY, 0, 0, 0, 0)),
1400
1401 /* MOV (immediate) cccc 0011 101x xxxx xxxx xxxx xxxx xxxx */
1402 /* MVN (immediate) cccc 0011 111x xxxx xxxx xxxx xxxx xxxx */
1403 DECODE_EMULATEX (0x0fa00000, 0x03a00000, emulate_rd12rn16rm0rs8_rwflags,
1404 REGS(0, ANY, 0, 0, 0)),
1405
1406 /* AND (immediate) cccc 0010 000x xxxx xxxx xxxx xxxx xxxx */
1407 /* EOR (immediate) cccc 0010 001x xxxx xxxx xxxx xxxx xxxx */
1408 /* SUB (immediate) cccc 0010 010x xxxx xxxx xxxx xxxx xxxx */
1409 /* RSB (immediate) cccc 0010 011x xxxx xxxx xxxx xxxx xxxx */
1410 /* ADD (immediate) cccc 0010 100x xxxx xxxx xxxx xxxx xxxx */
1411 /* ADC (immediate) cccc 0010 101x xxxx xxxx xxxx xxxx xxxx */
1412 /* SBC (immediate) cccc 0010 110x xxxx xxxx xxxx xxxx xxxx */
1413 /* RSC (immediate) cccc 0010 111x xxxx xxxx xxxx xxxx xxxx */
1414 /* ORR (immediate) cccc 0011 100x xxxx xxxx xxxx xxxx xxxx */
1415 /* BIC (immediate) cccc 0011 110x xxxx xxxx xxxx xxxx xxxx */
1416 DECODE_EMULATEX (0x0e000000, 0x02000000, emulate_rd12rn16rm0rs8_rwflags,
1417 REGS(ANY, ANY, 0, 0, 0)),
1418
1419 DECODE_END
1420};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001421
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001422static const union decode_item arm_cccc_0110_____xxx1_table[] = {
1423 /* Media instructions */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001424
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001425 /* SEL cccc 0110 1000 xxxx xxxx xxxx 1011 xxxx */
1426 DECODE_EMULATEX (0x0ff000f0, 0x068000b0, emulate_rd12rn16rm0_rwflags_nopc,
1427 REGS(NOPC, NOPC, 0, 0, NOPC)),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001428
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001429 /* SSAT cccc 0110 101x xxxx xxxx xxxx xx01 xxxx */
1430 /* USAT cccc 0110 111x xxxx xxxx xxxx xx01 xxxx */
1431 DECODE_OR(0x0fa00030, 0x06a00010),
1432 /* SSAT16 cccc 0110 1010 xxxx xxxx xxxx 0011 xxxx */
1433 /* USAT16 cccc 0110 1110 xxxx xxxx xxxx 0011 xxxx */
1434 DECODE_EMULATEX (0x0fb000f0, 0x06a00030, emulate_rd12rn16rm0_rwflags_nopc,
1435 REGS(0, NOPC, 0, 0, NOPC)),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001436
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001437 /* REV cccc 0110 1011 xxxx xxxx xxxx 0011 xxxx */
1438 /* REV16 cccc 0110 1011 xxxx xxxx xxxx 1011 xxxx */
1439 /* RBIT cccc 0110 1111 xxxx xxxx xxxx 0011 xxxx */
1440 /* REVSH cccc 0110 1111 xxxx xxxx xxxx 1011 xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001441 DECODE_EMULATEX (0x0fb00070, 0x06b00030, emulate_rd12rm0_noflags_nopc,
1442 REGS(0, NOPC, 0, 0, NOPC)),
Jon Medhurst780b5c12011-04-12 07:45:23 +01001443
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001444 /* ??? cccc 0110 0x00 xxxx xxxx xxxx xxx1 xxxx */
1445 DECODE_REJECT (0x0fb00010, 0x06000010),
1446 /* ??? cccc 0110 0xxx xxxx xxxx xxxx 1011 xxxx */
1447 DECODE_REJECT (0x0f8000f0, 0x060000b0),
1448 /* ??? cccc 0110 0xxx xxxx xxxx xxxx 1101 xxxx */
1449 DECODE_REJECT (0x0f8000f0, 0x060000d0),
1450 /* SADD16 cccc 0110 0001 xxxx xxxx xxxx 0001 xxxx */
1451 /* SADDSUBX cccc 0110 0001 xxxx xxxx xxxx 0011 xxxx */
1452 /* SSUBADDX cccc 0110 0001 xxxx xxxx xxxx 0101 xxxx */
1453 /* SSUB16 cccc 0110 0001 xxxx xxxx xxxx 0111 xxxx */
1454 /* SADD8 cccc 0110 0001 xxxx xxxx xxxx 1001 xxxx */
1455 /* SSUB8 cccc 0110 0001 xxxx xxxx xxxx 1111 xxxx */
1456 /* QADD16 cccc 0110 0010 xxxx xxxx xxxx 0001 xxxx */
1457 /* QADDSUBX cccc 0110 0010 xxxx xxxx xxxx 0011 xxxx */
1458 /* QSUBADDX cccc 0110 0010 xxxx xxxx xxxx 0101 xxxx */
1459 /* QSUB16 cccc 0110 0010 xxxx xxxx xxxx 0111 xxxx */
1460 /* QADD8 cccc 0110 0010 xxxx xxxx xxxx 1001 xxxx */
1461 /* QSUB8 cccc 0110 0010 xxxx xxxx xxxx 1111 xxxx */
1462 /* SHADD16 cccc 0110 0011 xxxx xxxx xxxx 0001 xxxx */
1463 /* SHADDSUBX cccc 0110 0011 xxxx xxxx xxxx 0011 xxxx */
1464 /* SHSUBADDX cccc 0110 0011 xxxx xxxx xxxx 0101 xxxx */
1465 /* SHSUB16 cccc 0110 0011 xxxx xxxx xxxx 0111 xxxx */
1466 /* SHADD8 cccc 0110 0011 xxxx xxxx xxxx 1001 xxxx */
1467 /* SHSUB8 cccc 0110 0011 xxxx xxxx xxxx 1111 xxxx */
1468 /* UADD16 cccc 0110 0101 xxxx xxxx xxxx 0001 xxxx */
1469 /* UADDSUBX cccc 0110 0101 xxxx xxxx xxxx 0011 xxxx */
1470 /* USUBADDX cccc 0110 0101 xxxx xxxx xxxx 0101 xxxx */
1471 /* USUB16 cccc 0110 0101 xxxx xxxx xxxx 0111 xxxx */
1472 /* UADD8 cccc 0110 0101 xxxx xxxx xxxx 1001 xxxx */
1473 /* USUB8 cccc 0110 0101 xxxx xxxx xxxx 1111 xxxx */
1474 /* UQADD16 cccc 0110 0110 xxxx xxxx xxxx 0001 xxxx */
1475 /* UQADDSUBX cccc 0110 0110 xxxx xxxx xxxx 0011 xxxx */
1476 /* UQSUBADDX cccc 0110 0110 xxxx xxxx xxxx 0101 xxxx */
1477 /* UQSUB16 cccc 0110 0110 xxxx xxxx xxxx 0111 xxxx */
1478 /* UQADD8 cccc 0110 0110 xxxx xxxx xxxx 1001 xxxx */
1479 /* UQSUB8 cccc 0110 0110 xxxx xxxx xxxx 1111 xxxx */
1480 /* UHADD16 cccc 0110 0111 xxxx xxxx xxxx 0001 xxxx */
1481 /* UHADDSUBX cccc 0110 0111 xxxx xxxx xxxx 0011 xxxx */
1482 /* UHSUBADDX cccc 0110 0111 xxxx xxxx xxxx 0101 xxxx */
1483 /* UHSUB16 cccc 0110 0111 xxxx xxxx xxxx 0111 xxxx */
1484 /* UHADD8 cccc 0110 0111 xxxx xxxx xxxx 1001 xxxx */
1485 /* UHSUB8 cccc 0110 0111 xxxx xxxx xxxx 1111 xxxx */
Jon Medhurst35fab772011-06-10 17:55:10 +01001486 DECODE_EMULATEX (0x0f800010, 0x06000010, emulate_rd12rn16rm0_rwflags_nopc,
1487 REGS(NOPC, NOPC, 0, 0, NOPC)),
Jon Medhurst780b5c12011-04-12 07:45:23 +01001488
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001489 /* PKHBT cccc 0110 1000 xxxx xxxx xxxx x001 xxxx */
1490 /* PKHTB cccc 0110 1000 xxxx xxxx xxxx x101 xxxx */
Jon Medhurst35fab772011-06-10 17:55:10 +01001491 DECODE_EMULATEX (0x0ff00030, 0x06800010, emulate_rd12rn16rm0_rwflags_nopc,
1492 REGS(NOPC, NOPC, 0, 0, NOPC)),
Jon Medhurst8dd7cfb2011-04-12 07:45:24 +01001493
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001494 /* ??? cccc 0110 1001 xxxx xxxx xxxx 0111 xxxx */
1495 /* ??? cccc 0110 1101 xxxx xxxx xxxx 0111 xxxx */
1496 DECODE_REJECT (0x0fb000f0, 0x06900070),
Jon Medhurst780b5c12011-04-12 07:45:23 +01001497
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001498 /* SXTB16 cccc 0110 1000 1111 xxxx xxxx 0111 xxxx */
1499 /* SXTB cccc 0110 1010 1111 xxxx xxxx 0111 xxxx */
1500 /* SXTH cccc 0110 1011 1111 xxxx xxxx 0111 xxxx */
1501 /* UXTB16 cccc 0110 1100 1111 xxxx xxxx 0111 xxxx */
1502 /* UXTB cccc 0110 1110 1111 xxxx xxxx 0111 xxxx */
1503 /* UXTH cccc 0110 1111 1111 xxxx xxxx 0111 xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001504 DECODE_EMULATEX (0x0f8f00f0, 0x068f0070, emulate_rd12rm0_noflags_nopc,
1505 REGS(0, NOPC, 0, 0, NOPC)),
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001506
1507 /* SXTAB16 cccc 0110 1000 xxxx xxxx xxxx 0111 xxxx */
1508 /* SXTAB cccc 0110 1010 xxxx xxxx xxxx 0111 xxxx */
1509 /* SXTAH cccc 0110 1011 xxxx xxxx xxxx 0111 xxxx */
1510 /* UXTAB16 cccc 0110 1100 xxxx xxxx xxxx 0111 xxxx */
1511 /* UXTAB cccc 0110 1110 xxxx xxxx xxxx 0111 xxxx */
1512 /* UXTAH cccc 0110 1111 xxxx xxxx xxxx 0111 xxxx */
Jon Medhurst35fab772011-06-10 17:55:10 +01001513 DECODE_EMULATEX (0x0f8000f0, 0x06800070, emulate_rd12rn16rm0_rwflags_nopc,
1514 REGS(NOPCX, NOPC, 0, 0, NOPC)),
Jon Medhurst2ce5d032011-06-08 17:36:45 +01001515
1516 DECODE_END
1517};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001518
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001519static const union decode_item arm_cccc_0111_____xxx1_table[] = {
1520 /* Media instructions */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001521
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001522 /* UNDEFINED cccc 0111 1111 xxxx xxxx xxxx 1111 xxxx */
1523 DECODE_REJECT (0x0ff000f0, 0x07f000f0),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001524
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001525 /* SMLALD cccc 0111 0100 xxxx xxxx xxxx 00x1 xxxx */
1526 /* SMLSLD cccc 0111 0100 xxxx xxxx xxxx 01x1 xxxx */
Jon Medhurst12ce5d32011-06-10 18:32:15 +01001527 DECODE_EMULATEX (0x0ff00090, 0x07400010, emulate_rdlo12rdhi16rn0rm8_rwflags_nopc,
1528 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst038c3832011-04-12 07:45:25 +01001529
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001530 /* SMUAD cccc 0111 0000 xxxx 1111 xxxx 00x1 xxxx */
1531 /* SMUSD cccc 0111 0000 xxxx 1111 xxxx 01x1 xxxx */
1532 DECODE_OR (0x0ff0f090, 0x0700f010),
1533 /* SMMUL cccc 0111 0101 xxxx 1111 xxxx 00x1 xxxx */
1534 DECODE_OR (0x0ff0f0d0, 0x0750f010),
1535 /* USAD8 cccc 0111 1000 xxxx 1111 xxxx 0001 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001536 DECODE_EMULATEX (0x0ff0f0f0, 0x0780f010, emulate_rd16rn12rm0rs8_rwflags_nopc,
1537 REGS(NOPC, 0, NOPC, 0, NOPC)),
Jon Medhurst038c3832011-04-12 07:45:25 +01001538
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001539 /* SMLAD cccc 0111 0000 xxxx xxxx xxxx 00x1 xxxx */
1540 /* SMLSD cccc 0111 0000 xxxx xxxx xxxx 01x1 xxxx */
1541 DECODE_OR (0x0ff00090, 0x07000010),
1542 /* SMMLA cccc 0111 0101 xxxx xxxx xxxx 00x1 xxxx */
1543 DECODE_OR (0x0ff000d0, 0x07500010),
1544 /* USADA8 cccc 0111 1000 xxxx xxxx xxxx 0001 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001545 DECODE_EMULATEX (0x0ff000f0, 0x07800010, emulate_rd16rn12rm0rs8_rwflags_nopc,
1546 REGS(NOPC, NOPCX, NOPC, 0, NOPC)),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001547
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001548 /* SMMLS cccc 0111 0101 xxxx xxxx xxxx 11x1 xxxx */
Jon Medhurst6091dfa2011-06-10 17:35:51 +01001549 DECODE_EMULATEX (0x0ff000d0, 0x075000d0, emulate_rd16rn12rm0rs8_rwflags_nopc,
1550 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
Jon Medhurst20e81552011-04-19 10:52:18 +01001551
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001552 /* SBFX cccc 0111 101x xxxx xxxx xxxx x101 xxxx */
1553 /* UBFX cccc 0111 111x xxxx xxxx xxxx x101 xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001554 DECODE_EMULATEX (0x0fa00070, 0x07a00050, emulate_rd12rm0_noflags_nopc,
1555 REGS(0, NOPC, 0, 0, NOPC)),
Jon Medhurst20e81552011-04-19 10:52:18 +01001556
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001557 /* BFC cccc 0111 110x xxxx xxxx xxxx x001 1111 */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001558 DECODE_EMULATEX (0x0fe0007f, 0x07c0001f, emulate_rd12rm0_noflags_nopc,
1559 REGS(0, NOPC, 0, 0, 0)),
Jon Medhurst20e81552011-04-19 10:52:18 +01001560
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001561 /* BFI cccc 0111 110x xxxx xxxx xxxx x001 xxxx */
Jon Medhurstc82584e2011-06-10 18:10:36 +01001562 DECODE_EMULATEX (0x0fe00070, 0x07c00010, emulate_rd12rm0_noflags_nopc,
1563 REGS(0, NOPC, 0, 0, NOPCX)),
Jon Medhurstad2e81a2011-06-08 18:09:36 +01001564
1565 DECODE_END
1566};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001567
Jon Medhurst56d8fbd2011-06-09 09:12:58 +01001568static const union decode_item arm_cccc_01xx_table[] = {
1569 /* Load/store word and unsigned byte */
Jon Medhurst81ff5722011-04-12 07:45:21 +01001570
Jon Medhurst56d8fbd2011-06-09 09:12:58 +01001571 /* LDRB/STRB pc,[...] cccc 01xx x0xx xxxx xxxx xxxx xxxx xxxx */
1572 DECODE_REJECT (0x0c40f000, 0x0440f000),
Jon Medhurst81ff5722011-04-12 07:45:21 +01001573
Jon Medhurst465f1ea2011-06-11 15:16:41 +01001574 /* STRT cccc 01x0 x010 xxxx xxxx xxxx xxxx xxxx */
1575 /* LDRT cccc 01x0 x011 xxxx xxxx xxxx xxxx xxxx */
1576 /* STRBT cccc 01x0 x110 xxxx xxxx xxxx xxxx xxxx */
1577 /* LDRBT cccc 01x0 x111 xxxx xxxx xxxx xxxx xxxx */
1578 DECODE_REJECT (0x0d200000, 0x04200000),
1579
Jon Medhurst711bf102011-06-11 15:08:24 +01001580 /* STR (immediate) cccc 010x x0x0 xxxx xxxx xxxx xxxx xxxx */
1581 /* STRB (immediate) cccc 010x x1x0 xxxx xxxx xxxx xxxx xxxx */
1582 DECODE_EMULATEX (0x0e100000, 0x04000000, emulate_str,
1583 REGS(NOPCWB, ANY, 0, 0, 0)),
1584
1585 /* LDR (immediate) cccc 010x x0x1 xxxx xxxx xxxx xxxx xxxx */
1586 /* LDRB (immediate) cccc 010x x1x1 xxxx xxxx xxxx xxxx xxxx */
1587 DECODE_EMULATEX (0x0e100000, 0x04100000, emulate_ldr,
1588 REGS(NOPCWB, ANY, 0, 0, 0)),
1589
1590 /* STR (register) cccc 011x x0x0 xxxx xxxx xxxx xxxx xxxx */
1591 /* STRB (register) cccc 011x x1x0 xxxx xxxx xxxx xxxx xxxx */
1592 DECODE_EMULATEX (0x0e100000, 0x06000000, emulate_str,
1593 REGS(NOPCWB, ANY, 0, 0, NOPC)),
1594
1595 /* LDR (register) cccc 011x x0x1 xxxx xxxx xxxx xxxx xxxx */
1596 /* LDRB (register) cccc 011x x1x1 xxxx xxxx xxxx xxxx xxxx */
1597 DECODE_EMULATEX (0x0e100000, 0x06100000, emulate_ldr,
1598 REGS(NOPCWB, ANY, 0, 0, NOPC)),
Jon Medhurst56d8fbd2011-06-09 09:12:58 +01001599
1600 DECODE_END
1601};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001602
Jon Medhurst0d32e7d2011-06-09 09:46:56 +01001603static const union decode_item arm_cccc_100x_table[] = {
1604 /* Block data transfer instructions */
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001605
Jon Medhurst0d32e7d2011-06-09 09:46:56 +01001606 /* LDM cccc 100x x0x1 xxxx xxxx xxxx xxxx xxxx */
1607 /* STM cccc 100x x0x0 xxxx xxxx xxxx xxxx xxxx */
1608 DECODE_CUSTOM (0x0e400000, 0x08000000, kprobe_decode_ldmstm),
Jon Medhurst235a4ce2011-07-07 08:57:22 +01001609
Jon Medhurst0d32e7d2011-06-09 09:46:56 +01001610 /* STM (user registers) cccc 100x x1x0 xxxx xxxx xxxx xxxx xxxx */
1611 /* LDM (user registers) cccc 100x x1x1 xxxx 0xxx xxxx xxxx xxxx */
1612 /* LDM (exception ret) cccc 100x x1x1 xxxx 1xxx xxxx xxxx xxxx */
1613 DECODE_END
1614};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001615
Jon Medhurste9a92852011-06-10 11:36:36 +01001616const union decode_item kprobe_decode_arm_table[] = {
1617 /*
1618 * Unconditional instructions
1619 * 1111 xxxx xxxx xxxx xxxx xxxx xxxx xxxx
1620 */
1621 DECODE_TABLE (0xf0000000, 0xf0000000, arm_1111_table),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001622
Jon Medhurste9a92852011-06-10 11:36:36 +01001623 /*
1624 * Miscellaneous instructions
1625 * cccc 0001 0xx0 xxxx xxxx xxxx 0xxx xxxx
1626 */
1627 DECODE_TABLE (0x0f900080, 0x01000000, arm_cccc_0001_0xx0____0xxx_table),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001628
Jon Medhurste9a92852011-06-10 11:36:36 +01001629 /*
1630 * Halfword multiply and multiply-accumulate
1631 * cccc 0001 0xx0 xxxx xxxx xxxx 1xx0 xxxx
1632 */
1633 DECODE_TABLE (0x0f900090, 0x01000080, arm_cccc_0001_0xx0____1xx0_table),
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001634
Jon Medhurste9a92852011-06-10 11:36:36 +01001635 /*
1636 * Multiply and multiply-accumulate
1637 * cccc 0000 xxxx xxxx xxxx xxxx 1001 xxxx
1638 */
1639 DECODE_TABLE (0x0f0000f0, 0x00000090, arm_cccc_0000_____1001_table),
1640
1641 /*
1642 * Synchronization primitives
1643 * cccc 0001 xxxx xxxx xxxx xxxx 1001 xxxx
1644 */
1645 DECODE_TABLE (0x0f0000f0, 0x01000090, arm_cccc_0001_____1001_table),
1646
1647 /*
1648 * Extra load/store instructions
1649 * cccc 000x xxxx xxxx xxxx xxxx 1xx1 xxxx
1650 */
1651 DECODE_TABLE (0x0e000090, 0x00000090, arm_cccc_000x_____1xx1_table),
1652
1653 /*
1654 * Data-processing (register)
1655 * cccc 000x xxxx xxxx xxxx xxxx xxx0 xxxx
1656 * Data-processing (register-shifted register)
1657 * cccc 000x xxxx xxxx xxxx xxxx 0xx1 xxxx
1658 */
1659 DECODE_TABLE (0x0e000000, 0x00000000, arm_cccc_000x_table),
1660
1661 /*
1662 * Data-processing (immediate)
1663 * cccc 001x xxxx xxxx xxxx xxxx xxxx xxxx
1664 */
1665 DECODE_TABLE (0x0e000000, 0x02000000, arm_cccc_001x_table),
1666
1667 /*
1668 * Media instructions
1669 * cccc 011x xxxx xxxx xxxx xxxx xxx1 xxxx
1670 */
1671 DECODE_TABLE (0x0f000010, 0x06000010, arm_cccc_0110_____xxx1_table),
1672 DECODE_TABLE (0x0f000010, 0x07000010, arm_cccc_0111_____xxx1_table),
1673
1674 /*
1675 * Load/store word and unsigned byte
1676 * cccc 01xx xxxx xxxx xxxx xxxx xxxx xxxx
1677 */
1678 DECODE_TABLE (0x0c000000, 0x04000000, arm_cccc_01xx_table),
1679
1680 /*
1681 * Block data transfer instructions
1682 * cccc 100x xxxx xxxx xxxx xxxx xxxx xxxx
1683 */
1684 DECODE_TABLE (0x0e000000, 0x08000000, arm_cccc_100x_table),
1685
1686 /* B cccc 1010 xxxx xxxx xxxx xxxx xxxx xxxx */
1687 /* BL cccc 1011 xxxx xxxx xxxx xxxx xxxx xxxx */
1688 DECODE_SIMULATE (0x0e000000, 0x0a000000, simulate_bbl),
1689
1690 /*
1691 * Supervisor Call, and coprocessor instructions
1692 */
1693
1694 /* MCRR cccc 1100 0100 xxxx xxxx xxxx xxxx xxxx */
1695 /* MRRC cccc 1100 0101 xxxx xxxx xxxx xxxx xxxx */
1696 /* LDC cccc 110x xxx1 xxxx xxxx xxxx xxxx xxxx */
1697 /* STC cccc 110x xxx0 xxxx xxxx xxxx xxxx xxxx */
1698 /* CDP cccc 1110 xxxx xxxx xxxx xxxx xxx0 xxxx */
1699 /* MCR cccc 1110 xxx0 xxxx xxxx xxxx xxx1 xxxx */
1700 /* MRC cccc 1110 xxx1 xxxx xxxx xxxx xxx1 xxxx */
1701 /* SVC cccc 1111 xxxx xxxx xxxx xxxx xxxx xxxx */
1702 DECODE_REJECT (0x0c000000, 0x0c000000),
1703
1704 DECODE_END
1705};
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001706
Jon Medhurstc6a7d972011-06-09 12:11:27 +01001707static void __kprobes arm_singlestep(struct kprobe *p, struct pt_regs *regs)
1708{
1709 regs->ARM_pc += 4;
1710 p->ainsn.insn_handler(p, regs);
1711}
1712
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001713/* Return:
1714 * INSN_REJECTED If instruction is one not allowed to kprobe,
1715 * INSN_GOOD If instruction is supported and uses instruction slot,
1716 * INSN_GOOD_NO_SLOT If instruction is supported but doesn't use its slot.
1717 *
1718 * For instructions we don't want to kprobe (INSN_REJECTED return result):
1719 * These are generally ones that modify the processor state making
1720 * them "hard" to simulate such as switches processor modes or
1721 * make accesses in alternate modes. Any of these could be simulated
1722 * if the work was put into it, but low return considering they
1723 * should also be very rare.
1724 */
1725enum kprobe_insn __kprobes
1726arm_kprobe_decode_insn(kprobe_opcode_t insn, struct arch_specific_insn *asi)
1727{
Jon Medhurstc6a7d972011-06-09 12:11:27 +01001728 asi->insn_singlestep = arm_singlestep;
Jon Medhurst0ab4c022011-07-06 11:25:18 +01001729 asi->insn_check_cc = kprobe_condition_checks[insn>>28];
Jon Medhurste9a92852011-06-10 11:36:36 +01001730 return kprobe_decode_insn(insn, asi, kprobe_decode_arm_table, false);
Quentin Barnes35aa1df2007-06-11 22:20:10 +00001731}