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 * See file CREDITS for list of people who contributed to this 11 * project. 12 * 13 * This program is free software; you can redistribute it and/or 14 * modify it under the terms of the GNU General Public License as 15 * published by the Free Software Foundation; either version 2 of 16 * the License, or (at your option) any later version. 17 * 18 * This program is distributed in the hope that it will be useful, 19 * but WITHOUT ANY WARRANTY; without even the implied warranty of 20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 21 * GNU General Public License for more details. 22 * 23 * You should have received a copy of the GNU General Public License 24 * along with this program; if not, write to the Free Software 25 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 26 * MA 02111-1307 USA 27 */ 28 29 #include <common.h> 30 #include <asm/ptrace.h> 31 #include <asm/system.h> 32 #undef INTERRUPT_MODE 33 34 static int int_flag; 35 36 int irq_flags; /* needed by asm-nds32/system.h */ 37 38 int GIE_STATUS(void) 39 { 40 int ret; 41 42 __asm__ __volatile__ ( 43 "mfsr $p0, $psw\n\t" 44 "andi %0, %0, 0x1\n\t" 45 : "=r" (ret) 46 : 47 : "memory" 48 ); 49 return ret; 50 } 51 52 #ifdef CONFIG_USE_INTERRUPT 53 54 /* enable interrupts */ 55 void enable_interrupts(void) 56 { 57 local_irq_restore(int_flag); 58 } 59 60 /* 61 * disable interrupts 62 * Return TRUE if GIE is enabled before we disable it. 63 */ 64 int disable_interrupts(void) 65 { 66 67 int gie_ori_status; 68 69 gie_ori_status = GIE_STATUS(); 70 71 local_irq_save(int_flag); 72 73 return gie_ori_status; 74 } 75 #endif 76 77 void bad_mode(void) 78 { 79 panic("Resetting CPU ...\n"); 80 reset_cpu(0); 81 } 82 83 void show_regs(struct pt_regs *regs) 84 { 85 const char *processor_modes[] = {"USER", "SuperUser" , "HyperVisor"}; 86 87 printf("\n"); 88 printf("pc : [<%08lx>] sp: [<%08lx>]\n" 89 "lp : %08lx gp : %08lx fp : %08lx\n", 90 regs->ipc, regs->sp, regs->lp, regs->gp, regs->fp); 91 printf("D1H: %08lx D1L: %08lx D0H: %08lx D0L: %08lx\n", 92 regs->d1hi, regs->d1lo, regs->d0hi, regs->d0lo); 93 printf("r27: %08lx r26: %08lx r25: %08lx r24: %08lx\n", 94 regs->r[27], regs->r[26], regs->r[25], regs->r[24]); 95 printf("r23: %08lx r22: %08lx r21: %08lx r20: %08lx\n", 96 regs->r[23], regs->r[22], regs->r[21], regs->r[20]); 97 printf("r19: %08lx r18: %08lx r17: %08lx r16: %08lx\n", 98 regs->r[19], regs->r[18], regs->r[17], regs->r[16]); 99 printf("r15: %08lx r14: %08lx r13: %08lx r12: %08lx\n", 100 regs->r[15], regs->r[14], regs->r[13], regs->r[12]); 101 printf("r11: %08lx r10: %08lx r9 : %08lx r8 : %08lx\n", 102 regs->r[11], regs->r[10], regs->r[9], regs->r[8]); 103 printf("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n", 104 regs->r[7], regs->r[6], regs->r[5], regs->r[4]); 105 printf("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n", 106 regs->r[3], regs->r[2], regs->r[1], regs->r[0]); 107 printf(" Interrupts %s Mode %s\n", 108 interrupts_enabled(regs) ? "on" : "off", 109 processor_modes[processor_mode(regs)]); 110 } 111 112 void do_interruption(struct pt_regs *pt_regs, int EVIC_num) 113 { 114 const char *interruption_type[] = { 115 "Reset", 116 "TLB Fill", 117 "TLB Not Present", 118 "TLB Misc", 119 "VLPT Miss", 120 "Cache Parity Error", 121 "Debug", 122 "General Exception", 123 "External Interrupt" 124 }; 125 126 printf("%s\n", interruption_type[EVIC_num]); 127 show_regs(pt_regs); 128 bad_mode(); 129 } 130