linux/arch/arm/probes/decode-thumb.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * arch/arm/probes/decode-thumb.c
   4 *
   5 * Copyright (C) 2011 Jon Medhurst <tixy@yxit.co.uk>.
   6 */
   7
   8#include <linux/stddef.h>
   9#include <linux/kernel.h>
  10#include <linux/module.h>
  11
  12#include "decode.h"
  13#include "decode-thumb.h"
  14
  15
  16static const union decode_item t32_table_1110_100x_x0xx[] = {
  17        /* Load/store multiple instructions */
  18
  19        /* Rn is PC             1110 100x x0xx 1111 xxxx xxxx xxxx xxxx */
  20        DECODE_REJECT   (0xfe4f0000, 0xe80f0000),
  21
  22        /* SRS                  1110 1000 00x0 xxxx xxxx xxxx xxxx xxxx */
  23        /* RFE                  1110 1000 00x1 xxxx xxxx xxxx xxxx xxxx */
  24        DECODE_REJECT   (0xffc00000, 0xe8000000),
  25        /* SRS                  1110 1001 10x0 xxxx xxxx xxxx xxxx xxxx */
  26        /* RFE                  1110 1001 10x1 xxxx xxxx xxxx xxxx xxxx */
  27        DECODE_REJECT   (0xffc00000, 0xe9800000),
  28
  29        /* STM Rn, {...pc}      1110 100x x0x0 xxxx 1xxx xxxx xxxx xxxx */
  30        DECODE_REJECT   (0xfe508000, 0xe8008000),
  31        /* LDM Rn, {...lr,pc}   1110 100x x0x1 xxxx 11xx xxxx xxxx xxxx */
  32        DECODE_REJECT   (0xfe50c000, 0xe810c000),
  33        /* LDM/STM Rn, {...sp}  1110 100x x0xx xxxx xx1x xxxx xxxx xxxx */
  34        DECODE_REJECT   (0xfe402000, 0xe8002000),
  35
  36        /* STMIA                1110 1000 10x0 xxxx xxxx xxxx xxxx xxxx */
  37        /* LDMIA                1110 1000 10x1 xxxx xxxx xxxx xxxx xxxx */
  38        /* STMDB                1110 1001 00x0 xxxx xxxx xxxx xxxx xxxx */
  39        /* LDMDB                1110 1001 00x1 xxxx xxxx xxxx xxxx xxxx */
  40        DECODE_CUSTOM   (0xfe400000, 0xe8000000, PROBES_T32_LDMSTM),
  41
  42        DECODE_END
  43};
  44
  45static const union decode_item t32_table_1110_100x_x1xx[] = {
  46        /* Load/store dual, load/store exclusive, table branch */
  47
  48        /* STRD (immediate)     1110 1000 x110 xxxx xxxx xxxx xxxx xxxx */
  49        /* LDRD (immediate)     1110 1000 x111 xxxx xxxx xxxx xxxx xxxx */
  50        DECODE_OR       (0xff600000, 0xe8600000),
  51        /* STRD (immediate)     1110 1001 x1x0 xxxx xxxx xxxx xxxx xxxx */
  52        /* LDRD (immediate)     1110 1001 x1x1 xxxx xxxx xxxx xxxx xxxx */
  53        DECODE_EMULATEX (0xff400000, 0xe9400000, PROBES_T32_LDRDSTRD,
  54                                                 REGS(NOPCWB, NOSPPC, NOSPPC, 0, 0)),
  55
  56        /* TBB                  1110 1000 1101 xxxx xxxx xxxx 0000 xxxx */
  57        /* TBH                  1110 1000 1101 xxxx xxxx xxxx 0001 xxxx */
  58        DECODE_SIMULATEX(0xfff000e0, 0xe8d00000, PROBES_T32_TABLE_BRANCH,
  59                                                 REGS(NOSP, 0, 0, 0, NOSPPC)),
  60
  61        /* STREX                1110 1000 0100 xxxx xxxx xxxx xxxx xxxx */
  62        /* LDREX                1110 1000 0101 xxxx xxxx xxxx xxxx xxxx */
  63        /* STREXB               1110 1000 1100 xxxx xxxx xxxx 0100 xxxx */
  64        /* STREXH               1110 1000 1100 xxxx xxxx xxxx 0101 xxxx */
  65        /* STREXD               1110 1000 1100 xxxx xxxx xxxx 0111 xxxx */
  66        /* LDREXB               1110 1000 1101 xxxx xxxx xxxx 0100 xxxx */
  67        /* LDREXH               1110 1000 1101 xxxx xxxx xxxx 0101 xxxx */
  68        /* LDREXD               1110 1000 1101 xxxx xxxx xxxx 0111 xxxx */
  69        /* And unallocated instructions...                              */
  70        DECODE_END
  71};
  72
  73static const union decode_item t32_table_1110_101x[] = {
  74        /* Data-processing (shifted register)                           */
  75
  76        /* TST                  1110 1010 0001 xxxx xxxx 1111 xxxx xxxx */
  77        /* TEQ                  1110 1010 1001 xxxx xxxx 1111 xxxx xxxx */
  78        DECODE_EMULATEX (0xff700f00, 0xea100f00, PROBES_T32_TST,
  79                                                 REGS(NOSPPC, 0, 0, 0, NOSPPC)),
  80
  81        /* CMN                  1110 1011 0001 xxxx xxxx 1111 xxxx xxxx */
  82        DECODE_OR       (0xfff00f00, 0xeb100f00),
  83        /* CMP                  1110 1011 1011 xxxx xxxx 1111 xxxx xxxx */
  84        DECODE_EMULATEX (0xfff00f00, 0xebb00f00, PROBES_T32_TST,
  85                                                 REGS(NOPC, 0, 0, 0, NOSPPC)),
  86
  87        /* MOV                  1110 1010 010x 1111 xxxx xxxx xxxx xxxx */
  88        /* MVN                  1110 1010 011x 1111 xxxx xxxx xxxx xxxx */
  89        DECODE_EMULATEX (0xffcf0000, 0xea4f0000, PROBES_T32_MOV,
  90                                                 REGS(0, 0, NOSPPC, 0, NOSPPC)),
  91
  92        /* ???                  1110 1010 101x xxxx xxxx xxxx xxxx xxxx */
  93        /* ???                  1110 1010 111x xxxx xxxx xxxx xxxx xxxx */
  94        DECODE_REJECT   (0xffa00000, 0xeaa00000),
  95        /* ???                  1110 1011 001x xxxx xxxx xxxx xxxx xxxx */
  96        DECODE_REJECT   (0xffe00000, 0xeb200000),
  97        /* ???                  1110 1011 100x xxxx xxxx xxxx xxxx xxxx */
  98        DECODE_REJECT   (0xffe00000, 0xeb800000),
  99        /* ???                  1110 1011 111x xxxx xxxx xxxx xxxx xxxx */
 100        DECODE_REJECT   (0xffe00000, 0xebe00000),
 101
 102        /* ADD/SUB SP, SP, Rm, LSL #0..3                                */
 103        /*                      1110 1011 x0xx 1101 x000 1101 xx00 xxxx */
 104        DECODE_EMULATEX (0xff4f7f30, 0xeb0d0d00, PROBES_T32_ADDSUB,
 105                                                 REGS(SP, 0, SP, 0, NOSPPC)),
 106
 107        /* ADD/SUB SP, SP, Rm, shift                                    */
 108        /*                      1110 1011 x0xx 1101 xxxx 1101 xxxx xxxx */
 109        DECODE_REJECT   (0xff4f0f00, 0xeb0d0d00),
 110
 111        /* ADD/SUB Rd, SP, Rm, shift                                    */
 112        /*                      1110 1011 x0xx 1101 xxxx xxxx xxxx xxxx */
 113        DECODE_EMULATEX (0xff4f0000, 0xeb0d0000, PROBES_T32_ADDSUB,
 114                                                 REGS(SP, 0, NOPC, 0, NOSPPC)),
 115
 116        /* AND                  1110 1010 000x xxxx xxxx xxxx xxxx xxxx */
 117        /* BIC                  1110 1010 001x xxxx xxxx xxxx xxxx xxxx */
 118        /* ORR                  1110 1010 010x xxxx xxxx xxxx xxxx xxxx */
 119        /* ORN                  1110 1010 011x xxxx xxxx xxxx xxxx xxxx */
 120        /* EOR                  1110 1010 100x xxxx xxxx xxxx xxxx xxxx */
 121        /* PKH                  1110 1010 110x xxxx xxxx xxxx xxxx xxxx */
 122        /* ADD                  1110 1011 000x xxxx xxxx xxxx xxxx xxxx */
 123        /* ADC                  1110 1011 010x xxxx xxxx xxxx xxxx xxxx */
 124        /* SBC                  1110 1011 011x xxxx xxxx xxxx xxxx xxxx */
 125        /* SUB                  1110 1011 101x xxxx xxxx xxxx xxxx xxxx */
 126        /* RSB                  1110 1011 110x xxxx xxxx xxxx xxxx xxxx */
 127        DECODE_EMULATEX (0xfe000000, 0xea000000, PROBES_T32_LOGICAL,
 128                                                 REGS(NOSPPC, 0, NOSPPC, 0, NOSPPC)),
 129
 130        DECODE_END
 131};
 132
 133static const union decode_item t32_table_1111_0x0x___0[] = {
 134        /* Data-processing (modified immediate)                         */
 135
 136        /* TST                  1111 0x00 0001 xxxx 0xxx 1111 xxxx xxxx */
 137        /* TEQ                  1111 0x00 1001 xxxx 0xxx 1111 xxxx xxxx */
 138        DECODE_EMULATEX (0xfb708f00, 0xf0100f00, PROBES_T32_TST,
 139                                                 REGS(NOSPPC, 0, 0, 0, 0)),
 140
 141        /* CMN                  1111 0x01 0001 xxxx 0xxx 1111 xxxx xxxx */
 142        DECODE_OR       (0xfbf08f00, 0xf1100f00),
 143        /* CMP                  1111 0x01 1011 xxxx 0xxx 1111 xxxx xxxx */
 144        DECODE_EMULATEX (0xfbf08f00, 0xf1b00f00, PROBES_T32_CMP,
 145                                                 REGS(NOPC, 0, 0, 0, 0)),
 146
 147        /* MOV                  1111 0x00 010x 1111 0xxx xxxx xxxx xxxx */
 148        /* MVN                  1111 0x00 011x 1111 0xxx xxxx xxxx xxxx */
 149        DECODE_EMULATEX (0xfbcf8000, 0xf04f0000, PROBES_T32_MOV,
 150                                                 REGS(0, 0, NOSPPC, 0, 0)),
 151
 152        /* ???                  1111 0x00 101x xxxx 0xxx xxxx xxxx xxxx */
 153        DECODE_REJECT   (0xfbe08000, 0xf0a00000),
 154        /* ???                  1111 0x00 110x xxxx 0xxx xxxx xxxx xxxx */
 155        /* ???                  1111 0x00 111x xxxx 0xxx xxxx xxxx xxxx */
 156        DECODE_REJECT   (0xfbc08000, 0xf0c00000),
 157        /* ???                  1111 0x01 001x xxxx 0xxx xxxx xxxx xxxx */
 158        DECODE_REJECT   (0xfbe08000, 0xf1200000),
 159        /* ???                  1111 0x01 100x xxxx 0xxx xxxx xxxx xxxx */
 160        DECODE_REJECT   (0xfbe08000, 0xf1800000),
 161        /* ???                  1111 0x01 111x xxxx 0xxx xxxx xxxx xxxx */
 162        DECODE_REJECT   (0xfbe08000, 0xf1e00000),
 163
 164        /* ADD Rd, SP, #imm     1111 0x01 000x 1101 0xxx xxxx xxxx xxxx */
 165        /* SUB Rd, SP, #imm     1111 0x01 101x 1101 0xxx xxxx xxxx xxxx */
 166        DECODE_EMULATEX (0xfb4f8000, 0xf10d0000, PROBES_T32_ADDSUB,
 167                                                 REGS(SP, 0, NOPC, 0, 0)),
 168
 169        /* AND                  1111 0x00 000x xxxx 0xxx xxxx xxxx xxxx */
 170        /* BIC                  1111 0x00 001x xxxx 0xxx xxxx xxxx xxxx */
 171        /* ORR                  1111 0x00 010x xxxx 0xxx xxxx xxxx xxxx */
 172        /* ORN                  1111 0x00 011x xxxx 0xxx xxxx xxxx xxxx */
 173        /* EOR                  1111 0x00 100x xxxx 0xxx xxxx xxxx xxxx */
 174        /* ADD                  1111 0x01 000x xxxx 0xxx xxxx xxxx xxxx */
 175        /* ADC                  1111 0x01 010x xxxx 0xxx xxxx xxxx xxxx */
 176        /* SBC                  1111 0x01 011x xxxx 0xxx xxxx xxxx xxxx */
 177        /* SUB                  1111 0x01 101x xxxx 0xxx xxxx xxxx xxxx */
 178        /* RSB                  1111 0x01 110x xxxx 0xxx xxxx xxxx xxxx */
 179        DECODE_EMULATEX (0xfa008000, 0xf0000000, PROBES_T32_LOGICAL,
 180                                                 REGS(NOSPPC, 0, NOSPPC, 0, 0)),
 181
 182        DECODE_END
 183};
 184
 185static const union decode_item t32_table_1111_0x1x___0[] = {
 186        /* Data-processing (plain binary immediate)                     */
 187
 188        /* ADDW Rd, PC, #imm    1111 0x10 0000 1111 0xxx xxxx xxxx xxxx */
 189        DECODE_OR       (0xfbff8000, 0xf20f0000),
 190        /* SUBW Rd, PC, #imm    1111 0x10 1010 1111 0xxx xxxx xxxx xxxx */
 191        DECODE_EMULATEX (0xfbff8000, 0xf2af0000, PROBES_T32_ADDWSUBW_PC,
 192                                                 REGS(PC, 0, NOSPPC, 0, 0)),
 193
 194        /* ADDW SP, SP, #imm    1111 0x10 0000 1101 0xxx 1101 xxxx xxxx */
 195        DECODE_OR       (0xfbff8f00, 0xf20d0d00),
 196        /* SUBW SP, SP, #imm    1111 0x10 1010 1101 0xxx 1101 xxxx xxxx */
 197        DECODE_EMULATEX (0xfbff8f00, 0xf2ad0d00, PROBES_T32_ADDWSUBW,
 198                                                 REGS(SP, 0, SP, 0, 0)),
 199
 200        /* ADDW                 1111 0x10 0000 xxxx 0xxx xxxx xxxx xxxx */
 201        DECODE_OR       (0xfbf08000, 0xf2000000),
 202        /* SUBW                 1111 0x10 1010 xxxx 0xxx xxxx xxxx xxxx */
 203        DECODE_EMULATEX (0xfbf08000, 0xf2a00000, PROBES_T32_ADDWSUBW,
 204                                                 REGS(NOPCX, 0, NOSPPC, 0, 0)),
 205
 206        /* MOVW                 1111 0x10 0100 xxxx 0xxx xxxx xxxx xxxx */
 207        /* MOVT                 1111 0x10 1100 xxxx 0xxx xxxx xxxx xxxx */
 208        DECODE_EMULATEX (0xfb708000, 0xf2400000, PROBES_T32_MOVW,
 209                                                 REGS(0, 0, NOSPPC, 0, 0)),
 210
 211        /* SSAT16               1111 0x11 0010 xxxx 0000 xxxx 00xx xxxx */
 212        /* SSAT                 1111 0x11 00x0 xxxx 0xxx xxxx xxxx xxxx */
 213        /* USAT16               1111 0x11 1010 xxxx 0000 xxxx 00xx xxxx */
 214        /* USAT                 1111 0x11 10x0 xxxx 0xxx xxxx xxxx xxxx */
 215        DECODE_EMULATEX (0xfb508000, 0xf3000000, PROBES_T32_SAT,
 216                                                 REGS(NOSPPC, 0, NOSPPC, 0, 0)),
 217
 218        /* SFBX                 1111 0x11 0100 xxxx 0xxx xxxx xxxx xxxx */
 219        /* UFBX                 1111 0x11 1100 xxxx 0xxx xxxx xxxx xxxx */
 220        DECODE_EMULATEX (0xfb708000, 0xf3400000, PROBES_T32_BITFIELD,
 221                                                 REGS(NOSPPC, 0, NOSPPC, 0, 0)),
 222
 223        /* BFC                  1111 0x11 0110 1111 0xxx xxxx xxxx xxxx */
 224        DECODE_EMULATEX (0xfbff8000, 0xf36f0000, PROBES_T32_BITFIELD,
 225                                                 REGS(0, 0, NOSPPC, 0, 0)),
 226
 227        /* BFI                  1111 0x11 0110 xxxx 0xxx xxxx xxxx xxxx */
 228        DECODE_EMULATEX (0xfbf08000, 0xf3600000, PROBES_T32_BITFIELD,
 229                                                 REGS(NOSPPCX, 0, NOSPPC, 0, 0)),
 230
 231        DECODE_END
 232};
 233
 234static const union decode_item t32_table_1111_0xxx___1[] = {
 235        /* Branches and miscellaneous control                           */
 236
 237        /* YIELD                1111 0011 1010 xxxx 10x0 x000 0000 0001 */
 238        DECODE_OR       (0xfff0d7ff, 0xf3a08001),
 239        /* SEV                  1111 0011 1010 xxxx 10x0 x000 0000 0100 */
 240        DECODE_EMULATE  (0xfff0d7ff, 0xf3a08004, PROBES_T32_SEV),
 241        /* NOP                  1111 0011 1010 xxxx 10x0 x000 0000 0000 */
 242        /* WFE                  1111 0011 1010 xxxx 10x0 x000 0000 0010 */
 243        /* WFI                  1111 0011 1010 xxxx 10x0 x000 0000 0011 */
 244        DECODE_SIMULATE (0xfff0d7fc, 0xf3a08000, PROBES_T32_WFE),
 245
 246        /* MRS Rd, CPSR         1111 0011 1110 xxxx 10x0 xxxx xxxx xxxx */
 247        DECODE_SIMULATEX(0xfff0d000, 0xf3e08000, PROBES_T32_MRS,
 248                                                 REGS(0, 0, NOSPPC, 0, 0)),
 249
 250        /*
 251         * Unsupported instructions
 252         *                      1111 0x11 1xxx xxxx 10x0 xxxx xxxx xxxx
 253         *
 254         * MSR                  1111 0011 100x xxxx 10x0 xxxx xxxx xxxx
 255         * DBG hint             1111 0011 1010 xxxx 10x0 x000 1111 xxxx
 256         * Unallocated hints    1111 0011 1010 xxxx 10x0 x000 xxxx xxxx
 257         * CPS                  1111 0011 1010 xxxx 10x0 xxxx xxxx xxxx
 258         * CLREX/DSB/DMB/ISB    1111 0011 1011 xxxx 10x0 xxxx xxxx xxxx
 259         * BXJ                  1111 0011 1100 xxxx 10x0 xxxx xxxx xxxx
 260         * SUBS PC,LR,#<imm8>   1111 0011 1101 xxxx 10x0 xxxx xxxx xxxx
 261         * MRS Rd, SPSR         1111 0011 1111 xxxx 10x0 xxxx xxxx xxxx
 262         * SMC                  1111 0111 1111 xxxx 1000 xxxx xxxx xxxx
 263         * UNDEFINED            1111 0111 1111 xxxx 1010 xxxx xxxx xxxx
 264         * ???                  1111 0111 1xxx xxxx 1010 xxxx xxxx xxxx
 265         */
 266        DECODE_REJECT   (0xfb80d000, 0xf3808000),
 267
 268        /* Bcc                  1111 0xxx xxxx xxxx 10x0 xxxx xxxx xxxx */
 269        DECODE_CUSTOM   (0xf800d000, 0xf0008000, PROBES_T32_BRANCH_COND),
 270
 271        /* BLX                  1111 0xxx xxxx xxxx 11x0 xxxx xxxx xxx0 */
 272        DECODE_OR       (0xf800d001, 0xf000c000),
 273        /* B                    1111 0xxx xxxx xxxx 10x1 xxxx xxxx xxxx */
 274        /* BL                   1111 0xxx xxxx xxxx 11x1 xxxx xxxx xxxx */
 275        DECODE_SIMULATE (0xf8009000, 0xf0009000, PROBES_T32_BRANCH),
 276
 277        DECODE_END
 278};
 279
 280static const union decode_item t32_table_1111_100x_x0x1__1111[] = {
 281        /* Memory hints                                                 */
 282
 283        /* PLD (literal)        1111 1000 x001 1111 1111 xxxx xxxx xxxx */
 284        /* PLI (literal)        1111 1001 x001 1111 1111 xxxx xxxx xxxx */
 285        DECODE_SIMULATE (0xfe7ff000, 0xf81ff000, PROBES_T32_PLDI),
 286
 287        /* PLD{W} (immediate)   1111 1000 10x1 xxxx 1111 xxxx xxxx xxxx */
 288        DECODE_OR       (0xffd0f000, 0xf890f000),
 289        /* PLD{W} (immediate)   1111 1000 00x1 xxxx 1111 1100 xxxx xxxx */
 290        DECODE_OR       (0xffd0ff00, 0xf810fc00),
 291        /* PLI (immediate)      1111 1001 1001 xxxx 1111 xxxx xxxx xxxx */
 292        DECODE_OR       (0xfff0f000, 0xf990f000),
 293        /* PLI (immediate)      1111 1001 0001 xxxx 1111 1100 xxxx xxxx */
 294        DECODE_SIMULATEX(0xfff0ff00, 0xf910fc00, PROBES_T32_PLDI,
 295                                                 REGS(NOPCX, 0, 0, 0, 0)),
 296
 297        /* PLD{W} (register)    1111 1000 00x1 xxxx 1111 0000 00xx xxxx */
 298        DECODE_OR       (0xffd0ffc0, 0xf810f000),
 299        /* PLI (register)       1111 1001 0001 xxxx 1111 0000 00xx xxxx */
 300        DECODE_SIMULATEX(0xfff0ffc0, 0xf910f000, PROBES_T32_PLDI,
 301                                                 REGS(NOPCX, 0, 0, 0, NOSPPC)),
 302
 303        /* Other unallocated instructions...                            */
 304        DECODE_END
 305};
 306
 307static const union decode_item t32_table_1111_100x[] = {
 308        /* Store/Load single data item                                  */
 309
 310        /* ???                  1111 100x x11x xxxx xxxx xxxx xxxx xxxx */
 311        DECODE_REJECT   (0xfe600000, 0xf8600000),
 312
 313        /* ???                  1111 1001 0101 xxxx xxxx xxxx xxxx xxxx */
 314        DECODE_REJECT   (0xfff00000, 0xf9500000),
 315
 316        /* ???                  1111 100x 0xxx xxxx xxxx 10x0 xxxx xxxx */
 317        DECODE_REJECT   (0xfe800d00, 0xf8000800),
 318
 319        /* STRBT                1111 1000 0000 xxxx xxxx 1110 xxxx xxxx */
 320        /* STRHT                1111 1000 0010 xxxx xxxx 1110 xxxx xxxx */
 321        /* STRT                 1111 1000 0100 xxxx xxxx 1110 xxxx xxxx */
 322        /* LDRBT                1111 1000 0001 xxxx xxxx 1110 xxxx xxxx */
 323        /* LDRSBT               1111 1001 0001 xxxx xxxx 1110 xxxx xxxx */
 324        /* LDRHT                1111 1000 0011 xxxx xxxx 1110 xxxx xxxx */
 325        /* LDRSHT               1111 1001 0011 xxxx xxxx 1110 xxxx xxxx */
 326        /* LDRT                 1111 1000 0101 xxxx xxxx 1110 xxxx xxxx */
 327        DECODE_REJECT   (0xfe800f00, 0xf8000e00),
 328
 329        /* STR{,B,H} Rn,[PC...] 1111 1000 xxx0 1111 xxxx xxxx xxxx xxxx */
 330        DECODE_REJECT   (0xff1f0000, 0xf80f0000),
 331
 332        /* STR{,B,H} PC,[Rn...] 1111 1000 xxx0 xxxx 1111 xxxx xxxx xxxx */
 333        DECODE_REJECT   (0xff10f000, 0xf800f000),
 334
 335        /* LDR (literal)        1111 1000 x101 1111 xxxx xxxx xxxx xxxx */
 336        DECODE_SIMULATEX(0xff7f0000, 0xf85f0000, PROBES_T32_LDR_LIT,
 337                                                 REGS(PC, ANY, 0, 0, 0)),
 338
 339        /* STR (immediate)      1111 1000 0100 xxxx xxxx 1xxx xxxx xxxx */
 340        /* LDR (immediate)      1111 1000 0101 xxxx xxxx 1xxx xxxx xxxx */
 341        DECODE_OR       (0xffe00800, 0xf8400800),
 342        /* STR (immediate)      1111 1000 1100 xxxx xxxx xxxx xxxx xxxx */
 343        /* LDR (immediate)      1111 1000 1101 xxxx xxxx xxxx xxxx xxxx */
 344        DECODE_EMULATEX (0xffe00000, 0xf8c00000, PROBES_T32_LDRSTR,
 345                                                 REGS(NOPCX, ANY, 0, 0, 0)),
 346
 347        /* STR (register)       1111 1000 0100 xxxx xxxx 0000 00xx xxxx */
 348        /* LDR (register)       1111 1000 0101 xxxx xxxx 0000 00xx xxxx */
 349        DECODE_EMULATEX (0xffe00fc0, 0xf8400000, PROBES_T32_LDRSTR,
 350                                                 REGS(NOPCX, ANY, 0, 0, NOSPPC)),
 351
 352        /* LDRB (literal)       1111 1000 x001 1111 xxxx xxxx xxxx xxxx */
 353        /* LDRSB (literal)      1111 1001 x001 1111 xxxx xxxx xxxx xxxx */
 354        /* LDRH (literal)       1111 1000 x011 1111 xxxx xxxx xxxx xxxx */
 355        /* LDRSH (literal)      1111 1001 x011 1111 xxxx xxxx xxxx xxxx */
 356        DECODE_SIMULATEX(0xfe5f0000, 0xf81f0000, PROBES_T32_LDR_LIT,
 357                                                 REGS(PC, NOSPPCX, 0, 0, 0)),
 358
 359        /* STRB (immediate)     1111 1000 0000 xxxx xxxx 1xxx xxxx xxxx */
 360        /* STRH (immediate)     1111 1000 0010 xxxx xxxx 1xxx xxxx xxxx */
 361        /* LDRB (immediate)     1111 1000 0001 xxxx xxxx 1xxx xxxx xxxx */
 362        /* LDRSB (immediate)    1111 1001 0001 xxxx xxxx 1xxx xxxx xxxx */
 363        /* LDRH (immediate)     1111 1000 0011 xxxx xxxx 1xxx xxxx xxxx */
 364        /* LDRSH (immediate)    1111 1001 0011 xxxx xxxx 1xxx xxxx xxxx */
 365        DECODE_OR       (0xfec00800, 0xf8000800),
 366        /* STRB (immediate)     1111 1000 1000 xxxx xxxx xxxx xxxx xxxx */
 367        /* STRH (immediate)     1111 1000 1010 xxxx xxxx xxxx xxxx xxxx */
 368        /* LDRB (immediate)     1111 1000 1001 xxxx xxxx xxxx xxxx xxxx */
 369        /* LDRSB (immediate)    1111 1001 1001 xxxx xxxx xxxx xxxx xxxx */
 370        /* LDRH (immediate)     1111 1000 1011 xxxx xxxx xxxx xxxx xxxx */
 371        /* LDRSH (immediate)    1111 1001 1011 xxxx xxxx xxxx xxxx xxxx */
 372        DECODE_EMULATEX (0xfec00000, 0xf8800000, PROBES_T32_LDRSTR,
 373                                                 REGS(NOPCX, NOSPPCX, 0, 0, 0)),
 374
 375        /* STRB (register)      1111 1000 0000 xxxx xxxx 0000 00xx xxxx */
 376        /* STRH (register)      1111 1000 0010 xxxx xxxx 0000 00xx xxxx */
 377        /* LDRB (register)      1111 1000 0001 xxxx xxxx 0000 00xx xxxx */
 378        /* LDRSB (register)     1111 1001 0001 xxxx xxxx 0000 00xx xxxx */
 379        /* LDRH (register)      1111 1000 0011 xxxx xxxx 0000 00xx xxxx */
 380        /* LDRSH (register)     1111 1001 0011 xxxx xxxx 0000 00xx xxxx */
 381        DECODE_EMULATEX (0xfe800fc0, 0xf8000000, PROBES_T32_LDRSTR,
 382                                                 REGS(NOPCX, NOSPPCX, 0, 0, NOSPPC)),
 383
 384        /* Other unallocated instructions...                            */
 385        DECODE_END
 386};
 387
 388static const union decode_item t32_table_1111_1010___1111[] = {
 389        /* Data-processing (register)                                   */
 390
 391        /* ???                  1111 1010 011x xxxx 1111 xxxx 1xxx xxxx */
 392        DECODE_REJECT   (0xffe0f080, 0xfa60f080),
 393
 394        /* SXTH                 1111 1010 0000 1111 1111 xxxx 1xxx xxxx */
 395        /* UXTH                 1111 1010 0001 1111 1111 xxxx 1xxx xxxx */
 396        /* SXTB16               1111 1010 0010 1111 1111 xxxx 1xxx xxxx */
 397        /* UXTB16               1111 1010 0011 1111 1111 xxxx 1xxx xxxx */
 398        /* SXTB                 1111 1010 0100 1111 1111 xxxx 1xxx xxxx */
 399        /* UXTB                 1111 1010 0101 1111 1111 xxxx 1xxx xxxx */
 400        DECODE_EMULATEX (0xff8ff080, 0xfa0ff080, PROBES_T32_SIGN_EXTEND,
 401                                                 REGS(0, 0, NOSPPC, 0, NOSPPC)),
 402
 403
 404        /* ???                  1111 1010 1xxx xxxx 1111 xxxx 0x11 xxxx */
 405        DECODE_REJECT   (0xff80f0b0, 0xfa80f030),
 406        /* ???                  1111 1010 1x11 xxxx 1111 xxxx 0xxx xxxx */
 407        DECODE_REJECT   (0xffb0f080, 0xfab0f000),
 408
 409        /* SADD16               1111 1010 1001 xxxx 1111 xxxx 0000 xxxx */
 410        /* SASX                 1111 1010 1010 xxxx 1111 xxxx 0000 xxxx */
 411        /* SSAX                 1111 1010 1110 xxxx 1111 xxxx 0000 xxxx */
 412        /* SSUB16               1111 1010 1101 xxxx 1111 xxxx 0000 xxxx */
 413        /* SADD8                1111 1010 1000 xxxx 1111 xxxx 0000 xxxx */
 414        /* SSUB8                1111 1010 1100 xxxx 1111 xxxx 0000 xxxx */
 415
 416        /* QADD16               1111 1010 1001 xxxx 1111 xxxx 0001 xxxx */
 417        /* QASX                 1111 1010 1010 xxxx 1111 xxxx 0001 xxxx */
 418        /* QSAX                 1111 1010 1110 xxxx 1111 xxxx 0001 xxxx */
 419        /* QSUB16               1111 1010 1101 xxxx 1111 xxxx 0001 xxxx */
 420        /* QADD8                1111 1010 1000 xxxx 1111 xxxx 0001 xxxx */
 421        /* QSUB8                1111 1010 1100 xxxx 1111 xxxx 0001 xxxx */
 422
 423        /* SHADD16              1111 1010 1001 xxxx 1111 xxxx 0010 xxxx */
 424        /* SHASX                1111 1010 1010 xxxx 1111 xxxx 0010 xxxx */
 425        /* SHSAX                1111 1010 1110 xxxx 1111 xxxx 0010 xxxx */
 426        /* SHSUB16              1111 1010 1101 xxxx 1111 xxxx 0010 xxxx */
 427        /* SHADD8               1111 1010 1000 xxxx 1111 xxxx 0010 xxxx */
 428        /* SHSUB8               1111 1010 1100 xxxx 1111 xxxx 0010 xxxx */
 429
 430        /* UADD16               1111 1010 1001 xxxx 1111 xxxx 0100 xxxx */
 431        /* UASX                 1111 1010 1010 xxxx 1111 xxxx 0100 xxxx */
 432        /* USAX                 1111 1010 1110 xxxx 1111 xxxx 0100 xxxx */
 433        /* USUB16               1111 1010 1101 xxxx 1111 xxxx 0100 xxxx */
 434        /* UADD8                1111 1010 1000 xxxx 1111 xxxx 0100 xxxx */
 435        /* USUB8                1111 1010 1100 xxxx 1111 xxxx 0100 xxxx */
 436
 437        /* UQADD16              1111 1010 1001 xxxx 1111 xxxx 0101 xxxx */
 438        /* UQASX                1111 1010 1010 xxxx 1111 xxxx 0101 xxxx */
 439        /* UQSAX                1111 1010 1110 xxxx 1111 xxxx 0101 xxxx */
 440        /* UQSUB16              1111 1010 1101 xxxx 1111 xxxx 0101 xxxx */
 441        /* UQADD8               1111 1010 1000 xxxx 1111 xxxx 0101 xxxx */
 442        /* UQSUB8               1111 1010 1100 xxxx 1111 xxxx 0101 xxxx */
 443
 444        /* UHADD16              1111 1010 1001 xxxx 1111 xxxx 0110 xxxx */
 445        /* UHASX                1111 1010 1010 xxxx 1111 xxxx 0110 xxxx */
 446        /* UHSAX                1111 1010 1110 xxxx 1111 xxxx 0110 xxxx */
 447        /* UHSUB16              1111 1010 1101 xxxx 1111 xxxx 0110 xxxx */
 448        /* UHADD8               1111 1010 1000 xxxx 1111 xxxx 0110 xxxx */
 449        /* UHSUB8               1111 1010 1100 xxxx 1111 xxxx 0110 xxxx */
 450        DECODE_OR       (0xff80f080, 0xfa80f000),
 451
 452        /* SXTAH                1111 1010 0000 xxxx 1111 xxxx 1xxx xxxx */
 453        /* UXTAH                1111 1010 0001 xxxx 1111 xxxx 1xxx xxxx */
 454        /* SXTAB16              1111 1010 0010 xxxx 1111 xxxx 1xxx xxxx */
 455        /* UXTAB16              1111 1010 0011 xxxx 1111 xxxx 1xxx xxxx */
 456        /* SXTAB                1111 1010 0100 xxxx 1111 xxxx 1xxx xxxx */
 457        /* UXTAB                1111 1010 0101 xxxx 1111 xxxx 1xxx xxxx */
 458        DECODE_OR       (0xff80f080, 0xfa00f080),
 459
 460        /* QADD                 1111 1010 1000 xxxx 1111 xxxx 1000 xxxx */
 461        /* QDADD                1111 1010 1000 xxxx 1111 xxxx 1001 xxxx */
 462        /* QSUB                 1111 1010 1000 xxxx 1111 xxxx 1010 xxxx */
 463        /* QDSUB                1111 1010 1000 xxxx 1111 xxxx 1011 xxxx */
 464        DECODE_OR       (0xfff0f0c0, 0xfa80f080),
 465
 466        /* SEL                  1111 1010 1010 xxxx 1111 xxxx 1000 xxxx */
 467        DECODE_OR       (0xfff0f0f0, 0xfaa0f080),
 468
 469        /* LSL                  1111 1010 000x xxxx 1111 xxxx 0000 xxxx */
 470        /* LSR                  1111 1010 001x xxxx 1111 xxxx 0000 xxxx */
 471        /* ASR                  1111 1010 010x xxxx 1111 xxxx 0000 xxxx */
 472        /* ROR                  1111 1010 011x xxxx 1111 xxxx 0000 xxxx */
 473        DECODE_EMULATEX (0xff80f0f0, 0xfa00f000, PROBES_T32_MEDIA,
 474                                                 REGS(NOSPPC, 0, NOSPPC, 0, NOSPPC)),
 475
 476        /* CLZ                  1111 1010 1010 xxxx 1111 xxxx 1000 xxxx */
 477        DECODE_OR       (0xfff0f0f0, 0xfab0f080),
 478
 479        /* REV                  1111 1010 1001 xxxx 1111 xxxx 1000 xxxx */
 480        /* REV16                1111 1010 1001 xxxx 1111 xxxx 1001 xxxx */
 481        /* RBIT                 1111 1010 1001 xxxx 1111 xxxx 1010 xxxx */
 482        /* REVSH                1111 1010 1001 xxxx 1111 xxxx 1011 xxxx */
 483        DECODE_EMULATEX (0xfff0f0c0, 0xfa90f080, PROBES_T32_REVERSE,
 484                                                 REGS(NOSPPC, 0, NOSPPC, 0, SAMEAS16)),
 485
 486        /* Other unallocated instructions...                            */
 487        DECODE_END
 488};
 489
 490static const union decode_item t32_table_1111_1011_0[] = {
 491        /* Multiply, multiply accumulate, and absolute difference       */
 492
 493        /* ???                  1111 1011 0000 xxxx 1111 xxxx 0001 xxxx */
 494        DECODE_REJECT   (0xfff0f0f0, 0xfb00f010),
 495        /* ???                  1111 1011 0111 xxxx 1111 xxxx 0001 xxxx */
 496        DECODE_REJECT   (0xfff0f0f0, 0xfb70f010),
 497
 498        /* SMULxy               1111 1011 0001 xxxx 1111 xxxx 00xx xxxx */
 499        DECODE_OR       (0xfff0f0c0, 0xfb10f000),
 500        /* MUL                  1111 1011 0000 xxxx 1111 xxxx 0000 xxxx */
 501        /* SMUAD{X}             1111 1011 0010 xxxx 1111 xxxx 000x xxxx */
 502        /* SMULWy               1111 1011 0011 xxxx 1111 xxxx 000x xxxx */
 503        /* SMUSD{X}             1111 1011 0100 xxxx 1111 xxxx 000x xxxx */
 504        /* SMMUL{R}             1111 1011 0101 xxxx 1111 xxxx 000x xxxx */
 505        /* USAD8                1111 1011 0111 xxxx 1111 xxxx 0000 xxxx */
 506        DECODE_EMULATEX (0xff80f0e0, 0xfb00f000, PROBES_T32_MUL_ADD,
 507                                                 REGS(NOSPPC, 0, NOSPPC, 0, NOSPPC)),
 508
 509        /* ???                  1111 1011 0111 xxxx xxxx xxxx 0001 xxxx */
 510        DECODE_REJECT   (0xfff000f0, 0xfb700010),
 511
 512        /* SMLAxy               1111 1011 0001 xxxx xxxx xxxx 00xx xxxx */
 513        DECODE_OR       (0xfff000c0, 0xfb100000),
 514        /* MLA                  1111 1011 0000 xxxx xxxx xxxx 0000 xxxx */
 515        /* MLS                  1111 1011 0000 xxxx xxxx xxxx 0001 xxxx */
 516        /* SMLAD{X}             1111 1011 0010 xxxx xxxx xxxx 000x xxxx */
 517        /* SMLAWy               1111 1011 0011 xxxx xxxx xxxx 000x xxxx */
 518        /* SMLSD{X}             1111 1011 0100 xxxx xxxx xxxx 000x xxxx */
 519        /* SMMLA{R}             1111 1011 0101 xxxx xxxx xxxx 000x xxxx */
 520        /* SMMLS{R}             1111 1011 0110 xxxx xxxx xxxx 000x xxxx */
 521        /* USADA8               1111 1011 0111 xxxx xxxx xxxx 0000 xxxx */
 522        DECODE_EMULATEX (0xff8000c0, 0xfb000000,  PROBES_T32_MUL_ADD2,
 523                                                 REGS(NOSPPC, NOSPPCX, NOSPPC, 0, NOSPPC)),
 524
 525        /* Other unallocated instructions...                            */
 526        DECODE_END
 527};
 528
 529static const union decode_item t32_table_1111_1011_1[] = {
 530        /* Long multiply, long multiply accumulate, and divide          */
 531
 532        /* UMAAL                1111 1011 1110 xxxx xxxx xxxx 0110 xxxx */
 533        DECODE_OR       (0xfff000f0, 0xfbe00060),
 534        /* SMLALxy              1111 1011 1100 xxxx xxxx xxxx 10xx xxxx */
 535        DECODE_OR       (0xfff000c0, 0xfbc00080),
 536        /* SMLALD{X}            1111 1011 1100 xxxx xxxx xxxx 110x xxxx */
 537        /* SMLSLD{X}            1111 1011 1101 xxxx xxxx xxxx 110x xxxx */
 538        DECODE_OR       (0xffe000e0, 0xfbc000c0),
 539        /* SMULL                1111 1011 1000 xxxx xxxx xxxx 0000 xxxx */
 540        /* UMULL                1111 1011 1010 xxxx xxxx xxxx 0000 xxxx */
 541        /* SMLAL                1111 1011 1100 xxxx xxxx xxxx 0000 xxxx */
 542        /* UMLAL                1111 1011 1110 xxxx xxxx xxxx 0000 xxxx */
 543        DECODE_EMULATEX (0xff9000f0, 0xfb800000, PROBES_T32_MUL_ADD_LONG,
 544                                                 REGS(NOSPPC, NOSPPC, NOSPPC, 0, NOSPPC)),
 545
 546        /* SDIV                 1111 1011 1001 xxxx xxxx xxxx 1111 xxxx */
 547        /* UDIV                 1111 1011 1011 xxxx xxxx xxxx 1111 xxxx */
 548        /* Other unallocated instructions...                            */
 549        DECODE_END
 550};
 551
 552const union decode_item probes_decode_thumb32_table[] = {
 553
 554        /*
 555         * Load/store multiple instructions
 556         *                      1110 100x x0xx xxxx xxxx xxxx xxxx xxxx
 557         */
 558        DECODE_TABLE    (0xfe400000, 0xe8000000, t32_table_1110_100x_x0xx),
 559
 560        /*
 561         * Load/store dual, load/store exclusive, table branch
 562         *                      1110 100x x1xx xxxx xxxx xxxx xxxx xxxx
 563         */
 564        DECODE_TABLE    (0xfe400000, 0xe8400000, t32_table_1110_100x_x1xx),
 565
 566        /*
 567         * Data-processing (shifted register)
 568         *                      1110 101x xxxx xxxx xxxx xxxx xxxx xxxx
 569         */
 570        DECODE_TABLE    (0xfe000000, 0xea000000, t32_table_1110_101x),
 571
 572        /*
 573         * Coprocessor instructions
 574         *                      1110 11xx xxxx xxxx xxxx xxxx xxxx xxxx
 575         */
 576        DECODE_REJECT   (0xfc000000, 0xec000000),
 577
 578        /*
 579         * Data-processing (modified immediate)
 580         *                      1111 0x0x xxxx xxxx 0xxx xxxx xxxx xxxx
 581         */
 582        DECODE_TABLE    (0xfa008000, 0xf0000000, t32_table_1111_0x0x___0),
 583
 584        /*
 585         * Data-processing (plain binary immediate)
 586         *                      1111 0x1x xxxx xxxx 0xxx xxxx xxxx xxxx
 587         */
 588        DECODE_TABLE    (0xfa008000, 0xf2000000, t32_table_1111_0x1x___0),
 589
 590        /*
 591         * Branches and miscellaneous control
 592         *                      1111 0xxx xxxx xxxx 1xxx xxxx xxxx xxxx
 593         */
 594        DECODE_TABLE    (0xf8008000, 0xf0008000, t32_table_1111_0xxx___1),
 595
 596        /*
 597         * Advanced SIMD element or structure load/store instructions
 598         *                      1111 1001 xxx0 xxxx xxxx xxxx xxxx xxxx
 599         */
 600        DECODE_REJECT   (0xff100000, 0xf9000000),
 601
 602        /*
 603         * Memory hints
 604         *                      1111 100x x0x1 xxxx 1111 xxxx xxxx xxxx
 605         */
 606        DECODE_TABLE    (0xfe50f000, 0xf810f000, t32_table_1111_100x_x0x1__1111),
 607
 608        /*
 609         * Store single data item
 610         *                      1111 1000 xxx0 xxxx xxxx xxxx xxxx xxxx
 611         * Load single data items
 612         *                      1111 100x xxx1 xxxx xxxx xxxx xxxx xxxx
 613         */
 614        DECODE_TABLE    (0xfe000000, 0xf8000000, t32_table_1111_100x),
 615
 616        /*
 617         * Data-processing (register)
 618         *                      1111 1010 xxxx xxxx 1111 xxxx xxxx xxxx
 619         */
 620        DECODE_TABLE    (0xff00f000, 0xfa00f000, t32_table_1111_1010___1111),
 621
 622        /*
 623         * Multiply, multiply accumulate, and absolute difference
 624         *                      1111 1011 0xxx xxxx xxxx xxxx xxxx xxxx
 625         */
 626        DECODE_TABLE    (0xff800000, 0xfb000000, t32_table_1111_1011_0),
 627
 628        /*
 629         * Long multiply, long multiply accumulate, and divide
 630         *                      1111 1011 1xxx xxxx xxxx xxxx xxxx xxxx
 631         */
 632        DECODE_TABLE    (0xff800000, 0xfb800000, t32_table_1111_1011_1),
 633
 634        /*
 635         * Coprocessor instructions
 636         *                      1111 11xx xxxx xxxx xxxx xxxx xxxx xxxx
 637         */
 638        DECODE_END
 639};
 640#ifdef CONFIG_ARM_KPROBES_TEST_MODULE
 641EXPORT_SYMBOL_GPL(probes_decode_thumb32_table);
 642#endif
 643
 644static const union decode_item t16_table_1011[] = {
 645        /* Miscellaneous 16-bit instructions                */
 646
 647        /* ADD (SP plus immediate)      1011 0000 0xxx xxxx */
 648        /* SUB (SP minus immediate)     1011 0000 1xxx xxxx */
 649        DECODE_SIMULATE (0xff00, 0xb000, PROBES_T16_ADD_SP),
 650
 651        /* CBZ                          1011 00x1 xxxx xxxx */
 652        /* CBNZ                         1011 10x1 xxxx xxxx */
 653        DECODE_SIMULATE (0xf500, 0xb100, PROBES_T16_CBZ),
 654
 655        /* SXTH                         1011 0010 00xx xxxx */
 656        /* SXTB                         1011 0010 01xx xxxx */
 657        /* UXTH                         1011 0010 10xx xxxx */
 658        /* UXTB                         1011 0010 11xx xxxx */
 659        /* REV                          1011 1010 00xx xxxx */
 660        /* REV16                        1011 1010 01xx xxxx */
 661        /* ???                          1011 1010 10xx xxxx */
 662        /* REVSH                        1011 1010 11xx xxxx */
 663        DECODE_REJECT   (0xffc0, 0xba80),
 664        DECODE_EMULATE  (0xf500, 0xb000, PROBES_T16_SIGN_EXTEND),
 665
 666        /* PUSH                         1011 010x xxxx xxxx */
 667        DECODE_CUSTOM   (0xfe00, 0xb400, PROBES_T16_PUSH),
 668        /* POP                          1011 110x xxxx xxxx */
 669        DECODE_CUSTOM   (0xfe00, 0xbc00, PROBES_T16_POP),
 670
 671        /*
 672         * If-Then, and hints
 673         *                              1011 1111 xxxx xxxx
 674         */
 675
 676        /* YIELD                        1011 1111 0001 0000 */
 677        DECODE_OR       (0xffff, 0xbf10),
 678        /* SEV                          1011 1111 0100 0000 */
 679        DECODE_EMULATE  (0xffff, 0xbf40, PROBES_T16_SEV),
 680        /* NOP                          1011 1111 0000 0000 */
 681        /* WFE                          1011 1111 0010 0000 */
 682        /* WFI                          1011 1111 0011 0000 */
 683        DECODE_SIMULATE (0xffcf, 0xbf00, PROBES_T16_WFE),
 684        /* Unassigned hints             1011 1111 xxxx 0000 */
 685        DECODE_REJECT   (0xff0f, 0xbf00),
 686        /* IT                           1011 1111 xxxx xxxx */
 687        DECODE_CUSTOM   (0xff00, 0xbf00, PROBES_T16_IT),
 688
 689        /* SETEND                       1011 0110 010x xxxx */
 690        /* CPS                          1011 0110 011x xxxx */
 691        /* BKPT                         1011 1110 xxxx xxxx */
 692        /* And unallocated instructions...                  */
 693        DECODE_END
 694};
 695
 696const union decode_item probes_decode_thumb16_table[] = {
 697
 698        /*
 699         * Shift (immediate), add, subtract, move, and compare
 700         *                              00xx xxxx xxxx xxxx
 701         */
 702
 703        /* CMP (immediate)              0010 1xxx xxxx xxxx */
 704        DECODE_EMULATE  (0xf800, 0x2800, PROBES_T16_CMP),
 705
 706        /* ADD (register)               0001 100x xxxx xxxx */
 707        /* SUB (register)               0001 101x xxxx xxxx */
 708        /* LSL (immediate)              0000 0xxx xxxx xxxx */
 709        /* LSR (immediate)              0000 1xxx xxxx xxxx */
 710        /* ASR (immediate)              0001 0xxx xxxx xxxx */
 711        /* ADD (immediate, Thumb)       0001 110x xxxx xxxx */
 712        /* SUB (immediate, Thumb)       0001 111x xxxx xxxx */
 713        /* MOV (immediate)              0010 0xxx xxxx xxxx */
 714        /* ADD (immediate, Thumb)       0011 0xxx xxxx xxxx */
 715        /* SUB (immediate, Thumb)       0011 1xxx xxxx xxxx */
 716        DECODE_EMULATE  (0xc000, 0x0000, PROBES_T16_ADDSUB),
 717
 718        /*
 719         * 16-bit Thumb data-processing instructions
 720         *                              0100 00xx xxxx xxxx
 721         */
 722
 723        /* TST (register)               0100 0010 00xx xxxx */
 724        DECODE_EMULATE  (0xffc0, 0x4200, PROBES_T16_CMP),
 725        /* CMP (register)               0100 0010 10xx xxxx */
 726        /* CMN (register)               0100 0010 11xx xxxx */
 727        DECODE_EMULATE  (0xff80, 0x4280, PROBES_T16_CMP),
 728        /* AND (register)               0100 0000 00xx xxxx */
 729        /* EOR (register)               0100 0000 01xx xxxx */
 730        /* LSL (register)               0100 0000 10xx xxxx */
 731        /* LSR (register)               0100 0000 11xx xxxx */
 732        /* ASR (register)               0100 0001 00xx xxxx */
 733        /* ADC (register)               0100 0001 01xx xxxx */
 734        /* SBC (register)               0100 0001 10xx xxxx */
 735        /* ROR (register)               0100 0001 11xx xxxx */
 736        /* RSB (immediate)              0100 0010 01xx xxxx */
 737        /* ORR (register)               0100 0011 00xx xxxx */
 738        /* MUL                          0100 0011 00xx xxxx */
 739        /* BIC (register)               0100 0011 10xx xxxx */
 740        /* MVN (register)               0100 0011 10xx xxxx */
 741        DECODE_EMULATE  (0xfc00, 0x4000, PROBES_T16_LOGICAL),
 742
 743        /*
 744         * Special data instructions and branch and exchange
 745         *                              0100 01xx xxxx xxxx
 746         */
 747
 748        /* BLX pc                       0100 0111 1111 1xxx */
 749        DECODE_REJECT   (0xfff8, 0x47f8),
 750
 751        /* BX (register)                0100 0111 0xxx xxxx */
 752        /* BLX (register)               0100 0111 1xxx xxxx */
 753        DECODE_SIMULATE (0xff00, 0x4700, PROBES_T16_BLX),
 754
 755        /* ADD pc, pc                   0100 0100 1111 1111 */
 756        DECODE_REJECT   (0xffff, 0x44ff),
 757
 758        /* ADD (register)               0100 0100 xxxx xxxx */
 759        /* CMP (register)               0100 0101 xxxx xxxx */
 760        /* MOV (register)               0100 0110 xxxx xxxx */
 761        DECODE_CUSTOM   (0xfc00, 0x4400, PROBES_T16_HIREGOPS),
 762
 763        /*
 764         * Load from Literal Pool
 765         * LDR (literal)                0100 1xxx xxxx xxxx
 766         */
 767        DECODE_SIMULATE (0xf800, 0x4800, PROBES_T16_LDR_LIT),
 768
 769        /*
 770         * 16-bit Thumb Load/store instructions
 771         *                              0101 xxxx xxxx xxxx
 772         *                              011x xxxx xxxx xxxx
 773         *                              100x xxxx xxxx xxxx
 774         */
 775
 776        /* STR (register)               0101 000x xxxx xxxx */
 777        /* STRH (register)              0101 001x xxxx xxxx */
 778        /* STRB (register)              0101 010x xxxx xxxx */
 779        /* LDRSB (register)             0101 011x xxxx xxxx */
 780        /* LDR (register)               0101 100x xxxx xxxx */
 781        /* LDRH (register)              0101 101x xxxx xxxx */
 782        /* LDRB (register)              0101 110x xxxx xxxx */
 783        /* LDRSH (register)             0101 111x xxxx xxxx */
 784        /* STR (immediate, Thumb)       0110 0xxx xxxx xxxx */
 785        /* LDR (immediate, Thumb)       0110 1xxx xxxx xxxx */
 786        /* STRB (immediate, Thumb)      0111 0xxx xxxx xxxx */
 787        /* LDRB (immediate, Thumb)      0111 1xxx xxxx xxxx */
 788        DECODE_EMULATE  (0xc000, 0x4000, PROBES_T16_LDRHSTRH),
 789        /* STRH (immediate, Thumb)      1000 0xxx xxxx xxxx */
 790        /* LDRH (immediate, Thumb)      1000 1xxx xxxx xxxx */
 791        DECODE_EMULATE  (0xf000, 0x8000, PROBES_T16_LDRHSTRH),
 792        /* STR (immediate, Thumb)       1001 0xxx xxxx xxxx */
 793        /* LDR (immediate, Thumb)       1001 1xxx xxxx xxxx */
 794        DECODE_SIMULATE (0xf000, 0x9000, PROBES_T16_LDRSTR),
 795
 796        /*
 797         * Generate PC-/SP-relative address
 798         * ADR (literal)                1010 0xxx xxxx xxxx
 799         * ADD (SP plus immediate)      1010 1xxx xxxx xxxx
 800         */
 801        DECODE_SIMULATE (0xf000, 0xa000, PROBES_T16_ADR),
 802
 803        /*
 804         * Miscellaneous 16-bit instructions
 805         *                              1011 xxxx xxxx xxxx
 806         */
 807        DECODE_TABLE    (0xf000, 0xb000, t16_table_1011),
 808
 809        /* STM                          1100 0xxx xxxx xxxx */
 810        /* LDM                          1100 1xxx xxxx xxxx */
 811        DECODE_EMULATE  (0xf000, 0xc000, PROBES_T16_LDMSTM),
 812
 813        /*
 814         * Conditional branch, and Supervisor Call
 815         */
 816
 817        /* Permanently UNDEFINED        1101 1110 xxxx xxxx */
 818        /* SVC                          1101 1111 xxxx xxxx */
 819        DECODE_REJECT   (0xfe00, 0xde00),
 820
 821        /* Conditional branch           1101 xxxx xxxx xxxx */
 822        DECODE_CUSTOM   (0xf000, 0xd000, PROBES_T16_BRANCH_COND),
 823
 824        /*
 825         * Unconditional branch
 826         * B                            1110 0xxx xxxx xxxx
 827         */
 828        DECODE_SIMULATE (0xf800, 0xe000, PROBES_T16_BRANCH),
 829
 830        DECODE_END
 831};
 832#ifdef CONFIG_ARM_KPROBES_TEST_MODULE
 833EXPORT_SYMBOL_GPL(probes_decode_thumb16_table);
 834#endif
 835
 836static unsigned long __kprobes thumb_check_cc(unsigned long cpsr)
 837{
 838        if (unlikely(in_it_block(cpsr)))
 839                return probes_condition_checks[current_cond(cpsr)](cpsr);
 840        return true;
 841}
 842
 843static void __kprobes thumb16_singlestep(probes_opcode_t opcode,
 844                struct arch_probes_insn *asi,
 845                struct pt_regs *regs)
 846{
 847        regs->ARM_pc += 2;
 848        asi->insn_handler(opcode, asi, regs);
 849        regs->ARM_cpsr = it_advance(regs->ARM_cpsr);
 850}
 851
 852static void __kprobes thumb32_singlestep(probes_opcode_t opcode,
 853                struct arch_probes_insn *asi,
 854                struct pt_regs *regs)
 855{
 856        regs->ARM_pc += 4;
 857        asi->insn_handler(opcode, asi, regs);
 858        regs->ARM_cpsr = it_advance(regs->ARM_cpsr);
 859}
 860
 861enum probes_insn __kprobes
 862thumb16_probes_decode_insn(probes_opcode_t insn, struct arch_probes_insn *asi,
 863                           bool emulate, const union decode_action *actions,
 864                           const struct decode_checker *checkers[])
 865{
 866        asi->insn_singlestep = thumb16_singlestep;
 867        asi->insn_check_cc = thumb_check_cc;
 868        return probes_decode_insn(insn, asi, probes_decode_thumb16_table, true,
 869                                  emulate, actions, checkers);
 870}
 871
 872enum probes_insn __kprobes
 873thumb32_probes_decode_insn(probes_opcode_t insn, struct arch_probes_insn *asi,
 874                           bool emulate, const union decode_action *actions,
 875                           const struct decode_checker *checkers[])
 876{
 877        asi->insn_singlestep = thumb32_singlestep;
 878        asi->insn_check_cc = thumb_check_cc;
 879        return probes_decode_insn(insn, asi, probes_decode_thumb32_table, true,
 880                                  emulate, actions, checkers);
 881}
 882