107 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			107 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * Copyright (C) 2005-2006 Atmel Corporation
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| #include <common.h>
 | |
| 
 | |
| #include <asm/sysreg.h>
 | |
| #include <asm/ptrace.h>
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| static const char * const cpu_modes[8] = {
 | |
| 	"Application", "Supervisor", "Interrupt level 0", "Interrupt level 1",
 | |
| 	"Interrupt level 2", "Interrupt level 3", "Exception", "NMI"
 | |
| };
 | |
| 
 | |
| static void dump_mem(const char *str, unsigned long bottom, unsigned long top)
 | |
| {
 | |
| 	unsigned long p;
 | |
| 	int i;
 | |
| 
 | |
| 	printf("%s(0x%08lx to 0x%08lx)\n", str, bottom, top);
 | |
| 
 | |
| 	for (p = bottom & ~31; p < top; ) {
 | |
| 		printf("%04lx: ", p & 0xffff);
 | |
| 
 | |
| 		for (i = 0; i < 8; i++, p += 4) {
 | |
| 			unsigned int val;
 | |
| 
 | |
| 			if (p < bottom || p >= top)
 | |
| 				printf("         ");
 | |
| 			else {
 | |
| 				val = *(unsigned long *)p;
 | |
| 				printf("%08x ", val);
 | |
| 			}
 | |
| 		}
 | |
| 		printf("\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| void do_unknown_exception(unsigned int ecr, struct pt_regs *regs)
 | |
| {
 | |
| 	unsigned int mode;
 | |
| 
 | |
| 	printf("\n *** Unhandled exception %u at PC=0x%08lx [%08lx]\n",
 | |
| 			ecr, regs->pc, regs->pc - gd->reloc_off);
 | |
| 
 | |
| 	switch (ecr) {
 | |
| 	case ECR_BUS_ERROR_WRITE:
 | |
| 	case ECR_BUS_ERROR_READ:
 | |
| 		printf("Bus error at address 0x%08lx\n",
 | |
| 		       sysreg_read(BEAR));
 | |
| 		break;
 | |
| 	case ECR_TLB_MULTIPLE:
 | |
| 	case ECR_ADDR_ALIGN_X:
 | |
| 	case ECR_PROTECTION_X:
 | |
| 	case ECR_ADDR_ALIGN_R:
 | |
| 	case ECR_ADDR_ALIGN_W:
 | |
| 	case ECR_PROTECTION_R:
 | |
| 	case ECR_PROTECTION_W:
 | |
| 	case ECR_DTLB_MODIFIED:
 | |
| 	case ECR_TLB_MISS_X:
 | |
| 	case ECR_TLB_MISS_R:
 | |
| 	case ECR_TLB_MISS_W:
 | |
| 		printf("MMU exception at address 0x%08lx\n",
 | |
| 		       sysreg_read(TLBEAR));
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	printf("   pc: %08lx    lr: %08lx    sp: %08lx   r12: %08lx\n",
 | |
| 	       regs->pc, regs->lr, regs->sp, regs->r12);
 | |
| 	printf("  r11: %08lx   r10: %08lx    r9: %08lx    r8: %08lx\n",
 | |
| 	       regs->r11, regs->r10, regs->r9, regs->r8);
 | |
| 	printf("   r7: %08lx    r6: %08lx    r5: %08lx    r4: %08lx\n",
 | |
| 	       regs->r7, regs->r6, regs->r5, regs->r4);
 | |
| 	printf("   r3: %08lx    r2: %08lx    r1: %08lx    r0: %08lx\n",
 | |
| 	       regs->r3, regs->r2, regs->r1, regs->r0);
 | |
| 	printf("Flags: %c%c%c%c%c\n",
 | |
| 	       regs->sr & SR_Q ? 'Q' : 'q',
 | |
| 	       regs->sr & SR_V ? 'V' : 'v',
 | |
| 	       regs->sr & SR_N ? 'N' : 'n',
 | |
| 	       regs->sr & SR_Z ? 'Z' : 'z',
 | |
| 	       regs->sr & SR_C ? 'C' : 'c');
 | |
| 	printf("Mode bits: %c%c%c%c%c%c%c%c%c\n",
 | |
| 	       regs->sr & SR_H ? 'H' : 'h',
 | |
| 	       regs->sr & SR_R ? 'R' : 'r',
 | |
| 	       regs->sr & SR_J ? 'J' : 'j',
 | |
| 	       regs->sr & SR_EM ? 'E' : 'e',
 | |
| 	       regs->sr & SR_I3M ? '3' : '.',
 | |
| 	       regs->sr & SR_I2M ? '2' : '.',
 | |
| 	       regs->sr & SR_I1M ? '1' : '.',
 | |
| 	       regs->sr & SR_I0M ? '0' : '.',
 | |
| 	       regs->sr & SR_GM ? 'G' : 'g');
 | |
| 	mode = (regs->sr >> SYSREG_M0_OFFSET) & 7;
 | |
| 	printf("CPU Mode: %s\n", cpu_modes[mode]);
 | |
| 
 | |
| 	/* Avoid exception loops */
 | |
| 	if (regs->sp < (gd->arch.stack_end - CONFIG_STACKSIZE)
 | |
| 			|| regs->sp >= gd->arch.stack_end)
 | |
| 		printf("\nStack pointer seems bogus, won't do stack dump\n");
 | |
| 	else
 | |
| 		dump_mem("\nStack: ", regs->sp, gd->arch.stack_end);
 | |
| 
 | |
| 	panic("Unhandled exception\n");
 | |
| }
 |