linux/arch/arm/probes/decode-arm.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 *
   4 * arch/arm/probes/decode-arm.c
   5 *
   6 * Some code moved here from arch/arm/kernel/kprobes-arm.c
   7 *
   8 * Copyright (C) 2006, 2007 Motorola Inc.
   9 */
  10
  11#include <linux/kernel.h>
  12#include <linux/module.h>
  13#include <linux/stddef.h>
  14#include <linux/ptrace.h>
  15
  16#include "decode.h"
  17#include "decode-arm.h"
  18
  19#define sign_extend(x, signbit) ((x) | (0 - ((x) & (1 << (signbit)))))
  20
  21#define branch_displacement(insn) sign_extend(((insn) & 0xffffff) << 2, 25)
  22
  23/*
  24 * To avoid the complications of mimicing single-stepping on a
  25 * processor without a Next-PC or a single-step mode, and to
  26 * avoid having to deal with the side-effects of boosting, we
  27 * simulate or emulate (almost) all ARM instructions.
  28 *
  29 * "Simulation" is where the instruction's behavior is duplicated in
  30 * C code.  "Emulation" is where the original instruction is rewritten
  31 * and executed, often by altering its registers.
  32 *
  33 * By having all behavior of the kprobe'd instruction completed before
  34 * returning from the kprobe_handler(), all locks (scheduler and
  35 * interrupt) can safely be released.  There is no need for secondary
  36 * breakpoints, no race with MP or preemptable kernels, nor having to
  37 * clean up resources counts at a later time impacting overall system
  38 * performance.  By rewriting the instruction, only the minimum registers
  39 * need to be loaded and saved back optimizing performance.
  40 *
  41 * Calling the insnslot_*_rwflags version of a function doesn't hurt
  42 * anything even when the CPSR flags aren't updated by the
  43 * instruction.  It's just a little slower in return for saving
  44 * a little space by not having a duplicate function that doesn't
  45 * update the flags.  (The same optimization can be said for
  46 * instructions that do or don't perform register writeback)
  47 * Also, instructions can either read the flags, only write the
  48 * flags, or read and write the flags.  To save combinations
  49 * rather than for sheer performance, flag functions just assume
  50 * read and write of flags.
  51 */
  52
  53void __kprobes simulate_bbl(probes_opcode_t insn,
  54                struct arch_probes_insn *asi, struct pt_regs *regs)
  55{
  56        long iaddr = (long) regs->ARM_pc - 4;
  57        int disp  = branch_displacement(insn);
  58
  59        if (insn & (1 << 24))
  60                regs->ARM_lr = iaddr + 4;
  61
  62        regs->ARM_pc = iaddr + 8 + disp;
  63}
  64
  65void __kprobes simulate_blx1(probes_opcode_t insn,
  66                struct arch_probes_insn *asi, struct pt_regs *regs)
  67{
  68        long iaddr = (long) regs->ARM_pc - 4;
  69        int disp = branch_displacement(insn);
  70
  71        regs->ARM_lr = iaddr + 4;
  72        regs->ARM_pc = iaddr + 8 + disp + ((insn >> 23) & 0x2);
  73        regs->ARM_cpsr |= PSR_T_BIT;
  74}
  75
  76void __kprobes simulate_blx2bx(probes_opcode_t insn,
  77                struct arch_probes_insn *asi, struct pt_regs *regs)
  78{
  79        int rm = insn & 0xf;
  80        long rmv = regs->uregs[rm];
  81
  82        if (insn & (1 << 5))
  83                regs->ARM_lr = (long) regs->ARM_pc;
  84
  85        regs->ARM_pc = rmv & ~0x1;
  86        regs->ARM_cpsr &= ~PSR_T_BIT;
  87        if (rmv & 0x1)
  88                regs->ARM_cpsr |= PSR_T_BIT;
  89}
  90
  91void __kprobes simulate_mrs(probes_opcode_t insn,
  92                struct arch_probes_insn *asi, struct pt_regs *regs)
  93{
  94        int rd = (insn >> 12) & 0xf;
  95        unsigned long mask = 0xf8ff03df; /* Mask out execution state */
  96        regs->uregs[rd] = regs->ARM_cpsr & mask;
  97}
  98
  99void __kprobes simulate_mov_ipsp(probes_opcode_t insn,
 100                struct arch_probes_insn *asi, struct pt_regs *regs)
 101{
 102        regs->uregs[12] = regs->uregs[13];
 103}
 104
 105/*
 106 * For the instruction masking and comparisons in all the "space_*"
 107 * functions below, Do _not_ rearrange the order of tests unless
 108 * you're very, very sure of what you are doing.  For the sake of
 109 * efficiency, the masks for some tests sometimes assume other test
 110 * have been done prior to them so the number of patterns to test
 111 * for an instruction set can be as broad as possible to reduce the
 112 * number of tests needed.
 113 */
 114
 115static const union decode_item arm_1111_table[] = {
 116        /* Unconditional instructions                                   */
 117
 118        /* memory hint          1111 0100 x001 xxxx xxxx xxxx xxxx xxxx */
 119        /* PLDI (immediate)     1111 0100 x101 xxxx xxxx xxxx xxxx xxxx */
 120        /* PLDW (immediate)     1111 0101 x001 xxxx xxxx xxxx xxxx xxxx */
 121        /* PLD (immediate)      1111 0101 x101 xxxx xxxx xxxx xxxx xxxx */
 122        DECODE_SIMULATE (0xfe300000, 0xf4100000, PROBES_PRELOAD_IMM),
 123
 124        /* memory hint          1111 0110 x001 xxxx xxxx xxxx xxx0 xxxx */
 125        /* PLDI (register)      1111 0110 x101 xxxx xxxx xxxx xxx0 xxxx */
 126        /* PLDW (register)      1111 0111 x001 xxxx xxxx xxxx xxx0 xxxx */
 127        /* PLD (register)       1111 0111 x101 xxxx xxxx xxxx xxx0 xxxx */
 128        DECODE_SIMULATE (0xfe300010, 0xf6100000, PROBES_PRELOAD_REG),
 129
 130        /* BLX (immediate)      1111 101x xxxx xxxx xxxx xxxx xxxx xxxx */
 131        DECODE_SIMULATE (0xfe000000, 0xfa000000, PROBES_BRANCH_IMM),
 132
 133        /* CPS                  1111 0001 0000 xxx0 xxxx xxxx xx0x xxxx */
 134        /* SETEND               1111 0001 0000 0001 xxxx xxxx 0000 xxxx */
 135        /* SRS                  1111 100x x1x0 xxxx xxxx xxxx xxxx xxxx */
 136        /* RFE                  1111 100x x0x1 xxxx xxxx xxxx xxxx xxxx */
 137
 138        /* Coprocessor instructions... */
 139        /* MCRR2                1111 1100 0100 xxxx xxxx xxxx xxxx xxxx */
 140        /* MRRC2                1111 1100 0101 xxxx xxxx xxxx xxxx xxxx */
 141        /* LDC2                 1111 110x xxx1 xxxx xxxx xxxx xxxx xxxx */
 142        /* STC2                 1111 110x xxx0 xxxx xxxx xxxx xxxx xxxx */
 143        /* CDP2                 1111 1110 xxxx xxxx xxxx xxxx xxx0 xxxx */
 144        /* MCR2                 1111 1110 xxx0 xxxx xxxx xxxx xxx1 xxxx */
 145        /* MRC2                 1111 1110 xxx1 xxxx xxxx xxxx xxx1 xxxx */
 146
 147        /* Other unallocated instructions...                            */
 148        DECODE_END
 149};
 150
 151static const union decode_item arm_cccc_0001_0xx0____0xxx_table[] = {
 152        /* Miscellaneous instructions                                   */
 153
 154        /* MRS cpsr             cccc 0001 0000 xxxx xxxx xxxx 0000 xxxx */
 155        DECODE_SIMULATEX(0x0ff000f0, 0x01000000, PROBES_MRS,
 156                                                 REGS(0, NOPC, 0, 0, 0)),
 157
 158        /* BX                   cccc 0001 0010 xxxx xxxx xxxx 0001 xxxx */
 159        DECODE_SIMULATE (0x0ff000f0, 0x01200010, PROBES_BRANCH_REG),
 160
 161        /* BLX (register)       cccc 0001 0010 xxxx xxxx xxxx 0011 xxxx */
 162        DECODE_SIMULATEX(0x0ff000f0, 0x01200030, PROBES_BRANCH_REG,
 163                                                 REGS(0, 0, 0, 0, NOPC)),
 164
 165        /* CLZ                  cccc 0001 0110 xxxx xxxx xxxx 0001 xxxx */
 166        DECODE_EMULATEX (0x0ff000f0, 0x01600010, PROBES_CLZ,
 167                                                 REGS(0, NOPC, 0, 0, NOPC)),
 168
 169        /* QADD                 cccc 0001 0000 xxxx xxxx xxxx 0101 xxxx */
 170        /* QSUB                 cccc 0001 0010 xxxx xxxx xxxx 0101 xxxx */
 171        /* QDADD                cccc 0001 0100 xxxx xxxx xxxx 0101 xxxx */
 172        /* QDSUB                cccc 0001 0110 xxxx xxxx xxxx 0101 xxxx */
 173        DECODE_EMULATEX (0x0f9000f0, 0x01000050, PROBES_SATURATING_ARITHMETIC,
 174                                                 REGS(NOPC, NOPC, 0, 0, NOPC)),
 175
 176        /* BXJ                  cccc 0001 0010 xxxx xxxx xxxx 0010 xxxx */
 177        /* MSR                  cccc 0001 0x10 xxxx xxxx xxxx 0000 xxxx */
 178        /* MRS spsr             cccc 0001 0100 xxxx xxxx xxxx 0000 xxxx */
 179        /* BKPT                 1110 0001 0010 xxxx xxxx xxxx 0111 xxxx */
 180        /* SMC                  cccc 0001 0110 xxxx xxxx xxxx 0111 xxxx */
 181        /* And unallocated instructions...                              */
 182        DECODE_END
 183};
 184
 185static const union decode_item arm_cccc_0001_0xx0____1xx0_table[] = {
 186        /* Halfword multiply and multiply-accumulate                    */
 187
 188        /* SMLALxy              cccc 0001 0100 xxxx xxxx xxxx 1xx0 xxxx */
 189        DECODE_EMULATEX (0x0ff00090, 0x01400080, PROBES_MUL1,
 190                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 191
 192        /* SMULWy               cccc 0001 0010 xxxx xxxx xxxx 1x10 xxxx */
 193        DECODE_OR       (0x0ff000b0, 0x012000a0),
 194        /* SMULxy               cccc 0001 0110 xxxx xxxx xxxx 1xx0 xxxx */
 195        DECODE_EMULATEX (0x0ff00090, 0x01600080, PROBES_MUL2,
 196                                                 REGS(NOPC, 0, NOPC, 0, NOPC)),
 197
 198        /* SMLAxy               cccc 0001 0000 xxxx xxxx xxxx 1xx0 xxxx */
 199        DECODE_OR       (0x0ff00090, 0x01000080),
 200        /* SMLAWy               cccc 0001 0010 xxxx xxxx xxxx 1x00 xxxx */
 201        DECODE_EMULATEX (0x0ff000b0, 0x01200080, PROBES_MUL2,
 202                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 203
 204        DECODE_END
 205};
 206
 207static const union decode_item arm_cccc_0000_____1001_table[] = {
 208        /* Multiply and multiply-accumulate                             */
 209
 210        /* MUL                  cccc 0000 0000 xxxx xxxx xxxx 1001 xxxx */
 211        /* MULS                 cccc 0000 0001 xxxx xxxx xxxx 1001 xxxx */
 212        DECODE_EMULATEX (0x0fe000f0, 0x00000090, PROBES_MUL2,
 213                                                 REGS(NOPC, 0, NOPC, 0, NOPC)),
 214
 215        /* MLA                  cccc 0000 0010 xxxx xxxx xxxx 1001 xxxx */
 216        /* MLAS                 cccc 0000 0011 xxxx xxxx xxxx 1001 xxxx */
 217        DECODE_OR       (0x0fe000f0, 0x00200090),
 218        /* MLS                  cccc 0000 0110 xxxx xxxx xxxx 1001 xxxx */
 219        DECODE_EMULATEX (0x0ff000f0, 0x00600090, PROBES_MUL2,
 220                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 221
 222        /* UMAAL                cccc 0000 0100 xxxx xxxx xxxx 1001 xxxx */
 223        DECODE_OR       (0x0ff000f0, 0x00400090),
 224        /* UMULL                cccc 0000 1000 xxxx xxxx xxxx 1001 xxxx */
 225        /* UMULLS               cccc 0000 1001 xxxx xxxx xxxx 1001 xxxx */
 226        /* UMLAL                cccc 0000 1010 xxxx xxxx xxxx 1001 xxxx */
 227        /* UMLALS               cccc 0000 1011 xxxx xxxx xxxx 1001 xxxx */
 228        /* SMULL                cccc 0000 1100 xxxx xxxx xxxx 1001 xxxx */
 229        /* SMULLS               cccc 0000 1101 xxxx xxxx xxxx 1001 xxxx */
 230        /* SMLAL                cccc 0000 1110 xxxx xxxx xxxx 1001 xxxx */
 231        /* SMLALS               cccc 0000 1111 xxxx xxxx xxxx 1001 xxxx */
 232        DECODE_EMULATEX (0x0f8000f0, 0x00800090, PROBES_MUL1,
 233                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 234
 235        DECODE_END
 236};
 237
 238static const union decode_item arm_cccc_0001_____1001_table[] = {
 239        /* Synchronization primitives                                   */
 240
 241#if __LINUX_ARM_ARCH__ < 6
 242        /* Deprecated on ARMv6 and may be UNDEFINED on v7               */
 243        /* SMP/SWPB             cccc 0001 0x00 xxxx xxxx xxxx 1001 xxxx */
 244        DECODE_EMULATEX (0x0fb000f0, 0x01000090, PROBES_SWP,
 245                                                 REGS(NOPC, NOPC, 0, 0, NOPC)),
 246#endif
 247        /* LDREX/STREX{,D,B,H}  cccc 0001 1xxx xxxx xxxx xxxx 1001 xxxx */
 248        /* And unallocated instructions...                              */
 249        DECODE_END
 250};
 251
 252static const union decode_item arm_cccc_000x_____1xx1_table[] = {
 253        /* Extra load/store instructions                                */
 254
 255        /* STRHT                cccc 0000 xx10 xxxx xxxx xxxx 1011 xxxx */
 256        /* ???                  cccc 0000 xx10 xxxx xxxx xxxx 11x1 xxxx */
 257        /* LDRHT                cccc 0000 xx11 xxxx xxxx xxxx 1011 xxxx */
 258        /* LDRSBT               cccc 0000 xx11 xxxx xxxx xxxx 1101 xxxx */
 259        /* LDRSHT               cccc 0000 xx11 xxxx xxxx xxxx 1111 xxxx */
 260        DECODE_REJECT   (0x0f200090, 0x00200090),
 261
 262        /* LDRD/STRD lr,pc,{... cccc 000x x0x0 xxxx 111x xxxx 1101 xxxx */
 263        DECODE_REJECT   (0x0e10e0d0, 0x0000e0d0),
 264
 265        /* LDRD (register)      cccc 000x x0x0 xxxx xxxx xxxx 1101 xxxx */
 266        /* STRD (register)      cccc 000x x0x0 xxxx xxxx xxxx 1111 xxxx */
 267        DECODE_EMULATEX (0x0e5000d0, 0x000000d0, PROBES_LDRSTRD,
 268                                                 REGS(NOPCWB, NOPCX, 0, 0, NOPC)),
 269
 270        /* LDRD (immediate)     cccc 000x x1x0 xxxx xxxx xxxx 1101 xxxx */
 271        /* STRD (immediate)     cccc 000x x1x0 xxxx xxxx xxxx 1111 xxxx */
 272        DECODE_EMULATEX (0x0e5000d0, 0x004000d0, PROBES_LDRSTRD,
 273                                                 REGS(NOPCWB, NOPCX, 0, 0, 0)),
 274
 275        /* STRH (register)      cccc 000x x0x0 xxxx xxxx xxxx 1011 xxxx */
 276        DECODE_EMULATEX (0x0e5000f0, 0x000000b0, PROBES_STORE_EXTRA,
 277                                                 REGS(NOPCWB, NOPC, 0, 0, NOPC)),
 278
 279        /* LDRH (register)      cccc 000x x0x1 xxxx xxxx xxxx 1011 xxxx */
 280        /* LDRSB (register)     cccc 000x x0x1 xxxx xxxx xxxx 1101 xxxx */
 281        /* LDRSH (register)     cccc 000x x0x1 xxxx xxxx xxxx 1111 xxxx */
 282        DECODE_EMULATEX (0x0e500090, 0x00100090, PROBES_LOAD_EXTRA,
 283                                                 REGS(NOPCWB, NOPC, 0, 0, NOPC)),
 284
 285        /* STRH (immediate)     cccc 000x x1x0 xxxx xxxx xxxx 1011 xxxx */
 286        DECODE_EMULATEX (0x0e5000f0, 0x004000b0, PROBES_STORE_EXTRA,
 287                                                 REGS(NOPCWB, NOPC, 0, 0, 0)),
 288
 289        /* LDRH (immediate)     cccc 000x x1x1 xxxx xxxx xxxx 1011 xxxx */
 290        /* LDRSB (immediate)    cccc 000x x1x1 xxxx xxxx xxxx 1101 xxxx */
 291        /* LDRSH (immediate)    cccc 000x x1x1 xxxx xxxx xxxx 1111 xxxx */
 292        DECODE_EMULATEX (0x0e500090, 0x00500090, PROBES_LOAD_EXTRA,
 293                                                 REGS(NOPCWB, NOPC, 0, 0, 0)),
 294
 295        DECODE_END
 296};
 297
 298static const union decode_item arm_cccc_000x_table[] = {
 299        /* Data-processing (register)                                   */
 300
 301        /* <op>S PC, ...        cccc 000x xxx1 xxxx 1111 xxxx xxxx xxxx */
 302        DECODE_REJECT   (0x0e10f000, 0x0010f000),
 303
 304        /* MOV IP, SP           1110 0001 1010 0000 1100 0000 0000 1101 */
 305        DECODE_SIMULATE (0xffffffff, 0xe1a0c00d, PROBES_MOV_IP_SP),
 306
 307        /* TST (register)       cccc 0001 0001 xxxx xxxx xxxx xxx0 xxxx */
 308        /* TEQ (register)       cccc 0001 0011 xxxx xxxx xxxx xxx0 xxxx */
 309        /* CMP (register)       cccc 0001 0101 xxxx xxxx xxxx xxx0 xxxx */
 310        /* CMN (register)       cccc 0001 0111 xxxx xxxx xxxx xxx0 xxxx */
 311        DECODE_EMULATEX (0x0f900010, 0x01100000, PROBES_DATA_PROCESSING_REG,
 312                                                 REGS(ANY, 0, 0, 0, ANY)),
 313
 314        /* MOV (register)       cccc 0001 101x xxxx xxxx xxxx xxx0 xxxx */
 315        /* MVN (register)       cccc 0001 111x xxxx xxxx xxxx xxx0 xxxx */
 316        DECODE_EMULATEX (0x0fa00010, 0x01a00000, PROBES_DATA_PROCESSING_REG,
 317                                                 REGS(0, ANY, 0, 0, ANY)),
 318
 319        /* AND (register)       cccc 0000 000x xxxx xxxx xxxx xxx0 xxxx */
 320        /* EOR (register)       cccc 0000 001x xxxx xxxx xxxx xxx0 xxxx */
 321        /* SUB (register)       cccc 0000 010x xxxx xxxx xxxx xxx0 xxxx */
 322        /* RSB (register)       cccc 0000 011x xxxx xxxx xxxx xxx0 xxxx */
 323        /* ADD (register)       cccc 0000 100x xxxx xxxx xxxx xxx0 xxxx */
 324        /* ADC (register)       cccc 0000 101x xxxx xxxx xxxx xxx0 xxxx */
 325        /* SBC (register)       cccc 0000 110x xxxx xxxx xxxx xxx0 xxxx */
 326        /* RSC (register)       cccc 0000 111x xxxx xxxx xxxx xxx0 xxxx */
 327        /* ORR (register)       cccc 0001 100x xxxx xxxx xxxx xxx0 xxxx */
 328        /* BIC (register)       cccc 0001 110x xxxx xxxx xxxx xxx0 xxxx */
 329        DECODE_EMULATEX (0x0e000010, 0x00000000, PROBES_DATA_PROCESSING_REG,
 330                                                 REGS(ANY, ANY, 0, 0, ANY)),
 331
 332        /* TST (reg-shift reg)  cccc 0001 0001 xxxx xxxx xxxx 0xx1 xxxx */
 333        /* TEQ (reg-shift reg)  cccc 0001 0011 xxxx xxxx xxxx 0xx1 xxxx */
 334        /* CMP (reg-shift reg)  cccc 0001 0101 xxxx xxxx xxxx 0xx1 xxxx */
 335        /* CMN (reg-shift reg)  cccc 0001 0111 xxxx xxxx xxxx 0xx1 xxxx */
 336        DECODE_EMULATEX (0x0f900090, 0x01100010, PROBES_DATA_PROCESSING_REG,
 337                                                 REGS(NOPC, 0, NOPC, 0, NOPC)),
 338
 339        /* MOV (reg-shift reg)  cccc 0001 101x xxxx xxxx xxxx 0xx1 xxxx */
 340        /* MVN (reg-shift reg)  cccc 0001 111x xxxx xxxx xxxx 0xx1 xxxx */
 341        DECODE_EMULATEX (0x0fa00090, 0x01a00010, PROBES_DATA_PROCESSING_REG,
 342                                                 REGS(0, NOPC, NOPC, 0, NOPC)),
 343
 344        /* AND (reg-shift reg)  cccc 0000 000x xxxx xxxx xxxx 0xx1 xxxx */
 345        /* EOR (reg-shift reg)  cccc 0000 001x xxxx xxxx xxxx 0xx1 xxxx */
 346        /* SUB (reg-shift reg)  cccc 0000 010x xxxx xxxx xxxx 0xx1 xxxx */
 347        /* RSB (reg-shift reg)  cccc 0000 011x xxxx xxxx xxxx 0xx1 xxxx */
 348        /* ADD (reg-shift reg)  cccc 0000 100x xxxx xxxx xxxx 0xx1 xxxx */
 349        /* ADC (reg-shift reg)  cccc 0000 101x xxxx xxxx xxxx 0xx1 xxxx */
 350        /* SBC (reg-shift reg)  cccc 0000 110x xxxx xxxx xxxx 0xx1 xxxx */
 351        /* RSC (reg-shift reg)  cccc 0000 111x xxxx xxxx xxxx 0xx1 xxxx */
 352        /* ORR (reg-shift reg)  cccc 0001 100x xxxx xxxx xxxx 0xx1 xxxx */
 353        /* BIC (reg-shift reg)  cccc 0001 110x xxxx xxxx xxxx 0xx1 xxxx */
 354        DECODE_EMULATEX (0x0e000090, 0x00000010, PROBES_DATA_PROCESSING_REG,
 355                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 356
 357        DECODE_END
 358};
 359
 360static const union decode_item arm_cccc_001x_table[] = {
 361        /* Data-processing (immediate)                                  */
 362
 363        /* MOVW                 cccc 0011 0000 xxxx xxxx xxxx xxxx xxxx */
 364        /* MOVT                 cccc 0011 0100 xxxx xxxx xxxx xxxx xxxx */
 365        DECODE_EMULATEX (0x0fb00000, 0x03000000, PROBES_MOV_HALFWORD,
 366                                                 REGS(0, NOPC, 0, 0, 0)),
 367
 368        /* YIELD                cccc 0011 0010 0000 xxxx xxxx 0000 0001 */
 369        DECODE_OR       (0x0fff00ff, 0x03200001),
 370        /* SEV                  cccc 0011 0010 0000 xxxx xxxx 0000 0100 */
 371        DECODE_EMULATE  (0x0fff00ff, 0x03200004, PROBES_SEV),
 372        /* NOP                  cccc 0011 0010 0000 xxxx xxxx 0000 0000 */
 373        /* WFE                  cccc 0011 0010 0000 xxxx xxxx 0000 0010 */
 374        /* WFI                  cccc 0011 0010 0000 xxxx xxxx 0000 0011 */
 375        DECODE_SIMULATE (0x0fff00fc, 0x03200000, PROBES_WFE),
 376        /* DBG                  cccc 0011 0010 0000 xxxx xxxx ffff xxxx */
 377        /* unallocated hints    cccc 0011 0010 0000 xxxx xxxx xxxx xxxx */
 378        /* MSR (immediate)      cccc 0011 0x10 xxxx xxxx xxxx xxxx xxxx */
 379        DECODE_REJECT   (0x0fb00000, 0x03200000),
 380
 381        /* <op>S PC, ...        cccc 001x xxx1 xxxx 1111 xxxx xxxx xxxx */
 382        DECODE_REJECT   (0x0e10f000, 0x0210f000),
 383
 384        /* TST (immediate)      cccc 0011 0001 xxxx xxxx xxxx xxxx xxxx */
 385        /* TEQ (immediate)      cccc 0011 0011 xxxx xxxx xxxx xxxx xxxx */
 386        /* CMP (immediate)      cccc 0011 0101 xxxx xxxx xxxx xxxx xxxx */
 387        /* CMN (immediate)      cccc 0011 0111 xxxx xxxx xxxx xxxx xxxx */
 388        DECODE_EMULATEX (0x0f900000, 0x03100000, PROBES_DATA_PROCESSING_IMM,
 389                                                 REGS(ANY, 0, 0, 0, 0)),
 390
 391        /* MOV (immediate)      cccc 0011 101x xxxx xxxx xxxx xxxx xxxx */
 392        /* MVN (immediate)      cccc 0011 111x xxxx xxxx xxxx xxxx xxxx */
 393        DECODE_EMULATEX (0x0fa00000, 0x03a00000, PROBES_DATA_PROCESSING_IMM,
 394                                                 REGS(0, ANY, 0, 0, 0)),
 395
 396        /* AND (immediate)      cccc 0010 000x xxxx xxxx xxxx xxxx xxxx */
 397        /* EOR (immediate)      cccc 0010 001x xxxx xxxx xxxx xxxx xxxx */
 398        /* SUB (immediate)      cccc 0010 010x xxxx xxxx xxxx xxxx xxxx */
 399        /* RSB (immediate)      cccc 0010 011x xxxx xxxx xxxx xxxx xxxx */
 400        /* ADD (immediate)      cccc 0010 100x xxxx xxxx xxxx xxxx xxxx */
 401        /* ADC (immediate)      cccc 0010 101x xxxx xxxx xxxx xxxx xxxx */
 402        /* SBC (immediate)      cccc 0010 110x xxxx xxxx xxxx xxxx xxxx */
 403        /* RSC (immediate)      cccc 0010 111x xxxx xxxx xxxx xxxx xxxx */
 404        /* ORR (immediate)      cccc 0011 100x xxxx xxxx xxxx xxxx xxxx */
 405        /* BIC (immediate)      cccc 0011 110x xxxx xxxx xxxx xxxx xxxx */
 406        DECODE_EMULATEX (0x0e000000, 0x02000000, PROBES_DATA_PROCESSING_IMM,
 407                                                 REGS(ANY, ANY, 0, 0, 0)),
 408
 409        DECODE_END
 410};
 411
 412static const union decode_item arm_cccc_0110_____xxx1_table[] = {
 413        /* Media instructions                                           */
 414
 415        /* SEL                  cccc 0110 1000 xxxx xxxx xxxx 1011 xxxx */
 416        DECODE_EMULATEX (0x0ff000f0, 0x068000b0, PROBES_SATURATE,
 417                                                 REGS(NOPC, NOPC, 0, 0, NOPC)),
 418
 419        /* SSAT                 cccc 0110 101x xxxx xxxx xxxx xx01 xxxx */
 420        /* USAT                 cccc 0110 111x xxxx xxxx xxxx xx01 xxxx */
 421        DECODE_OR(0x0fa00030, 0x06a00010),
 422        /* SSAT16               cccc 0110 1010 xxxx xxxx xxxx 0011 xxxx */
 423        /* USAT16               cccc 0110 1110 xxxx xxxx xxxx 0011 xxxx */
 424        DECODE_EMULATEX (0x0fb000f0, 0x06a00030, PROBES_SATURATE,
 425                                                 REGS(0, NOPC, 0, 0, NOPC)),
 426
 427        /* REV                  cccc 0110 1011 xxxx xxxx xxxx 0011 xxxx */
 428        /* REV16                cccc 0110 1011 xxxx xxxx xxxx 1011 xxxx */
 429        /* RBIT                 cccc 0110 1111 xxxx xxxx xxxx 0011 xxxx */
 430        /* REVSH                cccc 0110 1111 xxxx xxxx xxxx 1011 xxxx */
 431        DECODE_EMULATEX (0x0fb00070, 0x06b00030, PROBES_REV,
 432                                                 REGS(0, NOPC, 0, 0, NOPC)),
 433
 434        /* ???                  cccc 0110 0x00 xxxx xxxx xxxx xxx1 xxxx */
 435        DECODE_REJECT   (0x0fb00010, 0x06000010),
 436        /* ???                  cccc 0110 0xxx xxxx xxxx xxxx 1011 xxxx */
 437        DECODE_REJECT   (0x0f8000f0, 0x060000b0),
 438        /* ???                  cccc 0110 0xxx xxxx xxxx xxxx 1101 xxxx */
 439        DECODE_REJECT   (0x0f8000f0, 0x060000d0),
 440        /* SADD16               cccc 0110 0001 xxxx xxxx xxxx 0001 xxxx */
 441        /* SADDSUBX             cccc 0110 0001 xxxx xxxx xxxx 0011 xxxx */
 442        /* SSUBADDX             cccc 0110 0001 xxxx xxxx xxxx 0101 xxxx */
 443        /* SSUB16               cccc 0110 0001 xxxx xxxx xxxx 0111 xxxx */
 444        /* SADD8                cccc 0110 0001 xxxx xxxx xxxx 1001 xxxx */
 445        /* SSUB8                cccc 0110 0001 xxxx xxxx xxxx 1111 xxxx */
 446        /* QADD16               cccc 0110 0010 xxxx xxxx xxxx 0001 xxxx */
 447        /* QADDSUBX             cccc 0110 0010 xxxx xxxx xxxx 0011 xxxx */
 448        /* QSUBADDX             cccc 0110 0010 xxxx xxxx xxxx 0101 xxxx */
 449        /* QSUB16               cccc 0110 0010 xxxx xxxx xxxx 0111 xxxx */
 450        /* QADD8                cccc 0110 0010 xxxx xxxx xxxx 1001 xxxx */
 451        /* QSUB8                cccc 0110 0010 xxxx xxxx xxxx 1111 xxxx */
 452        /* SHADD16              cccc 0110 0011 xxxx xxxx xxxx 0001 xxxx */
 453        /* SHADDSUBX            cccc 0110 0011 xxxx xxxx xxxx 0011 xxxx */
 454        /* SHSUBADDX            cccc 0110 0011 xxxx xxxx xxxx 0101 xxxx */
 455        /* SHSUB16              cccc 0110 0011 xxxx xxxx xxxx 0111 xxxx */
 456        /* SHADD8               cccc 0110 0011 xxxx xxxx xxxx 1001 xxxx */
 457        /* SHSUB8               cccc 0110 0011 xxxx xxxx xxxx 1111 xxxx */
 458        /* UADD16               cccc 0110 0101 xxxx xxxx xxxx 0001 xxxx */
 459        /* UADDSUBX             cccc 0110 0101 xxxx xxxx xxxx 0011 xxxx */
 460        /* USUBADDX             cccc 0110 0101 xxxx xxxx xxxx 0101 xxxx */
 461        /* USUB16               cccc 0110 0101 xxxx xxxx xxxx 0111 xxxx */
 462        /* UADD8                cccc 0110 0101 xxxx xxxx xxxx 1001 xxxx */
 463        /* USUB8                cccc 0110 0101 xxxx xxxx xxxx 1111 xxxx */
 464        /* UQADD16              cccc 0110 0110 xxxx xxxx xxxx 0001 xxxx */
 465        /* UQADDSUBX            cccc 0110 0110 xxxx xxxx xxxx 0011 xxxx */
 466        /* UQSUBADDX            cccc 0110 0110 xxxx xxxx xxxx 0101 xxxx */
 467        /* UQSUB16              cccc 0110 0110 xxxx xxxx xxxx 0111 xxxx */
 468        /* UQADD8               cccc 0110 0110 xxxx xxxx xxxx 1001 xxxx */
 469        /* UQSUB8               cccc 0110 0110 xxxx xxxx xxxx 1111 xxxx */
 470        /* UHADD16              cccc 0110 0111 xxxx xxxx xxxx 0001 xxxx */
 471        /* UHADDSUBX            cccc 0110 0111 xxxx xxxx xxxx 0011 xxxx */
 472        /* UHSUBADDX            cccc 0110 0111 xxxx xxxx xxxx 0101 xxxx */
 473        /* UHSUB16              cccc 0110 0111 xxxx xxxx xxxx 0111 xxxx */
 474        /* UHADD8               cccc 0110 0111 xxxx xxxx xxxx 1001 xxxx */
 475        /* UHSUB8               cccc 0110 0111 xxxx xxxx xxxx 1111 xxxx */
 476        DECODE_EMULATEX (0x0f800010, 0x06000010, PROBES_MMI,
 477                                                 REGS(NOPC, NOPC, 0, 0, NOPC)),
 478
 479        /* PKHBT                cccc 0110 1000 xxxx xxxx xxxx x001 xxxx */
 480        /* PKHTB                cccc 0110 1000 xxxx xxxx xxxx x101 xxxx */
 481        DECODE_EMULATEX (0x0ff00030, 0x06800010, PROBES_PACK,
 482                                                 REGS(NOPC, NOPC, 0, 0, NOPC)),
 483
 484        /* ???                  cccc 0110 1001 xxxx xxxx xxxx 0111 xxxx */
 485        /* ???                  cccc 0110 1101 xxxx xxxx xxxx 0111 xxxx */
 486        DECODE_REJECT   (0x0fb000f0, 0x06900070),
 487
 488        /* SXTB16               cccc 0110 1000 1111 xxxx xxxx 0111 xxxx */
 489        /* SXTB                 cccc 0110 1010 1111 xxxx xxxx 0111 xxxx */
 490        /* SXTH                 cccc 0110 1011 1111 xxxx xxxx 0111 xxxx */
 491        /* UXTB16               cccc 0110 1100 1111 xxxx xxxx 0111 xxxx */
 492        /* UXTB                 cccc 0110 1110 1111 xxxx xxxx 0111 xxxx */
 493        /* UXTH                 cccc 0110 1111 1111 xxxx xxxx 0111 xxxx */
 494        DECODE_EMULATEX (0x0f8f00f0, 0x068f0070, PROBES_EXTEND,
 495                                                 REGS(0, NOPC, 0, 0, NOPC)),
 496
 497        /* SXTAB16              cccc 0110 1000 xxxx xxxx xxxx 0111 xxxx */
 498        /* SXTAB                cccc 0110 1010 xxxx xxxx xxxx 0111 xxxx */
 499        /* SXTAH                cccc 0110 1011 xxxx xxxx xxxx 0111 xxxx */
 500        /* UXTAB16              cccc 0110 1100 xxxx xxxx xxxx 0111 xxxx */
 501        /* UXTAB                cccc 0110 1110 xxxx xxxx xxxx 0111 xxxx */
 502        /* UXTAH                cccc 0110 1111 xxxx xxxx xxxx 0111 xxxx */
 503        DECODE_EMULATEX (0x0f8000f0, 0x06800070, PROBES_EXTEND_ADD,
 504                                                 REGS(NOPCX, NOPC, 0, 0, NOPC)),
 505
 506        DECODE_END
 507};
 508
 509static const union decode_item arm_cccc_0111_____xxx1_table[] = {
 510        /* Media instructions                                           */
 511
 512        /* UNDEFINED            cccc 0111 1111 xxxx xxxx xxxx 1111 xxxx */
 513        DECODE_REJECT   (0x0ff000f0, 0x07f000f0),
 514
 515        /* SMLALD               cccc 0111 0100 xxxx xxxx xxxx 00x1 xxxx */
 516        /* SMLSLD               cccc 0111 0100 xxxx xxxx xxxx 01x1 xxxx */
 517        DECODE_EMULATEX (0x0ff00090, 0x07400010, PROBES_MUL_ADD_LONG,
 518                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 519
 520        /* SMUAD                cccc 0111 0000 xxxx 1111 xxxx 00x1 xxxx */
 521        /* SMUSD                cccc 0111 0000 xxxx 1111 xxxx 01x1 xxxx */
 522        DECODE_OR       (0x0ff0f090, 0x0700f010),
 523        /* SMMUL                cccc 0111 0101 xxxx 1111 xxxx 00x1 xxxx */
 524        DECODE_OR       (0x0ff0f0d0, 0x0750f010),
 525        /* USAD8                cccc 0111 1000 xxxx 1111 xxxx 0001 xxxx */
 526        DECODE_EMULATEX (0x0ff0f0f0, 0x0780f010, PROBES_MUL_ADD,
 527                                                 REGS(NOPC, 0, NOPC, 0, NOPC)),
 528
 529        /* SMLAD                cccc 0111 0000 xxxx xxxx xxxx 00x1 xxxx */
 530        /* SMLSD                cccc 0111 0000 xxxx xxxx xxxx 01x1 xxxx */
 531        DECODE_OR       (0x0ff00090, 0x07000010),
 532        /* SMMLA                cccc 0111 0101 xxxx xxxx xxxx 00x1 xxxx */
 533        DECODE_OR       (0x0ff000d0, 0x07500010),
 534        /* USADA8               cccc 0111 1000 xxxx xxxx xxxx 0001 xxxx */
 535        DECODE_EMULATEX (0x0ff000f0, 0x07800010, PROBES_MUL_ADD,
 536                                                 REGS(NOPC, NOPCX, NOPC, 0, NOPC)),
 537
 538        /* SMMLS                cccc 0111 0101 xxxx xxxx xxxx 11x1 xxxx */
 539        DECODE_EMULATEX (0x0ff000d0, 0x075000d0, PROBES_MUL_ADD,
 540                                                 REGS(NOPC, NOPC, NOPC, 0, NOPC)),
 541
 542        /* SBFX                 cccc 0111 101x xxxx xxxx xxxx x101 xxxx */
 543        /* UBFX                 cccc 0111 111x xxxx xxxx xxxx x101 xxxx */
 544        DECODE_EMULATEX (0x0fa00070, 0x07a00050, PROBES_BITFIELD,
 545                                                 REGS(0, NOPC, 0, 0, NOPC)),
 546
 547        /* BFC                  cccc 0111 110x xxxx xxxx xxxx x001 1111 */
 548        DECODE_EMULATEX (0x0fe0007f, 0x07c0001f, PROBES_BITFIELD,
 549                                                 REGS(0, NOPC, 0, 0, 0)),
 550
 551        /* BFI                  cccc 0111 110x xxxx xxxx xxxx x001 xxxx */
 552        DECODE_EMULATEX (0x0fe00070, 0x07c00010, PROBES_BITFIELD,
 553                                                 REGS(0, NOPC, 0, 0, NOPCX)),
 554
 555        DECODE_END
 556};
 557
 558static const union decode_item arm_cccc_01xx_table[] = {
 559        /* Load/store word and unsigned byte                            */
 560
 561        /* LDRB/STRB pc,[...]   cccc 01xx x0xx xxxx xxxx xxxx xxxx xxxx */
 562        DECODE_REJECT   (0x0c40f000, 0x0440f000),
 563
 564        /* STRT                 cccc 01x0 x010 xxxx xxxx xxxx xxxx xxxx */
 565        /* LDRT                 cccc 01x0 x011 xxxx xxxx xxxx xxxx xxxx */
 566        /* STRBT                cccc 01x0 x110 xxxx xxxx xxxx xxxx xxxx */
 567        /* LDRBT                cccc 01x0 x111 xxxx xxxx xxxx xxxx xxxx */
 568        DECODE_REJECT   (0x0d200000, 0x04200000),
 569
 570        /* STR (immediate)      cccc 010x x0x0 xxxx xxxx xxxx xxxx xxxx */
 571        /* STRB (immediate)     cccc 010x x1x0 xxxx xxxx xxxx xxxx xxxx */
 572        DECODE_EMULATEX (0x0e100000, 0x04000000, PROBES_STORE,
 573                                                 REGS(NOPCWB, ANY, 0, 0, 0)),
 574
 575        /* LDR (immediate)      cccc 010x x0x1 xxxx xxxx xxxx xxxx xxxx */
 576        /* LDRB (immediate)     cccc 010x x1x1 xxxx xxxx xxxx xxxx xxxx */
 577        DECODE_EMULATEX (0x0e100000, 0x04100000, PROBES_LOAD,
 578                                                 REGS(NOPCWB, ANY, 0, 0, 0)),
 579
 580        /* STR (register)       cccc 011x x0x0 xxxx xxxx xxxx xxxx xxxx */
 581        /* STRB (register)      cccc 011x x1x0 xxxx xxxx xxxx xxxx xxxx */
 582        DECODE_EMULATEX (0x0e100000, 0x06000000, PROBES_STORE,
 583                                                 REGS(NOPCWB, ANY, 0, 0, NOPC)),
 584
 585        /* LDR (register)       cccc 011x x0x1 xxxx xxxx xxxx xxxx xxxx */
 586        /* LDRB (register)      cccc 011x x1x1 xxxx xxxx xxxx xxxx xxxx */
 587        DECODE_EMULATEX (0x0e100000, 0x06100000, PROBES_LOAD,
 588                                                 REGS(NOPCWB, ANY, 0, 0, NOPC)),
 589
 590        DECODE_END
 591};
 592
 593static const union decode_item arm_cccc_100x_table[] = {
 594        /* Block data transfer instructions                             */
 595
 596        /* LDM                  cccc 100x x0x1 xxxx xxxx xxxx xxxx xxxx */
 597        /* STM                  cccc 100x x0x0 xxxx xxxx xxxx xxxx xxxx */
 598        DECODE_CUSTOM   (0x0e400000, 0x08000000, PROBES_LDMSTM),
 599
 600        /* STM (user registers) cccc 100x x1x0 xxxx xxxx xxxx xxxx xxxx */
 601        /* LDM (user registers) cccc 100x x1x1 xxxx 0xxx xxxx xxxx xxxx */
 602        /* LDM (exception ret)  cccc 100x x1x1 xxxx 1xxx xxxx xxxx xxxx */
 603        DECODE_END
 604};
 605
 606const union decode_item probes_decode_arm_table[] = {
 607        /*
 608         * Unconditional instructions
 609         *                      1111 xxxx xxxx xxxx xxxx xxxx xxxx xxxx
 610         */
 611        DECODE_TABLE    (0xf0000000, 0xf0000000, arm_1111_table),
 612
 613        /*
 614         * Miscellaneous instructions
 615         *                      cccc 0001 0xx0 xxxx xxxx xxxx 0xxx xxxx
 616         */
 617        DECODE_TABLE    (0x0f900080, 0x01000000, arm_cccc_0001_0xx0____0xxx_table),
 618
 619        /*
 620         * Halfword multiply and multiply-accumulate
 621         *                      cccc 0001 0xx0 xxxx xxxx xxxx 1xx0 xxxx
 622         */
 623        DECODE_TABLE    (0x0f900090, 0x01000080, arm_cccc_0001_0xx0____1xx0_table),
 624
 625        /*
 626         * Multiply and multiply-accumulate
 627         *                      cccc 0000 xxxx xxxx xxxx xxxx 1001 xxxx
 628         */
 629        DECODE_TABLE    (0x0f0000f0, 0x00000090, arm_cccc_0000_____1001_table),
 630
 631        /*
 632         * Synchronization primitives
 633         *                      cccc 0001 xxxx xxxx xxxx xxxx 1001 xxxx
 634         */
 635        DECODE_TABLE    (0x0f0000f0, 0x01000090, arm_cccc_0001_____1001_table),
 636
 637        /*
 638         * Extra load/store instructions
 639         *                      cccc 000x xxxx xxxx xxxx xxxx 1xx1 xxxx
 640         */
 641        DECODE_TABLE    (0x0e000090, 0x00000090, arm_cccc_000x_____1xx1_table),
 642
 643        /*
 644         * Data-processing (register)
 645         *                      cccc 000x xxxx xxxx xxxx xxxx xxx0 xxxx
 646         * Data-processing (register-shifted register)
 647         *                      cccc 000x xxxx xxxx xxxx xxxx 0xx1 xxxx
 648         */
 649        DECODE_TABLE    (0x0e000000, 0x00000000, arm_cccc_000x_table),
 650
 651        /*
 652         * Data-processing (immediate)
 653         *                      cccc 001x xxxx xxxx xxxx xxxx xxxx xxxx
 654         */
 655        DECODE_TABLE    (0x0e000000, 0x02000000, arm_cccc_001x_table),
 656
 657        /*
 658         * Media instructions
 659         *                      cccc 011x xxxx xxxx xxxx xxxx xxx1 xxxx
 660         */
 661        DECODE_TABLE    (0x0f000010, 0x06000010, arm_cccc_0110_____xxx1_table),
 662        DECODE_TABLE    (0x0f000010, 0x07000010, arm_cccc_0111_____xxx1_table),
 663
 664        /*
 665         * Load/store word and unsigned byte
 666         *                      cccc 01xx xxxx xxxx xxxx xxxx xxxx xxxx
 667         */
 668        DECODE_TABLE    (0x0c000000, 0x04000000, arm_cccc_01xx_table),
 669
 670        /*
 671         * Block data transfer instructions
 672         *                      cccc 100x xxxx xxxx xxxx xxxx xxxx xxxx
 673         */
 674        DECODE_TABLE    (0x0e000000, 0x08000000, arm_cccc_100x_table),
 675
 676        /* B                    cccc 1010 xxxx xxxx xxxx xxxx xxxx xxxx */
 677        /* BL                   cccc 1011 xxxx xxxx xxxx xxxx xxxx xxxx */
 678        DECODE_SIMULATE (0x0e000000, 0x0a000000, PROBES_BRANCH),
 679
 680        /*
 681         * Supervisor Call, and coprocessor instructions
 682         */
 683
 684        /* MCRR                 cccc 1100 0100 xxxx xxxx xxxx xxxx xxxx */
 685        /* MRRC                 cccc 1100 0101 xxxx xxxx xxxx xxxx xxxx */
 686        /* LDC                  cccc 110x xxx1 xxxx xxxx xxxx xxxx xxxx */
 687        /* STC                  cccc 110x xxx0 xxxx xxxx xxxx xxxx xxxx */
 688        /* CDP                  cccc 1110 xxxx xxxx xxxx xxxx xxx0 xxxx */
 689        /* MCR                  cccc 1110 xxx0 xxxx xxxx xxxx xxx1 xxxx */
 690        /* MRC                  cccc 1110 xxx1 xxxx xxxx xxxx xxx1 xxxx */
 691        /* SVC                  cccc 1111 xxxx xxxx xxxx xxxx xxxx xxxx */
 692        DECODE_REJECT   (0x0c000000, 0x0c000000),
 693
 694        DECODE_END
 695};
 696#ifdef CONFIG_ARM_KPROBES_TEST_MODULE
 697EXPORT_SYMBOL_GPL(probes_decode_arm_table);
 698#endif
 699
 700static void __kprobes arm_singlestep(probes_opcode_t insn,
 701                struct arch_probes_insn *asi, struct pt_regs *regs)
 702{
 703        regs->ARM_pc += 4;
 704        asi->insn_handler(insn, asi, regs);
 705}
 706
 707/* Return:
 708 *   INSN_REJECTED     If instruction is one not allowed to kprobe,
 709 *   INSN_GOOD         If instruction is supported and uses instruction slot,
 710 *   INSN_GOOD_NO_SLOT If instruction is supported but doesn't use its slot.
 711 *
 712 * For instructions we don't want to kprobe (INSN_REJECTED return result):
 713 *   These are generally ones that modify the processor state making
 714 *   them "hard" to simulate such as switches processor modes or
 715 *   make accesses in alternate modes.  Any of these could be simulated
 716 *   if the work was put into it, but low return considering they
 717 *   should also be very rare.
 718 */
 719enum probes_insn __kprobes
 720arm_probes_decode_insn(probes_opcode_t insn, struct arch_probes_insn *asi,
 721                       bool emulate, const union decode_action *actions,
 722                       const struct decode_checker *checkers[])
 723{
 724        asi->insn_singlestep = arm_singlestep;
 725        asi->insn_check_cc = probes_condition_checks[insn>>28];
 726        return probes_decode_insn(insn, asi, probes_decode_arm_table, false,
 727                                  emulate, actions, checkers);
 728}
 729