1 /* 2 * (C) Copyright 2002 3 * Sysgo Real-Time Solutions, GmbH <www.elinos.com> 4 * Alex Zuepke <azu@sysgo.de> 5 * 6 * Copyright (C) 2011 Andes Technology Corporation 7 * Shawn Lin, Andes Technology Corporation <nobuhiro@andestech.com> 8 * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com> 9 * 10 * SPDX-License-Identifier: GPL-2.0+ 11 */ 12 13 #include <common.h> 14 #include <asm/ptrace.h> 15 #include <asm/system.h> 16 #undef INTERRUPT_MODE 17 18 static int int_flag; 19 20 int irq_flags; /* needed by asm-nds32/system.h */ 21 22 int GIE_STATUS(void) 23 { 24 int ret; 25 26 __asm__ __volatile__ ( 27 "mfsr $p0, $psw\n\t" 28 "andi %0, %0, 0x1\n\t" 29 : "=r" (ret) 30 : 31 : "memory" 32 ); 33 return ret; 34 } 35 36 #ifdef CONFIG_USE_INTERRUPT 37 38 int interrupt_init(void) 39 { 40 return 0; 41 } 42 /* enable interrupts */ 43 void enable_interrupts(void) 44 { 45 local_irq_restore(int_flag); 46 } 47 48 /* 49 * disable interrupts 50 * Return true if GIE is enabled before we disable it. 51 */ 52 int disable_interrupts(void) 53 { 54 55 int gie_ori_status; 56 57 gie_ori_status = GIE_STATUS(); 58 59 local_irq_save(int_flag); 60 61 return gie_ori_status; 62 } 63 #endif 64 65 void bad_mode(void) 66 { 67 panic("Resetting CPU ...\n"); 68 reset_cpu(0); 69 } 70 71 void show_regs(struct pt_regs *regs) 72 { 73 const char *processor_modes[] = {"USER", "SuperUser" , "HyperVisor"}; 74 75 printf("\n"); 76 printf("pc : [<%08lx>] sp: [<%08lx>]\n" 77 "lp : %08lx gp : %08lx fp : %08lx\n", 78 regs->ipc, regs->sp, regs->lp, regs->gp, regs->fp); 79 printf("D1H: %08lx D1L: %08lx D0H: %08lx D0L: %08lx\n", 80 regs->d1hi, regs->d1lo, regs->d0hi, regs->d0lo); 81 printf("r27: %08lx r26: %08lx r25: %08lx r24: %08lx\n", 82 regs->p1, regs->p0, regs->r[25], regs->r[24]); 83 printf("r23: %08lx r22: %08lx r21: %08lx r20: %08lx\n", 84 regs->r[23], regs->r[22], regs->r[21], regs->r[20]); 85 printf("r19: %08lx r18: %08lx r17: %08lx r16: %08lx\n", 86 regs->r[19], regs->r[18], regs->r[17], regs->r[16]); 87 printf("r15: %08lx r14: %08lx r13: %08lx r12: %08lx\n", 88 regs->r[15], regs->r[14], regs->r[13], regs->r[12]); 89 printf("r11: %08lx r10: %08lx r9 : %08lx r8 : %08lx\n", 90 regs->r[11], regs->r[10], regs->r[9], regs->r[8]); 91 printf("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n", 92 regs->r[7], regs->r[6], regs->r[5], regs->r[4]); 93 printf("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n", 94 regs->r[3], regs->r[2], regs->r[1], regs->r[0]); 95 printf(" Interrupts %s Mode %s\n", 96 interrupts_enabled(regs) ? "on" : "off", 97 processor_modes[processor_mode(regs)]); 98 } 99 100 void do_interruption(struct pt_regs *pt_regs, int EVIC_num) 101 { 102 const char *interruption_type[] = { 103 "Reset", 104 "TLB Fill", 105 "TLB Not Present", 106 "TLB Misc", 107 "VLPT Miss", 108 "Cache Parity Error", 109 "Debug", 110 "General Exception", 111 "External Interrupt" 112 }; 113 114 printf("%s\n", interruption_type[EVIC_num]); 115 show_regs(pt_regs); 116 bad_mode(); 117 } 118