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