blob: 2f7fe6bc4e0411a01088a4104d0131c995916dc9 [file] [log] [blame]
pbrook06338792007-05-23 19:58:11 +00001/*
2 * M68K helper routines
ths5fafdf22007-09-16 21:08:06 +00003 *
pbrook06338792007-05-23 19:58:11 +00004 * Copyright (c) 2007 CodeSourcery
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
Blue Swirl8167ee82009-07-16 20:47:01 +000017 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
pbrook06338792007-05-23 19:58:11 +000018 */
Blue Swirl3e457172011-07-13 12:44:15 +000019#include "cpu.h"
20#include "dyngen-exec.h"
pbrooke1f38082008-05-24 22:29:16 +000021#include "helpers.h"
pbrook06338792007-05-23 19:58:11 +000022
23#if defined(CONFIG_USER_ONLY)
24
Blue Swirl3c688822011-05-21 07:55:24 +000025void do_interrupt(CPUState *env1)
pbrook06338792007-05-23 19:58:11 +000026{
Blue Swirl3c688822011-05-21 07:55:24 +000027 env1->exception_index = -1;
28}
29
30void do_interrupt_m68k_hardirq(CPUState *env1)
31{
pbrook06338792007-05-23 19:58:11 +000032}
33
34#else
35
pbrooka87295e2007-05-26 15:09:38 +000036extern int semihosting_enabled;
37
Blue Swirl3e457172011-07-13 12:44:15 +000038#include "softmmu_exec.h"
39
pbrook06338792007-05-23 19:58:11 +000040#define MMUSUFFIX _mmu
pbrook06338792007-05-23 19:58:11 +000041
42#define SHIFT 0
43#include "softmmu_template.h"
44
45#define SHIFT 1
46#include "softmmu_template.h"
47
48#define SHIFT 2
49#include "softmmu_template.h"
50
51#define SHIFT 3
52#include "softmmu_template.h"
53
54/* Try to fill the TLB and return an exception if error. If retaddr is
55 NULL, it means that the function was called in C code (i.e. not
56 from generated code or from helper.c) */
57/* XXX: fix it to restore all registers */
Blue Swirlbccd9ec2011-07-04 20:57:05 +000058void tlb_fill(CPUState *env1, target_ulong addr, int is_write, int mmu_idx,
59 void *retaddr)
pbrook06338792007-05-23 19:58:11 +000060{
61 TranslationBlock *tb;
62 CPUState *saved_env;
bellard44f86252007-11-11 12:35:55 +000063 unsigned long pc;
pbrook06338792007-05-23 19:58:11 +000064 int ret;
65
pbrook06338792007-05-23 19:58:11 +000066 saved_env = env;
Blue Swirlbccd9ec2011-07-04 20:57:05 +000067 env = env1;
Blue Swirl97b348e2011-08-01 16:12:17 +000068 ret = cpu_m68k_handle_mmu_fault(env, addr, is_write, mmu_idx);
ths551bd272008-07-03 17:57:36 +000069 if (unlikely(ret)) {
pbrook06338792007-05-23 19:58:11 +000070 if (retaddr) {
71 /* now we have a real cpu fault */
bellard44f86252007-11-11 12:35:55 +000072 pc = (unsigned long)retaddr;
pbrook06338792007-05-23 19:58:11 +000073 tb = tb_find_pc(pc);
74 if (tb) {
75 /* the PC is inside the translated code. It means that we have
76 a virtual CPU fault */
Stefan Weil618ba8e2011-04-18 06:39:53 +000077 cpu_restore_state(tb, env, pc);
pbrook06338792007-05-23 19:58:11 +000078 }
79 }
Blue Swirl1162c042011-05-14 12:52:35 +000080 cpu_loop_exit(env);
pbrook06338792007-05-23 19:58:11 +000081 }
82 env = saved_env;
83}
84
85static void do_rte(void)
86{
87 uint32_t sp;
88 uint32_t fmt;
89
90 sp = env->aregs[7];
91 fmt = ldl_kernel(sp);
92 env->pc = ldl_kernel(sp + 4);
93 sp |= (fmt >> 28) & 3;
94 env->sr = fmt & 0xffff;
pbrook20dcee92007-06-03 11:13:39 +000095 m68k_switch_sp(env);
pbrook06338792007-05-23 19:58:11 +000096 env->aregs[7] = sp + 8;
97}
98
Blue Swirl3c688822011-05-21 07:55:24 +000099static void do_interrupt_all(int is_hw)
pbrook06338792007-05-23 19:58:11 +0000100{
101 uint32_t sp;
102 uint32_t fmt;
103 uint32_t retaddr;
104 uint32_t vector;
105
106 fmt = 0;
107 retaddr = env->pc;
108
109 if (!is_hw) {
110 switch (env->exception_index) {
111 case EXCP_RTE:
112 /* Return from an exception. */
113 do_rte();
114 return;
pbrooka87295e2007-05-26 15:09:38 +0000115 case EXCP_HALT_INSN:
116 if (semihosting_enabled
117 && (env->sr & SR_S) != 0
118 && (env->pc & 3) == 0
119 && lduw_code(env->pc - 4) == 0x4e71
120 && ldl_code(env->pc) == 0x4e7bf000) {
121 env->pc += 4;
122 do_m68k_semihosting(env, env->dregs[0]);
123 return;
124 }
125 env->halted = 1;
126 env->exception_index = EXCP_HLT;
Blue Swirl1162c042011-05-14 12:52:35 +0000127 cpu_loop_exit(env);
pbrooka87295e2007-05-26 15:09:38 +0000128 return;
pbrook06338792007-05-23 19:58:11 +0000129 }
130 if (env->exception_index >= EXCP_TRAP0
131 && env->exception_index <= EXCP_TRAP15) {
132 /* Move the PC after the trap instruction. */
133 retaddr += 2;
134 }
135 }
136
pbrook06338792007-05-23 19:58:11 +0000137 vector = env->exception_index << 2;
138
pbrook0cf5c672007-06-09 20:48:46 +0000139 sp = env->aregs[7];
140
pbrook06338792007-05-23 19:58:11 +0000141 fmt |= 0x40000000;
142 fmt |= (sp & 3) << 28;
143 fmt |= vector << 16;
144 fmt |= env->sr;
145
pbrook20dcee92007-06-03 11:13:39 +0000146 env->sr |= SR_S;
147 if (is_hw) {
148 env->sr = (env->sr & ~SR_I) | (env->pending_level << SR_I_SHIFT);
149 env->sr &= ~SR_M;
150 }
151 m68k_switch_sp(env);
152
pbrook06338792007-05-23 19:58:11 +0000153 /* ??? This could cause MMU faults. */
154 sp &= ~3;
155 sp -= 4;
156 stl_kernel(sp, retaddr);
157 sp -= 4;
158 stl_kernel(sp, fmt);
159 env->aregs[7] = sp;
pbrook06338792007-05-23 19:58:11 +0000160 /* Jump to vector. */
161 env->pc = ldl_kernel(env->vbr + vector);
162}
163
Blue Swirl3c688822011-05-21 07:55:24 +0000164void do_interrupt(CPUState *env1)
165{
166 CPUState *saved_env;
167
168 saved_env = env;
169 env = env1;
170 do_interrupt_all(0);
171 env = saved_env;
172}
173
174void do_interrupt_m68k_hardirq(CPUState *env1)
175{
176 CPUState *saved_env;
177
178 saved_env = env;
179 env = env1;
180 do_interrupt_all(1);
181 env = saved_env;
182}
pbrook06338792007-05-23 19:58:11 +0000183#endif
pbrooke1f38082008-05-24 22:29:16 +0000184
185static void raise_exception(int tt)
186{
187 env->exception_index = tt;
Blue Swirl1162c042011-05-14 12:52:35 +0000188 cpu_loop_exit(env);
pbrooke1f38082008-05-24 22:29:16 +0000189}
190
191void HELPER(raise_exception)(uint32_t tt)
192{
193 raise_exception(tt);
194}
195
196void HELPER(divu)(CPUState *env, uint32_t word)
197{
198 uint32_t num;
199 uint32_t den;
200 uint32_t quot;
201 uint32_t rem;
202 uint32_t flags;
203
204 num = env->div1;
205 den = env->div2;
206 /* ??? This needs to make sure the throwing location is accurate. */
207 if (den == 0)
208 raise_exception(EXCP_DIV0);
209 quot = num / den;
210 rem = num % den;
211 flags = 0;
212 /* Avoid using a PARAM1 of zero. This breaks dyngen because it uses
213 the address of a symbol, and gcc knows symbols can't have address
214 zero. */
215 if (word && quot > 0xffff)
216 flags |= CCF_V;
217 if (quot == 0)
218 flags |= CCF_Z;
219 else if ((int32_t)quot < 0)
220 flags |= CCF_N;
221 env->div1 = quot;
222 env->div2 = rem;
223 env->cc_dest = flags;
224}
225
226void HELPER(divs)(CPUState *env, uint32_t word)
227{
228 int32_t num;
229 int32_t den;
230 int32_t quot;
231 int32_t rem;
232 int32_t flags;
233
234 num = env->div1;
235 den = env->div2;
236 if (den == 0)
237 raise_exception(EXCP_DIV0);
238 quot = num / den;
239 rem = num % den;
240 flags = 0;
241 if (word && quot != (int16_t)quot)
242 flags |= CCF_V;
243 if (quot == 0)
244 flags |= CCF_Z;
245 else if (quot < 0)
246 flags |= CCF_N;
247 env->div1 = quot;
248 env->div2 = rem;
249 env->cc_dest = flags;
250}