| #include <linux/bug.h> |
| #include <linux/io.h> |
| #include <linux/types.h> |
| #include <linux/kdebug.h> |
| #include <linux/signal.h> |
| #include <linux/sched.h> |
| #include <linux/uaccess.h> |
| #include <linux/hardirq.h> |
| #include <asm/unwinder.h> |
| #include <asm/traps.h> |
| |
| #ifdef CONFIG_GENERIC_BUG |
| static void handle_BUG(struct pt_regs *regs) |
| { |
| const struct bug_entry *bug; |
| unsigned long bugaddr = regs->pc; |
| enum bug_trap_type tt; |
| |
| if (!is_valid_bugaddr(bugaddr)) |
| goto invalid; |
| |
| bug = find_bug(bugaddr); |
| |
| /* Switch unwinders when unwind_stack() is called */ |
| if (bug->flags & BUGFLAG_UNWINDER) |
| unwinder_faulted = 1; |
| |
| tt = report_bug(bugaddr, regs); |
| if (tt == BUG_TRAP_TYPE_WARN) { |
| regs->pc += instruction_size(bugaddr); |
| return; |
| } |
| |
| invalid: |
| die("Kernel BUG", regs, TRAPA_BUG_OPCODE & 0xff); |
| } |
| |
| int is_valid_bugaddr(unsigned long addr) |
| { |
| insn_size_t opcode; |
| |
| if (addr < PAGE_OFFSET) |
| return 0; |
| if (probe_kernel_address((insn_size_t *)addr, opcode)) |
| return 0; |
| if (opcode == TRAPA_BUG_OPCODE) |
| return 1; |
| |
| return 0; |
| } |
| #endif |
| |
| /* |
| * Generic trap handler. |
| */ |
| BUILD_TRAP_HANDLER(debug) |
| { |
| TRAP_HANDLER_DECL; |
| |
| /* Rewind */ |
| regs->pc -= instruction_size(__raw_readw(regs->pc - 4)); |
| |
| if (notify_die(DIE_TRAP, "debug trap", regs, 0, vec & 0xff, |
| SIGTRAP) == NOTIFY_STOP) |
| return; |
| |
| force_sig(SIGTRAP, current); |
| } |
| |
| /* |
| * Special handler for BUG() traps. |
| */ |
| BUILD_TRAP_HANDLER(bug) |
| { |
| TRAP_HANDLER_DECL; |
| |
| /* Rewind */ |
| regs->pc -= instruction_size(__raw_readw(regs->pc - 4)); |
| |
| if (notify_die(DIE_TRAP, "bug trap", regs, 0, TRAPA_BUG_OPCODE & 0xff, |
| SIGTRAP) == NOTIFY_STOP) |
| return; |
| |
| #ifdef CONFIG_GENERIC_BUG |
| if (__kernel_text_address(instruction_pointer(regs))) { |
| insn_size_t insn = *(insn_size_t *)instruction_pointer(regs); |
| if (insn == TRAPA_BUG_OPCODE) |
| handle_BUG(regs); |
| return; |
| } |
| #endif |
| |
| force_sig(SIGTRAP, current); |
| } |
| |
| BUILD_TRAP_HANDLER(nmi) |
| { |
| unsigned int cpu = smp_processor_id(); |
| TRAP_HANDLER_DECL; |
| |
| nmi_enter(); |
| nmi_count(cpu)++; |
| |
| switch (notify_die(DIE_NMI, "NMI", regs, 0, vec & 0xff, SIGINT)) { |
| case NOTIFY_OK: |
| case NOTIFY_STOP: |
| break; |
| case NOTIFY_BAD: |
| die("Fatal Non-Maskable Interrupt", regs, SIGINT); |
| default: |
| printk(KERN_ALERT "Got NMI, but nobody cared. Ignoring...\n"); |
| break; |
| } |
| |
| nmi_exit(); |
| } |