Revision | 091210480270103f218218c1947460b03e30abe6 (tree) |
---|---|
Time | 2020-01-23 21:44:18 |
Author | Yoshinori Sato <ysato@user...> |
Commiter | Yoshinori Sato |
target/rx: TCG helper
Signed-off-by: Yoshinori Sato <ysato@users.sourceforge.jp>
Message-Id: <20190616142836.10614-3-ysato@users.sourceforge.jp>
Reviewed-by: Richard Henderson <richard.henderson@linaro.org>
Message-Id: <20190607091116.49044-3-ysato@users.sourceforge.jp>
Tested-by: Philippe Mathieu-Daudé <philmd@redhat.com>
Signed-off-by: Richard Henderson <richard.henderson@linaro.org>
[PMD: Removed tlb_fill, extracted from patch of Yoshinori Sato
Signed-off-by: Philippe Mathieu-Daudé <philmd@redhat.com>
@@ -0,0 +1,149 @@ | ||
1 | +/* | |
2 | + * RX emulation | |
3 | + * | |
4 | + * Copyright (c) 2019 Yoshinori Sato | |
5 | + * | |
6 | + * This program is free software; you can redistribute it and/or modify it | |
7 | + * under the terms and conditions of the GNU General Public License, | |
8 | + * version 2 or later, as published by the Free Software Foundation. | |
9 | + * | |
10 | + * This program is distributed in the hope it will be useful, but WITHOUT | |
11 | + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
12 | + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
13 | + * more details. | |
14 | + * | |
15 | + * You should have received a copy of the GNU General Public License along with | |
16 | + * this program. If not, see <http://www.gnu.org/licenses/>. | |
17 | + */ | |
18 | + | |
19 | +#include "qemu/osdep.h" | |
20 | +#include "qemu/bitops.h" | |
21 | +#include "cpu.h" | |
22 | +#include "exec/log.h" | |
23 | +#include "exec/cpu_ldst.h" | |
24 | +#include "sysemu/sysemu.h" | |
25 | +#include "hw/irq.h" | |
26 | + | |
27 | +void rx_cpu_unpack_psw(CPURXState *env, uint32_t psw, int rte) | |
28 | +{ | |
29 | + if (env->psw_pm == 0) { | |
30 | + env->psw_ipl = FIELD_EX32(psw, PSW, IPL); | |
31 | + if (rte) { | |
32 | + /* PSW.PM can write RTE and RTFI */ | |
33 | + env->psw_pm = FIELD_EX32(psw, PSW, PM); | |
34 | + } | |
35 | + env->psw_u = FIELD_EX32(psw, PSW, U); | |
36 | + env->psw_i = FIELD_EX32(psw, PSW, I); | |
37 | + } | |
38 | + env->psw_o = FIELD_EX32(psw, PSW, O) << 31; | |
39 | + env->psw_s = FIELD_EX32(psw, PSW, S) << 31; | |
40 | + env->psw_z = 1 - FIELD_EX32(psw, PSW, Z); | |
41 | + env->psw_c = FIELD_EX32(psw, PSW, C); | |
42 | +} | |
43 | + | |
44 | +#define INT_FLAGS (CPU_INTERRUPT_HARD | CPU_INTERRUPT_FIR) | |
45 | +void rx_cpu_do_interrupt(CPUState *cs) | |
46 | +{ | |
47 | + RXCPU *cpu = RXCPU(cs); | |
48 | + CPURXState *env = &cpu->env; | |
49 | + int do_irq = cs->interrupt_request & INT_FLAGS; | |
50 | + uint32_t save_psw; | |
51 | + | |
52 | + env->in_sleep = 0; | |
53 | + | |
54 | + if (env->psw_u) { | |
55 | + env->usp = env->regs[0]; | |
56 | + } else { | |
57 | + env->isp = env->regs[0]; | |
58 | + } | |
59 | + save_psw = rx_cpu_pack_psw(env); | |
60 | + env->psw_pm = env->psw_i = env->psw_u = 0; | |
61 | + | |
62 | + if (do_irq) { | |
63 | + if (do_irq & CPU_INTERRUPT_FIR) { | |
64 | + env->bpc = env->pc; | |
65 | + env->bpsw = save_psw; | |
66 | + env->pc = env->fintv; | |
67 | + env->psw_ipl = 15; | |
68 | + cs->interrupt_request &= ~CPU_INTERRUPT_FIR; | |
69 | + qemu_set_irq(env->ack, env->ack_irq); | |
70 | + qemu_log_mask(CPU_LOG_INT, "fast interrupt raised\n"); | |
71 | + } else if (do_irq & CPU_INTERRUPT_HARD) { | |
72 | + env->isp -= 4; | |
73 | + cpu_stl_data(env, env->isp, save_psw); | |
74 | + env->isp -= 4; | |
75 | + cpu_stl_data(env, env->isp, env->pc); | |
76 | + env->pc = cpu_ldl_data(env, env->intb + env->ack_irq * 4); | |
77 | + env->psw_ipl = env->ack_ipl; | |
78 | + cs->interrupt_request &= ~CPU_INTERRUPT_HARD; | |
79 | + qemu_set_irq(env->ack, env->ack_irq); | |
80 | + qemu_log_mask(CPU_LOG_INT, | |
81 | + "interrupt 0x%02x raised\n", env->ack_irq); | |
82 | + } | |
83 | + } else { | |
84 | + uint32_t vec = cs->exception_index; | |
85 | + const char *expname = "unknown exception"; | |
86 | + | |
87 | + env->isp -= 4; | |
88 | + cpu_stl_data(env, env->isp, save_psw); | |
89 | + env->isp -= 4; | |
90 | + cpu_stl_data(env, env->isp, env->pc); | |
91 | + | |
92 | + if (vec < 0x100) { | |
93 | + env->pc = cpu_ldl_data(env, 0xffffffc0 + vec * 4); | |
94 | + } else { | |
95 | + env->pc = cpu_ldl_data(env, env->intb + (vec & 0xff) * 4); | |
96 | + } | |
97 | + switch (vec) { | |
98 | + case 20: | |
99 | + expname = "privilege violation"; | |
100 | + break; | |
101 | + case 21: | |
102 | + expname = "access exception"; | |
103 | + break; | |
104 | + case 23: | |
105 | + expname = "illegal instruction"; | |
106 | + break; | |
107 | + case 25: | |
108 | + expname = "fpu exception"; | |
109 | + break; | |
110 | + case 30: | |
111 | + expname = "non-maskable interrupt"; | |
112 | + break; | |
113 | + case 0x100 ... 0x1ff: | |
114 | + expname = "unconditional trap"; | |
115 | + } | |
116 | + qemu_log_mask(CPU_LOG_INT, "exception 0x%02x [%s] raised\n", | |
117 | + (vec & 0xff), expname); | |
118 | + } | |
119 | + env->regs[0] = env->isp; | |
120 | +} | |
121 | + | |
122 | +bool rx_cpu_exec_interrupt(CPUState *cs, int interrupt_request) | |
123 | +{ | |
124 | + RXCPU *cpu = RXCPU(cs); | |
125 | + CPURXState *env = &cpu->env; | |
126 | + int accept = 0; | |
127 | + /* hardware interrupt (Normal) */ | |
128 | + if ((interrupt_request & CPU_INTERRUPT_HARD) && | |
129 | + env->psw_i && (env->psw_ipl < env->req_ipl)) { | |
130 | + env->ack_irq = env->req_irq; | |
131 | + env->ack_ipl = env->req_ipl; | |
132 | + accept = 1; | |
133 | + } | |
134 | + /* hardware interrupt (FIR) */ | |
135 | + if ((interrupt_request & CPU_INTERRUPT_FIR) && | |
136 | + env->psw_i && (env->psw_ipl < 15)) { | |
137 | + accept = 1; | |
138 | + } | |
139 | + if (accept) { | |
140 | + rx_cpu_do_interrupt(cs); | |
141 | + return true; | |
142 | + } | |
143 | + return false; | |
144 | +} | |
145 | + | |
146 | +hwaddr rx_cpu_get_phys_page_debug(CPUState *cs, vaddr addr) | |
147 | +{ | |
148 | + return addr; | |
149 | +} |
@@ -0,0 +1,31 @@ | ||
1 | +DEF_HELPER_1(raise_illegal_instruction, noreturn, env) | |
2 | +DEF_HELPER_1(raise_access_fault, noreturn, env) | |
3 | +DEF_HELPER_1(raise_privilege_violation, noreturn, env) | |
4 | +DEF_HELPER_1(wait, noreturn, env) | |
5 | +DEF_HELPER_1(debug, noreturn, env) | |
6 | +DEF_HELPER_2(rxint, noreturn, env, i32) | |
7 | +DEF_HELPER_1(rxbrk, noreturn, env) | |
8 | +DEF_HELPER_FLAGS_3(fadd, TCG_CALL_NO_WG, f32, env, f32, f32) | |
9 | +DEF_HELPER_FLAGS_3(fsub, TCG_CALL_NO_WG, f32, env, f32, f32) | |
10 | +DEF_HELPER_FLAGS_3(fmul, TCG_CALL_NO_WG, f32, env, f32, f32) | |
11 | +DEF_HELPER_FLAGS_3(fdiv, TCG_CALL_NO_WG, f32, env, f32, f32) | |
12 | +DEF_HELPER_FLAGS_3(fcmp, TCG_CALL_NO_WG, void, env, f32, f32) | |
13 | +DEF_HELPER_FLAGS_2(ftoi, TCG_CALL_NO_WG, i32, env, f32) | |
14 | +DEF_HELPER_FLAGS_2(round, TCG_CALL_NO_WG, i32, env, f32) | |
15 | +DEF_HELPER_FLAGS_2(itof, TCG_CALL_NO_WG, f32, env, i32) | |
16 | +DEF_HELPER_2(set_fpsw, void, env, i32) | |
17 | +DEF_HELPER_FLAGS_2(racw, TCG_CALL_NO_WG, void, env, i32) | |
18 | +DEF_HELPER_FLAGS_2(set_psw_rte, TCG_CALL_NO_WG, void, env, i32) | |
19 | +DEF_HELPER_FLAGS_2(set_psw, TCG_CALL_NO_WG, void, env, i32) | |
20 | +DEF_HELPER_1(pack_psw, i32, env) | |
21 | +DEF_HELPER_FLAGS_3(div, TCG_CALL_NO_WG, i32, env, i32, i32) | |
22 | +DEF_HELPER_FLAGS_3(divu, TCG_CALL_NO_WG, i32, env, i32, i32) | |
23 | +DEF_HELPER_FLAGS_1(scmpu, TCG_CALL_NO_WG, void, env) | |
24 | +DEF_HELPER_1(smovu, void, env) | |
25 | +DEF_HELPER_1(smovf, void, env) | |
26 | +DEF_HELPER_1(smovb, void, env) | |
27 | +DEF_HELPER_2(sstr, void, env, i32) | |
28 | +DEF_HELPER_FLAGS_2(swhile, TCG_CALL_NO_WG, void, env, i32) | |
29 | +DEF_HELPER_FLAGS_2(suntil, TCG_CALL_NO_WG, void, env, i32) | |
30 | +DEF_HELPER_FLAGS_2(rmpa, TCG_CALL_NO_WG, void, env, i32) | |
31 | +DEF_HELPER_1(satr, void, env) |
@@ -0,0 +1,470 @@ | ||
1 | +/* | |
2 | + * RX helper functions | |
3 | + * | |
4 | + * Copyright (c) 2019 Yoshinori Sato | |
5 | + * | |
6 | + * This program is free software; you can redistribute it and/or modify it | |
7 | + * under the terms and conditions of the GNU General Public License, | |
8 | + * version 2 or later, as published by the Free Software Foundation. | |
9 | + * | |
10 | + * This program is distributed in the hope it will be useful, but WITHOUT | |
11 | + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
12 | + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
13 | + * more details. | |
14 | + * | |
15 | + * You should have received a copy of the GNU General Public License along with | |
16 | + * this program. If not, see <http://www.gnu.org/licenses/>. | |
17 | + */ | |
18 | + | |
19 | +#include "qemu/osdep.h" | |
20 | +#include "qemu/bitops.h" | |
21 | +#include "cpu.h" | |
22 | +#include "exec/exec-all.h" | |
23 | +#include "exec/helper-proto.h" | |
24 | +#include "exec/cpu_ldst.h" | |
25 | +#include "fpu/softfloat.h" | |
26 | + | |
27 | +static inline void QEMU_NORETURN raise_exception(CPURXState *env, int index, | |
28 | + uintptr_t retaddr); | |
29 | + | |
30 | +static void _set_psw(CPURXState *env, uint32_t psw, uint32_t rte) | |
31 | +{ | |
32 | + uint32_t prev_u; | |
33 | + prev_u = env->psw_u; | |
34 | + rx_cpu_unpack_psw(env, psw, rte); | |
35 | + if (prev_u != env->psw_u) { | |
36 | + /* switch r0 */ | |
37 | + if (env->psw_u) { | |
38 | + env->isp = env->regs[0]; | |
39 | + env->regs[0] = env->usp; | |
40 | + } else { | |
41 | + env->usp = env->regs[0]; | |
42 | + env->regs[0] = env->isp; | |
43 | + } | |
44 | + } | |
45 | +} | |
46 | + | |
47 | +void helper_set_psw(CPURXState *env, uint32_t psw) | |
48 | +{ | |
49 | + _set_psw(env, psw, 0); | |
50 | +} | |
51 | + | |
52 | +void helper_set_psw_rte(CPURXState *env, uint32_t psw) | |
53 | +{ | |
54 | + _set_psw(env, psw, 1); | |
55 | +} | |
56 | + | |
57 | +uint32_t helper_pack_psw(CPURXState *env) | |
58 | +{ | |
59 | + return rx_cpu_pack_psw(env); | |
60 | +} | |
61 | + | |
62 | +#define SET_FPSW(b) \ | |
63 | + do { \ | |
64 | + env->fpsw = FIELD_DP32(env->fpsw, FPSW, C ## b, 1); \ | |
65 | + if (!FIELD_EX32(env->fpsw, FPSW, E ## b)) { \ | |
66 | + env->fpsw = FIELD_DP32(env->fpsw, FPSW, F ## b, 1); \ | |
67 | + } \ | |
68 | + } while (0) | |
69 | + | |
70 | +/* fp operations */ | |
71 | +static void update_fpsw(CPURXState *env, float32 ret, uintptr_t retaddr) | |
72 | +{ | |
73 | + int xcpt, cause, enable; | |
74 | + | |
75 | + env->psw_z = ret & ~(1 << 31); /* mask sign bit */ | |
76 | + env->psw_s = ret; | |
77 | + | |
78 | + xcpt = get_float_exception_flags(&env->fp_status); | |
79 | + | |
80 | + /* Clear the cause entries */ | |
81 | + env->fpsw = FIELD_DP32(env->fpsw, FPSW, CAUSE, 0); | |
82 | + | |
83 | + /* set FPSW */ | |
84 | + if (unlikely(xcpt)) { | |
85 | + if (xcpt & float_flag_invalid) { | |
86 | + SET_FPSW(V); | |
87 | + } | |
88 | + if (xcpt & float_flag_divbyzero) { | |
89 | + SET_FPSW(Z); | |
90 | + } | |
91 | + if (xcpt & float_flag_overflow) { | |
92 | + SET_FPSW(O); | |
93 | + } | |
94 | + if (xcpt & float_flag_underflow) { | |
95 | + SET_FPSW(U); | |
96 | + } | |
97 | + if (xcpt & float_flag_inexact) { | |
98 | + SET_FPSW(X); | |
99 | + } | |
100 | + if ((xcpt & (float_flag_input_denormal | |
101 | + | float_flag_output_denormal)) | |
102 | + && !FIELD_EX32(env->fpsw, FPSW, DN)) { | |
103 | + env->fpsw = FIELD_DP32(env->fpsw, FPSW, CE, 1); | |
104 | + } | |
105 | + | |
106 | + /* update FPSW_FLAG_S */ | |
107 | + if (FIELD_EX32(env->fpsw, FPSW, FLAGS) != 0) { | |
108 | + env->fpsw = FIELD_DP32(env->fpsw, FPSW, FS, 1); | |
109 | + } | |
110 | + | |
111 | + /* Generate an exception if enabled */ | |
112 | + cause = FIELD_EX32(env->fpsw, FPSW, CAUSE); | |
113 | + enable = FIELD_EX32(env->fpsw, FPSW, ENABLE); | |
114 | + enable |= 1 << 5; /* CE always enabled */ | |
115 | + if (cause & enable) { | |
116 | + raise_exception(env, 21, retaddr); | |
117 | + } | |
118 | + } | |
119 | +} | |
120 | + | |
121 | +void helper_set_fpsw(CPURXState *env, uint32_t val) | |
122 | +{ | |
123 | + static const int roundmode[] = { | |
124 | + float_round_nearest_even, | |
125 | + float_round_to_zero, | |
126 | + float_round_up, | |
127 | + float_round_down, | |
128 | + }; | |
129 | + uint32_t fpsw = env->fpsw; | |
130 | + fpsw |= 0x7fffff03; | |
131 | + val &= ~0x80000000; | |
132 | + fpsw &= val; | |
133 | + FIELD_DP32(fpsw, FPSW, FS, FIELD_EX32(fpsw, FPSW, FLAGS) != 0); | |
134 | + env->fpsw = fpsw; | |
135 | + set_float_rounding_mode(roundmode[FIELD_EX32(env->fpsw, FPSW, RM)], | |
136 | + &env->fp_status); | |
137 | +} | |
138 | + | |
139 | +#define FLOATOP(op, func) \ | |
140 | + float32 helper_##op(CPURXState *env, float32 t0, float32 t1) \ | |
141 | + { \ | |
142 | + float32 ret; \ | |
143 | + ret = func(t0, t1, &env->fp_status); \ | |
144 | + update_fpsw(env, *(uint32_t *)&ret, GETPC()); \ | |
145 | + return ret; \ | |
146 | + } | |
147 | + | |
148 | +FLOATOP(fadd, float32_add) | |
149 | +FLOATOP(fsub, float32_sub) | |
150 | +FLOATOP(fmul, float32_mul) | |
151 | +FLOATOP(fdiv, float32_div) | |
152 | + | |
153 | +void helper_fcmp(CPURXState *env, float32 t0, float32 t1) | |
154 | +{ | |
155 | + int st; | |
156 | + st = float32_compare(t0, t1, &env->fp_status); | |
157 | + update_fpsw(env, 0, GETPC()); | |
158 | + env->psw_z = 1; | |
159 | + env->psw_s = env->psw_o = 0; | |
160 | + switch (st) { | |
161 | + case float_relation_equal: | |
162 | + env->psw_z = 0; | |
163 | + break; | |
164 | + case float_relation_less: | |
165 | + env->psw_s = -1; | |
166 | + break; | |
167 | + case float_relation_unordered: | |
168 | + env->psw_o = -1; | |
169 | + break; | |
170 | + } | |
171 | +} | |
172 | + | |
173 | +uint32_t helper_ftoi(CPURXState *env, float32 t0) | |
174 | +{ | |
175 | + uint32_t ret; | |
176 | + ret = float32_to_int32_round_to_zero(t0, &env->fp_status); | |
177 | + update_fpsw(env, ret, GETPC()); | |
178 | + return ret; | |
179 | +} | |
180 | + | |
181 | +uint32_t helper_round(CPURXState *env, float32 t0) | |
182 | +{ | |
183 | + uint32_t ret; | |
184 | + ret = float32_to_int32(t0, &env->fp_status); | |
185 | + update_fpsw(env, ret, GETPC()); | |
186 | + return ret; | |
187 | +} | |
188 | + | |
189 | +float32 helper_itof(CPURXState *env, uint32_t t0) | |
190 | +{ | |
191 | + float32 ret; | |
192 | + ret = int32_to_float32(t0, &env->fp_status); | |
193 | + update_fpsw(env, ret, GETPC()); | |
194 | + return ret; | |
195 | +} | |
196 | + | |
197 | +/* string operations */ | |
198 | +void helper_scmpu(CPURXState *env) | |
199 | +{ | |
200 | + uint8_t tmp0, tmp1; | |
201 | + if (env->regs[3] == 0) { | |
202 | + return; | |
203 | + } | |
204 | + while (env->regs[3] != 0) { | |
205 | + tmp0 = cpu_ldub_data_ra(env, env->regs[1]++, GETPC()); | |
206 | + tmp1 = cpu_ldub_data_ra(env, env->regs[2]++, GETPC()); | |
207 | + env->regs[3]--; | |
208 | + if (tmp0 != tmp1 || tmp0 == '\0') { | |
209 | + break; | |
210 | + } | |
211 | + } | |
212 | + env->psw_z = tmp0 - tmp1; | |
213 | + env->psw_c = (tmp0 >= tmp1); | |
214 | +} | |
215 | + | |
216 | +static uint32_t (* const cpu_ldufn[])(CPUArchState *env, | |
217 | + target_ulong ptr, | |
218 | + uintptr_t retaddr) = { | |
219 | + cpu_ldub_data_ra, cpu_lduw_data_ra, cpu_ldl_data_ra, | |
220 | +}; | |
221 | + | |
222 | +static uint32_t (* const cpu_ldfn[])(CPUArchState *env, | |
223 | + target_ulong ptr, | |
224 | + uintptr_t retaddr) = { | |
225 | + cpu_ldub_data_ra, cpu_lduw_data_ra, cpu_ldl_data_ra, | |
226 | +}; | |
227 | + | |
228 | +static void (* const cpu_stfn[])(CPUArchState *env, | |
229 | + target_ulong ptr, | |
230 | + uint32_t val, | |
231 | + uintptr_t retaddr) = { | |
232 | + cpu_stb_data_ra, cpu_stw_data_ra, cpu_stl_data_ra, | |
233 | +}; | |
234 | + | |
235 | +void helper_sstr(CPURXState *env, uint32_t sz) | |
236 | +{ | |
237 | + tcg_debug_assert(sz < 3); | |
238 | + while (env->regs[3] != 0) { | |
239 | + cpu_stfn[sz](env, env->regs[1], env->regs[2], GETPC()); | |
240 | + env->regs[1] += 1 << sz; | |
241 | + env->regs[3]--; | |
242 | + } | |
243 | +} | |
244 | + | |
245 | +#define OP_SMOVU 1 | |
246 | +#define OP_SMOVF 0 | |
247 | +#define OP_SMOVB 2 | |
248 | + | |
249 | +static void smov(uint32_t mode, CPURXState *env) | |
250 | +{ | |
251 | + uint8_t tmp; | |
252 | + int dir; | |
253 | + | |
254 | + dir = (mode & OP_SMOVB) ? -1 : 1; | |
255 | + while (env->regs[3] != 0) { | |
256 | + tmp = cpu_ldub_data_ra(env, env->regs[2], GETPC()); | |
257 | + cpu_stb_data_ra(env, env->regs[1], tmp, GETPC()); | |
258 | + env->regs[1] += dir; | |
259 | + env->regs[2] += dir; | |
260 | + env->regs[3]--; | |
261 | + if ((mode & OP_SMOVU) && tmp == 0) { | |
262 | + break; | |
263 | + } | |
264 | + } | |
265 | +} | |
266 | + | |
267 | +void helper_smovu(CPURXState *env) | |
268 | +{ | |
269 | + smov(OP_SMOVU, env); | |
270 | +} | |
271 | + | |
272 | +void helper_smovf(CPURXState *env) | |
273 | +{ | |
274 | + smov(OP_SMOVF, env); | |
275 | +} | |
276 | + | |
277 | +void helper_smovb(CPURXState *env) | |
278 | +{ | |
279 | + smov(OP_SMOVB, env); | |
280 | +} | |
281 | + | |
282 | + | |
283 | +void helper_suntil(CPURXState *env, uint32_t sz) | |
284 | +{ | |
285 | + uint32_t tmp; | |
286 | + tcg_debug_assert(sz < 3); | |
287 | + if (env->regs[3] == 0) { | |
288 | + return ; | |
289 | + } | |
290 | + while (env->regs[3] != 0) { | |
291 | + tmp = cpu_ldufn[sz](env, env->regs[1], GETPC()); | |
292 | + env->regs[1] += 1 << sz; | |
293 | + env->regs[3]--; | |
294 | + if (tmp == env->regs[2]) { | |
295 | + break; | |
296 | + } | |
297 | + } | |
298 | + env->psw_z = tmp - env->regs[2]; | |
299 | + env->psw_c = (tmp <= env->regs[2]); | |
300 | +} | |
301 | + | |
302 | +void helper_swhile(CPURXState *env, uint32_t sz) | |
303 | +{ | |
304 | + uint32_t tmp; | |
305 | + tcg_debug_assert(sz < 3); | |
306 | + if (env->regs[3] == 0) { | |
307 | + return ; | |
308 | + } | |
309 | + while (env->regs[3] != 0) { | |
310 | + tmp = cpu_ldufn[sz](env, env->regs[1], GETPC()); | |
311 | + env->regs[1] += 1 << sz; | |
312 | + env->regs[3]--; | |
313 | + if (tmp != env->regs[2]) { | |
314 | + break; | |
315 | + } | |
316 | + } | |
317 | + env->psw_z = env->regs[3]; | |
318 | + env->psw_c = (tmp <= env->regs[2]); | |
319 | +} | |
320 | + | |
321 | +/* accumlator operations */ | |
322 | +void helper_rmpa(CPURXState *env, uint32_t sz) | |
323 | +{ | |
324 | + uint64_t result_l, prev; | |
325 | + int32_t result_h; | |
326 | + int64_t tmp0, tmp1; | |
327 | + | |
328 | + if (env->regs[3] == 0) { | |
329 | + return; | |
330 | + } | |
331 | + result_l = env->regs[5]; | |
332 | + result_l <<= 32; | |
333 | + result_l |= env->regs[4]; | |
334 | + result_h = env->regs[6]; | |
335 | + env->psw_o = 0; | |
336 | + | |
337 | + while (env->regs[3] != 0) { | |
338 | + tmp0 = cpu_ldfn[sz](env, env->regs[1], GETPC()); | |
339 | + tmp1 = cpu_ldfn[sz](env, env->regs[2], GETPC()); | |
340 | + tmp0 *= tmp1; | |
341 | + prev = result_l; | |
342 | + result_l += tmp0; | |
343 | + /* carry / bollow */ | |
344 | + if (tmp0 < 0) { | |
345 | + if (prev > result_l) { | |
346 | + result_h--; | |
347 | + } | |
348 | + } else { | |
349 | + if (prev < result_l) { | |
350 | + result_h++; | |
351 | + } | |
352 | + } | |
353 | + | |
354 | + env->regs[1] += 1 << sz; | |
355 | + env->regs[2] += 1 << sz; | |
356 | + } | |
357 | + env->psw_s = result_h; | |
358 | + env->psw_o = (result_h != 0 && result_h != -1) << 31; | |
359 | + env->regs[6] = result_h; | |
360 | + env->regs[5] = result_l >> 32; | |
361 | + env->regs[4] = result_l & 0xffffffff; | |
362 | +} | |
363 | + | |
364 | +void helper_racw(CPURXState *env, uint32_t imm) | |
365 | +{ | |
366 | + int64_t acc; | |
367 | + acc = env->acc; | |
368 | + acc <<= (imm + 1); | |
369 | + acc += 0x0000000080000000LL; | |
370 | + if (acc > 0x00007fff00000000LL) { | |
371 | + acc = 0x00007fff00000000LL; | |
372 | + } else if (acc < -0x800000000000LL) { | |
373 | + acc = -0x800000000000LL; | |
374 | + } else { | |
375 | + acc &= 0xffffffff00000000LL; | |
376 | + } | |
377 | + env->acc = acc; | |
378 | +} | |
379 | + | |
380 | +void helper_satr(CPURXState *env) | |
381 | +{ | |
382 | + if (env->psw_o >> 31) { | |
383 | + if ((int)env->psw_s < 0) { | |
384 | + env->regs[6] = 0x00000000; | |
385 | + env->regs[5] = 0x7fffffff; | |
386 | + env->regs[4] = 0xffffffff; | |
387 | + } else { | |
388 | + env->regs[6] = 0xffffffff; | |
389 | + env->regs[5] = 0x80000000; | |
390 | + env->regs[4] = 0x00000000; | |
391 | + } | |
392 | + } | |
393 | +} | |
394 | + | |
395 | +/* div */ | |
396 | +uint32_t helper_div(CPURXState *env, uint32_t num, uint32_t den) | |
397 | +{ | |
398 | + uint32_t ret = num; | |
399 | + if (!((num == INT_MIN && den == -1) || den == 0)) { | |
400 | + ret = (int32_t)num / (int32_t)den; | |
401 | + env->psw_o = 0; | |
402 | + } else { | |
403 | + env->psw_o = -1; | |
404 | + } | |
405 | + return ret; | |
406 | +} | |
407 | + | |
408 | +uint32_t helper_divu(CPURXState *env, uint32_t num, uint32_t den) | |
409 | +{ | |
410 | + uint32_t ret = num; | |
411 | + if (den != 0) { | |
412 | + ret = num / den; | |
413 | + env->psw_o = 0; | |
414 | + } else { | |
415 | + env->psw_o = -1; | |
416 | + } | |
417 | + return ret; | |
418 | +} | |
419 | + | |
420 | +/* exception */ | |
421 | +static inline void QEMU_NORETURN raise_exception(CPURXState *env, int index, | |
422 | + uintptr_t retaddr) | |
423 | +{ | |
424 | + CPUState *cs = env_cpu(env); | |
425 | + | |
426 | + cs->exception_index = index; | |
427 | + cpu_loop_exit_restore(cs, retaddr); | |
428 | +} | |
429 | + | |
430 | +void QEMU_NORETURN helper_raise_privilege_violation(CPURXState *env) | |
431 | +{ | |
432 | + raise_exception(env, 20, GETPC()); | |
433 | +} | |
434 | + | |
435 | +void QEMU_NORETURN helper_raise_access_fault(CPURXState *env) | |
436 | +{ | |
437 | + raise_exception(env, 21, GETPC()); | |
438 | +} | |
439 | + | |
440 | +void QEMU_NORETURN helper_raise_illegal_instruction(CPURXState *env) | |
441 | +{ | |
442 | + raise_exception(env, 23, GETPC()); | |
443 | +} | |
444 | + | |
445 | +void QEMU_NORETURN helper_wait(CPURXState *env) | |
446 | +{ | |
447 | + CPUState *cs = env_cpu(env); | |
448 | + | |
449 | + cs->halted = 1; | |
450 | + env->in_sleep = 1; | |
451 | + raise_exception(env, EXCP_HLT, 0); | |
452 | +} | |
453 | + | |
454 | +void QEMU_NORETURN helper_debug(CPURXState *env) | |
455 | +{ | |
456 | + CPUState *cs = env_cpu(env); | |
457 | + | |
458 | + cs->exception_index = EXCP_DEBUG; | |
459 | + cpu_loop_exit(cs); | |
460 | +} | |
461 | + | |
462 | +void QEMU_NORETURN helper_rxint(CPURXState *env, uint32_t vec) | |
463 | +{ | |
464 | + raise_exception(env, 0x100 + vec, 0); | |
465 | +} | |
466 | + | |
467 | +void QEMU_NORETURN helper_rxbrk(CPURXState *env) | |
468 | +{ | |
469 | + raise_exception(env, 0x100, 0); | |
470 | +} |