1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "qemu/osdep.h"
21#include "qemu/log.h"
22#include "cpu.h"
23#include "exec/exec-all.h"
24#include "gdbstub/helpers.h"
25#include "qemu/host-utils.h"
26#ifndef CONFIG_USER_ONLY
27#include "hw/loader.h"
28#endif
29
30void openrisc_cpu_do_interrupt(CPUState *cs)
31{
32 OpenRISCCPU *cpu = OPENRISC_CPU(cs);
33 CPUOpenRISCState *env = &cpu->env;
34 int exception = cs->exception_index;
35
36 env->epcr = env->pc;
37 if (exception == EXCP_SYSCALL) {
38 env->epcr += 4;
39 }
40
41
42 if (exception == EXCP_ILLEGAL) {
43 env->eear = env->pc;
44 }
45
46
47 env->esr = cpu_get_sr(env);
48
49
50 env->sr &= ~SR_DME;
51 env->sr &= ~SR_IME;
52 env->sr |= SR_SM;
53 env->sr &= ~SR_IEE;
54 env->sr &= ~SR_TEE;
55 env->pmr &= ~PMR_DME;
56 env->pmr &= ~PMR_SME;
57 env->lock_addr = -1;
58
59
60 if (env->dflag) {
61 env->dflag = 0;
62 env->sr |= SR_DSX;
63 env->epcr -= 4;
64 } else {
65 env->sr &= ~SR_DSX;
66 }
67
68 if (exception > 0 && exception < EXCP_NR) {
69 static const char * const int_name[EXCP_NR] = {
70 [EXCP_RESET] = "RESET",
71 [EXCP_BUSERR] = "BUSERR (bus error)",
72 [EXCP_DPF] = "DFP (data protection fault)",
73 [EXCP_IPF] = "IPF (code protection fault)",
74 [EXCP_TICK] = "TICK (timer interrupt)",
75 [EXCP_ALIGN] = "ALIGN",
76 [EXCP_ILLEGAL] = "ILLEGAL",
77 [EXCP_INT] = "INT (device interrupt)",
78 [EXCP_DTLBMISS] = "DTLBMISS (data tlb miss)",
79 [EXCP_ITLBMISS] = "ITLBMISS (code tlb miss)",
80 [EXCP_RANGE] = "RANGE",
81 [EXCP_SYSCALL] = "SYSCALL",
82 [EXCP_FPE] = "FPE",
83 [EXCP_TRAP] = "TRAP",
84 };
85
86 qemu_log_mask(CPU_LOG_INT, "CPU: %d INT: %s\n",
87 cs->cpu_index,
88 int_name[exception]);
89
90 hwaddr vect_pc = exception << 8;
91 if (env->cpucfgr & CPUCFGR_EVBARP) {
92 vect_pc |= env->evbar;
93 }
94 if (env->sr & SR_EPH) {
95 vect_pc |= 0xf0000000;
96 }
97 env->pc = vect_pc;
98 } else {
99 cpu_abort(cs, "Unhandled exception 0x%x\n", exception);
100 }
101
102 cs->exception_index = -1;
103}
104
105bool openrisc_cpu_exec_interrupt(CPUState *cs, int interrupt_request)
106{
107 OpenRISCCPU *cpu = OPENRISC_CPU(cs);
108 CPUOpenRISCState *env = &cpu->env;
109 int idx = -1;
110
111 if ((interrupt_request & CPU_INTERRUPT_HARD) && (env->sr & SR_IEE)) {
112 idx = EXCP_INT;
113 }
114 if ((interrupt_request & CPU_INTERRUPT_TIMER) && (env->sr & SR_TEE)) {
115 idx = EXCP_TICK;
116 }
117 if (idx >= 0) {
118 cs->exception_index = idx;
119 openrisc_cpu_do_interrupt(cs);
120 return true;
121 }
122 return false;
123}
124