]>
git.proxmox.com Git - qemu.git/blob - target-cris/helper.c
2 * CRIS helper routines.
4 * Copyright (c) 2007 AXIS Communications AB
5 * Written by Edgar E. Iglesias.
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
23 #include "qemu/host-utils.h"
26 //#define CRIS_HELPER_DEBUG
29 #ifdef CRIS_HELPER_DEBUG
31 #define D_LOG(...) qemu_log(__VA_ARGS__)
34 #define D_LOG(...) do { } while (0)
37 #if defined(CONFIG_USER_ONLY)
39 void do_interrupt(CPUCRISState
*env
)
41 env
->exception_index
= -1;
42 env
->pregs
[PR_ERP
] = env
->pc
;
45 int cpu_cris_handle_mmu_fault(CPUCRISState
* env
, target_ulong address
, int rw
,
48 env
->exception_index
= 0xaa;
49 env
->pregs
[PR_EDA
] = address
;
50 cpu_dump_state(env
, stderr
, fprintf
, 0);
54 #else /* !CONFIG_USER_ONLY */
57 static void cris_shift_ccs(CPUCRISState
*env
)
60 /* Apply the ccs shift. */
61 ccs
= env
->pregs
[PR_CCS
];
62 ccs
= ((ccs
& 0xc0000000) | ((ccs
<< 12) >> 2)) & ~0x3ff;
63 env
->pregs
[PR_CCS
] = ccs
;
66 int cpu_cris_handle_mmu_fault(CPUCRISState
*env
, target_ulong address
, int rw
,
69 struct cris_mmu_result res
;
74 D(printf("%s addr=%x pc=%x rw=%x\n", __func__
, address
, env
->pc
, rw
));
75 miss
= cris_mmu_translate(&res
, env
, address
& TARGET_PAGE_MASK
,
78 if (env
->exception_index
== EXCP_BUSFAULT
) {
80 "CRIS: Illegal recursive bus fault."
85 env
->pregs
[PR_EDA
] = address
;
86 env
->exception_index
= EXCP_BUSFAULT
;
87 env
->fault_vector
= res
.bf_vec
;
91 * Mask off the cache selection bit. The ETRAX busses do not
94 phy
= res
.phy
& ~0x80000000;
96 tlb_set_page(env
, address
& TARGET_PAGE_MASK
, phy
,
97 prot
, mmu_idx
, TARGET_PAGE_SIZE
);
101 D_LOG("%s returns %d irqreq=%x addr=%x phy=%x vec=%x pc=%x\n",
102 __func__
, r
, env
->interrupt_request
, address
, res
.phy
,
103 res
.bf_vec
, env
->pc
);
108 static void do_interruptv10(CPUCRISState
*env
)
112 D_LOG("exception index=%d interrupt_req=%d\n",
113 env
->exception_index
,
114 env
->interrupt_request
);
116 assert(!(env
->pregs
[PR_CCS
] & PFIX_FLAG
));
117 switch (env
->exception_index
) {
119 /* These exceptions are genereated by the core itself.
120 ERP should point to the insn following the brk. */
121 ex_vec
= env
->trap_vector
;
122 env
->pregs
[PRV10_BRP
] = env
->pc
;
126 /* NMI is hardwired to vector zero. */
128 env
->pregs
[PR_CCS
] &= ~M_FLAG_V10
;
129 env
->pregs
[PRV10_BRP
] = env
->pc
;
133 cpu_abort(env
, "Unhandled busfault");
137 /* The interrupt controller gives us the vector. */
138 ex_vec
= env
->interrupt_vector
;
139 /* Normal interrupts are taken between
140 TB's. env->pc is valid here. */
141 env
->pregs
[PR_ERP
] = env
->pc
;
145 if (env
->pregs
[PR_CCS
] & U_FLAG
) {
146 /* Swap stack pointers. */
147 env
->pregs
[PR_USP
] = env
->regs
[R_SP
];
148 env
->regs
[R_SP
] = env
->ksp
;
151 /* Now that we are in kernel mode, load the handlers address. */
152 env
->pc
= cpu_ldl_code(env
, env
->pregs
[PR_EBP
] + ex_vec
* 4);
154 env
->pregs
[PR_CCS
] |= F_FLAG_V10
; /* set F. */
156 qemu_log_mask(CPU_LOG_INT
, "%s isr=%x vec=%x ccs=%x pid=%d erp=%x\n",
157 __func__
, env
->pc
, ex_vec
,
163 void do_interrupt(CPUCRISState
*env
)
167 if (env
->pregs
[PR_VR
] < 32) {
168 return do_interruptv10(env
);
171 D_LOG("exception index=%d interrupt_req=%d\n",
172 env
->exception_index
,
173 env
->interrupt_request
);
175 switch (env
->exception_index
) {
177 /* These exceptions are genereated by the core itself.
178 ERP should point to the insn following the brk. */
179 ex_vec
= env
->trap_vector
;
180 env
->pregs
[PR_ERP
] = env
->pc
;
184 /* NMI is hardwired to vector zero. */
186 env
->pregs
[PR_CCS
] &= ~M_FLAG_V32
;
187 env
->pregs
[PR_NRP
] = env
->pc
;
191 ex_vec
= env
->fault_vector
;
192 env
->pregs
[PR_ERP
] = env
->pc
;
196 /* The interrupt controller gives us the vector. */
197 ex_vec
= env
->interrupt_vector
;
198 /* Normal interrupts are taken between
199 TB's. env->pc is valid here. */
200 env
->pregs
[PR_ERP
] = env
->pc
;
204 /* Fill in the IDX field. */
205 env
->pregs
[PR_EXS
] = (ex_vec
& 0xff) << 8;
208 D_LOG("excp isr=%x PC=%x ds=%d SP=%x"
209 " ERP=%x pid=%x ccs=%x cc=%d %x\n",
210 ex_vec
, env
->pc
, env
->dslot
,
212 env
->pregs
[PR_ERP
], env
->pregs
[PR_PID
],
214 env
->cc_op
, env
->cc_mask
);
215 /* We loose the btarget, btaken state here so rexec the
217 env
->pregs
[PR_ERP
] -= env
->dslot
;
218 /* Exception starts with dslot cleared. */
222 if (env
->pregs
[PR_CCS
] & U_FLAG
) {
223 /* Swap stack pointers. */
224 env
->pregs
[PR_USP
] = env
->regs
[R_SP
];
225 env
->regs
[R_SP
] = env
->ksp
;
228 /* Apply the CRIS CCS shift. Clears U if set. */
231 /* Now that we are in kernel mode, load the handlers address.
232 This load may not fault, real hw leaves that behaviour as
234 env
->pc
= cpu_ldl_code(env
, env
->pregs
[PR_EBP
] + ex_vec
* 4);
236 /* Clear the excption_index to avoid spurios hw_aborts for recursive
238 env
->exception_index
= -1;
240 D_LOG("%s isr=%x vec=%x ccs=%x pid=%d erp=%x\n",
241 __func__
, env
->pc
, ex_vec
,
247 hwaddr
cpu_get_phys_page_debug(CPUCRISState
* env
, target_ulong addr
)
250 struct cris_mmu_result res
;
253 miss
= cris_mmu_translate(&res
, env
, addr
, 0, 0, 1);
254 /* If D TLB misses, try I TLB. */
256 miss
= cris_mmu_translate(&res
, env
, addr
, 2, 0, 1);
262 D(fprintf(stderr
, "%s %x -> %x\n", __func__
, addr
, phy
));