forked from rubenslte/android_kernel_samsung_msm8226
Steve Muckle
f132c6cf77
AU_LINUX_ANDROID_ICS.04.00.04.00.126 from msm-3.0. First parent is from google/android-3.4. * commit 'AU_LINUX_ANDROID_ICS.04.00.04.00.126': (8712 commits) PRNG: Device tree entry for qrng device. vidc:1080p: Set video core timeout value for Thumbnail mode msm: sps: improve the debugging support in SPS driver board-8064 msm: Overlap secure and non secure video firmware heaps. msm: clock: Add handoff ops for 7x30 and copper XO clocks msm_fb: display: Wait for external vsync before DTV IOMMU unmap msm: Fix ciruclar dependency in debug UART settings msm: gdsc: Add GDSC regulator driver for msm-copper defconfig: Enable Mobicore Driver. mobicore: Add mobicore driver. mobicore: rename variable to lower case. mobicore: rename folder. mobicore: add makefiles mobicore: initial import of kernel driver ASoC: msm: Add SLIMBUS_2_RX CPU DAI board-8064-gpio: Update FUNC for EPM SPI CS msm_fb: display: Remove chicken bit config during video playback mmc: msm_sdcc: enable the sanitize capability msm-fb: display: lm2 writeback support on mpq platfroms msm_fb: display: Disable LVDS phy & pll during panel off ... Signed-off-by: Steve Muckle <smuckle@codeaurora.org>
84 lines
1.8 KiB
C
84 lines
1.8 KiB
C
#include <linux/kernel.h>
|
|
#include <linux/kprobes.h>
|
|
#include <linux/stop_machine.h>
|
|
|
|
#include <asm/cacheflush.h>
|
|
#include <asm/smp_plat.h>
|
|
#include <asm/opcodes.h>
|
|
#include <asm/mmu_writeable.h>
|
|
|
|
#include "patch.h"
|
|
|
|
struct patch {
|
|
void *addr;
|
|
unsigned int insn;
|
|
};
|
|
|
|
void __kprobes __patch_text(void *addr, unsigned int insn)
|
|
{
|
|
bool thumb2 = IS_ENABLED(CONFIG_THUMB2_KERNEL);
|
|
int size;
|
|
unsigned long flags;
|
|
|
|
mem_text_writeable_spinlock(&flags);
|
|
mem_text_address_writeable((unsigned long)addr);
|
|
|
|
if (thumb2 && __opcode_is_thumb16(insn)) {
|
|
*(u16 *)addr = __opcode_to_mem_thumb16(insn);
|
|
size = sizeof(u16);
|
|
} else if (thumb2 && ((uintptr_t)addr & 2)) {
|
|
u16 first = __opcode_thumb32_first(insn);
|
|
u16 second = __opcode_thumb32_second(insn);
|
|
u16 *addrh = addr;
|
|
|
|
addrh[0] = __opcode_to_mem_thumb16(first);
|
|
addrh[1] = __opcode_to_mem_thumb16(second);
|
|
|
|
size = sizeof(u32);
|
|
} else {
|
|
if (thumb2)
|
|
insn = __opcode_to_mem_thumb32(insn);
|
|
else
|
|
insn = __opcode_to_mem_arm(insn);
|
|
|
|
*(u32 *)addr = insn;
|
|
size = sizeof(u32);
|
|
}
|
|
|
|
flush_icache_range((uintptr_t)(addr),
|
|
(uintptr_t)(addr) + size);
|
|
|
|
mem_text_address_restore();
|
|
mem_text_writeable_spinunlock(&flags);
|
|
}
|
|
|
|
static int __kprobes patch_text_stop_machine(void *data)
|
|
{
|
|
struct patch *patch = data;
|
|
|
|
__patch_text(patch->addr, patch->insn);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void __kprobes patch_text(void *addr, unsigned int insn)
|
|
{
|
|
struct patch patch = {
|
|
.addr = addr,
|
|
.insn = insn,
|
|
};
|
|
|
|
if (cache_ops_need_broadcast()) {
|
|
stop_machine(patch_text_stop_machine, &patch, cpu_online_mask);
|
|
} else {
|
|
bool straddles_word = IS_ENABLED(CONFIG_THUMB2_KERNEL)
|
|
&& __opcode_is_thumb32(insn)
|
|
&& ((uintptr_t)addr & 2);
|
|
|
|
if (straddles_word)
|
|
stop_machine(patch_text_stop_machine, &patch, NULL);
|
|
else
|
|
__patch_text(addr, insn);
|
|
}
|
|
}
|