traps.c 36.9 KB
Newer Older
B
Bryan Wu 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
/*
 * File:         arch/blackfin/kernel/traps.c
 * Based on:
 * Author:       Hamish Macdonald
 *
 * Created:
 * Description:  uses S/W interrupt 15 for the system calls
 *
 * Modified:
 *               Copyright 2004-2006 Analog Devices Inc.
 *
 * Bugs:         Enter bugs at http://blackfin.uclinux.org/
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, see the file COPYING, or write
 * to the Free Software Foundation, Inc.,
 * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 */

30
#include <linux/bug.h>
31 32 33 34
#include <linux/uaccess.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/kallsyms.h>
35
#include <linux/fs.h>
36
#include <linux/rbtree.h>
B
Bryan Wu 已提交
37 38
#include <asm/traps.h>
#include <asm/cacheflush.h>
39
#include <asm/cplb.h>
40
#include <asm/dma.h>
B
Bryan Wu 已提交
41 42
#include <asm/blackfin.h>
#include <asm/irq_handler.h>
43
#include <linux/irq.h>
44
#include <asm/trace.h>
45
#include <asm/fixed_code.h>
B
Bryan Wu 已提交
46 47 48

#ifdef CONFIG_KGDB
# include <linux/kgdb.h>
49 50 51

# define CHK_DEBUGGER_TRAP() \
	do { \
52
		kgdb_handle_exception(trapnr, sig, info.si_code, fp); \
53 54 55 56 57 58 59 60 61
	} 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)
B
Bryan Wu 已提交
62 63
#endif

64

