| /* | 
 |  * Copyright (C) 2003-2006, Axis Communications AB. | 
 |  */ | 
 |  | 
 | #include <linux/ptrace.h> | 
 | #include <linux/module.h> | 
 | #include <asm/uaccess.h> | 
 | #include <hwregs/supp_reg.h> | 
 | #include <hwregs/intr_vect_defs.h> | 
 | #include <asm/irq.h> | 
 |  | 
 | void | 
 | show_registers(struct pt_regs *regs) | 
 | { | 
 | 	/* | 
 | 	 * It's possible to use either the USP register or current->thread.usp. | 
 | 	 * USP might not correspond to the current process for all cases this | 
 | 	 * function is called, and current->thread.usp isn't up to date for the | 
 | 	 * current process. Experience shows that using USP is the way to go. | 
 | 	 */ | 
 | 	unsigned long usp = rdusp(); | 
 | 	unsigned long d_mmu_cause; | 
 | 	unsigned long i_mmu_cause; | 
 |  | 
 | 	printk("CPU: %d\n", smp_processor_id()); | 
 |  | 
 | 	printk("ERP: %08lx SRP: %08lx  CCS: %08lx USP: %08lx MOF: %08lx\n", | 
 | 	       regs->erp, regs->srp, regs->ccs, usp, regs->mof); | 
 |  | 
 | 	printk(" r0: %08lx  r1: %08lx   r2: %08lx  r3: %08lx\n", | 
 | 	       regs->r0, regs->r1, regs->r2, regs->r3); | 
 |  | 
 | 	printk(" r4: %08lx  r5: %08lx   r6: %08lx  r7: %08lx\n", | 
 | 	       regs->r4, regs->r5, regs->r6, regs->r7); | 
 |  | 
 | 	printk(" r8: %08lx  r9: %08lx  r10: %08lx r11: %08lx\n", | 
 | 	       regs->r8, regs->r9, regs->r10, regs->r11); | 
 |  | 
 | 	printk("r12: %08lx r13: %08lx oR10: %08lx acr: %08lx\n", | 
 | 	       regs->r12, regs->r13, regs->orig_r10, regs->acr); | 
 |  | 
 | 	printk(" sp: %08lx\n", (unsigned long)regs); | 
 |  | 
 | 	SUPP_BANK_SEL(BANK_IM); | 
 | 	SUPP_REG_RD(RW_MM_CAUSE, i_mmu_cause); | 
 |  | 
 | 	SUPP_BANK_SEL(BANK_DM); | 
 | 	SUPP_REG_RD(RW_MM_CAUSE, d_mmu_cause); | 
 |  | 
 | 	printk("       Data MMU Cause: %08lx\n", d_mmu_cause); | 
 | 	printk("Instruction MMU Cause: %08lx\n", i_mmu_cause); | 
 |  | 
 | 	printk("Process %s (pid: %d, stackpage=%08lx)\n", | 
 | 	       current->comm, current->pid, (unsigned long)current); | 
 |  | 
 | 	/* | 
 | 	 * When in-kernel, we also print out the stack and code at the | 
 | 	 * time of the fault.. | 
 | 	 */ | 
 | 	if (!user_mode(regs)) { | 
 | 		int i; | 
 |  | 
 | 		show_stack(NULL, (unsigned long *)usp); | 
 |  | 
 | 		/* | 
 | 		 * If the previous stack-dump wasn't a kernel one, dump the | 
 | 		 * kernel stack now. | 
 | 		 */ | 
 | 		if (usp != 0) | 
 | 			show_stack(NULL, NULL); | 
 |  | 
 | 		printk("\nCode: "); | 
 |  | 
 | 		if (regs->erp < PAGE_OFFSET) | 
 | 			goto bad_value; | 
 |  | 
 | 		/* | 
 | 		 * Quite often the value at regs->erp doesn't point to the | 
 | 		 * interesting instruction, which often is the previous | 
 | 		 * instruction. So dump at an offset large enough that the | 
 | 		 * instruction decoding should be in sync at the interesting | 
 | 		 * point, but small enough to fit on a row. The regs->erp | 
 | 		 * location is pointed out in a ksymoops-friendly way by | 
 | 		 * wrapping the byte for that address in parenthesises. | 
 | 		 */ | 
 | 		for (i = -12; i < 12; i++) { | 
 | 			unsigned char c; | 
 |  | 
 | 			if (__get_user(c, &((unsigned char *)regs->erp)[i])) { | 
 | bad_value: | 
 | 				printk(" Bad IP value."); | 
 | 				break; | 
 | 			} | 
 |  | 
 | 			if (i == 0) | 
 | 				printk("(%02x) ", c); | 
 | 			else | 
 | 				printk("%02x ", c); | 
 | 		} | 
 | 		printk("\n"); | 
 | 	} | 
 | } | 
 |  | 
 | void | 
 | arch_enable_nmi(void) | 
 | { | 
 | 	unsigned long flags; | 
 |  | 
 | 	local_save_flags(flags); | 
 | 	flags |= (1 << 30); /* NMI M flag is at bit 30 */ | 
 | 	local_irq_restore(flags); | 
 | } | 
 |  | 
 | extern void (*nmi_handler)(struct pt_regs *); | 
 | void handle_nmi(struct pt_regs *regs) | 
 | { | 
 | #ifdef CONFIG_ETRAXFS | 
 | 	reg_intr_vect_r_nmi r; | 
 | #endif | 
 |  | 
 | 	if (nmi_handler) | 
 | 		nmi_handler(regs); | 
 |  | 
 | #ifdef CONFIG_ETRAXFS | 
 | 	/* Wait until nmi is no longer active. */ | 
 | 	do { | 
 | 		r = REG_RD(intr_vect, regi_irq, r_nmi); | 
 | 	} while (r.ext == regk_intr_vect_on); | 
 | #endif | 
 | } | 
 |  | 
 |  | 
 | #ifdef CONFIG_BUG | 
 | extern void die_if_kernel(const char *str, struct pt_regs *regs, long err); | 
 |  | 
 | /* Copy of the regs at BUG() time.  */ | 
 | struct pt_regs BUG_regs; | 
 |  | 
 | void do_BUG(char *file, unsigned int line) | 
 | { | 
 | 	printk("kernel BUG at %s:%d!\n", file, line); | 
 | 	die_if_kernel("Oops", &BUG_regs, 0); | 
 | } | 
 | EXPORT_SYMBOL(do_BUG); | 
 |  | 
 | void fixup_BUG(struct pt_regs *regs) | 
 | { | 
 | 	BUG_regs = *regs; | 
 |  | 
 | #ifdef CONFIG_DEBUG_BUGVERBOSE | 
 | 	/* | 
 | 	 * Fixup the BUG arguments through exception handlers. | 
 | 	 */ | 
 | 	{ | 
 | 		const struct exception_table_entry *fixup; | 
 |  | 
 | 		/* | 
 | 		 * ERP points at the "break 14" + 2, compensate for the 2 | 
 | 		 * bytes. | 
 | 		 */ | 
 | 		fixup = search_exception_tables(instruction_pointer(regs) - 2); | 
 | 		if (fixup) { | 
 | 			/* Adjust the instruction pointer in the stackframe. */ | 
 | 			instruction_pointer(regs) = fixup->fixup; | 
 | 			arch_fixup(regs); | 
 | 		} | 
 | 	} | 
 | #else | 
 | 	/* Dont try to lookup the filename + line, just dump regs.  */ | 
 | 	do_BUG("unknown", 0); | 
 | #endif | 
 | } | 
 |  | 
 | /* | 
 |  * Break 14 handler. Save regs and jump into the fixup_BUG. | 
 |  */ | 
 | __asm__  ( ".text\n\t" | 
 | 	   ".global breakh_BUG\n\t" | 
 | 	   "breakh_BUG:\n\t" | 
 | 	   SAVE_ALL | 
 | 	   KGDB_FIXUP | 
 | 	   "move.d $sp, $r10\n\t" | 
 | 	   "jsr fixup_BUG\n\t" | 
 | 	   "nop\n\t" | 
 | 	   "jump ret_from_intr\n\t" | 
 | 	   "nop\n\t"); | 
 |  | 
 |  | 
 | #ifdef CONFIG_DEBUG_BUGVERBOSE | 
 | void | 
 | handle_BUG(struct pt_regs *regs) | 
 | { | 
 | } | 
 | #endif | 
 | #endif |