arch/arm/kernel/probes-thumb.c

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