2 * linux/arch/unicore32/mm/fault.c
4 * Code specific to PKUnity SoC and UniCore ISA
6 * Copyright (C) 2001-2010 GUAN Xue-tao
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 #include <linux/module.h>
13 #include <linux/signal.h>
15 #include <linux/hardirq.h>
16 #include <linux/init.h>
17 #include <linux/kprobes.h>
18 #include <linux/uaccess.h>
19 #include <linux/page-flags.h>
20 #include <linux/sched.h>
23 #include <asm/pgtable.h>
24 #include <asm/tlbflush.h>
27 * Fault status register encodings. We steal bit 31 for our own purposes.
29 #define FSR_LNX_PF (1 << 31)
31 static inline int fsr_fs(unsigned int fsr)
33 /* xyabcde will be abcde+xy */
34 return (fsr & 31) + ((fsr & (3 << 5)) >> 5);
38 * This is useful to dump out the page tables associated with
41 void show_pte(struct mm_struct *mm, unsigned long addr)
48 printk(KERN_ALERT "pgd = %p\n", mm->pgd);
49 pgd = pgd_offset(mm, addr);
50 printk(KERN_ALERT "[%08lx] *pgd=%08lx", addr, pgd_val(*pgd));
64 pmd = pmd_offset((pud_t *) pgd, addr);
65 if (PTRS_PER_PMD != 1)
66 printk(", *pmd=%08lx", pmd_val(*pmd));
76 /* We must not map this if we have highmem enabled */
77 if (PageHighMem(pfn_to_page(pmd_val(*pmd) >> PAGE_SHIFT)))
80 pte = pte_offset_map(pmd, addr);
81 printk(", *pte=%08lx", pte_val(*pte));
89 * Oops. The kernel tried to access some page that wasn't present.
91 static void __do_kernel_fault(struct mm_struct *mm, unsigned long addr,
92 unsigned int fsr, struct pt_regs *regs)
95 * Are we prepared to handle this kernel fault?
97 if (fixup_exception(regs))
101 * No handler, we'll have to terminate things with extreme prejudice.
105 "Unable to handle kernel %s at virtual address %08lx\n",
106 (addr < PAGE_SIZE) ? "NULL pointer dereference" :
107 "paging request", addr);
110 die("Oops", regs, fsr);
116 * Something tried to access memory that isn't in our memory map..
117 * User mode accesses just cause a SIGSEGV
119 static void __do_user_fault(struct task_struct *tsk, unsigned long addr,
120 unsigned int fsr, unsigned int sig, int code,
121 struct pt_regs *regs)
125 tsk->thread.address = addr;
126 tsk->thread.error_code = fsr;
127 tsk->thread.trap_no = 14;
131 si.si_addr = (void __user *)addr;
132 force_sig_info(sig, &si, tsk);
135 void do_bad_area(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
137 struct task_struct *tsk = current;
138 struct mm_struct *mm = tsk->active_mm;
141 * If we are in kernel mode at this point, we
142 * have no context to handle this fault with.
145 __do_user_fault(tsk, addr, fsr, SIGSEGV, SEGV_MAPERR, regs);
147 __do_kernel_fault(mm, addr, fsr, regs);
150 #define VM_FAULT_BADMAP 0x010000
151 #define VM_FAULT_BADACCESS 0x020000
154 * Check that the permissions on the VMA allow for the fault which occurred.
155 * If we encountered a write fault, we must have write permission, otherwise
156 * we allow any permission.
158 static inline bool access_error(unsigned int fsr, struct vm_area_struct *vma)
160 unsigned int mask = VM_READ | VM_WRITE | VM_EXEC;
162 if (!(fsr ^ 0x12)) /* write? */
164 if (fsr & FSR_LNX_PF)
167 return vma->vm_flags & mask ? false : true;
170 static int __do_pf(struct mm_struct *mm, unsigned long addr, unsigned int fsr,
171 struct task_struct *tsk)
173 struct vm_area_struct *vma;
176 vma = find_vma(mm, addr);
177 fault = VM_FAULT_BADMAP;
180 if (unlikely(vma->vm_start > addr))
184 * Ok, we have a good vm_area for this
185 * memory access, so we can handle it.
188 if (access_error(fsr, vma)) {
189 fault = VM_FAULT_BADACCESS;
194 * If for any reason at all we couldn't handle the fault, make
195 * sure we exit gracefully rather than endlessly redo the fault.
197 fault = handle_mm_fault(mm, vma, addr & PAGE_MASK,
198 (!(fsr ^ 0x12)) ? FAULT_FLAG_WRITE : 0);
199 if (unlikely(fault & VM_FAULT_ERROR))
201 if (fault & VM_FAULT_MAJOR)
208 if (vma->vm_flags & VM_GROWSDOWN && !expand_stack(vma, addr))
214 static int do_pf(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
216 struct task_struct *tsk;
217 struct mm_struct *mm;
218 int fault, sig, code;
224 * If we're in an interrupt or have no user
225 * context, we must not take the fault..
227 if (in_atomic() || !mm)
231 * As per x86, we may deadlock here. However, since the kernel only
232 * validly references user space from well defined areas of the code,
233 * we can bug out early if this is from code which shouldn't.
235 if (!down_read_trylock(&mm->mmap_sem)) {
237 && !search_exception_tables(regs->UCreg_pc))
239 down_read(&mm->mmap_sem);
242 * The above down_read_trylock() might have succeeded in
243 * which case, we'll have missed the might_sleep() from
247 #ifdef CONFIG_DEBUG_VM
248 if (!user_mode(regs) &&
249 !search_exception_tables(regs->UCreg_pc))
254 fault = __do_pf(mm, addr, fsr, tsk);
255 up_read(&mm->mmap_sem);
258 * Handle the "normal" case first - VM_FAULT_MAJOR / VM_FAULT_MINOR
261 (VM_FAULT_ERROR | VM_FAULT_BADMAP | VM_FAULT_BADACCESS))))
264 if (fault & VM_FAULT_OOM) {
266 * We ran out of memory, call the OOM killer, and return to
267 * userspace (which will retry the fault, or kill us if we
270 pagefault_out_of_memory();
275 * If we are in kernel mode at this point, we
276 * have no context to handle this fault with.
278 if (!user_mode(regs))
281 if (fault & VM_FAULT_SIGBUS) {
283 * We had some memory, but were unable to
284 * successfully fix up this page fault.
290 * Something tried to access memory that
291 * isn't in our memory map..
294 code = fault == VM_FAULT_BADACCESS ? SEGV_ACCERR : SEGV_MAPERR;
297 __do_user_fault(tsk, addr, fsr, sig, code, regs);
301 __do_kernel_fault(mm, addr, fsr, regs);
306 * First Level Translation Fault Handler
308 * We enter here because the first level page table doesn't contain
309 * a valid entry for the address.
311 * If the address is in kernel space (>= TASK_SIZE), then we are
312 * probably faulting in the vmalloc() area.
314 * If the init_task's first level page tables contains the relevant
315 * entry, we copy the it to this task. If not, we send the process
316 * a signal, fixup the exception, or oops the kernel.
318 * NOTE! We MUST NOT take any locks for this case. We may be in an
319 * interrupt or a critical region, and should only copy the information
320 * from the master page table, nothing more.
322 static int do_ifault(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
328 if (addr < TASK_SIZE)
329 return do_pf(addr, fsr, regs);
334 index = pgd_index(addr);
336 pgd = cpu_get_pgd() + index;
337 pgd_k = init_mm.pgd + index;
339 if (pgd_none(*pgd_k))
342 pmd_k = pmd_offset((pud_t *) pgd_k, addr);
343 pmd = pmd_offset((pud_t *) pgd, addr);
345 if (pmd_none(*pmd_k))
348 set_pmd(pmd, *pmd_k);
349 flush_pmd_entry(pmd);
353 do_bad_area(addr, fsr, regs);
358 * This abort handler always returns "fault".
360 static int do_bad(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
365 static int do_good(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
367 unsigned int res1, res2;
369 printk("dabt exception but no error!\n");
371 __asm__ __volatile__(
374 : "=r"(res1), "=r"(res2)
378 printk(KERN_EMERG "r0 :%08x r1 :%08x\n", res1, res2);
383 static struct fsr_info {
384 int (*fn) (unsigned long addr, unsigned int fsr, struct pt_regs *regs);
390 * The following are the standard Unicore-I and UniCore-II aborts.
392 { do_good, SIGBUS, 0, "no error" },
393 { do_bad, SIGBUS, BUS_ADRALN, "alignment exception" },
394 { do_bad, SIGBUS, BUS_OBJERR, "external exception" },
395 { do_bad, SIGBUS, 0, "burst operation" },
396 { do_bad, SIGBUS, 0, "unknown 00100" },
397 { do_ifault, SIGSEGV, SEGV_MAPERR, "2nd level pt non-exist"},
398 { do_bad, SIGBUS, 0, "2nd lvl large pt non-exist" },
399 { do_bad, SIGBUS, 0, "invalid pte" },
400 { do_pf, SIGSEGV, SEGV_MAPERR, "page miss" },
401 { do_bad, SIGBUS, 0, "middle page miss" },
402 { do_bad, SIGBUS, 0, "large page miss" },
403 { do_pf, SIGSEGV, SEGV_MAPERR, "super page (section) miss" },
404 { do_bad, SIGBUS, 0, "unknown 01100" },
405 { do_bad, SIGBUS, 0, "unknown 01101" },
406 { do_bad, SIGBUS, 0, "unknown 01110" },
407 { do_bad, SIGBUS, 0, "unknown 01111" },
408 { do_bad, SIGBUS, 0, "addr: up 3G or IO" },
409 { do_pf, SIGSEGV, SEGV_ACCERR, "read unreadable addr" },
410 { do_pf, SIGSEGV, SEGV_ACCERR, "write unwriteable addr"},
411 { do_pf, SIGSEGV, SEGV_ACCERR, "exec unexecutable addr"},
412 { do_bad, SIGBUS, 0, "unknown 10100" },
413 { do_bad, SIGBUS, 0, "unknown 10101" },
414 { do_bad, SIGBUS, 0, "unknown 10110" },
415 { do_bad, SIGBUS, 0, "unknown 10111" },
416 { do_bad, SIGBUS, 0, "unknown 11000" },
417 { do_bad, SIGBUS, 0, "unknown 11001" },
418 { do_bad, SIGBUS, 0, "unknown 11010" },
419 { do_bad, SIGBUS, 0, "unknown 11011" },
420 { do_bad, SIGBUS, 0, "unknown 11100" },
421 { do_bad, SIGBUS, 0, "unknown 11101" },
422 { do_bad, SIGBUS, 0, "unknown 11110" },
423 { do_bad, SIGBUS, 0, "unknown 11111" }
426 void __init hook_fault_code(int nr,
427 int (*fn) (unsigned long, unsigned int, struct pt_regs *),
428 int sig, int code, const char *name)
430 if (nr < 0 || nr >= ARRAY_SIZE(fsr_info))
433 fsr_info[nr].fn = fn;
434 fsr_info[nr].sig = sig;
435 fsr_info[nr].code = code;
436 fsr_info[nr].name = name;
440 * Dispatch a data abort to the relevant handler.
442 asmlinkage void do_DataAbort(unsigned long addr, unsigned int fsr,
443 struct pt_regs *regs)
445 const struct fsr_info *inf = fsr_info + fsr_fs(fsr);
448 if (!inf->fn(addr, fsr & ~FSR_LNX_PF, regs))
451 printk(KERN_ALERT "Unhandled fault: %s (0x%03x) at 0x%08lx\n",
452 inf->name, fsr, addr);
454 info.si_signo = inf->sig;
456 info.si_code = inf->code;
457 info.si_addr = (void __user *)addr;
458 uc32_notify_die("", regs, &info, fsr, 0);
461 asmlinkage void do_PrefetchAbort(unsigned long addr,
462 unsigned int ifsr, struct pt_regs *regs)
464 const struct fsr_info *inf = fsr_info + fsr_fs(ifsr);
467 if (!inf->fn(addr, ifsr | FSR_LNX_PF, regs))
470 printk(KERN_ALERT "Unhandled prefetch abort: %s (0x%03x) at 0x%08lx\n",
471 inf->name, ifsr, addr);
473 info.si_signo = inf->sig;
475 info.si_code = inf->code;
476 info.si_addr = (void __user *)addr;
477 uc32_notify_die("", regs, &info, ifsr, 0);