|
@@ -12,41 +12,30 @@
|
|
#include <linux/mm.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pagemap.h>
|
|
#include <linux/pagemap.h>
|
|
-
|
|
|
|
#include <linux/kdebug.h>
|
|
#include <linux/kdebug.h>
|
|
|
|
+#include <linux/kprobes.h>
|
|
|
|
+
|
|
#include <asm/mmu_context.h>
|
|
#include <asm/mmu_context.h>
|
|
#include <asm/sysreg.h>
|
|
#include <asm/sysreg.h>
|
|
#include <asm/tlb.h>
|
|
#include <asm/tlb.h>
|
|
#include <asm/uaccess.h>
|
|
#include <asm/uaccess.h>
|
|
|
|
|
|
#ifdef CONFIG_KPROBES
|
|
#ifdef CONFIG_KPROBES
|
|
-ATOMIC_NOTIFIER_HEAD(notify_page_fault_chain);
|
|
|
|
-
|
|
|
|
-/* Hook to register for page fault notifications */
|
|
|
|
-int register_page_fault_notifier(struct notifier_block *nb)
|
|
|
|
|
|
+static inline int notify_page_fault(struct pt_regs *regs, int trap)
|
|
{
|
|
{
|
|
- return atomic_notifier_chain_register(¬ify_page_fault_chain, nb);
|
|
|
|
-}
|
|
|
|
|
|
+ int ret = 0;
|
|
|
|
|
|
-int unregister_page_fault_notifier(struct notifier_block *nb)
|
|
|
|
-{
|
|
|
|
- return atomic_notifier_chain_unregister(¬ify_page_fault_chain, nb);
|
|
|
|
-}
|
|
|
|
|
|
+ if (!user_mode(regs)) {
|
|
|
|
+ if (kprobe_running() && kprobe_fault_handler(regs, trap))
|
|
|
|
+ ret = 1;
|
|
|
|
+ }
|
|
|
|
|
|
-static inline int notify_page_fault(enum die_val val, struct pt_regs *regs,
|
|
|
|
- int trap, int sig)
|
|
|
|
-{
|
|
|
|
- struct die_args args = {
|
|
|
|
- .regs = regs,
|
|
|
|
- .trapnr = trap,
|
|
|
|
- };
|
|
|
|
- return atomic_notifier_call_chain(¬ify_page_fault_chain, val, &args);
|
|
|
|
|
|
+ return ret;
|
|
}
|
|
}
|
|
#else
|
|
#else
|
|
-static inline int notify_page_fault(enum die_val val, struct pt_regs *regs,
|
|
|
|
- int trap, int sig)
|
|
|
|
|
|
+static inline int notify_page_fault(struct pt_regs *regs, int trap)
|
|
{
|
|
{
|
|
- return NOTIFY_DONE;
|
|
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
@@ -76,8 +65,7 @@ asmlinkage void do_page_fault(unsigned long ecr, struct pt_regs *regs)
|
|
long signr;
|
|
long signr;
|
|
int code;
|
|
int code;
|
|
|
|
|
|
- if (notify_page_fault(DIE_PAGE_FAULT, regs,
|
|
|
|
- ecr, SIGSEGV) == NOTIFY_STOP)
|
|
|
|
|
|
+ if (notify_page_fault(regs, ecr))
|
|
return;
|
|
return;
|
|
|
|
|
|
address = sysreg_read(TLBEAR);
|
|
address = sysreg_read(TLBEAR);
|