65
#ifdef CONFIG_DEBUG_VERBOSE
66 67 68 69 70 71 72
#define verbose_printk(fmt, arg...) \
	printk(fmt, ##arg)
#else
#define verbose_printk(fmt, arg...) \
	({ if (0) printk(fmt, ##arg); 0; })
#endif

73 74 75 76 77 78 79
#if defined(CONFIG_DEBUG_MMRS) || defined(CONFIG_DEBUG_MMRS_MODULE)
u32 last_seqstat;
#ifdef CONFIG_DEBUG_MMRS_MODULE
EXPORT_SYMBOL(last_seqstat);
#endif
#endif

B
Bryan Wu 已提交
80 81 82 83 84 85 86 87
/* Initiate the event table handler */
void __init trap_init(void)
{
	CSYNC();
	bfin_write_EVT3(trap);
	CSYNC();
}

88
static void decode_address(char *buf, unsigned long address)
B
Bryan Wu 已提交
89
{
90
#ifdef CONFIG_DEBUG_VERBOSE
B
Bryan Wu 已提交
91 92
	struct task_struct *p;
	struct mm_struct *mm;
93
	unsigned long flags, offset;
94
	unsigned char in_atomic = (bfin_read_IPEND() & 0x10) || in_atomic();
95
	struct rb_node *n;
B
Bryan Wu 已提交
96 97

#ifdef CONFIG_KALLSYMS
98
	unsigned long symsize;
B
Bryan Wu 已提交
99 100 101 102
	const char *symname;
	char *modname;
	char *delim = ":";
	char namebuf[128];
103 104 105
#endif

	buf += sprintf(buf, "<0x%08lx> ", address);
B
Bryan Wu 已提交
106

107
#ifdef CONFIG_KALLSYMS
B
Bryan Wu 已提交
108 109 110 111 112 113 114
	/* look up the address and see if we are in kernel space */
	symname = kallsyms_lookup(address, &symsize, &offset, &modname, namebuf);

	if (symname) {
		/* yeah! kernel space! */
		if (!modname)
			modname = delim = "";
115 116 117
		sprintf(buf, "{ %s%s%s%s + 0x%lx }",
		        delim, modname, delim, symname,
		        (unsigned long)offset);
118
		return;
B
Bryan Wu 已提交
119 120 121
	}
#endif

122
	if (address >= FIXED_CODE_START && address < FIXED_CODE_END) {
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
		/* Problem in fixed code section? */
		strcat(buf, "/* Maybe fixed code section */");
		return;

	} else if (address < CONFIG_BOOT_LOAD) {
		/* Problem somewhere before the kernel start address */
		strcat(buf, "/* Maybe null pointer? */");
		return;

	} else if (address >= COREMMR_BASE) {
		strcat(buf, "/* core mmrs */");
		return;

	} else if (address >= SYSMMR_BASE) {
		strcat(buf, "/* system mmrs */");
138 139
		return;

140 141
	} else if (address >= L1_ROM_START && address < L1_ROM_START + L1_ROM_LENGTH) {
		strcat(buf, "/* on-chip L1 ROM */");
142 143 144
		return;
	}

B
Bryan Wu 已提交
145 146 147 148
	/* looks like we're off in user-land, so let's walk all the
	 * mappings of all our processes and see if we can't be a whee
	 * bit more specific
	 */
149
	write_lock_irqsave(&tasklist_lock, flags);
B
Bryan Wu 已提交
150
	for_each_process(p) {
151
		mm = (in_atomic ? p->mm : get_task_mm(p));
B
Bryan Wu 已提交
152 153 154
		if (!mm)
			continue;

155 156 157 158
		for (n = rb_first(&mm->mm_rb); n; n = rb_next(n)) {
			struct vm_area_struct *vma;

			vma = rb_entry(n, struct vm_area_struct, vm_rb);
B
Bryan Wu 已提交
159 160

			if (address >= vma->vm_start && address < vma->vm_end) {
161
				char _tmpbuf[256];
B
Bryan Wu 已提交
162 163
				char *name = p->comm;
				struct file *file = vma->vm_file;
164

165 166
				if (file) {
					char *d_name = d_path(&file->f_path, _tmpbuf,
167
						      sizeof(_tmpbuf));
168 169 170
					if (!IS_ERR(d_name))
						name = d_name;
				}
B
Bryan Wu 已提交
171

172 173 174
				/* FLAT does not have its text aligned to the start of
				 * the map while FDPIC ELF does ...
				 */
175 176 177 178 179 180 181 182 183 184 185 186 187 188

				/* before we can check flat/fdpic, we need to
				 * make sure current is valid
				 */
				if ((unsigned long)current >= FIXED_CODE_START &&
				    !((unsigned long)current & 0x3)) {
					if (current->mm &&
					    (address > current->mm->start_code) &&
					    (address < current->mm->end_code))
						offset = address - current->mm->start_code;
					else
						offset = (address - vma->vm_start) +
							 (vma->vm_pgoff << PAGE_SHIFT);

189
					sprintf(buf, "[ %s + 0x%lx ]", name, offset);
190
				} else
191 192
					sprintf(buf, "[ %s vma:0x%lx-0x%lx]",
						name, vma->vm_start, vma->vm_end);
193

194
				if (!in_atomic)
195
					mmput(mm);
196

197 198
				if (buf[0] == '\0')
					sprintf(buf, "[ %s ] dynamic memory", name);
199

200
				goto done;
B
Bryan Wu 已提交
201 202
			}
		}
203
		if (!in_atomic)
204
			mmput(mm);
B
Bryan Wu 已提交
205 206 207
	}

	/* we were unable to find this address anywhere */
208
	sprintf(buf, "/* kernel dynamic memory */");
209 210 211

done:
	write_unlock_irqrestore(&tasklist_lock, flags);
212 213 214
#else
	sprintf(buf, " ");
#endif
B
Bryan Wu 已提交
215 216
}

217 218
asmlinkage void double_fault_c(struct pt_regs *fp)
{
219 220 221 222 223
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_ON
	int j;
	trace_buffer_save(j);
#endif

224 225
	console_verbose();
	oops_in_progress = 1;
226
#ifdef CONFIG_DEBUG_VERBOSE
227
	printk(KERN_EMERG "Double Fault\n");
228 229
#ifdef CONFIG_DEBUG_DOUBLEFAULT_PRINT
	if (((long)fp->seqstat &  SEQSTAT_EXCAUSE) == VEC_UNCOV) {
230
		unsigned int cpu = smp_processor_id();
231
		char buf[150];
232
		decode_address(buf, cpu_pda[cpu].retx);
233
		printk(KERN_EMERG "While handling exception (EXCAUSE = 0x%x) at %s:\n",
234 235
			(unsigned int)cpu_pda[cpu].seqstat & SEQSTAT_EXCAUSE, buf);
		decode_address(buf, cpu_pda[cpu].dcplb_fault_addr);
236
		printk(KERN_NOTICE "   DCPLB_FAULT_ADDR: %s\n", buf);
237
		decode_address(buf, cpu_pda[cpu].icplb_fault_addr);
238 239 240
		printk(KERN_NOTICE "   ICPLB_FAULT_ADDR: %s\n", buf);

		decode_address(buf, fp->retx);
241
		printk(KERN_NOTICE "The instruction at %s caused a double exception\n", buf);
242 243 244 245 246 247
	} else
#endif
	{
		dump_bfin_process(fp);
		dump_bfin_mem(fp);
		show_regs(fp);
248
		dump_bfin_trace_buffer();
249
	}
250
#endif
251
	panic("Double Fault - unrecoverable event");
252 253 254

}

255 256 257 258 259
static int kernel_mode_regs(struct pt_regs *regs)
{
	return regs->ipend & 0xffc0;
}

B
Bryan Wu 已提交
260 261
asmlinkage void trap_c(struct pt_regs *fp)
{
262 263
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_ON
	int j;
264 265 266
#endif
#ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
	unsigned int cpu = smp_processor_id();
267
#endif
268
	const char *strerror = NULL;
269
	int sig = 0;
B
Bryan Wu 已提交
270 271 272
	siginfo_t info;
	unsigned long trapnr = fp->seqstat & SEQSTAT_EXCAUSE;

273
	trace_buffer_save(j);
274 275 276
#if defined(CONFIG_DEBUG_MMRS) || defined(CONFIG_DEBUG_MMRS_MODULE)
	last_seqstat = (u32)fp->seqstat;
#endif
277 278 279 280 281

	/* Important - be very careful dereferncing pointers - will lead to
	 * double faults if the stack has become corrupt
	 */

B
Bryan Wu 已提交
282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307
	/* 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 conjuction 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 */
308
		if (kernel_mode_regs(fp))
309
			goto traps_done;
B
Bryan Wu 已提交
310 311
		else
			break;
M
Mike Frysinger 已提交
312
	/* 0x03 - User Defined, userspace stack overflow */
B
Bryan Wu 已提交
313 314 315
	case VEC_EXCPT03:
		info.si_code = SEGV_STACKFLOW;
		sig = SIGSEGV;
316
		strerror = KERN_NOTICE EXC_0x03(KERN_NOTICE);
317
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
318
		break;
319 320 321 322 323 324
	/* 0x02 - KGDB initial connection and break signal trap */
	case VEC_EXCPT02:
#ifdef CONFIG_KGDB
		info.si_code = TRAP_ILLTRAP;
		sig = SIGTRAP;
		CHK_DEBUGGER_TRAP();
325
		goto traps_done;
326
#endif
327 328 329 330 331 332 333 334 335 336 337 338
	/* 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 */
339
	/* If we got here, it is most likely that someone was trying to use a
340 341 342 343 344
	 * custom exception handler, and it is not actually installed properly
	 */
	case VEC_EXCPT04 ... VEC_EXCPT15:
		info.si_code = ILL_ILLPARAOP;
		sig = SIGILL;
345
		strerror = KERN_NOTICE EXC_0x04(KERN_NOTICE);
346 347
		CHK_DEBUGGER_TRAP_MAYBE();
		break;
B
Bryan Wu 已提交
348 349 350 351 352 353
	/* 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 */
354
		if (kernel_mode_regs(fp))
355
			goto traps_done;
B
Bryan Wu 已提交
356 357 358 359 360 361
		else
			break;
	/* 0x11 - Trace Buffer Full, handled here */
	case VEC_OVFLOW:
		info.si_code = TRAP_TRACEFLOW;
		sig = SIGTRAP;
362
		strerror = KERN_NOTICE EXC_0x11(KERN_NOTICE);
363
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
		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:
382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398
#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
B
Bryan Wu 已提交
399 400
		info.si_code = ILL_ILLOPC;
		sig = SIGILL;
401
		strerror = KERN_NOTICE EXC_0x21(KERN_NOTICE);
402
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
403 404 405 406 407
		break;
	/* 0x22 - Illegal Instruction Combination, handled here */
	case VEC_ILGAL_I:
		info.si_code = ILL_ILLPARAOP;
		sig = SIGILL;
408
		strerror = KERN_NOTICE EXC_0x22(KERN_NOTICE);
409
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
410
		break;
411
	/* 0x23 - Data CPLB protection violation, handled here */
B
Bryan Wu 已提交
412 413
	case VEC_CPLB_VL:
		info.si_code = ILL_CPLB_VI;
414
		sig = SIGBUS;
415
		strerror = KERN_NOTICE EXC_0x23(KERN_NOTICE);
416
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
417 418 419 420 421
		break;
	/* 0x24 - Data access misaligned, handled here */
	case VEC_MISALI_D:
		info.si_code = BUS_ADRALN;
		sig = SIGBUS;
422
		strerror = KERN_NOTICE EXC_0x24(KERN_NOTICE);
423
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
424 425 426 427 428
		break;
	/* 0x25 - Unrecoverable Event, handled here */
	case VEC_UNCOV:
		info.si_code = ILL_ILLEXCPT;
		sig = SIGILL;
429
		strerror = KERN_NOTICE EXC_0x25(KERN_NOTICE);
430
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
431 432 433 434 435 436
		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;
437
		strerror = KERN_NOTICE EXC_0x26(KERN_NOTICE);
B
Bryan Wu 已提交
438 439 440 441 442
		break;
	/* 0x27 - Data CPLB Multiple Hits - Linux Trap Zero, handled here */
	case VEC_CPLB_MHIT:
		info.si_code = ILL_CPLB_MULHIT;
		sig = SIGSEGV;
443
#ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
444
		if (cpu_pda[cpu].dcplb_fault_addr < FIXED_CODE_START)
445
			strerror = KERN_NOTICE "NULL pointer access\n";
446
		else
B
Bryan Wu 已提交
447
#endif
448
			strerror = KERN_NOTICE EXC_0x27(KERN_NOTICE);
449
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
450 451 452 453 454
		break;
	/* 0x28 - Emulation Watchpoint, handled here */
	case VEC_WATCH:
		info.si_code = TRAP_WATCHPT;
		sig = SIGTRAP;
455
		pr_debug(EXC_0x28(KERN_DEBUG));
B
Bryan Wu 已提交
456 457
		CHK_DEBUGGER_TRAP_MAYBE();
		/* Check if this is a watchpoint in kernel space */
458
		if (kernel_mode_regs(fp))
459
			goto traps_done;
B
Bryan Wu 已提交
460 461 462 463 464 465 466
		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;
467
		strerror = KERN_NOTICE "BF535: VEC_ISTRU_VL\n";
468
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
469 470 471 472 473 474 475 476
		break;
#else
	/* 0x29 - Reserved, Caught by default */
#endif
	/* 0x2A - Instruction fetch misaligned, handled here */
	case VEC_MISALI_I:
		info.si_code = BUS_ADRALN;
		sig = SIGBUS;
477
		strerror = KERN_NOTICE EXC_0x2A(KERN_NOTICE);
478
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
479
		break;
480
	/* 0x2B - Instruction CPLB protection violation, handled here */
B
Bryan Wu 已提交
481 482
	case VEC_CPLB_I_VL:
		info.si_code = ILL_CPLB_VI;
483
		sig = SIGBUS;
484
		strerror = KERN_NOTICE EXC_0x2B(KERN_NOTICE);
485
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
486 487 488 489 490
		break;
	/* 0x2C - Instruction CPLB miss, handled in _cplb_hdr */
	case VEC_CPLB_I_M:
		info.si_code = ILL_CPLB_MISS;
		sig = SIGBUS;
491
		strerror = KERN_NOTICE EXC_0x2C(KERN_NOTICE);
B
Bryan Wu 已提交
492 493 494 495 496
		break;
	/* 0x2D - Instruction CPLB Multiple Hits, handled here */
	case VEC_CPLB_I_MHIT:
		info.si_code = ILL_CPLB_MULHIT;
		sig = SIGSEGV;
497
#ifdef CONFIG_DEBUG_HUNT_FOR_ZERO
498
		if (cpu_pda[cpu].icplb_fault_addr < FIXED_CODE_START)
499
			strerror = KERN_NOTICE "Jump to NULL address\n";
500
		else
B
Bryan Wu 已提交
501
#endif
502
			strerror = KERN_NOTICE EXC_0x2D(KERN_NOTICE);
503
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
504 505 506 507 508
		break;
	/* 0x2E - Illegal use of Supervisor Resource, handled here */
	case VEC_ILL_RES:
		info.si_code = ILL_PRVOPC;
		sig = SIGILL;
509
		strerror = KERN_NOTICE EXC_0x2E(KERN_NOTICE);
510
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
		break;
	/* 0x2F - Reserved, Caught by default */
	/* 0x30 - Reserved, Caught by default */
	/* 0x31 - Reserved, Caught by default */
	/* 0x32 - Reserved, Caught by default */
	/* 0x33 - Reserved, Caught by default */
	/* 0x34 - Reserved, Caught by default */
	/* 0x35 - Reserved, Caught by default */
	/* 0x36 - Reserved, Caught by default */
	/* 0x37 - Reserved, Caught by default */
	/* 0x38 - Reserved, Caught by default */
	/* 0x39 - Reserved, Caught by default */
	/* 0x3A - Reserved, Caught by default */
	/* 0x3B - Reserved, Caught by default */
	/* 0x3C - Reserved, Caught by default */
	/* 0x3D - Reserved, Caught by default */
	/* 0x3E - Reserved, Caught by default */
	/* 0x3F - Reserved, Caught by default */
529 530 531 532 533 534 535 536
	case VEC_HWERR:
		info.si_code = BUS_ADRALN;
		sig = SIGBUS;
		switch (fp->seqstat & SEQSTAT_HWERRCAUSE) {
		/* System MMR Error */
		case (SEQSTAT_HWERRCAUSE_SYSTEM_MMR):
			info.si_code = BUS_ADRALN;
			sig = SIGBUS;
537
			strerror = KERN_NOTICE HWC_x2(KERN_NOTICE);
538 539 540 541 542
			break;
		/* External Memory Addressing Error */
		case (SEQSTAT_HWERRCAUSE_EXTERN_ADDR):
			info.si_code = BUS_ADRERR;
			sig = SIGBUS;
543
			strerror = KERN_NOTICE HWC_x3(KERN_NOTICE);
544 545 546
			break;
		/* Performance Monitor Overflow */
		case (SEQSTAT_HWERRCAUSE_PERF_FLOW):
547
			strerror = KERN_NOTICE HWC_x12(KERN_NOTICE);
548 549 550 551 552 553 554 555 556
			break;
		/* RAISE 5 instruction */
		case (SEQSTAT_HWERRCAUSE_RAISE_5):
			printk(KERN_NOTICE HWC_x18(KERN_NOTICE));
			break;
		default:        /* Reserved */
			printk(KERN_NOTICE HWC_default(KERN_NOTICE));
			break;
		}
557
		CHK_DEBUGGER_TRAP_MAYBE();
558
		break;
559 560 561 562
	/*
	 * We should be handling all known exception types above,
	 * if we get here we hit a reserved one, so panic
	 */
B
Bryan Wu 已提交
563
	default:
564 565
		info.si_code = ILL_ILLPARAOP;
		sig = SIGILL;
566
		verbose_printk(KERN_EMERG "Caught Unhandled Exception, code = %08lx\n",
B
Bryan Wu 已提交
567
			(fp->seqstat & SEQSTAT_EXCAUSE));
568
		CHK_DEBUGGER_TRAP_MAYBE();
B
Bryan Wu 已提交
569 570 571
		break;
	}

572 573
	BUG_ON(sig == 0);

574 575 576 577 578 579 580 581
	/* If the fault was caused by a kernel thread, or interrupt handler
	 * we will kernel panic, so the system reboots.
	 */
	if (kernel_mode_regs(fp) || (current && !current->mm)) {
		console_verbose();
		oops_in_progress = 1;
	}

582
	if (sig != SIGTRAP) {
583 584 585
		if (strerror)
			verbose_printk(strerror);

586
		dump_bfin_process(fp);
587
		dump_bfin_mem(fp);
588
		show_regs(fp);
589 590 591 592

		/* Print out the trace buffer if it makes sense */
#ifndef CONFIG_DEBUG_BFIN_NO_KERN_HWTRACE
		if (trapnr == VEC_CPLB_I_M || trapnr == VEC_CPLB_M)
593
			verbose_printk(KERN_NOTICE "No trace since you do not have "
594
			       "CONFIG_DEBUG_BFIN_NO_KERN_HWTRACE enabled\n\n");
595 596 597
		else
#endif
			dump_bfin_trace_buffer();
598

599
		if (oops_in_progress) {
600
			/* Dump the current kernel stack */
601
			verbose_printk(KERN_NOTICE "Kernel Stack\n");
602
			show_stack(current, NULL);
603
			print_modules();
604
#ifndef CONFIG_ACCESS_CHECK
605
			verbose_printk(KERN_EMERG "Please turn on "
606
			       "CONFIG_ACCESS_CHECK\n");
607
#endif
B
Bryan Wu 已提交
608
			panic("Kernel exception");
609
		} else {
610
#ifdef CONFIG_DEBUG_VERBOSE
611
			unsigned long *stack;
612 613
			/* Dump the user space stack */
			stack = (unsigned long *)rdusp();
614
			verbose_printk(KERN_NOTICE "Userspace Stack\n");
615
			show_stack(NULL, stack);
616
#endif
617
		}
B
Bryan Wu 已提交
618
	}
619

620 621 622 623 624 625 626 627 628
#ifdef CONFIG_IPIPE
	if (!ipipe_trap_notify(fp->seqstat & 0x3f, fp))
#endif
	{
		info.si_signo = sig;
		info.si_errno = 0;
		info.si_addr = (void __user *)fp->pc;
		force_sig_info(sig, &info, current);
	}
B
Bryan Wu 已提交
629

630
	if ((ANOMALY_05000461 && trapnr == VEC_HWERR && !access_ok(VERIFY_READ, fp->pc, 8)) ||
631 632
	    (ANOMALY_05000281 && trapnr == VEC_HWERR) ||
	    (ANOMALY_05000189 && (trapnr == VEC_CPLB_I_VL || trapnr == VEC_CPLB_VL)))
633 634
		fp->pc = SAFE_USER_INSTRUCTION;

635
 traps_done:
B
Bryan Wu 已提交
636 637 638 639 640
	trace_buffer_restore(j);
}

/* Typical exception handling routines	*/

641 642
#define EXPAND_LEN ((1 << CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN) * 256 - 1)

643 644 645 646
/*
 * Similar to get_user, do some address checking, then dereference
 * Return true on sucess, false on bad address
 */
647
static bool get_instruction(unsigned short *val, unsigned short *address)
648
{
649
	unsigned long addr = (unsigned long)address;
650 651 652 653 654

	/* Check for odd addresses */
	if (addr & 0x1)
		return false;

655 656
	/* MMR region will never have instructions */
	if (addr >= SYSMMR_BASE)
657 658
		return false;

659 660 661 662 663 664 665 666 667 668 669 670 671
	switch (bfin_mem_access_type(addr, 2)) {
		case BFIN_MEM_ACCESS_CORE:
		case BFIN_MEM_ACCESS_CORE_ONLY:
			*val = *address;
			return true;
		case BFIN_MEM_ACCESS_DMA:
			dma_memcpy(val, address, 2);
			return true;
		case BFIN_MEM_ACCESS_ITEST:
			isram_memcpy(val, address, 2);
			return true;
		default: /* invalid access */
			return false;
672 673 674
	}
}

675
/*
676 677 678 679 680
 * decode the instruction if we are printing out the trace, as it
 * makes things easier to follow, without running it through objdump
 * These are the normal instructions which cause change of flow, which
 * would be at the source of the trace buffer
 */
681
#if defined(CONFIG_DEBUG_VERBOSE) && defined(CONFIG_DEBUG_BFIN_HWTRACE_ON)
682
static void decode_instruction(unsigned short *address)
683 684 685 686 687
{
	unsigned short opcode;

	if (get_instruction(&opcode, address)) {
		if (opcode == 0x0010)
688
			verbose_printk("RTS");
689
		else if (opcode == 0x0011)
690
			verbose_printk("RTI");
691
		else if (opcode == 0x0012)
692
			verbose_printk("RTX");
693 694 695 696 697 698 699 700
		else if (opcode == 0x0013)
			verbose_printk("RTN");
		else if (opcode == 0x0014)
			verbose_printk("RTE");
		else if (opcode == 0x0025)
			verbose_printk("EMUEXCPT");
		else if (opcode == 0x0040 && opcode <= 0x0047)
			verbose_printk("STI R%i", opcode & 7);
701
		else if (opcode >= 0x0050 && opcode <= 0x0057)
702
			verbose_printk("JUMP (P%i)", opcode & 7);
703
		else if (opcode >= 0x0060 && opcode <= 0x0067)
704
			verbose_printk("CALL (P%i)", opcode & 7);
705
		else if (opcode >= 0x0070 && opcode <= 0x0077)
706
			verbose_printk("CALL (PC+P%i)", opcode & 7);
707
		else if (opcode >= 0x0080 && opcode <= 0x0087)
708
			verbose_printk("JUMP (PC+P%i)", opcode & 7);
709 710 711 712
		else if (opcode >= 0x0090 && opcode <= 0x009F)
			verbose_printk("RAISE 0x%x", opcode & 0xF);
		else if (opcode >= 0x00A0 && opcode <= 0x00AF)
			verbose_printk("EXCPT 0x%x", opcode & 0xF);
713
		else if ((opcode >= 0x1000 && opcode <= 0x13FF) || (opcode >= 0x1800 && opcode <= 0x1BFF))
714
			verbose_printk("IF !CC JUMP");
715
		else if ((opcode >= 0x1400 && opcode <= 0x17ff) || (opcode >= 0x1c00 && opcode <= 0x1fff))
716
			verbose_printk("IF CC JUMP");
717
		else if (opcode >= 0x2000 && opcode <= 0x2fff)
718
			verbose_printk("JUMP.S");
719
		else if (opcode >= 0xe080 && opcode <= 0xe0ff)
720
			verbose_printk("LSETUP");
721
		else if (opcode >= 0xe200 && opcode <= 0xe2ff)
722
			verbose_printk("JUMP.L");
723
		else if (opcode >= 0xe300 && opcode <= 0xe3ff)
724
			verbose_printk("CALL pcrel");
725
		else
726
			verbose_printk("0x%04x", opcode);
727 728 729
	}

}
730
#endif
731

B
Bryan Wu 已提交
732 733
void dump_bfin_trace_buffer(void)
{
734
#ifdef CONFIG_DEBUG_VERBOSE
735 736
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_ON
	int tflags, i = 0;
737
	char buf[150];
738
	unsigned short *addr;
739 740 741 742
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_EXPAND
	int j, index;
#endif

B
Bryan Wu 已提交
743 744
	trace_buffer_save(tflags);

745
	printk(KERN_NOTICE "Hardware Trace:\n");
746

747 748 749 750
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_EXPAND
	printk(KERN_NOTICE "WARNING: Expanded trace turned on - can not trace exceptions\n");
#endif

B
Bryan Wu 已提交
751
	if (likely(bfin_read_TBUFSTAT() & TBUFCNT)) {
752
		for (; bfin_read_TBUFSTAT() & TBUFCNT; i++) {
753 754
			decode_address(buf, (unsigned long)bfin_read_TBUF());
			printk(KERN_NOTICE "%4i Target : %s\n", i, buf);
755 756 757
			addr = (unsigned short *)bfin_read_TBUF();
			decode_address(buf, (unsigned long)addr);
			printk(KERN_NOTICE "     Source : %s ", buf);
758
			decode_instruction(addr);
759
			printk("\n");
B
Bryan Wu 已提交
760 761 762
		}
	}

763 764
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_EXPAND
	if (trace_buff_offset)
765
		index = trace_buff_offset / 4;
766 767 768 769 770
	else
		index = EXPAND_LEN;

	j = (1 << CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN) * 128;
	while (j) {
771 772
		decode_address(buf, software_trace_buff[index]);
		printk(KERN_NOTICE "%4i Target : %s\n", i, buf);
773 774 775
		index -= 1;
		if (index < 0 )
			index = EXPAND_LEN;
776
		decode_address(buf, software_trace_buff[index]);
777 778 779
		printk(KERN_NOTICE "     Source : %s ", buf);
		decode_instruction((unsigned short *)software_trace_buff[index]);
		printk("\n");
780 781 782 783 784 785 786 787
		index -= 1;
		if (index < 0)
			index = EXPAND_LEN;
		j--;
		i++;
	}
#endif

B
Bryan Wu 已提交
788
	trace_buffer_restore(tflags);
789
#endif
790
#endif
B
Bryan Wu 已提交
791 792 793
}
EXPORT_SYMBOL(dump_bfin_trace_buffer);

794 795 796 797 798 799 800 801 802 803 804 805
#ifdef CONFIG_BUG
int is_valid_bugaddr(unsigned long addr)
{
	unsigned short opcode;

	if (!get_instruction(&opcode, (unsigned short *)addr))
		return 0;

	return opcode == BFIN_BUG_OPCODE;
}
#endif

806 807 808 809
/*
 * Checks to see if the address pointed to is either a
 * 16-bit CALL instruction, or a 32-bit CALL instruction
 */
810
static bool is_bfin_call(unsigned short *addr)
B
Bryan Wu 已提交
811
{
812 813
	unsigned short opcode = 0, *ins_addr;
	ins_addr = (unsigned short *)addr;
B
Bryan Wu 已提交
814

815 816
	if (!get_instruction(&opcode, ins_addr))
		return false;
B
Bryan Wu 已提交
817

818 819 820 821 822 823 824
	if ((opcode >= 0x0060 && opcode <= 0x0067) ||
	    (opcode >= 0x0070 && opcode <= 0x0077))
		return true;

	ins_addr--;
	if (!get_instruction(&opcode, ins_addr))
		return false;
B
Bryan Wu 已提交
825

826 827 828 829 830 831
	if (opcode >= 0xE300 && opcode <= 0xE3FF)
		return true;

	return false;

}
832

B
Bryan Wu 已提交
833 834
void show_stack(struct task_struct *task, unsigned long *stack)
{
835
#ifdef CONFIG_PRINTK
836 837 838 839
	unsigned int *addr, *endstack, *fp = 0, *frame;
	unsigned short *ins_addr;
	char buf[150];
	unsigned int i, j, ret_addr, frame_no = 0;
B
Bryan Wu 已提交
840

841 842 843 844
	/*
	 * If we have been passed a specific stack, use that one otherwise
	 *    if we have been passed a task structure, use that, otherwise
	 *    use the stack of where the variable "stack" exists
B
Bryan Wu 已提交
845 846
	 */

847 848 849
	if (stack == NULL) {
		if (task) {
			/* We know this is a kernel stack, so this is the start/end */
B
Bryan Wu 已提交
850
			stack = (unsigned long *)task->thread.ksp;
851 852 853
			endstack = (unsigned int *)(((unsigned int)(stack) & ~(THREAD_SIZE - 1)) + THREAD_SIZE);
		} else {
			/* print out the existing stack info */
B
Bryan Wu 已提交
854
			stack = (unsigned long *)&stack;
855 856 857 858 859
			endstack = (unsigned int *)PAGE_ALIGN((unsigned int)stack);
		}
	} else
		endstack = (unsigned int *)PAGE_ALIGN((unsigned int)stack);

860
	printk(KERN_NOTICE "Stack info:\n");
861
	decode_address(buf, (unsigned int)stack);
862 863
	printk(KERN_NOTICE " SP: [0x%p] %s\n", stack, buf);

864 865 866 867 868
	if (!access_ok(VERIFY_READ, stack, (unsigned int)endstack - (unsigned int)stack)) {
		printk(KERN_NOTICE "Invalid stack pointer\n");
		return;
	}

869
	/* First thing is to look for a frame pointer */
870
	for (addr = (unsigned int *)((unsigned int)stack & ~0xF); addr < endstack; addr++) {
871 872 873 874 875 876 877 878 879
		if (*addr & 0x1)
			continue;
		ins_addr = (unsigned short *)*addr;
		ins_addr--;
		if (is_bfin_call(ins_addr))
			fp = addr - 1;

		if (fp) {
			/* Let's check to see if it is a frame pointer */
880 881
			while (fp >= (addr - 1) && fp < endstack
			       && fp && ((unsigned int) fp & 0x3) == 0)
882 883 884 885 886 887 888
				fp = (unsigned int *)*fp;
			if (fp == 0 || fp == endstack) {
				fp = addr - 1;
				break;
			}
			fp = 0;
		}
B
Bryan Wu 已提交
889
	}
890 891
	if (fp) {
		frame = fp;
892
		printk(KERN_NOTICE " FP: (0x%p)\n", fp);
893 894
	} else
		frame = 0;
B
Bryan Wu 已提交
895

896 897 898 899 900 901
	/*
	 * Now that we think we know where things are, we
	 * walk the stack again, this time printing things out
	 * incase there is no frame pointer, we still look for
	 * valid return addresses
	 */
B
Bryan Wu 已提交
902

903 904 905 906 907 908 909 910 911 912 913
	/* First time print out data, next time, print out symbols */
	for (j = 0; j <= 1; j++) {
		if (j)
			printk(KERN_NOTICE "Return addresses in stack:\n");
		else
			printk(KERN_NOTICE " Memory from 0x%08lx to %p", ((long unsigned int)stack & ~0xF), endstack);

		fp = frame;
		frame_no = 0;

		for (addr = (unsigned int *)((unsigned int)stack & ~0xF), i = 0;
914
		     addr < endstack; addr++, i++) {
915 916 917

			ret_addr = 0;
			if (!j && i % 8 == 0)
918
				printk(KERN_NOTICE "%p:",addr);
919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955

			/* if it is an odd address, or zero, just skip it */
			if (*addr & 0x1 || !*addr)
				goto print;

			ins_addr = (unsigned short *)*addr;

			/* Go back one instruction, and see if it is a CALL */
			ins_addr--;
			ret_addr = is_bfin_call(ins_addr);
 print:
			if (!j && stack == (unsigned long *)addr)
				printk("[%08x]", *addr);
			else if (ret_addr)
				if (j) {
					decode_address(buf, (unsigned int)*addr);
					if (frame == addr) {
						printk(KERN_NOTICE "   frame %2i : %s\n", frame_no, buf);
						continue;
					}
					printk(KERN_NOTICE "    address : %s\n", buf);
				} else
					printk("<%08x>", *addr);
			else if (fp == addr) {
				if (j)
					frame = addr+1;
				else
					printk("(%08x)", *addr);

				fp = (unsigned int *)*addr;
				frame_no++;

			} else if (!j)
				printk(" %08x ", *addr);
		}
		if (!j)
			printk("\n");
B
Bryan Wu 已提交
956
	}
957
#endif
B
Bryan Wu 已提交
958
}
959
EXPORT_SYMBOL(show_stack);
B
Bryan Wu 已提交
960 961 962 963

void dump_stack(void)
{
	unsigned long stack;
964
#ifdef CONFIG_DEBUG_BFIN_HWTRACE_ON
B
Bryan Wu 已提交
965
	int tflags;
966
#endif
B
Bryan Wu 已提交
967 968 969 970 971 972 973
	trace_buffer_save(tflags);
	dump_bfin_trace_buffer();
	show_stack(current, &stack);
	trace_buffer_restore(tflags);
}
EXPORT_SYMBOL(dump_stack);

974
void dump_bfin_process(struct pt_regs *fp)
B
Bryan Wu 已提交
975
{
976
#ifdef CONFIG_DEBUG_VERBOSE
977 978 979 980 981
	/* We should be able to look at fp->ipend, but we don't push it on the
	 * stack all the time, so do this until we fix that */
	unsigned int context = bfin_read_IPEND();

	if (oops_in_progress)
982
		verbose_printk(KERN_EMERG "Kernel OOPS in progress\n");
983

984
	if (context & 0x0020 && (fp->seqstat & SEQSTAT_EXCAUSE) == VEC_HWERR)
985
		verbose_printk(KERN_NOTICE "HW Error context\n");
986
	else if (context & 0x0020)
987
		verbose_printk(KERN_NOTICE "Deferred Exception context\n");
988
	else if (context & 0x3FC0)
989
		verbose_printk(KERN_NOTICE "Interrupt context\n");
990
	else if (context & 0x4000)
991
		verbose_printk(KERN_NOTICE "Deferred Interrupt context\n");
992
	else if (context & 0x8000)
993
		verbose_printk(KERN_NOTICE "Kernel process context\n");
994

995 996 997
	/* Because we are crashing, and pointers could be bad, we check things
	 * pretty closely before we use them
	 */
998 999
	if ((unsigned long)current >= FIXED_CODE_START &&
	    !((unsigned long)current & 0x3) && current->pid) {
1000
		verbose_printk(KERN_NOTICE "CURRENT PROCESS:\n");
1001
		if (current->comm >= (char *)FIXED_CODE_START)
1002
			verbose_printk(KERN_NOTICE "COMM=%s PID=%d\n",
1003 1004
				current->comm, current->pid);
		else
1005
			verbose_printk(KERN_NOTICE "COMM= invalid\n");
1006

1007
		printk(KERN_NOTICE "CPU = %d\n", current_thread_info()->cpu);
1008
		if (!((unsigned long)current->mm & 0x3) && (unsigned long)current->mm >= FIXED_CODE_START)
1009 1010 1011
			verbose_printk(KERN_NOTICE
				"TEXT = 0x%p-0x%p        DATA = 0x%p-0x%p\n"
				" BSS = 0x%p-0x%p  USER-STACK = 0x%p\n\n",
1012 1013 1014 1015 1016 1017 1018 1019
				(void *)current->mm->start_code,
				(void *)current->mm->end_code,
				(void *)current->mm->start_data,
				(void *)current->mm->end_data,
				(void *)current->mm->end_data,
				(void *)current->mm->brk,
				(void *)current->mm->start_stack);
		else
1020
			verbose_printk(KERN_NOTICE "invalid mm\n");
1021
	} else
1022 1023
		verbose_printk(KERN_NOTICE
			       "No Valid process in current context\n");
1024
#endif
1025
}
1026

1027
void dump_bfin_mem(struct pt_regs *fp)
1028
{
1029
#ifdef CONFIG_DEBUG_VERBOSE
1030 1031
	unsigned short *addr, *erraddr, val = 0, err = 0;
	char sti = 0, buf[6];
B
Bryan Wu 已提交
1032

1033
	erraddr = (void *)fp->pc;
1034

1035
	verbose_printk(KERN_NOTICE "return address: [0x%p]; contents of:", erraddr);
1036 1037 1038 1039 1040

	for (addr = (unsigned short *)((unsigned long)erraddr & ~0xF) - 0x10;
	     addr < (unsigned short *)((unsigned long)erraddr & ~0xF) + 0x10;
	     addr++) {
		if (!((unsigned long)addr & 0xF))
1041
			verbose_printk(KERN_NOTICE "0x%p: ", addr);
1042

1043
		if (!get_instruction(&val, addr)) {
1044 1045 1046 1047 1048 1049
				val = 0;
				sprintf(buf, "????");
		} else
			sprintf(buf, "%04x", val);

		if (addr == erraddr) {
1050
			verbose_printk("[%s]", buf);
1051 1052
			err = val;
		} else
1053
			verbose_printk(" %s ", buf);
1054 1055 1056 1057 1058 1059 1060 1061

		/* Do any previous instructions turn on interrupts? */
		if (addr <= erraddr &&				/* in the past */
		    ((val >= 0x0040 && val <= 0x0047) ||	/* STI instruction */
		      val == 0x017b))				/* [SP++] = RETI */
			sti = 1;
	}

1062
	verbose_printk("\n");
1063 1064 1065 1066

	/* Hardware error interrupts can be deferred */
	if (unlikely(sti && (fp->seqstat & SEQSTAT_EXCAUSE) == VEC_HWERR &&
	    oops_in_progress)){
1067
		verbose_printk(KERN_NOTICE "Looks like this was a deferred error - sorry\n");
B
Bryan Wu 已提交
1068
#ifndef CONFIG_DEBUG_HWERR
1069 1070 1071
		verbose_printk(KERN_NOTICE
"The remaining message may be meaningless\n"
"You should enable CONFIG_DEBUG_HWERR to get a better idea where it came from\n");
1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
#else
		/* If we are handling only one peripheral interrupt
		 * and current mm and pid are valid, and the last error
		 * was in that user space process's text area
		 * print it out - because that is where the problem exists
		 */
		if ((!(((fp)->ipend & ~0x30) & (((fp)->ipend & ~0x30) - 1))) &&
		     (current->pid && current->mm)) {
			/* And the last RETI points to the current userspace context */
			if ((fp + 1)->pc >= current->mm->start_code &&
			    (fp + 1)->pc <= current->mm->end_code) {
1083 1084
				verbose_printk(KERN_NOTICE "It might be better to look around here : \n");
				verbose_printk(KERN_NOTICE "-------------------------------------------\n");
1085
				show_regs(fp + 1);
1086
				verbose_printk(KERN_NOTICE "-------------------------------------------\n");
1087
			}
B
Bryan Wu 已提交
1088
		}
1089 1090
#endif
	}
1091
#endif
1092 1093 1094 1095
}

void show_regs(struct pt_regs *fp)
{
1096
#ifdef CONFIG_DEBUG_VERBOSE
1097
	char buf [150];
1098 1099
	struct irqaction *action;
	unsigned int i;
1100
	unsigned long flags = 0;
1101
	unsigned int cpu = smp_processor_id();
1102
	unsigned char in_atomic = (bfin_read_IPEND() & 0x10) || in_atomic();
1103

1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126
	verbose_printk(KERN_NOTICE "\n");
	if (CPUID != bfin_cpuid())
		verbose_printk(KERN_NOTICE "Compiled for cpu family 0x%04x (Rev %d), "
			"but running on:0x%04x (Rev %d)\n",
			CPUID, bfin_compiled_revid(), bfin_cpuid(), bfin_revid());

	verbose_printk(KERN_NOTICE "ADSP-%s-0.%d",
		CPU, bfin_compiled_revid());

	if (bfin_compiled_revid() !=  bfin_revid())
		verbose_printk("(Detected 0.%d)", bfin_revid());

	verbose_printk(" %lu(MHz CCLK) %lu(MHz SCLK) (%s)\n",
		get_cclk()/1000000, get_sclk()/1000000,
#ifdef CONFIG_MPU
		"mpu on"
#else
		"mpu off"
#endif
		);

	verbose_printk(KERN_NOTICE "%s", linux_banner);

1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
	verbose_printk(KERN_NOTICE "\nSEQUENCER STATUS:\t\t%s\n", print_tainted());
	verbose_printk(KERN_NOTICE " SEQSTAT: %08lx  IPEND: %04lx  IMASK: %04lx  SYSCFG: %04lx\n",
		(long)fp->seqstat, fp->ipend, cpu_pda[smp_processor_id()].ex_imask, fp->syscfg);
	if (fp->ipend & EVT_IRPTEN)
		verbose_printk(KERN_NOTICE "  Global Interrupts Disabled (IPEND[4])\n");
	if (!(cpu_pda[smp_processor_id()].ex_imask & (EVT_IVG13 | EVT_IVG12 | EVT_IVG11 |
			EVT_IVG10 | EVT_IVG9 | EVT_IVG8 | EVT_IVG7 | EVT_IVTMR)))
		verbose_printk(KERN_NOTICE "  Peripheral interrupts masked off\n");
	if (!(cpu_pda[smp_processor_id()].ex_imask & (EVT_IVG15 | EVT_IVG14)))
		verbose_printk(KERN_NOTICE "  Kernel interrupts masked off\n");
1137
	if ((fp->seqstat & SEQSTAT_EXCAUSE) == VEC_HWERR) {
1138
		verbose_printk(KERN_NOTICE "  HWERRCAUSE: 0x%lx\n",
1139 1140 1141 1142
			(fp->seqstat & SEQSTAT_HWERRCAUSE) >> 14);
#ifdef EBIU_ERRMST
		/* If the error was from the EBIU, print it out */
		if (bfin_read_EBIU_ERRMST() & CORE_ERROR) {
1143
			verbose_printk(KERN_NOTICE "  EBIU Error Reason  : 0x%04x\n",
1144
				bfin_read_EBIU_ERRMST());
1145
			verbose_printk(KERN_NOTICE "  EBIU Error Address : 0x%08x\n",
1146 1147 1148 1149
				bfin_read_EBIU_ERRADD());
		}
#endif
	}
1150
	verbose_printk(KERN_NOTICE "  EXCAUSE   : 0x%lx\n",
1151
		fp->seqstat & SEQSTAT_EXCAUSE);
1152
	for (i = 2; i <= 15 ; i++) {
1153
		if (fp->ipend & (1 << i)) {
1154 1155 1156 1157 1158
			if (i != 4) {
				decode_address(buf, bfin_read32(EVT0 + 4*i));
				verbose_printk(KERN_NOTICE "  physical IVG%i asserted : %s\n", i, buf);
			} else
				verbose_printk(KERN_NOTICE "  interrupts disabled\n");
1159 1160 1161 1162 1163 1164
		}
	}

	/* if no interrupts are going off, don't print this out */
	if (fp->ipend & ~0x3F) {
		for (i = 0; i < (NR_IRQS - 1); i++) {
1165 1166 1167
			if (!in_atomic)
				spin_lock_irqsave(&irq_desc[i].lock, flags);

1168 1169 1170 1171 1172
			action = irq_desc[i].action;
			if (!action)
				goto unlock;

			decode_address(buf, (unsigned int)action->handler);
1173
			verbose_printk(KERN_NOTICE "  logical irq %3d mapped  : %s", i, buf);
1174 1175
			for (action = action->next; action; action = action->next) {
				decode_address(buf, (unsigned int)action->handler);
1176
				verbose_printk(", %s", buf);
1177
			}
1178
			verbose_printk("\n");
1179
unlock:
1180 1181
			if (!in_atomic)
				spin_unlock_irqrestore(&irq_desc[i].lock, flags);
1182 1183
		}
	}
1184

1185
	decode_address(buf, fp->rete);
1186
	verbose_printk(KERN_NOTICE " RETE: %s\n", buf);
1187
	decode_address(buf, fp->retn);
1188
	verbose_printk(KERN_NOTICE " RETN: %s\n", buf);
1189
	decode_address(buf, fp->retx);
1190
	verbose_printk(KERN_NOTICE " RETX: %s\n", buf);
1191
	decode_address(buf, fp->rets);
1192
	verbose_printk(KERN_NOTICE " RETS: %s\n", buf);
1193
	decode_address(buf, fp->pc);
1194
	verbose_printk(KERN_NOTICE " PC  : %s\n", buf);
1195

1196 1197
	if (((long)fp->seqstat &  SEQSTAT_EXCAUSE) &&
	    (((long)fp->seqstat & SEQSTAT_EXCAUSE) != VEC_HWERR)) {
1198
		decode_address(buf, cpu_pda[cpu].dcplb_fault_addr);
1199
		verbose_printk(KERN_NOTICE "DCPLB_FAULT_ADDR: %s\n", buf);
1200
		decode_address(buf, cpu_pda[cpu].icplb_fault_addr);
1201
		verbose_printk(KERN_NOTICE "ICPLB_FAULT_ADDR: %s\n", buf);
1202 1203
	}

1204
	verbose_printk(KERN_NOTICE "PROCESSOR STATE:\n");
1205
	verbose_printk(KERN_NOTICE " R0 : %08lx    R1 : %08lx    R2 : %08lx    R3 : %08lx\n",
1206
		fp->r0, fp->r1, fp->r2, fp->r3);
1207
	verbose_printk(KERN_NOTICE " R4 : %08lx    R5 : %08lx    R6 : %08lx    R7 : %08lx\n",
1208
		fp->r4, fp->r5, fp->r6, fp->r7);
1209
	verbose_printk(KERN_NOTICE " P0 : %08lx    P1 : %08lx    P2 : %08lx    P3 : %08lx\n",
1210
		fp->p0, fp->p1, fp->p2, fp->p3);
1211
	verbose_printk(KERN_NOTICE " P4 : %08lx    P5 : %08lx    FP : %08lx    SP : %08lx\n",
1212
		fp->p4, fp->p5, fp->fp, (long)fp);
1213
	verbose_printk(KERN_NOTICE " LB0: %08lx    LT0: %08lx    LC0: %08lx\n",
1214
		fp->lb0, fp->lt0, fp->lc0);
1215
	verbose_printk(KERN_NOTICE " LB1: %08lx    LT1: %08lx    LC1: %08lx\n",
1216
		fp->lb1, fp->lt1, fp->lc1);
1217
	verbose_printk(KERN_NOTICE " B0 : %08lx    L0 : %08lx    M0 : %08lx    I0 : %08lx\n",
1218
		fp->b0, fp->l0, fp->m0, fp->i0);
1219
	verbose_printk(KERN_NOTICE " B1 : %08lx    L1 : %08lx    M1 : %08lx    I1 : %08lx\n",
1220
		fp->b1, fp->l1, fp->m1, fp->i1);
1221
	verbose_printk(KERN_NOTICE " B2 : %08lx    L2 : %08lx    M2 : %08lx    I2 : %08lx\n",
1222
		fp->b2, fp->l2, fp->m2, fp->i2);
1223
	verbose_printk(KERN_NOTICE " B3 : %08lx    L3 : %08lx    M3 : %08lx    I3 : %08lx\n",
1224
		fp->b3, fp->l3, fp->m3, fp->i3);
1225
	verbose_printk(KERN_NOTICE "A0.w: %08lx   A0.x: %08lx   A1.w: %08lx   A1.x: %08lx\n",
1226
		fp->a0w, fp->a0x, fp->a1w, fp->a1x);
1227

1228
	verbose_printk(KERN_NOTICE "USP : %08lx  ASTAT: %08lx\n",
1229
		rdusp(), fp->astat);
B
Bryan Wu 已提交
1230

1231 1232
	verbose_printk(KERN_NOTICE "\n");
#endif
B
Bryan Wu 已提交
1233 1234 1235 1236 1237 1238
}

#ifdef CONFIG_SYS_BFIN_SPINLOCK_L1
asmlinkage int sys_bfin_spinlock(int *spinlock)__attribute__((l1_text));
#endif

1239 1240 1241
static DEFINE_SPINLOCK(bfin_spinlock_lock);

asmlinkage int sys_bfin_spinlock(int *p)
B
Bryan Wu 已提交
1242
{
1243
	int ret, tmp = 0;
B
Bryan Wu 已提交
1244

1245 1246 1247 1248
	spin_lock(&bfin_spinlock_lock);	/* This would also hold kernel preemption. */
	ret = get_user(tmp, p);
	if (likely(ret == 0)) {
		if (unlikely(tmp))
B
Bryan Wu 已提交
1249
			ret = 1;
1250 1251
		else
			put_user(1, p);
B
Bryan Wu 已提交
1252
	}
1253
	spin_unlock(&bfin_spinlock_lock);
B
Bryan Wu 已提交
1254 1255 1256
	return ret;
}

1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
int bfin_request_exception(unsigned int exception, void (*handler)(void))
{
	void (*curr_handler)(void);

	if (exception > 0x3F)
		return -EINVAL;

	curr_handler = ex_table[exception];

	if (curr_handler != ex_replaceable)
		return -EBUSY;

	ex_table[exception] = handler;

	return 0;
}
EXPORT_SYMBOL(bfin_request_exception);

int bfin_free_exception(unsigned int exception, void (*handler)(void))
{
	void (*curr_handler)(void);

	if (exception > 0x3F)
		return -EINVAL;

	curr_handler = ex_table[exception];

	if (curr_handler != handler)
		return -EBUSY;

	ex_table[exception] = ex_replaceable;

	return 0;
}
EXPORT_SYMBOL(bfin_free_exception);

B
Bryan Wu 已提交
1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
void panic_cplb_error(int cplb_panic, struct pt_regs *fp)
{
	switch (cplb_panic) {
	case CPLB_NO_UNLOCKED:
		printk(KERN_EMERG "All CPLBs are locked\n");
		break;
	case CPLB_PROT_VIOL:
		return;
	case CPLB_NO_ADDR_MATCH:
		return;
	case CPLB_UNKNOWN_ERR:
		printk(KERN_EMERG "Unknown CPLB Exception\n");
		break;
	}

1308 1309
	oops_in_progress = 1;

1310
	dump_bfin_process(fp);
1311
	dump_bfin_mem(fp);
1312
	show_regs(fp);
B
Bryan Wu 已提交
1313
	dump_stack();
1314
	panic("Unrecoverable event");
B
Bryan Wu 已提交
1315
}