]>
Commit | Line | Data |
---|---|---|
fdf9b3e8 FB |
1 | /* |
2 | * SH4 emulation | |
5fafdf24 | 3 | * |
fdf9b3e8 FB |
4 | * Copyright (c) 2005 Samuel Tardieu |
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 | |
8167ee88 | 17 | * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
fdf9b3e8 FB |
18 | */ |
19 | #include <assert.h> | |
852d481f | 20 | #include <stdlib.h> |
fdf9b3e8 | 21 | #include "exec.h" |
a7812ae4 | 22 | #include "helper.h" |
fdf9b3e8 | 23 | |
21829e9b AJ |
24 | static void cpu_restore_state_from_retaddr(void *retaddr) |
25 | { | |
26 | TranslationBlock *tb; | |
27 | unsigned long pc; | |
28 | ||
29 | if (retaddr) { | |
30 | pc = (unsigned long) retaddr; | |
31 | tb = tb_find_pc(pc); | |
32 | if (tb) { | |
33 | /* the PC is inside the translated code. It means that we have | |
34 | a virtual CPU fault */ | |
35 | cpu_restore_state(tb, env, pc, NULL); | |
36 | } | |
37 | } | |
38 | } | |
39 | ||
fdf9b3e8 FB |
40 | #ifndef CONFIG_USER_ONLY |
41 | ||
42 | #define MMUSUFFIX _mmu | |
fdf9b3e8 FB |
43 | |
44 | #define SHIFT 0 | |
45 | #include "softmmu_template.h" | |
46 | ||
47 | #define SHIFT 1 | |
48 | #include "softmmu_template.h" | |
49 | ||
50 | #define SHIFT 2 | |
51 | #include "softmmu_template.h" | |
52 | ||
53 | #define SHIFT 3 | |
54 | #include "softmmu_template.h" | |
55 | ||
6ebbf390 | 56 | void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr) |
fdf9b3e8 | 57 | { |
fdf9b3e8 | 58 | CPUState *saved_env; |
fdf9b3e8 FB |
59 | int ret; |
60 | ||
61 | /* XXX: hack to restore env in all cases, even if not called from | |
62 | generated code */ | |
63 | saved_env = env; | |
64 | env = cpu_single_env; | |
6ebbf390 | 65 | ret = cpu_sh4_handle_mmu_fault(env, addr, is_write, mmu_idx, 1); |
fdf9b3e8 | 66 | if (ret) { |
21829e9b AJ |
67 | /* now we have a real cpu fault */ |
68 | cpu_restore_state_from_retaddr(retaddr); | |
e6afc2f4 | 69 | cpu_loop_exit(); |
fdf9b3e8 FB |
70 | } |
71 | env = saved_env; | |
72 | } | |
73 | ||
74 | #endif | |
75 | ||
ea2b542a AJ |
76 | void helper_ldtlb(void) |
77 | { | |
78 | #ifdef CONFIG_USER_ONLY | |
79 | /* XXXXX */ | |
43dc2a64 | 80 | cpu_abort(env, "Unhandled ldtlb"); |
ea2b542a AJ |
81 | #else |
82 | cpu_load_tlb(env); | |
83 | #endif | |
84 | } | |
85 | ||
fd4bab10 | 86 | static inline void raise_exception(int index, void *retaddr) |
e6afc2f4 | 87 | { |
fd4bab10 AJ |
88 | env->exception_index = index; |
89 | cpu_restore_state_from_retaddr(retaddr); | |
e6afc2f4 AJ |
90 | cpu_loop_exit(); |
91 | } | |
92 | ||
fd4bab10 AJ |
93 | void helper_raise_illegal_instruction(void) |
94 | { | |
95 | raise_exception(0x180, GETPC()); | |
96 | } | |
97 | ||
e6afc2f4 AJ |
98 | void helper_raise_slot_illegal_instruction(void) |
99 | { | |
fd4bab10 | 100 | raise_exception(0x1a0, GETPC()); |
e6afc2f4 AJ |
101 | } |
102 | ||
d8299bcc AJ |
103 | void helper_raise_fpu_disable(void) |
104 | { | |
fd4bab10 | 105 | raise_exception(0x800, GETPC()); |
d8299bcc AJ |
106 | } |
107 | ||
108 | void helper_raise_slot_fpu_disable(void) | |
109 | { | |
fd4bab10 | 110 | raise_exception(0x820, GETPC()); |
d8299bcc AJ |
111 | } |
112 | ||
e6afc2f4 AJ |
113 | void helper_debug(void) |
114 | { | |
115 | env->exception_index = EXCP_DEBUG; | |
116 | cpu_loop_exit(); | |
117 | } | |
118 | ||
f24f381b | 119 | void helper_sleep(uint32_t next_pc) |
e6afc2f4 AJ |
120 | { |
121 | env->halted = 1; | |
122 | env->exception_index = EXCP_HLT; | |
f24f381b | 123 | env->pc = next_pc; |
e6afc2f4 AJ |
124 | cpu_loop_exit(); |
125 | } | |
126 | ||
127 | void helper_trapa(uint32_t tra) | |
128 | { | |
129 | env->tra = tra << 2; | |
fd4bab10 | 130 | raise_exception(0x160, GETPC()); |
e6afc2f4 AJ |
131 | } |
132 | ||
852d481f EI |
133 | void helper_movcal(uint32_t address, uint32_t value) |
134 | { | |
135 | if (cpu_sh4_is_cached (env, address)) | |
136 | { | |
137 | memory_content *r = malloc (sizeof(memory_content)); | |
138 | r->address = address; | |
139 | r->value = value; | |
140 | r->next = NULL; | |
141 | ||
142 | *(env->movcal_backup_tail) = r; | |
143 | env->movcal_backup_tail = &(r->next); | |
144 | } | |
145 | } | |
146 | ||
147 | void helper_discard_movcal_backup(void) | |
148 | { | |
149 | memory_content *current = env->movcal_backup; | |
150 | ||
151 | while(current) | |
152 | { | |
153 | memory_content *next = current->next; | |
154 | free (current); | |
155 | env->movcal_backup = current = next; | |
b9d38e95 | 156 | if (current == NULL) |
852d481f EI |
157 | env->movcal_backup_tail = &(env->movcal_backup); |
158 | } | |
159 | } | |
160 | ||
161 | void helper_ocbi(uint32_t address) | |
162 | { | |
163 | memory_content **current = &(env->movcal_backup); | |
164 | while (*current) | |
165 | { | |
166 | uint32_t a = (*current)->address; | |
167 | if ((a & ~0x1F) == (address & ~0x1F)) | |
168 | { | |
169 | memory_content *next = (*current)->next; | |
170 | stl(a, (*current)->value); | |
171 | ||
b9d38e95 | 172 | if (next == NULL) |
852d481f EI |
173 | { |
174 | env->movcal_backup_tail = current; | |
175 | } | |
176 | ||
177 | free (*current); | |
178 | *current = next; | |
179 | break; | |
180 | } | |
181 | } | |
182 | } | |
183 | ||
6f06939b | 184 | uint32_t helper_addc(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
185 | { |
186 | uint32_t tmp0, tmp1; | |
187 | ||
6f06939b AJ |
188 | tmp1 = arg0 + arg1; |
189 | tmp0 = arg1; | |
190 | arg1 = tmp1 + (env->sr & 1); | |
fdf9b3e8 FB |
191 | if (tmp0 > tmp1) |
192 | env->sr |= SR_T; | |
193 | else | |
194 | env->sr &= ~SR_T; | |
6f06939b | 195 | if (tmp1 > arg1) |
fdf9b3e8 | 196 | env->sr |= SR_T; |
6f06939b | 197 | return arg1; |
fdf9b3e8 FB |
198 | } |
199 | ||
6f06939b | 200 | uint32_t helper_addv(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
201 | { |
202 | uint32_t dest, src, ans; | |
203 | ||
6f06939b | 204 | if ((int32_t) arg1 >= 0) |
fdf9b3e8 FB |
205 | dest = 0; |
206 | else | |
207 | dest = 1; | |
6f06939b | 208 | if ((int32_t) arg0 >= 0) |
fdf9b3e8 FB |
209 | src = 0; |
210 | else | |
211 | src = 1; | |
212 | src += dest; | |
6f06939b AJ |
213 | arg1 += arg0; |
214 | if ((int32_t) arg1 >= 0) | |
fdf9b3e8 FB |
215 | ans = 0; |
216 | else | |
217 | ans = 1; | |
218 | ans += dest; | |
219 | if (src == 0 || src == 2) { | |
220 | if (ans == 1) | |
221 | env->sr |= SR_T; | |
222 | else | |
223 | env->sr &= ~SR_T; | |
224 | } else | |
225 | env->sr &= ~SR_T; | |
6f06939b | 226 | return arg1; |
fdf9b3e8 FB |
227 | } |
228 | ||
229 | #define T (env->sr & SR_T) | |
230 | #define Q (env->sr & SR_Q ? 1 : 0) | |
231 | #define M (env->sr & SR_M ? 1 : 0) | |
232 | #define SETT env->sr |= SR_T | |
233 | #define CLRT env->sr &= ~SR_T | |
234 | #define SETQ env->sr |= SR_Q | |
235 | #define CLRQ env->sr &= ~SR_Q | |
236 | #define SETM env->sr |= SR_M | |
237 | #define CLRM env->sr &= ~SR_M | |
238 | ||
69d6275b | 239 | uint32_t helper_div1(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
240 | { |
241 | uint32_t tmp0, tmp2; | |
242 | uint8_t old_q, tmp1 = 0xff; | |
243 | ||
69d6275b | 244 | //printf("div1 arg0=0x%08x arg1=0x%08x M=%d Q=%d T=%d\n", arg0, arg1, M, Q, T); |
fdf9b3e8 | 245 | old_q = Q; |
69d6275b | 246 | if ((0x80000000 & arg1) != 0) |
fdf9b3e8 FB |
247 | SETQ; |
248 | else | |
249 | CLRQ; | |
69d6275b AJ |
250 | tmp2 = arg0; |
251 | arg1 <<= 1; | |
252 | arg1 |= T; | |
fdf9b3e8 FB |
253 | switch (old_q) { |
254 | case 0: | |
255 | switch (M) { | |
256 | case 0: | |
69d6275b AJ |
257 | tmp0 = arg1; |
258 | arg1 -= tmp2; | |
259 | tmp1 = arg1 > tmp0; | |
fdf9b3e8 FB |
260 | switch (Q) { |
261 | case 0: | |
262 | if (tmp1) | |
263 | SETQ; | |
264 | else | |
265 | CLRQ; | |
266 | break; | |
267 | case 1: | |
268 | if (tmp1 == 0) | |
269 | SETQ; | |
270 | else | |
271 | CLRQ; | |
272 | break; | |
273 | } | |
274 | break; | |
275 | case 1: | |
69d6275b AJ |
276 | tmp0 = arg1; |
277 | arg1 += tmp2; | |
278 | tmp1 = arg1 < tmp0; | |
fdf9b3e8 FB |
279 | switch (Q) { |
280 | case 0: | |
281 | if (tmp1 == 0) | |
282 | SETQ; | |
283 | else | |
284 | CLRQ; | |
285 | break; | |
286 | case 1: | |
287 | if (tmp1) | |
288 | SETQ; | |
289 | else | |
290 | CLRQ; | |
291 | break; | |
292 | } | |
293 | break; | |
294 | } | |
295 | break; | |
296 | case 1: | |
297 | switch (M) { | |
298 | case 0: | |
69d6275b AJ |
299 | tmp0 = arg1; |
300 | arg1 += tmp2; | |
301 | tmp1 = arg1 < tmp0; | |
fdf9b3e8 FB |
302 | switch (Q) { |
303 | case 0: | |
304 | if (tmp1) | |
305 | SETQ; | |
306 | else | |
307 | CLRQ; | |
308 | break; | |
309 | case 1: | |
310 | if (tmp1 == 0) | |
311 | SETQ; | |
312 | else | |
313 | CLRQ; | |
314 | break; | |
315 | } | |
316 | break; | |
317 | case 1: | |
69d6275b AJ |
318 | tmp0 = arg1; |
319 | arg1 -= tmp2; | |
320 | tmp1 = arg1 > tmp0; | |
fdf9b3e8 FB |
321 | switch (Q) { |
322 | case 0: | |
323 | if (tmp1 == 0) | |
324 | SETQ; | |
325 | else | |
326 | CLRQ; | |
327 | break; | |
328 | case 1: | |
329 | if (tmp1) | |
330 | SETQ; | |
331 | else | |
332 | CLRQ; | |
333 | break; | |
334 | } | |
335 | break; | |
336 | } | |
337 | break; | |
338 | } | |
339 | if (Q == M) | |
340 | SETT; | |
341 | else | |
342 | CLRT; | |
69d6275b AJ |
343 | //printf("Output: arg1=0x%08x M=%d Q=%d T=%d\n", arg1, M, Q, T); |
344 | return arg1; | |
fdf9b3e8 FB |
345 | } |
346 | ||
6f06939b | 347 | void helper_macl(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
348 | { |
349 | int64_t res; | |
350 | ||
351 | res = ((uint64_t) env->mach << 32) | env->macl; | |
6f06939b | 352 | res += (int64_t) (int32_t) arg0 *(int64_t) (int32_t) arg1; |
fdf9b3e8 FB |
353 | env->mach = (res >> 32) & 0xffffffff; |
354 | env->macl = res & 0xffffffff; | |
355 | if (env->sr & SR_S) { | |
356 | if (res < 0) | |
357 | env->mach |= 0xffff0000; | |
358 | else | |
359 | env->mach &= 0x00007fff; | |
360 | } | |
361 | } | |
362 | ||
6f06939b | 363 | void helper_macw(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
364 | { |
365 | int64_t res; | |
366 | ||
367 | res = ((uint64_t) env->mach << 32) | env->macl; | |
6f06939b | 368 | res += (int64_t) (int16_t) arg0 *(int64_t) (int16_t) arg1; |
fdf9b3e8 FB |
369 | env->mach = (res >> 32) & 0xffffffff; |
370 | env->macl = res & 0xffffffff; | |
371 | if (env->sr & SR_S) { | |
372 | if (res < -0x80000000) { | |
373 | env->mach = 1; | |
374 | env->macl = 0x80000000; | |
375 | } else if (res > 0x000000007fffffff) { | |
376 | env->mach = 1; | |
377 | env->macl = 0x7fffffff; | |
378 | } | |
379 | } | |
380 | } | |
381 | ||
6f06939b | 382 | uint32_t helper_subc(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
383 | { |
384 | uint32_t tmp0, tmp1; | |
385 | ||
6f06939b AJ |
386 | tmp1 = arg1 - arg0; |
387 | tmp0 = arg1; | |
388 | arg1 = tmp1 - (env->sr & SR_T); | |
fdf9b3e8 FB |
389 | if (tmp0 < tmp1) |
390 | env->sr |= SR_T; | |
391 | else | |
392 | env->sr &= ~SR_T; | |
6f06939b | 393 | if (tmp1 < arg1) |
fdf9b3e8 | 394 | env->sr |= SR_T; |
6f06939b | 395 | return arg1; |
fdf9b3e8 FB |
396 | } |
397 | ||
6f06939b | 398 | uint32_t helper_subv(uint32_t arg0, uint32_t arg1) |
fdf9b3e8 FB |
399 | { |
400 | int32_t dest, src, ans; | |
401 | ||
6f06939b | 402 | if ((int32_t) arg1 >= 0) |
fdf9b3e8 FB |
403 | dest = 0; |
404 | else | |
405 | dest = 1; | |
6f06939b | 406 | if ((int32_t) arg0 >= 0) |
fdf9b3e8 FB |
407 | src = 0; |
408 | else | |
409 | src = 1; | |
410 | src += dest; | |
6f06939b AJ |
411 | arg1 -= arg0; |
412 | if ((int32_t) arg1 >= 0) | |
fdf9b3e8 FB |
413 | ans = 0; |
414 | else | |
415 | ans = 1; | |
416 | ans += dest; | |
417 | if (src == 1) { | |
418 | if (ans == 1) | |
419 | env->sr |= SR_T; | |
420 | else | |
421 | env->sr &= ~SR_T; | |
422 | } else | |
423 | env->sr &= ~SR_T; | |
6f06939b | 424 | return arg1; |
fdf9b3e8 FB |
425 | } |
426 | ||
cc4ba6a9 AJ |
427 | static inline void set_t(void) |
428 | { | |
429 | env->sr |= SR_T; | |
430 | } | |
431 | ||
432 | static inline void clr_t(void) | |
433 | { | |
434 | env->sr &= ~SR_T; | |
435 | } | |
436 | ||
390af821 AJ |
437 | void helper_ld_fpscr(uint32_t val) |
438 | { | |
26ac1ea5 AJ |
439 | env->fpscr = val & FPSCR_MASK; |
440 | if ((val & FPSCR_RM_MASK) == FPSCR_RM_ZERO) { | |
390af821 | 441 | set_float_rounding_mode(float_round_to_zero, &env->fp_status); |
26ac1ea5 | 442 | } else { |
390af821 | 443 | set_float_rounding_mode(float_round_nearest_even, &env->fp_status); |
26ac1ea5 | 444 | } |
a0d4ac33 | 445 | set_flush_to_zero((val & FPSCR_DN) != 0, &env->fp_status); |
390af821 | 446 | } |
cc4ba6a9 | 447 | |
21829e9b AJ |
448 | static void update_fpscr(void *retaddr) |
449 | { | |
450 | int xcpt, cause, enable; | |
451 | ||
452 | xcpt = get_float_exception_flags(&env->fp_status); | |
453 | ||
454 | /* Clear the flag entries */ | |
455 | env->fpscr &= ~FPSCR_FLAG_MASK; | |
456 | ||
457 | if (unlikely(xcpt)) { | |
458 | if (xcpt & float_flag_invalid) { | |
459 | env->fpscr |= FPSCR_FLAG_V; | |
460 | } | |
461 | if (xcpt & float_flag_divbyzero) { | |
462 | env->fpscr |= FPSCR_FLAG_Z; | |
463 | } | |
464 | if (xcpt & float_flag_overflow) { | |
465 | env->fpscr |= FPSCR_FLAG_O; | |
466 | } | |
467 | if (xcpt & float_flag_underflow) { | |
468 | env->fpscr |= FPSCR_FLAG_U; | |
469 | } | |
470 | if (xcpt & float_flag_inexact) { | |
471 | env->fpscr |= FPSCR_FLAG_I; | |
472 | } | |
473 | ||
474 | /* Accumulate in cause entries */ | |
475 | env->fpscr |= (env->fpscr & FPSCR_FLAG_MASK) | |
476 | << (FPSCR_CAUSE_SHIFT - FPSCR_FLAG_SHIFT); | |
477 | ||
478 | /* Generate an exception if enabled */ | |
479 | cause = (env->fpscr & FPSCR_CAUSE_MASK) >> FPSCR_CAUSE_SHIFT; | |
480 | enable = (env->fpscr & FPSCR_ENABLE_MASK) >> FPSCR_ENABLE_SHIFT; | |
481 | if (cause & enable) { | |
482 | cpu_restore_state_from_retaddr(retaddr); | |
483 | env->exception_index = 0x120; | |
484 | cpu_loop_exit(); | |
485 | } | |
486 | } | |
487 | } | |
488 | ||
cc4ba6a9 AJ |
489 | uint32_t helper_fabs_FT(uint32_t t0) |
490 | { | |
9850d1e8 AJ |
491 | CPU_FloatU f; |
492 | f.l = t0; | |
493 | f.f = float32_abs(f.f); | |
494 | return f.l; | |
cc4ba6a9 AJ |
495 | } |
496 | ||
497 | uint64_t helper_fabs_DT(uint64_t t0) | |
498 | { | |
9850d1e8 AJ |
499 | CPU_DoubleU d; |
500 | d.ll = t0; | |
501 | d.d = float64_abs(d.d); | |
502 | return d.ll; | |
cc4ba6a9 AJ |
503 | } |
504 | ||
505 | uint32_t helper_fadd_FT(uint32_t t0, uint32_t t1) | |
506 | { | |
9850d1e8 AJ |
507 | CPU_FloatU f0, f1; |
508 | f0.l = t0; | |
509 | f1.l = t1; | |
21829e9b | 510 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 511 | f0.f = float32_add(f0.f, f1.f, &env->fp_status); |
21829e9b | 512 | update_fpscr(GETPC()); |
9850d1e8 | 513 | return f0.l; |
cc4ba6a9 AJ |
514 | } |
515 | ||
516 | uint64_t helper_fadd_DT(uint64_t t0, uint64_t t1) | |
517 | { | |
9850d1e8 AJ |
518 | CPU_DoubleU d0, d1; |
519 | d0.ll = t0; | |
520 | d1.ll = t1; | |
21829e9b | 521 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 522 | d0.d = float64_add(d0.d, d1.d, &env->fp_status); |
21829e9b | 523 | update_fpscr(GETPC()); |
9850d1e8 | 524 | return d0.ll; |
cc4ba6a9 AJ |
525 | } |
526 | ||
527 | void helper_fcmp_eq_FT(uint32_t t0, uint32_t t1) | |
528 | { | |
9850d1e8 | 529 | CPU_FloatU f0, f1; |
21829e9b | 530 | int relation; |
9850d1e8 AJ |
531 | f0.l = t0; |
532 | f1.l = t1; | |
533 | ||
21829e9b AJ |
534 | set_float_exception_flags(0, &env->fp_status); |
535 | relation = float32_compare(f0.f, f1.f, &env->fp_status); | |
536 | if (unlikely(relation == float_relation_unordered)) { | |
537 | update_fpscr(GETPC()); | |
538 | } else if (relation == float_relation_equal) { | |
cc4ba6a9 | 539 | set_t(); |
21829e9b | 540 | } else { |
cc4ba6a9 | 541 | clr_t(); |
21829e9b | 542 | } |
cc4ba6a9 AJ |
543 | } |
544 | ||
545 | void helper_fcmp_eq_DT(uint64_t t0, uint64_t t1) | |
546 | { | |
9850d1e8 | 547 | CPU_DoubleU d0, d1; |
21829e9b | 548 | int relation; |
9850d1e8 AJ |
549 | d0.ll = t0; |
550 | d1.ll = t1; | |
551 | ||
21829e9b AJ |
552 | set_float_exception_flags(0, &env->fp_status); |
553 | relation = float64_compare(d0.d, d1.d, &env->fp_status); | |
554 | if (unlikely(relation == float_relation_unordered)) { | |
555 | update_fpscr(GETPC()); | |
556 | } else if (relation == float_relation_equal) { | |
cc4ba6a9 | 557 | set_t(); |
21829e9b | 558 | } else { |
cc4ba6a9 | 559 | clr_t(); |
21829e9b | 560 | } |
cc4ba6a9 AJ |
561 | } |
562 | ||
563 | void helper_fcmp_gt_FT(uint32_t t0, uint32_t t1) | |
564 | { | |
9850d1e8 | 565 | CPU_FloatU f0, f1; |
21829e9b | 566 | int relation; |
9850d1e8 AJ |
567 | f0.l = t0; |
568 | f1.l = t1; | |
569 | ||
21829e9b AJ |
570 | set_float_exception_flags(0, &env->fp_status); |
571 | relation = float32_compare(f0.f, f1.f, &env->fp_status); | |
572 | if (unlikely(relation == float_relation_unordered)) { | |
573 | update_fpscr(GETPC()); | |
574 | } else if (relation == float_relation_greater) { | |
cc4ba6a9 | 575 | set_t(); |
21829e9b | 576 | } else { |
cc4ba6a9 | 577 | clr_t(); |
21829e9b | 578 | } |
cc4ba6a9 AJ |
579 | } |
580 | ||
581 | void helper_fcmp_gt_DT(uint64_t t0, uint64_t t1) | |
582 | { | |
9850d1e8 | 583 | CPU_DoubleU d0, d1; |
21829e9b | 584 | int relation; |
9850d1e8 AJ |
585 | d0.ll = t0; |
586 | d1.ll = t1; | |
587 | ||
21829e9b AJ |
588 | set_float_exception_flags(0, &env->fp_status); |
589 | relation = float64_compare(d0.d, d1.d, &env->fp_status); | |
590 | if (unlikely(relation == float_relation_unordered)) { | |
591 | update_fpscr(GETPC()); | |
592 | } else if (relation == float_relation_greater) { | |
cc4ba6a9 | 593 | set_t(); |
21829e9b | 594 | } else { |
cc4ba6a9 | 595 | clr_t(); |
21829e9b | 596 | } |
cc4ba6a9 AJ |
597 | } |
598 | ||
599 | uint64_t helper_fcnvsd_FT_DT(uint32_t t0) | |
600 | { | |
9850d1e8 AJ |
601 | CPU_DoubleU d; |
602 | CPU_FloatU f; | |
603 | f.l = t0; | |
21829e9b | 604 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 605 | d.d = float32_to_float64(f.f, &env->fp_status); |
21829e9b | 606 | update_fpscr(GETPC()); |
9850d1e8 | 607 | return d.ll; |
cc4ba6a9 AJ |
608 | } |
609 | ||
610 | uint32_t helper_fcnvds_DT_FT(uint64_t t0) | |
611 | { | |
9850d1e8 AJ |
612 | CPU_DoubleU d; |
613 | CPU_FloatU f; | |
614 | d.ll = t0; | |
21829e9b | 615 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 616 | f.f = float64_to_float32(d.d, &env->fp_status); |
21829e9b | 617 | update_fpscr(GETPC()); |
9850d1e8 | 618 | return f.l; |
cc4ba6a9 AJ |
619 | } |
620 | ||
621 | uint32_t helper_fdiv_FT(uint32_t t0, uint32_t t1) | |
622 | { | |
9850d1e8 AJ |
623 | CPU_FloatU f0, f1; |
624 | f0.l = t0; | |
625 | f1.l = t1; | |
21829e9b | 626 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 627 | f0.f = float32_div(f0.f, f1.f, &env->fp_status); |
21829e9b | 628 | update_fpscr(GETPC()); |
9850d1e8 | 629 | return f0.l; |
cc4ba6a9 AJ |
630 | } |
631 | ||
632 | uint64_t helper_fdiv_DT(uint64_t t0, uint64_t t1) | |
633 | { | |
9850d1e8 AJ |
634 | CPU_DoubleU d0, d1; |
635 | d0.ll = t0; | |
636 | d1.ll = t1; | |
21829e9b | 637 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 638 | d0.d = float64_div(d0.d, d1.d, &env->fp_status); |
21829e9b | 639 | update_fpscr(GETPC()); |
9850d1e8 | 640 | return d0.ll; |
cc4ba6a9 AJ |
641 | } |
642 | ||
643 | uint32_t helper_float_FT(uint32_t t0) | |
644 | { | |
9850d1e8 | 645 | CPU_FloatU f; |
21829e9b AJ |
646 | |
647 | set_float_exception_flags(0, &env->fp_status); | |
9850d1e8 | 648 | f.f = int32_to_float32(t0, &env->fp_status); |
21829e9b AJ |
649 | update_fpscr(GETPC()); |
650 | ||
9850d1e8 | 651 | return f.l; |
cc4ba6a9 AJ |
652 | } |
653 | ||
654 | uint64_t helper_float_DT(uint32_t t0) | |
655 | { | |
9850d1e8 | 656 | CPU_DoubleU d; |
21829e9b | 657 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 658 | d.d = int32_to_float64(t0, &env->fp_status); |
21829e9b | 659 | update_fpscr(GETPC()); |
9850d1e8 | 660 | return d.ll; |
cc4ba6a9 AJ |
661 | } |
662 | ||
5b7141a1 AJ |
663 | uint32_t helper_fmac_FT(uint32_t t0, uint32_t t1, uint32_t t2) |
664 | { | |
665 | CPU_FloatU f0, f1, f2; | |
666 | f0.l = t0; | |
667 | f1.l = t1; | |
668 | f2.l = t2; | |
21829e9b | 669 | set_float_exception_flags(0, &env->fp_status); |
5b7141a1 AJ |
670 | f0.f = float32_mul(f0.f, f1.f, &env->fp_status); |
671 | f0.f = float32_add(f0.f, f2.f, &env->fp_status); | |
21829e9b AJ |
672 | update_fpscr(GETPC()); |
673 | ||
5b7141a1 AJ |
674 | return f0.l; |
675 | } | |
676 | ||
cc4ba6a9 AJ |
677 | uint32_t helper_fmul_FT(uint32_t t0, uint32_t t1) |
678 | { | |
9850d1e8 AJ |
679 | CPU_FloatU f0, f1; |
680 | f0.l = t0; | |
681 | f1.l = t1; | |
21829e9b | 682 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 683 | f0.f = float32_mul(f0.f, f1.f, &env->fp_status); |
21829e9b | 684 | update_fpscr(GETPC()); |
9850d1e8 | 685 | return f0.l; |
cc4ba6a9 AJ |
686 | } |
687 | ||
688 | uint64_t helper_fmul_DT(uint64_t t0, uint64_t t1) | |
689 | { | |
9850d1e8 AJ |
690 | CPU_DoubleU d0, d1; |
691 | d0.ll = t0; | |
692 | d1.ll = t1; | |
21829e9b | 693 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 694 | d0.d = float64_mul(d0.d, d1.d, &env->fp_status); |
21829e9b AJ |
695 | update_fpscr(GETPC()); |
696 | ||
9850d1e8 | 697 | return d0.ll; |
cc4ba6a9 AJ |
698 | } |
699 | ||
7fdf924f AJ |
700 | uint32_t helper_fneg_T(uint32_t t0) |
701 | { | |
9850d1e8 AJ |
702 | CPU_FloatU f; |
703 | f.l = t0; | |
704 | f.f = float32_chs(f.f); | |
705 | return f.l; | |
7fdf924f AJ |
706 | } |
707 | ||
cc4ba6a9 AJ |
708 | uint32_t helper_fsqrt_FT(uint32_t t0) |
709 | { | |
9850d1e8 AJ |
710 | CPU_FloatU f; |
711 | f.l = t0; | |
21829e9b | 712 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 713 | f.f = float32_sqrt(f.f, &env->fp_status); |
21829e9b | 714 | update_fpscr(GETPC()); |
9850d1e8 | 715 | return f.l; |
cc4ba6a9 AJ |
716 | } |
717 | ||
718 | uint64_t helper_fsqrt_DT(uint64_t t0) | |
719 | { | |
9850d1e8 AJ |
720 | CPU_DoubleU d; |
721 | d.ll = t0; | |
21829e9b | 722 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 723 | d.d = float64_sqrt(d.d, &env->fp_status); |
21829e9b | 724 | update_fpscr(GETPC()); |
9850d1e8 | 725 | return d.ll; |
cc4ba6a9 AJ |
726 | } |
727 | ||
728 | uint32_t helper_fsub_FT(uint32_t t0, uint32_t t1) | |
729 | { | |
9850d1e8 AJ |
730 | CPU_FloatU f0, f1; |
731 | f0.l = t0; | |
732 | f1.l = t1; | |
21829e9b | 733 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 734 | f0.f = float32_sub(f0.f, f1.f, &env->fp_status); |
21829e9b | 735 | update_fpscr(GETPC()); |
9850d1e8 | 736 | return f0.l; |
cc4ba6a9 AJ |
737 | } |
738 | ||
739 | uint64_t helper_fsub_DT(uint64_t t0, uint64_t t1) | |
740 | { | |
9850d1e8 | 741 | CPU_DoubleU d0, d1; |
21829e9b | 742 | |
9850d1e8 AJ |
743 | d0.ll = t0; |
744 | d1.ll = t1; | |
21829e9b | 745 | set_float_exception_flags(0, &env->fp_status); |
9850d1e8 | 746 | d0.d = float64_sub(d0.d, d1.d, &env->fp_status); |
21829e9b | 747 | update_fpscr(GETPC()); |
9850d1e8 | 748 | return d0.ll; |
cc4ba6a9 AJ |
749 | } |
750 | ||
751 | uint32_t helper_ftrc_FT(uint32_t t0) | |
752 | { | |
9850d1e8 | 753 | CPU_FloatU f; |
21829e9b | 754 | uint32_t ret; |
9850d1e8 | 755 | f.l = t0; |
21829e9b AJ |
756 | set_float_exception_flags(0, &env->fp_status); |
757 | ret = float32_to_int32_round_to_zero(f.f, &env->fp_status); | |
758 | update_fpscr(GETPC()); | |
759 | return ret; | |
cc4ba6a9 AJ |
760 | } |
761 | ||
762 | uint32_t helper_ftrc_DT(uint64_t t0) | |
763 | { | |
9850d1e8 | 764 | CPU_DoubleU d; |
21829e9b | 765 | uint32_t ret; |
9850d1e8 | 766 | d.ll = t0; |
21829e9b AJ |
767 | set_float_exception_flags(0, &env->fp_status); |
768 | ret = float64_to_int32_round_to_zero(d.d, &env->fp_status); | |
769 | update_fpscr(GETPC()); | |
770 | return ret; | |
cc4ba6a9 | 771 | } |
af8c2bde AJ |
772 | |
773 | void helper_fipr(uint32_t m, uint32_t n) | |
774 | { | |
775 | int bank, i; | |
776 | float32 r, p; | |
777 | ||
778 | bank = (env->sr & FPSCR_FR) ? 16 : 0; | |
779 | r = float32_zero; | |
780 | set_float_exception_flags(0, &env->fp_status); | |
781 | ||
782 | for (i = 0 ; i < 4 ; i++) { | |
783 | p = float32_mul(env->fregs[bank + m + i], | |
784 | env->fregs[bank + n + i], | |
785 | &env->fp_status); | |
786 | r = float32_add(r, p, &env->fp_status); | |
787 | } | |
788 | update_fpscr(GETPC()); | |
789 | ||
790 | env->fregs[bank + n + 3] = r; | |
791 | } | |
17075f10 AJ |
792 | |
793 | void helper_ftrv(uint32_t n) | |
794 | { | |
795 | int bank_matrix, bank_vector; | |
796 | int i, j; | |
797 | float32 r[4]; | |
798 | float32 p; | |
799 | ||
800 | bank_matrix = (env->sr & FPSCR_FR) ? 0 : 16; | |
801 | bank_vector = (env->sr & FPSCR_FR) ? 16 : 0; | |
802 | set_float_exception_flags(0, &env->fp_status); | |
803 | for (i = 0 ; i < 4 ; i++) { | |
804 | r[i] = float32_zero; | |
805 | for (j = 0 ; j < 4 ; j++) { | |
806 | p = float32_mul(env->fregs[bank_matrix + 4 * j + i], | |
807 | env->fregs[bank_vector + j], | |
808 | &env->fp_status); | |
809 | r[i] = float32_add(r[i], p, &env->fp_status); | |
810 | } | |
811 | } | |
812 | update_fpscr(GETPC()); | |
813 | ||
814 | for (i = 0 ; i < 4 ; i++) { | |
815 | env->fregs[bank_vector + i] = r[i]; | |
816 | } | |
817 | } |