ARM: kprobes: Add condition code checking to Thumb emulation
[firefly-linux-kernel-4.4.55.git] / arch / arm / kernel / kprobes-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/kernel.h>
12 #include <linux/kprobes.h>
13
14 #include "kprobes.h"
15
16
17 /*
18  * True if current instruction is in an IT block.
19  */
20 #define in_it_block(cpsr)       ((cpsr & 0x06000c00) != 0x00000000)
21
22 /*
23  * Return the condition code to check for the currently executing instruction.
24  * This is in ITSTATE<7:4> which is in CPSR<15:12> but is only valid if
25  * in_it_block returns true.
26  */
27 #define current_cond(cpsr)      ((cpsr >> 12) & 0xf)
28
29 static unsigned long __kprobes thumb_check_cc(unsigned long cpsr)
30 {
31         if (unlikely(in_it_block(cpsr)))
32                 return kprobe_condition_checks[current_cond(cpsr)](cpsr);
33         return true;
34 }
35
36 enum kprobe_insn __kprobes
37 thumb16_kprobe_decode_insn(kprobe_opcode_t insn, struct arch_specific_insn *asi)
38 {
39         asi->insn_check_cc = thumb_check_cc;
40         return INSN_REJECTED;
41 }
42
43 enum kprobe_insn __kprobes
44 thumb32_kprobe_decode_insn(kprobe_opcode_t insn, struct arch_specific_insn *asi)
45 {
46         asi->insn_check_cc = thumb_check_cc;
47         return INSN_REJECTED;
48 }