| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292 | 
							- /*
 
-  * Main exception handling logic.
 
-  *
 
-  * Copyright 2004-2010 Analog Devices Inc.
 
-  *
 
-  * Licensed under the GPL-2 or later
 
-  */
 
- #include <linux/bug.h>
 
- #include <linux/uaccess.h>
 
- #include <linux/module.h>
 
- #include <asm/traps.h>
 
- #include <asm/cplb.h>
 
- #include <asm/blackfin.h>
 
- #include <asm/irq_handler.h>
 
- #include <linux/irq.h>
 
- #include <asm/trace.h>
 
- #include <asm/fixed_code.h>
 
- #include <asm/pseudo_instructions.h>
 
- #include <asm/pda.h>
 
- #ifdef CONFIG_KGDB
 
- # include <linux/kgdb.h>
 
- # define CHK_DEBUGGER_TRAP() \
 
- 	do { \
 
- 		kgdb_handle_exception(trapnr, sig, info.si_code, fp); \
 
- 	} while (0)
 
- # define CHK_DEBUGGER_TRAP_MAYBE() \
 
- 	do { \
 
- 		if (kgdb_connected) \
 
- 			CHK_DEBUGGER_TRAP(); \
 
- 	} while (0)
 
- #else
 
- # define CHK_DEBUGGER_TRAP() do { } while (0)
 
- # define CHK_DEBUGGER_TRAP_MAYBE() do { } while (0)
 
- #endif
 
- #ifdef CONFIG_DEBUG_VERBOSE
 
- #define verbose_printk(fmt, arg...) \
 
