| /* |
| * linux/arch/arm/mm/fault.c |
| * |
| * Copyright (C) 1995 Linus Torvalds |
| * Modifications for ARM processor (c) 1995-2004 Russell King |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| #include <linux/module.h> |
| #include <linux/signal.h> |
| #include <linux/mm.h> |
| #include <linux/hardirq.h> |
| #include <linux/init.h> |
| #include <linux/kprobes.h> |
| #include <linux/uaccess.h> |
| #include <linux/page-flags.h> |
| #include <linux/sched.h> |
| #include <linux/highmem.h> |
| #include <linux/perf_event.h> |
| |
| #include <asm/exception.h> |
| #include <asm/system.h> |
| #include <asm/pgtable.h> |
| #include <asm/tlbflush.h> |
| #include <asm/cputype.h> |
| #if defined(CONFIG_ARCH_MSM_SCORPION) && !defined(CONFIG_MSM_SMP) |
| #include <asm/io.h> |
| #include <mach/msm_iomap.h> |
| #endif |
| |
| #ifdef CONFIG_EMULATE_DOMAIN_MANAGER_V7 |
| #include <asm/domain.h> |
| #endif /* CONFIG_EMULATE_DOMAIN_MANAGER_V7 */ |
| |
| #include "fault.h" |
| |
| /* |
| * Fault status register encodings. We steal bit 31 for our own purposes. |
| */ |
| #define FSR_LNX_PF (1 << 31) |
| #define FSR_WRITE (1 << 11) |
| #define FSR_FS4 (1 << 10) |
| #define FSR_FS3_0 (15) |
| |
| static inline int fsr_fs(unsigned int fsr) |
| { |
| return (fsr & FSR_FS3_0) | (fsr & FSR_FS4) >> 6; |
| } |
| |
| #ifdef CONFIG_MMU |
| |
| #ifdef CONFIG_KPROBES |
| static inline int notify_page_fault(struct pt_regs *regs, unsigned int fsr) |
| { |
| int ret = 0; |
| |
| if (!user_mode(regs)) { |
| /* kprobe_running() needs smp_processor_id() */ |
| preempt_disable(); |
| if (kprobe_running() && kprobe_fault_handler(regs, fsr)) |
| ret = 1; |
| preempt_enable(); |
| } |
| |
| return ret; |
| } |
| #else |
| static inline int notify_page_fault(struct pt_regs *regs, unsigned int fsr) |
| { |
| return 0; |
| } |
| #endif |
| |
| /* |
| * This is useful to dump out the page tables associated with |
| * 'addr' in mm 'mm'. |
| */ |
| void show_pte(struct mm_struct *mm, unsigned long addr) |
| { |
| pgd_t *pgd; |
| |
| if (!mm) |
| mm = &init_mm; |
| |
| printk(KERN_ALERT "pgd = %p\n", mm->pgd); |
| pgd = pgd_offset(mm, addr); |
| printk(KERN_ALERT "[%08lx] *pgd=%08llx", |
| addr, (long long)pgd_val(*pgd)); |
| |
| do { |
| pud_t *pud; |
| pmd_t *pmd; |
| pte_t *pte; |
| |
| if (pgd_none(*pgd)) |
| break; |
| |
| if (pgd_bad(*pgd)) { |
| printk("(bad)"); |
| break; |
| } |
| |
| pud = pud_offset(pgd, addr); |
| if (PTRS_PER_PUD != 1) |
| printk(", *pud=%08lx", pud_val(*pud)); |
| |
| if (pud_none(*pud)) |
| break; |
| |
| if (pud_bad(*pud)) { |
| printk("(bad)"); |
| break; |
| } |
| |
| pmd = pmd_offset(pud, addr); |
| if (PTRS_PER_PMD != 1) |
| printk(", *pmd=%08llx", (long long)pmd_val(*pmd)); |
| |
| if (pmd_none(*pmd)) |
| break; |
| |
| if (pmd_bad(*pmd)) { |
| printk("(bad)"); |
| break; |
| } |
| |
| /* We must not map this if we have highmem enabled */ |
| if (PageHighMem(pfn_to_page(pmd_val(*pmd) >> PAGE_SHIFT))) |
| break; |
| |
| pte = pte_offset_map(pmd, addr); |
| printk(", *pte=%08llx", (long long)pte_val(*pte)); |
| printk(", *ppte=%08llx", |
| (long long)pte_val(pte[PTE_HWTABLE_PTRS])); |
| pte_unmap(pte); |
| } while(0); |
| |
| printk("\n"); |
| } |
| #else /* CONFIG_MMU */ |
| void show_pte(struct mm_struct *mm, unsigned long addr) |
| { } |
| #endif /* CONFIG_MMU */ |
| |
| /* |
| * Oops. The kernel tried to access some page that wasn't present. |
| */ |
| static void |
| __do_kernel_fault(struct mm_struct *mm, unsigned long addr, unsigned int fsr, |
| struct pt_regs *regs) |
| { |
| /* |
| * Are we prepared to handle this kernel fault? |
| */ |
| if (fixup_exception(regs)) |
| return; |
| |
| /* |
| * No handler, we'll have to terminate things with extreme prejudice. |
| */ |
| bust_spinlocks(1); |
| printk(KERN_ALERT |
| "Unable to handle kernel %s at virtual address %08lx\n", |
| (addr < PAGE_SIZE) ? "NULL pointer dereference" : |
| "paging request", addr); |
| |
| show_pte(mm, addr); |
| die("Oops", regs, fsr); |
| bust_spinlocks(0); |
| do_exit(SIGKILL); |
| } |
| |
| /* |
| * Something tried to access memory that isn't in our memory map.. |
| * User mode accesses just cause a SIGSEGV |
| */ |
| static void |
| __do_user_fault(struct task_struct *tsk, unsigned long addr, |
| unsigned int fsr, unsigned int sig, int code, |
| struct pt_regs *regs) |
| { |
| struct siginfo si; |
| |
| #ifdef CONFIG_DEBUG_USER |
| if (user_debug & UDBG_SEGV) { |
| printk(KERN_DEBUG "%s: unhandled page fault (%d) at 0x%08lx, code 0x%03x\n", |
| tsk->comm, sig, addr, fsr); |
| show_pte(tsk->mm, addr); |
| show_regs(regs); |
| } |
| #endif |
| |
| tsk->thread.address = addr; |
| tsk->thread.error_code = fsr; |
| tsk->thread.trap_no = 14; |
| si.si_signo = sig; |
| si.si_errno = 0; |
| si.si_code = code; |
| si.si_addr = (void __user *)addr; |
| force_sig_info(sig, &si, tsk); |
| } |
| |
| void do_bad_area(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| struct task_struct *tsk = current; |
| struct mm_struct *mm = tsk->active_mm; |
| |
| /* |
| * If we are in kernel mode at this point, we |
| * have no context to handle this fault with. |
| */ |
| if (user_mode(regs)) |
| __do_user_fault(tsk, addr, fsr, SIGSEGV, SEGV_MAPERR, regs); |
| else |
| __do_kernel_fault(mm, addr, fsr, regs); |
| } |
| |
| #ifdef CONFIG_MMU |
| #define VM_FAULT_BADMAP 0x010000 |
| #define VM_FAULT_BADACCESS 0x020000 |
| |
| /* |
| * Check that the permissions on the VMA allow for the fault which occurred. |
| * If we encountered a write fault, we must have write permission, otherwise |
| * we allow any permission. |
| */ |
| static inline bool access_error(unsigned int fsr, struct vm_area_struct *vma) |
| { |
| unsigned int mask = VM_READ | VM_WRITE | VM_EXEC; |
| |
| if (fsr & FSR_WRITE) |
| mask = VM_WRITE; |
| if (fsr & FSR_LNX_PF) |
| mask = VM_EXEC; |
| |
| return vma->vm_flags & mask ? false : true; |
| } |
| |
| static int __kprobes |
| __do_page_fault(struct mm_struct *mm, unsigned long addr, unsigned int fsr, |
| struct task_struct *tsk) |
| { |
| struct vm_area_struct *vma; |
| int fault; |
| |
| vma = find_vma(mm, addr); |
| fault = VM_FAULT_BADMAP; |
| if (unlikely(!vma)) |
| goto out; |
| if (unlikely(vma->vm_start > addr)) |
| goto check_stack; |
| |
| /* |
| * Ok, we have a good vm_area for this |
| * memory access, so we can handle it. |
| */ |
| good_area: |
| if (access_error(fsr, vma)) { |
| fault = VM_FAULT_BADACCESS; |
| goto out; |
| } |
| |
| /* |
| * If for any reason at all we couldn't handle the fault, make |
| * sure we exit gracefully rather than endlessly redo the fault. |
| */ |
| fault = handle_mm_fault(mm, vma, addr & PAGE_MASK, (fsr & FSR_WRITE) ? FAULT_FLAG_WRITE : 0); |
| if (unlikely(fault & VM_FAULT_ERROR)) |
| return fault; |
| if (fault & VM_FAULT_MAJOR) |
| tsk->maj_flt++; |
| else |
| tsk->min_flt++; |
| return fault; |
| |
| check_stack: |
| if (vma->vm_flags & VM_GROWSDOWN && !expand_stack(vma, addr)) |
| goto good_area; |
| out: |
| return fault; |
| } |
| |
| static int __kprobes |
| do_page_fault(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| struct task_struct *tsk; |
| struct mm_struct *mm; |
| int fault, sig, code; |
| |
| if (notify_page_fault(regs, fsr)) |
| return 0; |
| |
| tsk = current; |
| mm = tsk->mm; |
| |
| /* |
| * If we're in an interrupt or have no user |
| * context, we must not take the fault.. |
| */ |
| if (in_atomic() || !mm) |
| goto no_context; |
| |
| /* |
| * As per x86, we may deadlock here. However, since the kernel only |
| * validly references user space from well defined areas of the code, |
| * we can bug out early if this is from code which shouldn't. |
| */ |
| if (!down_read_trylock(&mm->mmap_sem)) { |
| if (!user_mode(regs) && !search_exception_tables(regs->ARM_pc)) |
| goto no_context; |
| down_read(&mm->mmap_sem); |
| } else { |
| /* |
| * The above down_read_trylock() might have succeeded in |
| * which case, we'll have missed the might_sleep() from |
| * down_read() |
| */ |
| might_sleep(); |
| #ifdef CONFIG_DEBUG_VM |
| if (!user_mode(regs) && |
| !search_exception_tables(regs->ARM_pc)) |
| goto no_context; |
| #endif |
| } |
| |
| fault = __do_page_fault(mm, addr, fsr, tsk); |
| up_read(&mm->mmap_sem); |
| |
| perf_sw_event(PERF_COUNT_SW_PAGE_FAULTS, 1, 0, regs, addr); |
| if (fault & VM_FAULT_MAJOR) |
| perf_sw_event(PERF_COUNT_SW_PAGE_FAULTS_MAJ, 1, 0, regs, addr); |
| else if (fault & VM_FAULT_MINOR) |
| perf_sw_event(PERF_COUNT_SW_PAGE_FAULTS_MIN, 1, 0, regs, addr); |
| |
| /* |
| * Handle the "normal" case first - VM_FAULT_MAJOR / VM_FAULT_MINOR |
| */ |
| if (likely(!(fault & (VM_FAULT_ERROR | VM_FAULT_BADMAP | VM_FAULT_BADACCESS)))) |
| return 0; |
| |
| if (fault & VM_FAULT_OOM) { |
| /* |
| * We ran out of memory, call the OOM killer, and return to |
| * userspace (which will retry the fault, or kill us if we |
| * got oom-killed) |
| */ |
| pagefault_out_of_memory(); |
| return 0; |
| } |
| |
| /* |
| * If we are in kernel mode at this point, we |
| * have no context to handle this fault with. |
| */ |
| if (!user_mode(regs)) |
| goto no_context; |
| |
| if (fault & VM_FAULT_SIGBUS) { |
| /* |
| * We had some memory, but were unable to |
| * successfully fix up this page fault. |
| */ |
| sig = SIGBUS; |
| code = BUS_ADRERR; |
| } else { |
| /* |
| * Something tried to access memory that |
| * isn't in our memory map.. |
| */ |
| sig = SIGSEGV; |
| code = fault == VM_FAULT_BADACCESS ? |
| SEGV_ACCERR : SEGV_MAPERR; |
| } |
| |
| __do_user_fault(tsk, addr, fsr, sig, code, regs); |
| return 0; |
| |
| no_context: |
| __do_kernel_fault(mm, addr, fsr, regs); |
| return 0; |
| } |
| #else /* CONFIG_MMU */ |
| static int |
| do_page_fault(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| return 0; |
| } |
| #endif /* CONFIG_MMU */ |
| |
| /* |
| * First Level Translation Fault Handler |
| * |
| * We enter here because the first level page table doesn't contain |
| * a valid entry for the address. |
| * |
| * If the address is in kernel space (>= TASK_SIZE), then we are |
| * probably faulting in the vmalloc() area. |
| * |
| * If the init_task's first level page tables contains the relevant |
| * entry, we copy the it to this task. If not, we send the process |
| * a signal, fixup the exception, or oops the kernel. |
| * |
| * NOTE! We MUST NOT take any locks for this case. We may be in an |
| * interrupt or a critical region, and should only copy the information |
| * from the master page table, nothing more. |
| */ |
| #ifdef CONFIG_MMU |
| static int __kprobes |
| do_translation_fault(unsigned long addr, unsigned int fsr, |
| struct pt_regs *regs) |
| { |
| unsigned int index; |
| pgd_t *pgd, *pgd_k; |
| pud_t *pud, *pud_k; |
| pmd_t *pmd, *pmd_k; |
| |
| if (addr < TASK_SIZE) |
| return do_page_fault(addr, fsr, regs); |
| |
| if (user_mode(regs)) |
| goto bad_area; |
| |
| index = pgd_index(addr); |
| |
| /* |
| * FIXME: CP15 C1 is write only on ARMv3 architectures. |
| */ |
| pgd = cpu_get_pgd() + index; |
| pgd_k = init_mm.pgd + index; |
| |
| if (pgd_none(*pgd_k)) |
| goto bad_area; |
| if (!pgd_present(*pgd)) |
| set_pgd(pgd, *pgd_k); |
| |
| pud = pud_offset(pgd, addr); |
| pud_k = pud_offset(pgd_k, addr); |
| |
| if (pud_none(*pud_k)) |
| goto bad_area; |
| if (!pud_present(*pud)) |
| set_pud(pud, *pud_k); |
| |
| pmd = pmd_offset(pud, addr); |
| pmd_k = pmd_offset(pud_k, addr); |
| |
| /* |
| * On ARM one Linux PGD entry contains two hardware entries (see page |
| * tables layout in pgtable.h). We normally guarantee that we always |
| * fill both L1 entries. But create_mapping() doesn't follow the rule. |
| * It can create inidividual L1 entries, so here we have to call |
| * pmd_none() check for the entry really corresponded to address, not |
| * for the first of pair. |
| */ |
| index = (addr >> SECTION_SHIFT) & 1; |
| if (pmd_none(pmd_k[index])) |
| goto bad_area; |
| |
| copy_pmd(pmd, pmd_k); |
| return 0; |
| |
| bad_area: |
| do_bad_area(addr, fsr, regs); |
| return 0; |
| } |
| #else /* CONFIG_MMU */ |
| static int |
| do_translation_fault(unsigned long addr, unsigned int fsr, |
| struct pt_regs *regs) |
| { |
| return 0; |
| } |
| #endif /* CONFIG_MMU */ |
| |
| /* |
| * Some section permission faults need to be handled gracefully. |
| * They can happen due to a __{get,put}_user during an oops. |
| */ |
| static int |
| do_sect_fault(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| do_bad_area(addr, fsr, regs); |
| return 0; |
| } |
| |
| /* |
| * This abort handler always returns "fault". |
| */ |
| static int |
| do_bad(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| return 1; |
| } |
| |
| #if defined(CONFIG_ARCH_MSM_SCORPION) && !defined(CONFIG_MSM_SMP) |
| #define __str(x) #x |
| #define MRC(x, v1, v2, v4, v5, v6) do { \ |
| unsigned int __##x; \ |
| asm("mrc " __str(v1) ", " __str(v2) ", %0, " __str(v4) ", " \ |
| __str(v5) ", " __str(v6) "\n" \ |
| : "=r" (__##x)); \ |
| pr_info("%s: %s = 0x%.8x\n", __func__, #x, __##x); \ |
| } while(0) |
| |
| #define MSM_TCSR_SPARE2 (MSM_TCSR_BASE + 0x60) |
| |
| #endif |
| |
| static int |
| do_imprecise_ext(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| #if defined(CONFIG_ARCH_MSM_SCORPION) && !defined(CONFIG_MSM_SMP) |
| MRC(ADFSR, p15, 0, c5, c1, 0); |
| MRC(DFSR, p15, 0, c5, c0, 0); |
| MRC(ACTLR, p15, 0, c1, c0, 1); |
| MRC(EFSR, p15, 7, c15, c0, 1); |
| MRC(L2SR, p15, 3, c15, c1, 0); |
| MRC(L2CR0, p15, 3, c15, c0, 1); |
| MRC(L2CPUESR, p15, 3, c15, c1, 1); |
| MRC(L2CPUCR, p15, 3, c15, c0, 2); |
| MRC(SPESR, p15, 1, c9, c7, 0); |
| MRC(SPCR, p15, 0, c9, c7, 0); |
| MRC(DMACHSR, p15, 1, c11, c0, 0); |
| MRC(DMACHESR, p15, 1, c11, c0, 1); |
| MRC(DMACHCR, p15, 0, c11, c0, 2); |
| |
| /* clear out EFSR and ADFSR after fault */ |
| asm volatile ("mcr p15, 7, %0, c15, c0, 1\n\t" |
| "mcr p15, 0, %0, c5, c1, 0" |
| : : "r" (0)); |
| #endif |
| #if defined(CONFIG_ARCH_MSM_SCORPION) && !defined(CONFIG_MSM_SMP) |
| pr_info("%s: TCSR_SPARE2 = 0x%.8x\n", __func__, readl(MSM_TCSR_SPARE2)); |
| #endif |
| return 1; |
| } |
| |
| static struct fsr_info { |
| int (*fn)(unsigned long addr, unsigned int fsr, struct pt_regs *regs); |
| int sig; |
| int code; |
| const char *name; |
| } fsr_info[] = { |
| /* |
| * The following are the standard ARMv3 and ARMv4 aborts. ARMv5 |
| * defines these to be "precise" aborts. |
| */ |
| { do_bad, SIGSEGV, 0, "vector exception" }, |
| { do_bad, SIGBUS, BUS_ADRALN, "alignment exception" }, |
| { do_bad, SIGKILL, 0, "terminal exception" }, |
| { do_bad, SIGBUS, BUS_ADRALN, "alignment exception" }, |
| { do_bad, SIGBUS, 0, "external abort on linefetch" }, |
| { do_translation_fault, SIGSEGV, SEGV_MAPERR, "section translation fault" }, |
| { do_bad, SIGBUS, 0, "external abort on linefetch" }, |
| { do_page_fault, SIGSEGV, SEGV_MAPERR, "page translation fault" }, |
| { do_bad, SIGBUS, 0, "external abort on non-linefetch" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "section domain fault" }, |
| { do_bad, SIGBUS, 0, "external abort on non-linefetch" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "page domain fault" }, |
| { do_bad, SIGBUS, 0, "external abort on translation" }, |
| { do_sect_fault, SIGSEGV, SEGV_ACCERR, "section permission fault" }, |
| { do_bad, SIGBUS, 0, "external abort on translation" }, |
| { do_page_fault, SIGSEGV, SEGV_ACCERR, "page permission fault" }, |
| /* |
| * The following are "imprecise" aborts, which are signalled by bit |
| * 10 of the FSR, and may not be recoverable. These are only |
| * supported if the CPU abort handler supports bit 10. |
| */ |
| { do_bad, SIGBUS, 0, "unknown 16" }, |
| { do_bad, SIGBUS, 0, "unknown 17" }, |
| { do_bad, SIGBUS, 0, "unknown 18" }, |
| { do_bad, SIGBUS, 0, "unknown 19" }, |
| { do_bad, SIGBUS, 0, "lock abort" }, /* xscale */ |
| { do_bad, SIGBUS, 0, "unknown 21" }, |
| { do_imprecise_ext, SIGBUS, BUS_OBJERR, "imprecise external abort" }, /* xscale */ |
| { do_bad, SIGBUS, 0, "unknown 23" }, |
| { do_bad, SIGBUS, 0, "dcache parity error" }, /* xscale */ |
| { do_bad, SIGBUS, 0, "unknown 25" }, |
| { do_bad, SIGBUS, 0, "unknown 26" }, |
| { do_bad, SIGBUS, 0, "unknown 27" }, |
| { do_bad, SIGBUS, 0, "unknown 28" }, |
| { do_bad, SIGBUS, 0, "unknown 29" }, |
| { do_bad, SIGBUS, 0, "unknown 30" }, |
| { do_bad, SIGBUS, 0, "unknown 31" } |
| }; |
| |
| void __init |
| hook_fault_code(int nr, int (*fn)(unsigned long, unsigned int, struct pt_regs *), |
| int sig, int code, const char *name) |
| { |
| if (nr < 0 || nr >= ARRAY_SIZE(fsr_info)) |
| BUG(); |
| |
| fsr_info[nr].fn = fn; |
| fsr_info[nr].sig = sig; |
| fsr_info[nr].code = code; |
| fsr_info[nr].name = name; |
| } |
| |
| #ifdef CONFIG_MSM_KRAIT_TBB_ABORT_HANDLER |
| static int krait_tbb_fixup(unsigned int fsr, struct pt_regs *regs) |
| { |
| int base_cond, cond = 0; |
| unsigned int p1, cpsr_z, cpsr_c, cpsr_n, cpsr_v; |
| |
| if ((read_cpuid_id() & 0xFFFFFFFC) != 0x510F04D0) |
| return 0; |
| |
| if (!thumb_mode(regs)) |
| return 0; |
| |
| /* If ITSTATE is 0, return quickly */ |
| if ((regs->ARM_cpsr & PSR_IT_MASK) == 0) |
| return 0; |
| |
| cpsr_n = (regs->ARM_cpsr & PSR_N_BIT) ? 1 : 0; |
| cpsr_z = (regs->ARM_cpsr & PSR_Z_BIT) ? 1 : 0; |
| cpsr_c = (regs->ARM_cpsr & PSR_C_BIT) ? 1 : 0; |
| cpsr_v = (regs->ARM_cpsr & PSR_V_BIT) ? 1 : 0; |
| |
| p1 = (regs->ARM_cpsr & BIT(12)) ? 1 : 0; |
| |
| base_cond = (regs->ARM_cpsr >> 13) & 0x07; |
| |
| switch (base_cond) { |
| case 0x0: /* equal */ |
| cond = cpsr_z; |
| break; |
| |
| case 0x1: /* carry set */ |
| cond = cpsr_c; |
| break; |
| |
| case 0x2: /* minus / negative */ |
| cond = cpsr_n; |
| break; |
| |
| case 0x3: /* overflow */ |
| cond = cpsr_v; |
| break; |
| |
| case 0x4: /* unsigned higher */ |
| cond = (cpsr_c == 1) && (cpsr_z == 0); |
| break; |
| |
| case 0x5: /* signed greater / equal */ |
| cond = (cpsr_n == cpsr_v); |
| break; |
| |
| case 0x6: /* signed greater */ |
| cond = (cpsr_z == 0) && (cpsr_n == cpsr_v); |
| break; |
| |
| case 0x7: /* always */ |
| cond = 1; |
| break; |
| }; |
| |
| if (cond == p1) { |
| pr_debug("Conditional abort fixup, PC=%08x, base=%d, cond=%d\n", |
| (unsigned int) regs->ARM_pc, base_cond, cond); |
| regs->ARM_pc += 2; |
| return 1; |
| } |
| return 0; |
| } |
| #endif |
| |
| /* |
| * Dispatch a data abort to the relevant handler. |
| */ |
| asmlinkage void __exception |
| do_DataAbort(unsigned long addr, unsigned int fsr, struct pt_regs *regs) |
| { |
| const struct fsr_info *inf = fsr_info + fsr_fs(fsr); |
| struct siginfo info; |
| |
| #ifdef CONFIG_EMULATE_DOMAIN_MANAGER_V7 |
| if (emulate_domain_manager_data_abort(fsr, addr)) |
| return; |
| #endif |
| |
| #ifdef CONFIG_MSM_KRAIT_TBB_ABORT_HANDLER |
| if (krait_tbb_fixup(fsr, regs)) |
| return; |
| #endif |
| |
| if (!inf->fn(addr, fsr & ~FSR_LNX_PF, regs)) |
| return; |
| |
| printk(KERN_ALERT "Unhandled fault: %s (0x%03x) at 0x%08lx\n", |
| inf->name, fsr, addr); |
| |
| info.si_signo = inf->sig; |
| info.si_errno = 0; |
| info.si_code = inf->code; |
| info.si_addr = (void __user *)addr; |
| arm_notify_die("", regs, &info, fsr, 0); |
| } |
| |
| |
| static struct fsr_info ifsr_info[] = { |
| { do_bad, SIGBUS, 0, "unknown 0" }, |
| { do_bad, SIGBUS, 0, "unknown 1" }, |
| { do_bad, SIGBUS, 0, "debug event" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "section access flag fault" }, |
| { do_bad, SIGBUS, 0, "unknown 4" }, |
| { do_translation_fault, SIGSEGV, SEGV_MAPERR, "section translation fault" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "page access flag fault" }, |
| { do_page_fault, SIGSEGV, SEGV_MAPERR, "page translation fault" }, |
| { do_bad, SIGBUS, 0, "external abort on non-linefetch" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "section domain fault" }, |
| { do_bad, SIGBUS, 0, "unknown 10" }, |
| { do_bad, SIGSEGV, SEGV_ACCERR, "page domain fault" }, |
| { do_bad, SIGBUS, 0, "external abort on translation" }, |
| { do_sect_fault, SIGSEGV, SEGV_ACCERR, "section permission fault" }, |
| { do_bad, SIGBUS, 0, "external abort on translation" }, |
| { do_page_fault, SIGSEGV, SEGV_ACCERR, "page permission fault" }, |
| { do_bad, SIGBUS, 0, "unknown 16" }, |
| { do_bad, SIGBUS, 0, "unknown 17" }, |
| { do_bad, SIGBUS, 0, "unknown 18" }, |
| { do_bad, SIGBUS, 0, "unknown 19" }, |
| { do_bad, SIGBUS, 0, "unknown 20" }, |
| { do_bad, SIGBUS, 0, "unknown 21" }, |
| { do_bad, SIGBUS, 0, "unknown 22" }, |
| { do_bad, SIGBUS, 0, "unknown 23" }, |
| { do_bad, SIGBUS, 0, "unknown 24" }, |
| { do_bad, SIGBUS, 0, "unknown 25" }, |
| { do_bad, SIGBUS, 0, "unknown 26" }, |
| { do_bad, SIGBUS, 0, "unknown 27" }, |
| { do_bad, SIGBUS, 0, "unknown 28" }, |
| { do_bad, SIGBUS, 0, "unknown 29" }, |
| { do_bad, SIGBUS, 0, "unknown 30" }, |
| { do_bad, SIGBUS, 0, "unknown 31" }, |
| }; |
| |
| void __init |
| hook_ifault_code(int nr, int (*fn)(unsigned long, unsigned int, struct pt_regs *), |
| int sig, int code, const char *name) |
| { |
| if (nr < 0 || nr >= ARRAY_SIZE(ifsr_info)) |
| BUG(); |
| |
| ifsr_info[nr].fn = fn; |
| ifsr_info[nr].sig = sig; |
| ifsr_info[nr].code = code; |
| ifsr_info[nr].name = name; |
| } |
| |
| asmlinkage void __exception |
| do_PrefetchAbort(unsigned long addr, unsigned int ifsr, struct pt_regs *regs) |
| { |
| const struct fsr_info *inf = ifsr_info + fsr_fs(ifsr); |
| struct siginfo info; |
| |
| #ifdef CONFIG_EMULATE_DOMAIN_MANAGER_V7 |
| if (emulate_domain_manager_prefetch_abort(ifsr, addr)) |
| return; |
| #endif |
| |
| if (!inf->fn(addr, ifsr | FSR_LNX_PF, regs)) |
| return; |
| |
| printk(KERN_ALERT "Unhandled prefetch abort: %s (0x%03x) at 0x%08lx\n", |
| inf->name, ifsr, addr); |
| |
| info.si_signo = inf->sig; |
| info.si_errno = 0; |
| info.si_code = inf->code; |
| info.si_addr = (void __user *)addr; |
| arm_notify_die("", regs, &info, ifsr, 0); |
| } |
| |
| static int __init exceptions_init(void) |
| { |
| if (cpu_architecture() >= CPU_ARCH_ARMv6) { |
| hook_fault_code(4, do_translation_fault, SIGSEGV, SEGV_MAPERR, |
| "I-cache maintenance fault"); |
| } |
| |
| if (cpu_architecture() >= CPU_ARCH_ARMv7) { |
| /* |
| * TODO: Access flag faults introduced in ARMv6K. |
| * Runtime check for 'K' extension is needed |
| */ |
| hook_fault_code(3, do_bad, SIGSEGV, SEGV_MAPERR, |
| "section access flag fault"); |
| hook_fault_code(6, do_bad, SIGSEGV, SEGV_MAPERR, |
| "section access flag fault"); |
| } |
| |
| return 0; |
| } |
| |
| arch_initcall(exceptions_init); |