- 	printk(fmt, ##arg)
 
- #else
 
- #define verbose_printk(fmt, arg...) \
 
- 	({ if (0) printk(fmt, ##arg); 0; })
 
- #endif
 
- #if defined(CONFIG_DEBUG_MMRS) || defined(CONFIG_DEBUG_MMRS_MODULE)
 
- u32 last_seqstat;
 
- #ifdef CONFIG_DEBUG_MMRS_MODULE
 
- EXPORT_SYMBOL(last_seqstat);
 
- #endif
 
- #endif
 
- /* Initiate the event table handler */
 
- void __init trap_init(void)
 
- {
 
- 	CSYNC();
 
- 	bfin_write_EVT3(trap);
 
- 	CSYNC();
 
- }
 
- static int kernel_mode_regs(struct pt_regs *regs)
 
- {
 
- 	return regs->ipend & 0xffc0;
 
- }
 
- asmlinkage notrace void trap_c(struct pt_regs *fp)
 
- {
 
- #ifdef CONFIG_DEBUG_BFIN_HWTRACE_ON
 
- 	int j;
 
- #endif
 
- #ifdef CONFIG_BFIN_PSEUDODBG_INSNS
 
- 	int opcode;
 
- #endif
 
- 	unsigned int cpu = raw_smp_processor_id();
 
- 	const char *strerror = NULL;
 
- 	int sig = 0;
 
- 	siginfo_t info;
 
- 	unsigned long trapnr = fp->seqstat & SEQSTAT_EXCAUSE;
 
- 	trace_buffer_save(j);
 
- #if defined(CONFIG_DEBUG_MMRS) || defined(CONFIG_DEBUG_MMRS_MODULE)
 
- 	last_seqstat = (u32)fp->seqstat;
 
- #endif
 
- 	/* Important - be very careful dereferncing pointers - will lead to
 
- 	 * double faults if the stack has become corrupt
 
- 	 */
 
- 	/* trap_c() will be called for exceptions. During exceptions
 
- 	 * processing, the pc value should be set with retx value.
 
- 	 * With this change we can cleanup some code in signal.c- TODO
 
- 	 */
 
- 	fp->orig_pc = fp->retx;
 
- 	/* printk("exception: 0x%x, ipend=%x, reti=%x, retx=%x\n",
 
- 		trapnr, fp->ipend, fp->pc, fp->retx); */
 
- 	/* send the appropriate signal to the user program */
 
- 	switch (trapnr) {
 
- 	/* This table works in conjunction with the one in ./mach-common/entry.S
 
- 	 * Some exceptions are handled there (in assembly, in exception space)
 
- 	 * Some are handled here, (in C, in interrupt space)
 
- 	 * Some, like CPLB, are handled in both, where the normal path is
 
- 	 * handled in assembly/exception space, and the error path is handled
 
- 	 * here
 
- 	 */
 
- 	/* 0x00 - Linux Syscall, getting here is an error */
 
- 	/* 0x01 - userspace gdb breakpoint, handled here */
 
- 	case VEC_EXCPT01:
 
- 		info.si_code = TRAP_ILLTRAP;
 
- 		sig = SIGTRAP;
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		/* Check if this is a breakpoint in kernel space */
 
- 		if (kernel_mode_regs(fp))
 
- 			goto traps_done;
 
- 		else
 
- 			break;
 
- 	/* 0x03 - User Defined, userspace stack overflow */
 
- 	case VEC_EXCPT03:
 
- 		info.si_code = SEGV_STACKFLOW;
 
- 		sig = SIGSEGV;
 
- 		strerror = KERN_NOTICE EXC_0x03(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x02 - KGDB initial connection and break signal trap */
 
- 	case VEC_EXCPT02:
 
- #ifdef CONFIG_KGDB
 
- 		info.si_code = TRAP_ILLTRAP;
 
- 		sig = SIGTRAP;
 
- 		CHK_DEBUGGER_TRAP();
 
- 		goto traps_done;
 
- #endif
 
- 	/* 0x04 - User Defined */
 
- 	/* 0x05 - User Defined */
 
- 	/* 0x06 - User Defined */
 
- 	/* 0x07 - User Defined */
 
- 	/* 0x08 - User Defined */
 
- 	/* 0x09 - User Defined */
 
- 	/* 0x0A - User Defined */
 
- 	/* 0x0B - User Defined */
 
- 	/* 0x0C - User Defined */
 
- 	/* 0x0D - User Defined */
 
- 	/* 0x0E - User Defined */
 
- 	/* 0x0F - User Defined */
 
- 	/* If we got here, it is most likely that someone was trying to use a
 
- 	 * custom exception handler, and it is not actually installed properly
 
- 	 */
 
- 	case VEC_EXCPT04 ... VEC_EXCPT15:
 
- 		info.si_code = ILL_ILLPARAOP;
 
- 		sig = SIGILL;
 
- 		strerror = KERN_NOTICE EXC_0x04(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x10 HW Single step, handled here */
 
- 	case VEC_STEP:
 
- 		info.si_code = TRAP_STEP;
 
- 		sig = SIGTRAP;
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		/* Check if this is a single step in kernel space */
 
- 		if (kernel_mode_regs(fp))
 
- 			goto traps_done;
 
- 		else
 
- 			break;
 
- 	/* 0x11 - Trace Buffer Full, handled here */
 
- 	case VEC_OVFLOW:
 
- 		info.si_code = TRAP_TRACEFLOW;
 
- 		sig = SIGTRAP;
 
- 		strerror = KERN_NOTICE EXC_0x11(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x12 - Reserved, Caught by default */
 
- 	/* 0x13 - Reserved, Caught by default */
 
- 	/* 0x14 - Reserved, Caught by default */
 
- 	/* 0x15 - Reserved, Caught by default */
 
- 	/* 0x16 - Reserved, Caught by default */
 
- 	/* 0x17 - Reserved, Caught by default */
 
- 	/* 0x18 - Reserved, Caught by default */
 
- 	/* 0x19 - Reserved, Caught by default */
 
- 	/* 0x1A - Reserved, Caught by default */
 
- 	/* 0x1B - Reserved, Caught by default */
 
- 	/* 0x1C - Reserved, Caught by default */
 
- 	/* 0x1D - Reserved, Caught by default */
 
- 	/* 0x1E - Reserved, Caught by default */
 
- 	/* 0x1F - Reserved, Caught by default */
 
- 	/* 0x20 - Reserved, Caught by default */
 
- 	/* 0x21 - Undefined Instruction, handled here */
 
- 	case VEC_UNDEF_I:
 
- #ifdef CONFIG_BUG
 
- 		if (kernel_mode_regs(fp)) {
 
- 			switch (report_bug(fp->pc, fp)) {
 
- 			case BUG_TRAP_TYPE_NONE:
 
- 				break;
 
- 			case BUG_TRAP_TYPE_WARN:
 
- 				dump_bfin_trace_buffer();
 
- 				fp->pc += 2;
 
- 				goto traps_done;
 
- 			case BUG_TRAP_TYPE_BUG:
 
- 				/* call to panic() will dump trace, and it is
 
- 				 * off at this point, so it won't be clobbered
 
- 				 */
 
- 				panic("BUG()");
 
- 			}
 
- 		}
 
- #endif
 
- #ifdef CONFIG_BFIN_PSEUDODBG_INSNS
 
- 		/*
 
- 		 * Support for the fake instructions, if the instruction fails,
 
- 		 * then just execute a illegal opcode failure (like normal).
 
- 		 * Don't support these instructions inside the kernel
 
- 		 */
 
- 		if (!kernel_mode_regs(fp) && get_instruction(&opcode, (unsigned short *)fp->pc)) {
 
- 			if (execute_pseudodbg_assert(fp, opcode))
 
- 				goto traps_done;
 
- 			if (execute_pseudodbg(fp, opcode))
 
- 				goto traps_done;
 
- 		}
 
- #endif
 
- 		info.si_code = ILL_ILLOPC;
 
- 		sig = SIGILL;
 
- 		strerror = KERN_NOTICE EXC_0x21(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x22 - Illegal Instruction Combination, handled here */
 
- 	case VEC_ILGAL_I:
 
- 		info.si_code = ILL_ILLPARAOP;
 
- 		sig = SIGILL;
 
- 		strerror = KERN_NOTICE EXC_0x22(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x23 - Data CPLB protection violation, handled here */
 
- 	case VEC_CPLB_VL:
 
- 		info.si_code = ILL_CPLB_VI;
 
- 		sig = SIGSEGV;
 
- 		strerror = KERN_NOTICE EXC_0x23(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x24 - Data access misaligned, handled here */
 
- 	case VEC_MISALI_D:
 
- 		info.si_code = BUS_ADRALN;
 
- 		sig = SIGBUS;
 
- 		strerror = KERN_NOTICE EXC_0x24(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x25 - Unrecoverable Event, handled here */
 
- 	case VEC_UNCOV:
 
- 		info.si_code = ILL_ILLEXCPT;
 
- 		sig = SIGILL;
 
- 		strerror = KERN_NOTICE EXC_0x25(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x26 - Data CPLB Miss, normal case is handled in _cplb_hdr,
 
- 		error case is handled here */
 
- 	case VEC_CPLB_M:
 
- 		info.si_code = BUS_ADRALN;
 
- 		sig = SIGBUS;
 
- 		strerror = KERN_NOTICE EXC_0x26(KERN_NOTICE);
 
- 		break;
 
- 	/* 0x27 - Data CPLB Multiple Hits - Linux Trap Zero, handled here */
 
- 	case VEC_CPLB_MHIT:
 
- 		info.si_code = ILL_CPLB_MULHIT;
 
- 		sig = SIGSEGV;
 
- #ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
 
- 		if (cpu_pda[cpu].dcplb_fault_addr < FIXED_CODE_START)
 
- 			strerror = KERN_NOTICE "NULL pointer access\n";
 
- 		else
 
- #endif
 
- 			strerror = KERN_NOTICE EXC_0x27(KERN_NOTICE);
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- 	/* 0x28 - Emulation Watchpoint, handled here */
 
- 	case VEC_WATCH:
 
- 		info.si_code = TRAP_WATCHPT;
 
- 		sig = SIGTRAP;
 
- 		pr_debug(EXC_0x28(KERN_DEBUG));
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		/* Check if this is a watchpoint in kernel space */
 
- 		if (kernel_mode_regs(fp))
 
- 			goto traps_done;
 
- 		else
 
- 			break;
 
- #ifdef CONFIG_BF535
 
- 	/* 0x29 - Instruction fetch access error (535 only) */
 
- 	case VEC_ISTRU_VL:      /* ADSP-BF535 only (MH) */
 
- 		info.si_code = BUS_OPFETCH;
 
- 		sig = SIGBUS;
 
- 		strerror = KERN_NOTICE "BF535: VEC_ISTRU_VL\n";
 
- 		CHK_DEBUGGER_TRAP_MAYBE();
 
- 		break;
 
- #else
 
 
  |