2 * PowerPC emulation helpers for qemu.
4 * Copyright (c) 2003-2007 Jocelyn Mayer
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.
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.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
22 #include "host-utils.h"
25 #include "helper_regs.h"
28 //#define DEBUG_EXCEPTIONS
29 //#define DEBUG_SOFTWARE_TLB
31 /*****************************************************************************/
32 /* Exceptions processing helpers */
34 void helper_raise_exception_err (uint32_t exception, uint32_t error_code)
37 printf("Raise exception %3x code : %d\n", exception, error_code);
39 env->exception_index = exception;
40 env->error_code = error_code;
44 void helper_raise_exception (uint32_t exception)
46 helper_raise_exception_err(exception, 0);
49 /*****************************************************************************/
50 /* Registers load and stores */
51 target_ulong helper_load_cr (void)
53 return (env->crf[0] << 28) |
63 void helper_store_cr (target_ulong val, uint32_t mask)
67 for (i = 0, sh = 7; i < 8; i++, sh--) {
69 env->crf[i] = (val >> (sh * 4)) & 0xFUL;
73 /*****************************************************************************/
75 void helper_load_dump_spr (uint32_t sprn)
78 fprintf(logfile, "Read SPR %d %03x => " ADDRX "\n",
79 sprn, sprn, env->spr[sprn]);
83 void helper_store_dump_spr (uint32_t sprn)
86 fprintf(logfile, "Write SPR %d %03x <= " ADDRX "\n",
87 sprn, sprn, env->spr[sprn]);
91 target_ulong helper_load_tbl (void)
93 return cpu_ppc_load_tbl(env);
96 target_ulong helper_load_tbu (void)
98 return cpu_ppc_load_tbu(env);
101 target_ulong helper_load_atbl (void)
103 return cpu_ppc_load_atbl(env);
106 target_ulong helper_load_atbu (void)
108 return cpu_ppc_load_atbu(env);
111 target_ulong helper_load_601_rtcl (void)
113 return cpu_ppc601_load_rtcl(env);
116 target_ulong helper_load_601_rtcu (void)
118 return cpu_ppc601_load_rtcu(env);
121 #if !defined(CONFIG_USER_ONLY)
122 #if defined (TARGET_PPC64)
123 void helper_store_asr (target_ulong val)
125 ppc_store_asr(env, val);
129 void helper_store_sdr1 (target_ulong val)
131 ppc_store_sdr1(env, val);
134 void helper_store_tbl (target_ulong val)
136 cpu_ppc_store_tbl(env, val);
139 void helper_store_tbu (target_ulong val)
141 cpu_ppc_store_tbu(env, val);
144 void helper_store_atbl (target_ulong val)
146 cpu_ppc_store_atbl(env, val);
149 void helper_store_atbu (target_ulong val)
151 cpu_ppc_store_atbu(env, val);
154 void helper_store_601_rtcl (target_ulong val)
156 cpu_ppc601_store_rtcl(env, val);
159 void helper_store_601_rtcu (target_ulong val)
161 cpu_ppc601_store_rtcu(env, val);
164 target_ulong helper_load_decr (void)
166 return cpu_ppc_load_decr(env);
169 void helper_store_decr (target_ulong val)
171 cpu_ppc_store_decr(env, val);
174 void helper_store_hid0_601 (target_ulong val)
178 hid0 = env->spr[SPR_HID0];
179 if ((val ^ hid0) & 0x00000008) {
180 /* Change current endianness */
181 env->hflags &= ~(1 << MSR_LE);
182 env->hflags_nmsr &= ~(1 << MSR_LE);
183 env->hflags_nmsr |= (1 << MSR_LE) & (((val >> 3) & 1) << MSR_LE);
184 env->hflags |= env->hflags_nmsr;
186 fprintf(logfile, "%s: set endianness to %c => " ADDRX "\n",
187 __func__, val & 0x8 ? 'l' : 'b', env->hflags);
190 env->spr[SPR_HID0] = (uint32_t)val;
193 void helper_store_403_pbr (uint32_t num, target_ulong value)
195 if (likely(env->pb[num] != value)) {
196 env->pb[num] = value;
197 /* Should be optimized */
202 target_ulong helper_load_40x_pit (void)
204 return load_40x_pit(env);
207 void helper_store_40x_pit (target_ulong val)
209 store_40x_pit(env, val);
212 void helper_store_40x_dbcr0 (target_ulong val)
214 store_40x_dbcr0(env, val);
217 void helper_store_40x_sler (target_ulong val)
219 store_40x_sler(env, val);
222 void helper_store_booke_tcr (target_ulong val)
224 store_booke_tcr(env, val);
227 void helper_store_booke_tsr (target_ulong val)
229 store_booke_tsr(env, val);
232 void helper_store_ibatu (uint32_t nr, target_ulong val)
234 ppc_store_ibatu(env, nr, val);
237 void helper_store_ibatl (uint32_t nr, target_ulong val)
239 ppc_store_ibatl(env, nr, val);
242 void helper_store_dbatu (uint32_t nr, target_ulong val)
244 ppc_store_dbatu(env, nr, val);
247 void helper_store_dbatl (uint32_t nr, target_ulong val)
249 ppc_store_dbatl(env, nr, val);
252 void helper_store_601_batl (uint32_t nr, target_ulong val)
254 ppc_store_ibatl_601(env, nr, val);
257 void helper_store_601_batu (uint32_t nr, target_ulong val)
259 ppc_store_ibatu_601(env, nr, val);
263 /*****************************************************************************/
264 /* Memory load and stores */
266 static always_inline target_ulong addr_add(target_ulong addr, target_long arg)
268 #if defined(TARGET_PPC64)
270 return (uint32_t)(addr + arg);
276 void helper_lmw (target_ulong addr, uint32_t reg)
278 for (; reg < 32; reg++) {
280 env->gpr[reg] = bswap32(ldl(addr));
282 env->gpr[reg] = ldl(addr);
283 addr = addr_add(addr, 4);
287 void helper_stmw (target_ulong addr, uint32_t reg)
289 for (; reg < 32; reg++) {
291 stl(addr, bswap32((uint32_t)env->gpr[reg]));
293 stl(addr, (uint32_t)env->gpr[reg]);
294 addr = addr_add(addr, 4);
298 void helper_lsw(target_ulong addr, uint32_t nb, uint32_t reg)
301 for (; nb > 3; nb -= 4) {
302 env->gpr[reg] = ldl(addr);
303 reg = (reg + 1) % 32;
304 addr = addr_add(addr, 4);
306 if (unlikely(nb > 0)) {
308 for (sh = 24; nb > 0; nb--, sh -= 8) {
309 env->gpr[reg] |= ldub(addr) << sh;
310 addr = addr_add(addr, 1);
314 /* PPC32 specification says we must generate an exception if
315 * rA is in the range of registers to be loaded.
316 * In an other hand, IBM says this is valid, but rA won't be loaded.
317 * For now, I'll follow the spec...
319 void helper_lswx(target_ulong addr, uint32_t reg, uint32_t ra, uint32_t rb)
321 if (likely(xer_bc != 0)) {
322 if (unlikely((ra != 0 && reg < ra && (reg + xer_bc) > ra) ||
323 (reg < rb && (reg + xer_bc) > rb))) {
324 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
326 POWERPC_EXCP_INVAL_LSWX);
328 helper_lsw(addr, xer_bc, reg);
333 void helper_stsw(target_ulong addr, uint32_t nb, uint32_t reg)
336 for (; nb > 3; nb -= 4) {
337 stl(addr, env->gpr[reg]);
338 reg = (reg + 1) % 32;
339 addr = addr_add(addr, 4);
341 if (unlikely(nb > 0)) {
342 for (sh = 24; nb > 0; nb--, sh -= 8) {
343 stb(addr, (env->gpr[reg] >> sh) & 0xFF);
344 addr = addr_add(addr, 1);
349 static void do_dcbz(target_ulong addr, int dcache_line_size)
351 addr &= ~(dcache_line_size - 1);
353 for (i = 0 ; i < dcache_line_size ; i += 4) {
356 if (env->reserve == addr)
357 env->reserve = (target_ulong)-1ULL;
360 void helper_dcbz(target_ulong addr)
362 do_dcbz(addr, env->dcache_line_size);
365 void helper_dcbz_970(target_ulong addr)
367 if (((env->spr[SPR_970_HID5] >> 7) & 0x3) == 1)
370 do_dcbz(addr, env->dcache_line_size);
373 void helper_icbi(target_ulong addr)
377 addr &= ~(env->dcache_line_size - 1);
378 /* Invalidate one cache line :
379 * PowerPC specification says this is to be treated like a load
380 * (not a fetch) by the MMU. To be sure it will be so,
381 * do the load "by hand".
384 tb_invalidate_page_range(addr, addr + env->icache_line_size);
388 target_ulong helper_lscbx (target_ulong addr, uint32_t reg, uint32_t ra, uint32_t rb)
392 for (i = 0; i < xer_bc; i++) {
394 addr = addr_add(addr, 1);
395 /* ra (if not 0) and rb are never modified */
396 if (likely(reg != rb && (ra == 0 || reg != ra))) {
397 env->gpr[reg] = (env->gpr[reg] & ~(0xFF << d)) | (c << d);
399 if (unlikely(c == xer_cmp))
401 if (likely(d != 0)) {
412 /*****************************************************************************/
413 /* Fixed point operations helpers */
414 #if defined(TARGET_PPC64)
416 /* multiply high word */
417 uint64_t helper_mulhd (uint64_t arg1, uint64_t arg2)
421 muls64(&tl, &th, arg1, arg2);
425 /* multiply high word unsigned */
426 uint64_t helper_mulhdu (uint64_t arg1, uint64_t arg2)
430 mulu64(&tl, &th, arg1, arg2);
434 uint64_t helper_mulldo (uint64_t arg1, uint64_t arg2)
439 muls64(&tl, (uint64_t *)&th, arg1, arg2);
440 /* If th != 0 && th != -1, then we had an overflow */
441 if (likely((uint64_t)(th + 1) <= 1)) {
442 env->xer &= ~(1 << XER_OV);
444 env->xer |= (1 << XER_OV) | (1 << XER_SO);
450 target_ulong helper_cntlzw (target_ulong t)
455 #if defined(TARGET_PPC64)
456 target_ulong helper_cntlzd (target_ulong t)
462 /* shift right arithmetic helper */
463 target_ulong helper_sraw (target_ulong value, target_ulong shift)
467 if (likely(!(shift & 0x20))) {
468 if (likely((uint32_t)shift != 0)) {
470 ret = (int32_t)value >> shift;
471 if (likely(ret >= 0 || (value & ((1 << shift) - 1)) == 0)) {
472 env->xer &= ~(1 << XER_CA);
474 env->xer |= (1 << XER_CA);
477 ret = (int32_t)value;
478 env->xer &= ~(1 << XER_CA);
481 ret = (int32_t)value >> 31;
483 env->xer |= (1 << XER_CA);
485 env->xer &= ~(1 << XER_CA);
488 return (target_long)ret;
491 #if defined(TARGET_PPC64)
492 target_ulong helper_srad (target_ulong value, target_ulong shift)
496 if (likely(!(shift & 0x40))) {
497 if (likely((uint64_t)shift != 0)) {
499 ret = (int64_t)value >> shift;
500 if (likely(ret >= 0 || (value & ((1 << shift) - 1)) == 0)) {
501 env->xer &= ~(1 << XER_CA);
503 env->xer |= (1 << XER_CA);
506 ret = (int64_t)value;
507 env->xer &= ~(1 << XER_CA);
510 ret = (int64_t)value >> 63;
512 env->xer |= (1 << XER_CA);
514 env->xer &= ~(1 << XER_CA);
521 target_ulong helper_popcntb (target_ulong val)
523 val = (val & 0x55555555) + ((val >> 1) & 0x55555555);
524 val = (val & 0x33333333) + ((val >> 2) & 0x33333333);
525 val = (val & 0x0f0f0f0f) + ((val >> 4) & 0x0f0f0f0f);
529 #if defined(TARGET_PPC64)
530 target_ulong helper_popcntb_64 (target_ulong val)
532 val = (val & 0x5555555555555555ULL) + ((val >> 1) & 0x5555555555555555ULL);
533 val = (val & 0x3333333333333333ULL) + ((val >> 2) & 0x3333333333333333ULL);
534 val = (val & 0x0f0f0f0f0f0f0f0fULL) + ((val >> 4) & 0x0f0f0f0f0f0f0f0fULL);
539 /*****************************************************************************/
540 /* Floating point operations helpers */
541 uint64_t helper_float32_to_float64(uint32_t arg)
546 d.d = float32_to_float64(f.f, &env->fp_status);
550 uint32_t helper_float64_to_float32(uint64_t arg)
555 f.f = float64_to_float32(d.d, &env->fp_status);
559 static always_inline int isden (float64 d)
565 return ((u.ll >> 52) & 0x7FF) == 0;
568 uint32_t helper_compute_fprf (uint64_t arg, uint32_t set_fprf)
574 isneg = float64_is_neg(farg.d);
575 if (unlikely(float64_is_nan(farg.d))) {
576 if (float64_is_signaling_nan(farg.d)) {
577 /* Signaling NaN: flags are undefined */
583 } else if (unlikely(float64_is_infinity(farg.d))) {
590 if (float64_is_zero(farg.d)) {
598 /* Denormalized numbers */
601 /* Normalized numbers */
612 /* We update FPSCR_FPRF */
613 env->fpscr &= ~(0x1F << FPSCR_FPRF);
614 env->fpscr |= ret << FPSCR_FPRF;
616 /* We just need fpcc to update Rc1 */
620 /* Floating-point invalid operations exception */
621 static always_inline uint64_t fload_invalid_op_excp (int op)
628 case POWERPC_EXCP_FP_VXSNAN:
629 env->fpscr |= 1 << FPSCR_VXSNAN;
631 case POWERPC_EXCP_FP_VXSOFT:
632 env->fpscr |= 1 << FPSCR_VXSOFT;
634 case POWERPC_EXCP_FP_VXISI:
635 /* Magnitude subtraction of infinities */
636 env->fpscr |= 1 << FPSCR_VXISI;
638 case POWERPC_EXCP_FP_VXIDI:
639 /* Division of infinity by infinity */
640 env->fpscr |= 1 << FPSCR_VXIDI;
642 case POWERPC_EXCP_FP_VXZDZ:
643 /* Division of zero by zero */
644 env->fpscr |= 1 << FPSCR_VXZDZ;
646 case POWERPC_EXCP_FP_VXIMZ:
647 /* Multiplication of zero by infinity */
648 env->fpscr |= 1 << FPSCR_VXIMZ;
650 case POWERPC_EXCP_FP_VXVC:
651 /* Ordered comparison of NaN */
652 env->fpscr |= 1 << FPSCR_VXVC;
653 env->fpscr &= ~(0xF << FPSCR_FPCC);
654 env->fpscr |= 0x11 << FPSCR_FPCC;
655 /* We must update the target FPR before raising the exception */
657 env->exception_index = POWERPC_EXCP_PROGRAM;
658 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_VXVC;
659 /* Update the floating-point enabled exception summary */
660 env->fpscr |= 1 << FPSCR_FEX;
661 /* Exception is differed */
665 case POWERPC_EXCP_FP_VXSQRT:
666 /* Square root of a negative number */
667 env->fpscr |= 1 << FPSCR_VXSQRT;
669 env->fpscr &= ~((1 << FPSCR_FR) | (1 << FPSCR_FI));
671 /* Set the result to quiet NaN */
672 ret = 0xFFF8000000000000ULL;
673 env->fpscr &= ~(0xF << FPSCR_FPCC);
674 env->fpscr |= 0x11 << FPSCR_FPCC;
677 case POWERPC_EXCP_FP_VXCVI:
678 /* Invalid conversion */
679 env->fpscr |= 1 << FPSCR_VXCVI;
680 env->fpscr &= ~((1 << FPSCR_FR) | (1 << FPSCR_FI));
682 /* Set the result to quiet NaN */
683 ret = 0xFFF8000000000000ULL;
684 env->fpscr &= ~(0xF << FPSCR_FPCC);
685 env->fpscr |= 0x11 << FPSCR_FPCC;
689 /* Update the floating-point invalid operation summary */
690 env->fpscr |= 1 << FPSCR_VX;
691 /* Update the floating-point exception summary */
692 env->fpscr |= 1 << FPSCR_FX;
694 /* Update the floating-point enabled exception summary */
695 env->fpscr |= 1 << FPSCR_FEX;
696 if (msr_fe0 != 0 || msr_fe1 != 0)
697 helper_raise_exception_err(POWERPC_EXCP_PROGRAM, POWERPC_EXCP_FP | op);
702 static always_inline void float_zero_divide_excp (void)
704 env->fpscr |= 1 << FPSCR_ZX;
705 env->fpscr &= ~((1 << FPSCR_FR) | (1 << FPSCR_FI));
706 /* Update the floating-point exception summary */
707 env->fpscr |= 1 << FPSCR_FX;
709 /* Update the floating-point enabled exception summary */
710 env->fpscr |= 1 << FPSCR_FEX;
711 if (msr_fe0 != 0 || msr_fe1 != 0) {
712 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
713 POWERPC_EXCP_FP | POWERPC_EXCP_FP_ZX);
718 static always_inline void float_overflow_excp (void)
720 env->fpscr |= 1 << FPSCR_OX;
721 /* Update the floating-point exception summary */
722 env->fpscr |= 1 << FPSCR_FX;
724 /* XXX: should adjust the result */
725 /* Update the floating-point enabled exception summary */
726 env->fpscr |= 1 << FPSCR_FEX;
727 /* We must update the target FPR before raising the exception */
728 env->exception_index = POWERPC_EXCP_PROGRAM;
729 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_OX;
731 env->fpscr |= 1 << FPSCR_XX;
732 env->fpscr |= 1 << FPSCR_FI;
736 static always_inline void float_underflow_excp (void)
738 env->fpscr |= 1 << FPSCR_UX;
739 /* Update the floating-point exception summary */
740 env->fpscr |= 1 << FPSCR_FX;
742 /* XXX: should adjust the result */
743 /* Update the floating-point enabled exception summary */
744 env->fpscr |= 1 << FPSCR_FEX;
745 /* We must update the target FPR before raising the exception */
746 env->exception_index = POWERPC_EXCP_PROGRAM;
747 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_UX;
751 static always_inline void float_inexact_excp (void)
753 env->fpscr |= 1 << FPSCR_XX;
754 /* Update the floating-point exception summary */
755 env->fpscr |= 1 << FPSCR_FX;
757 /* Update the floating-point enabled exception summary */
758 env->fpscr |= 1 << FPSCR_FEX;
759 /* We must update the target FPR before raising the exception */
760 env->exception_index = POWERPC_EXCP_PROGRAM;
761 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_XX;
765 static always_inline void fpscr_set_rounding_mode (void)
769 /* Set rounding mode */
772 /* Best approximation (round to nearest) */
773 rnd_type = float_round_nearest_even;
776 /* Smaller magnitude (round toward zero) */
777 rnd_type = float_round_to_zero;
780 /* Round toward +infinite */
781 rnd_type = float_round_up;
785 /* Round toward -infinite */
786 rnd_type = float_round_down;
789 set_float_rounding_mode(rnd_type, &env->fp_status);
792 void helper_fpscr_clrbit (uint32_t bit)
796 prev = (env->fpscr >> bit) & 1;
797 env->fpscr &= ~(1 << bit);
802 fpscr_set_rounding_mode();
810 void helper_fpscr_setbit (uint32_t bit)
814 prev = (env->fpscr >> bit) & 1;
815 env->fpscr |= 1 << bit;
819 env->fpscr |= 1 << FPSCR_FX;
823 env->fpscr |= 1 << FPSCR_FX;
828 env->fpscr |= 1 << FPSCR_FX;
833 env->fpscr |= 1 << FPSCR_FX;
838 env->fpscr |= 1 << FPSCR_FX;
851 env->fpscr |= 1 << FPSCR_VX;
852 env->fpscr |= 1 << FPSCR_FX;
859 env->error_code = POWERPC_EXCP_FP;
861 env->error_code |= POWERPC_EXCP_FP_VXSNAN;
863 env->error_code |= POWERPC_EXCP_FP_VXISI;
865 env->error_code |= POWERPC_EXCP_FP_VXIDI;
867 env->error_code |= POWERPC_EXCP_FP_VXZDZ;
869 env->error_code |= POWERPC_EXCP_FP_VXIMZ;
871 env->error_code |= POWERPC_EXCP_FP_VXVC;
873 env->error_code |= POWERPC_EXCP_FP_VXSOFT;
875 env->error_code |= POWERPC_EXCP_FP_VXSQRT;
877 env->error_code |= POWERPC_EXCP_FP_VXCVI;
884 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_OX;
891 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_UX;
898 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_ZX;
905 env->error_code = POWERPC_EXCP_FP | POWERPC_EXCP_FP_XX;
911 fpscr_set_rounding_mode();
916 /* Update the floating-point enabled exception summary */
917 env->fpscr |= 1 << FPSCR_FEX;
918 /* We have to update Rc1 before raising the exception */
919 env->exception_index = POWERPC_EXCP_PROGRAM;
925 void helper_store_fpscr (uint64_t arg, uint32_t mask)
928 * We use only the 32 LSB of the incoming fpr
936 new |= prev & 0x60000000;
937 for (i = 0; i < 8; i++) {
938 if (mask & (1 << i)) {
939 env->fpscr &= ~(0xF << (4 * i));
940 env->fpscr |= new & (0xF << (4 * i));
943 /* Update VX and FEX */
945 env->fpscr |= 1 << FPSCR_VX;
947 env->fpscr &= ~(1 << FPSCR_VX);
948 if ((fpscr_ex & fpscr_eex) != 0) {
949 env->fpscr |= 1 << FPSCR_FEX;
950 env->exception_index = POWERPC_EXCP_PROGRAM;
951 /* XXX: we should compute it properly */
952 env->error_code = POWERPC_EXCP_FP;
955 env->fpscr &= ~(1 << FPSCR_FEX);
956 fpscr_set_rounding_mode();
959 void helper_float_check_status (void)
961 #ifdef CONFIG_SOFTFLOAT
962 if (env->exception_index == POWERPC_EXCP_PROGRAM &&
963 (env->error_code & POWERPC_EXCP_FP)) {
964 /* Differred floating-point exception after target FPR update */
965 if (msr_fe0 != 0 || msr_fe1 != 0)
966 helper_raise_exception_err(env->exception_index, env->error_code);
968 int status = get_float_exception_flags(&env->fp_status);
969 if (status & float_flag_divbyzero) {
970 float_zero_divide_excp();
971 } else if (status & float_flag_overflow) {
972 float_overflow_excp();
973 } else if (status & float_flag_underflow) {
974 float_underflow_excp();
975 } else if (status & float_flag_inexact) {
976 float_inexact_excp();
980 if (env->exception_index == POWERPC_EXCP_PROGRAM &&
981 (env->error_code & POWERPC_EXCP_FP)) {
982 /* Differred floating-point exception after target FPR update */
983 if (msr_fe0 != 0 || msr_fe1 != 0)
984 helper_raise_exception_err(env->exception_index, env->error_code);
989 #ifdef CONFIG_SOFTFLOAT
990 void helper_reset_fpstatus (void)
992 set_float_exception_flags(0, &env->fp_status);
997 uint64_t helper_fadd (uint64_t arg1, uint64_t arg2)
999 CPU_DoubleU farg1, farg2;
1003 #if USE_PRECISE_EMULATION
1004 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1005 float64_is_signaling_nan(farg2.d))) {
1007 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1008 } else if (unlikely(float64_is_infinity(farg1.d) && float64_is_infinity(farg2.d) &&
1009 float64_is_neg(farg1.d) != float64_is_neg(farg2.d))) {
1010 /* Magnitude subtraction of infinities */
1011 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1013 farg1.d = float64_add(farg1.d, farg2.d, &env->fp_status);
1016 farg1.d = float64_add(farg1.d, farg2.d, &env->fp_status);
1022 uint64_t helper_fsub (uint64_t arg1, uint64_t arg2)
1024 CPU_DoubleU farg1, farg2;
1028 #if USE_PRECISE_EMULATION
1030 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1031 float64_is_signaling_nan(farg2.d))) {
1032 /* sNaN subtraction */
1033 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1034 } else if (unlikely(float64_is_infinity(farg1.d) && float64_is_infinity(farg2.d) &&
1035 float64_is_neg(farg1.d) == float64_is_neg(farg2.d))) {
1036 /* Magnitude subtraction of infinities */
1037 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1039 farg1.d = float64_sub(farg1.d, farg2.d, &env->fp_status);
1043 farg1.d = float64_sub(farg1.d, farg2.d, &env->fp_status);
1049 uint64_t helper_fmul (uint64_t arg1, uint64_t arg2)
1051 CPU_DoubleU farg1, farg2;
1055 #if USE_PRECISE_EMULATION
1056 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1057 float64_is_signaling_nan(farg2.d))) {
1058 /* sNaN multiplication */
1059 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1060 } else if (unlikely((float64_is_infinity(farg1.d) && float64_is_zero(farg2.d)) ||
1061 (float64_is_zero(farg1.d) && float64_is_infinity(farg2.d)))) {
1062 /* Multiplication of zero by infinity */
1063 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIMZ);
1065 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1068 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1074 uint64_t helper_fdiv (uint64_t arg1, uint64_t arg2)
1076 CPU_DoubleU farg1, farg2;
1080 #if USE_PRECISE_EMULATION
1081 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1082 float64_is_signaling_nan(farg2.d))) {
1084 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1085 } else if (unlikely(float64_is_infinity(farg1.d) && float64_is_infinity(farg2.d))) {
1086 /* Division of infinity by infinity */
1087 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIDI);
1088 } else if (unlikely(float64_is_zero(farg1.d) && float64_is_zero(farg2.d))) {
1089 /* Division of zero by zero */
1090 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXZDZ);
1092 farg1.d = float64_div(farg1.d, farg2.d, &env->fp_status);
1095 farg1.d = float64_div(farg1.d, farg2.d, &env->fp_status);
1101 uint64_t helper_fabs (uint64_t arg)
1106 farg.d = float64_abs(farg.d);
1111 uint64_t helper_fnabs (uint64_t arg)
1116 farg.d = float64_abs(farg.d);
1117 farg.d = float64_chs(farg.d);
1122 uint64_t helper_fneg (uint64_t arg)
1127 farg.d = float64_chs(farg.d);
1131 /* fctiw - fctiw. */
1132 uint64_t helper_fctiw (uint64_t arg)
1137 if (unlikely(float64_is_signaling_nan(farg.d))) {
1138 /* sNaN conversion */
1139 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN | POWERPC_EXCP_FP_VXCVI);
1140 } else if (unlikely(float64_is_nan(farg.d) || float64_is_infinity(farg.d))) {
1141 /* qNan / infinity conversion */
1142 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXCVI);
1144 farg.ll = float64_to_int32(farg.d, &env->fp_status);
1145 #if USE_PRECISE_EMULATION
1146 /* XXX: higher bits are not supposed to be significant.
1147 * to make tests easier, return the same as a real PowerPC 750
1149 farg.ll |= 0xFFF80000ULL << 32;
1155 /* fctiwz - fctiwz. */
1156 uint64_t helper_fctiwz (uint64_t arg)
1161 if (unlikely(float64_is_signaling_nan(farg.d))) {
1162 /* sNaN conversion */
1163 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN | POWERPC_EXCP_FP_VXCVI);
1164 } else if (unlikely(float64_is_nan(farg.d) || float64_is_infinity(farg.d))) {
1165 /* qNan / infinity conversion */
1166 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXCVI);
1168 farg.ll = float64_to_int32_round_to_zero(farg.d, &env->fp_status);
1169 #if USE_PRECISE_EMULATION
1170 /* XXX: higher bits are not supposed to be significant.
1171 * to make tests easier, return the same as a real PowerPC 750
1173 farg.ll |= 0xFFF80000ULL << 32;
1179 #if defined(TARGET_PPC64)
1180 /* fcfid - fcfid. */
1181 uint64_t helper_fcfid (uint64_t arg)
1184 farg.d = int64_to_float64(arg, &env->fp_status);
1188 /* fctid - fctid. */
1189 uint64_t helper_fctid (uint64_t arg)
1194 if (unlikely(float64_is_signaling_nan(farg.d))) {
1195 /* sNaN conversion */
1196 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN | POWERPC_EXCP_FP_VXCVI);
1197 } else if (unlikely(float64_is_nan(farg.d) || float64_is_infinity(farg.d))) {
1198 /* qNan / infinity conversion */
1199 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXCVI);
1201 farg.ll = float64_to_int64(farg.d, &env->fp_status);
1206 /* fctidz - fctidz. */
1207 uint64_t helper_fctidz (uint64_t arg)
1212 if (unlikely(float64_is_signaling_nan(farg.d))) {
1213 /* sNaN conversion */
1214 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN | POWERPC_EXCP_FP_VXCVI);
1215 } else if (unlikely(float64_is_nan(farg.d) || float64_is_infinity(farg.d))) {
1216 /* qNan / infinity conversion */
1217 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXCVI);
1219 farg.ll = float64_to_int64_round_to_zero(farg.d, &env->fp_status);
1226 static always_inline uint64_t do_fri (uint64_t arg, int rounding_mode)
1231 if (unlikely(float64_is_signaling_nan(farg.d))) {
1233 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN | POWERPC_EXCP_FP_VXCVI);
1234 } else if (unlikely(float64_is_nan(farg.d) || float64_is_infinity(farg.d))) {
1235 /* qNan / infinity round */
1236 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXCVI);
1238 set_float_rounding_mode(rounding_mode, &env->fp_status);
1239 farg.ll = float64_round_to_int(farg.d, &env->fp_status);
1240 /* Restore rounding mode from FPSCR */
1241 fpscr_set_rounding_mode();
1246 uint64_t helper_frin (uint64_t arg)
1248 return do_fri(arg, float_round_nearest_even);
1251 uint64_t helper_friz (uint64_t arg)
1253 return do_fri(arg, float_round_to_zero);
1256 uint64_t helper_frip (uint64_t arg)
1258 return do_fri(arg, float_round_up);
1261 uint64_t helper_frim (uint64_t arg)
1263 return do_fri(arg, float_round_down);
1266 /* fmadd - fmadd. */
1267 uint64_t helper_fmadd (uint64_t arg1, uint64_t arg2, uint64_t arg3)
1269 CPU_DoubleU farg1, farg2, farg3;
1274 #if USE_PRECISE_EMULATION
1275 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1276 float64_is_signaling_nan(farg2.d) ||
1277 float64_is_signaling_nan(farg3.d))) {
1278 /* sNaN operation */
1279 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1280 } else if (unlikely((float64_is_infinity(farg1.d) && float64_is_zero(farg2.d)) ||
1281 (float64_is_zero(farg1.d) && float64_is_infinity(farg2.d)))) {
1282 /* Multiplication of zero by infinity */
1283 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIMZ);
1286 /* This is the way the PowerPC specification defines it */
1287 float128 ft0_128, ft1_128;
1289 ft0_128 = float64_to_float128(farg1.d, &env->fp_status);
1290 ft1_128 = float64_to_float128(farg2.d, &env->fp_status);
1291 ft0_128 = float128_mul(ft0_128, ft1_128, &env->fp_status);
1292 if (unlikely(float128_is_infinity(ft0_128) && float64_is_infinity(farg3.d) &&
1293 float128_is_neg(ft0_128) != float64_is_neg(farg3.d))) {
1294 /* Magnitude subtraction of infinities */
1295 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1297 ft1_128 = float64_to_float128(farg3.d, &env->fp_status);
1298 ft0_128 = float128_add(ft0_128, ft1_128, &env->fp_status);
1299 farg1.d = float128_to_float64(ft0_128, &env->fp_status);
1302 /* This is OK on x86 hosts */
1303 farg1.d = (farg1.d * farg2.d) + farg3.d;
1307 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1308 farg1.d = float64_add(farg1.d, farg3.d, &env->fp_status);
1313 /* fmsub - fmsub. */
1314 uint64_t helper_fmsub (uint64_t arg1, uint64_t arg2, uint64_t arg3)
1316 CPU_DoubleU farg1, farg2, farg3;
1321 #if USE_PRECISE_EMULATION
1322 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1323 float64_is_signaling_nan(farg2.d) ||
1324 float64_is_signaling_nan(farg3.d))) {
1325 /* sNaN operation */
1326 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1327 } else if (unlikely((float64_is_infinity(farg1.d) && float64_is_zero(farg2.d)) ||
1328 (float64_is_zero(farg1.d) && float64_is_infinity(farg2.d)))) {
1329 /* Multiplication of zero by infinity */
1330 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIMZ);
1333 /* This is the way the PowerPC specification defines it */
1334 float128 ft0_128, ft1_128;
1336 ft0_128 = float64_to_float128(farg1.d, &env->fp_status);
1337 ft1_128 = float64_to_float128(farg2.d, &env->fp_status);
1338 ft0_128 = float128_mul(ft0_128, ft1_128, &env->fp_status);
1339 if (unlikely(float128_is_infinity(ft0_128) && float64_is_infinity(farg3.d) &&
1340 float128_is_neg(ft0_128) == float64_is_neg(farg3.d))) {
1341 /* Magnitude subtraction of infinities */
1342 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1344 ft1_128 = float64_to_float128(farg3.d, &env->fp_status);
1345 ft0_128 = float128_sub(ft0_128, ft1_128, &env->fp_status);
1346 farg1.d = float128_to_float64(ft0_128, &env->fp_status);
1349 /* This is OK on x86 hosts */
1350 farg1.d = (farg1.d * farg2.d) - farg3.d;
1354 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1355 farg1.d = float64_sub(farg1.d, farg3.d, &env->fp_status);
1360 /* fnmadd - fnmadd. */
1361 uint64_t helper_fnmadd (uint64_t arg1, uint64_t arg2, uint64_t arg3)
1363 CPU_DoubleU farg1, farg2, farg3;
1369 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1370 float64_is_signaling_nan(farg2.d) ||
1371 float64_is_signaling_nan(farg3.d))) {
1372 /* sNaN operation */
1373 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1374 } else if (unlikely((float64_is_infinity(farg1.d) && float64_is_zero(farg2.d)) ||
1375 (float64_is_zero(farg1.d) && float64_is_infinity(farg2.d)))) {
1376 /* Multiplication of zero by infinity */
1377 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIMZ);
1379 #if USE_PRECISE_EMULATION
1381 /* This is the way the PowerPC specification defines it */
1382 float128 ft0_128, ft1_128;
1384 ft0_128 = float64_to_float128(farg1.d, &env->fp_status);
1385 ft1_128 = float64_to_float128(farg2.d, &env->fp_status);
1386 ft0_128 = float128_mul(ft0_128, ft1_128, &env->fp_status);
1387 if (unlikely(float128_is_infinity(ft0_128) && float64_is_infinity(farg3.d) &&
1388 float128_is_neg(ft0_128) != float64_is_neg(farg3.d))) {
1389 /* Magnitude subtraction of infinities */
1390 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1392 ft1_128 = float64_to_float128(farg3.d, &env->fp_status);
1393 ft0_128 = float128_add(ft0_128, ft1_128, &env->fp_status);
1394 farg1.d = float128_to_float64(ft0_128, &env->fp_status);
1397 /* This is OK on x86 hosts */
1398 farg1.d = (farg1.d * farg2.d) + farg3.d;
1401 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1402 farg1.d = float64_add(farg1.d, farg3.d, &env->fp_status);
1404 if (likely(!float64_is_nan(farg1.d)))
1405 farg1.d = float64_chs(farg1.d);
1410 /* fnmsub - fnmsub. */
1411 uint64_t helper_fnmsub (uint64_t arg1, uint64_t arg2, uint64_t arg3)
1413 CPU_DoubleU farg1, farg2, farg3;
1419 if (unlikely(float64_is_signaling_nan(farg1.d) ||
1420 float64_is_signaling_nan(farg2.d) ||
1421 float64_is_signaling_nan(farg3.d))) {
1422 /* sNaN operation */
1423 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1424 } else if (unlikely((float64_is_infinity(farg1.d) && float64_is_zero(farg2.d)) ||
1425 (float64_is_zero(farg1.d) && float64_is_infinity(farg2.d)))) {
1426 /* Multiplication of zero by infinity */
1427 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXIMZ);
1429 #if USE_PRECISE_EMULATION
1431 /* This is the way the PowerPC specification defines it */
1432 float128 ft0_128, ft1_128;
1434 ft0_128 = float64_to_float128(farg1.d, &env->fp_status);
1435 ft1_128 = float64_to_float128(farg2.d, &env->fp_status);
1436 ft0_128 = float128_mul(ft0_128, ft1_128, &env->fp_status);
1437 if (unlikely(float128_is_infinity(ft0_128) && float64_is_infinity(farg3.d) &&
1438 float128_is_neg(ft0_128) == float64_is_neg(farg3.d))) {
1439 /* Magnitude subtraction of infinities */
1440 farg1.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXISI);
1442 ft1_128 = float64_to_float128(farg3.d, &env->fp_status);
1443 ft0_128 = float128_sub(ft0_128, ft1_128, &env->fp_status);
1444 farg1.d = float128_to_float64(ft0_128, &env->fp_status);
1447 /* This is OK on x86 hosts */
1448 farg1.d = (farg1.d * farg2.d) - farg3.d;
1451 farg1.d = float64_mul(farg1.d, farg2.d, &env->fp_status);
1452 farg1.d = float64_sub(farg1.d, farg3.d, &env->fp_status);
1454 if (likely(!float64_is_nan(farg1.d)))
1455 farg1.d = float64_chs(farg1.d);
1461 uint64_t helper_frsp (uint64_t arg)
1467 #if USE_PRECISE_EMULATION
1468 if (unlikely(float64_is_signaling_nan(farg.d))) {
1469 /* sNaN square root */
1470 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1472 f32 = float64_to_float32(farg.d, &env->fp_status);
1473 farg.d = float32_to_float64(f32, &env->fp_status);
1476 f32 = float64_to_float32(farg.d, &env->fp_status);
1477 farg.d = float32_to_float64(f32, &env->fp_status);
1482 /* fsqrt - fsqrt. */
1483 uint64_t helper_fsqrt (uint64_t arg)
1488 if (unlikely(float64_is_signaling_nan(farg.d))) {
1489 /* sNaN square root */
1490 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1491 } else if (unlikely(float64_is_neg(farg.d) && !float64_is_zero(farg.d))) {
1492 /* Square root of a negative nonzero number */
1493 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSQRT);
1495 farg.d = float64_sqrt(farg.d, &env->fp_status);
1501 uint64_t helper_fre (uint64_t arg)
1503 CPU_DoubleU fone, farg;
1504 fone.ll = 0x3FF0000000000000ULL; /* 1.0 */
1507 if (unlikely(float64_is_signaling_nan(farg.d))) {
1508 /* sNaN reciprocal */
1509 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1511 farg.d = float64_div(fone.d, farg.d, &env->fp_status);
1517 uint64_t helper_fres (uint64_t arg)
1519 CPU_DoubleU fone, farg;
1521 fone.ll = 0x3FF0000000000000ULL; /* 1.0 */
1524 if (unlikely(float64_is_signaling_nan(farg.d))) {
1525 /* sNaN reciprocal */
1526 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1528 farg.d = float64_div(fone.d, farg.d, &env->fp_status);
1529 f32 = float64_to_float32(farg.d, &env->fp_status);
1530 farg.d = float32_to_float64(f32, &env->fp_status);
1535 /* frsqrte - frsqrte. */
1536 uint64_t helper_frsqrte (uint64_t arg)
1538 CPU_DoubleU fone, farg;
1540 fone.ll = 0x3FF0000000000000ULL; /* 1.0 */
1543 if (unlikely(float64_is_signaling_nan(farg.d))) {
1544 /* sNaN reciprocal square root */
1545 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1546 } else if (unlikely(float64_is_neg(farg.d) && !float64_is_zero(farg.d))) {
1547 /* Reciprocal square root of a negative nonzero number */
1548 farg.ll = fload_invalid_op_excp(POWERPC_EXCP_FP_VXSQRT);
1550 farg.d = float64_sqrt(farg.d, &env->fp_status);
1551 farg.d = float64_div(fone.d, farg.d, &env->fp_status);
1552 f32 = float64_to_float32(farg.d, &env->fp_status);
1553 farg.d = float32_to_float64(f32, &env->fp_status);
1559 uint64_t helper_fsel (uint64_t arg1, uint64_t arg2, uint64_t arg3)
1565 if ((!float64_is_neg(farg1.d) || float64_is_zero(farg1.d)) && !float64_is_nan(farg1.d))
1571 void helper_fcmpu (uint64_t arg1, uint64_t arg2, uint32_t crfD)
1573 CPU_DoubleU farg1, farg2;
1578 if (unlikely(float64_is_nan(farg1.d) ||
1579 float64_is_nan(farg2.d))) {
1581 } else if (float64_lt(farg1.d, farg2.d, &env->fp_status)) {
1583 } else if (!float64_le(farg1.d, farg2.d, &env->fp_status)) {
1589 env->fpscr &= ~(0x0F << FPSCR_FPRF);
1590 env->fpscr |= ret << FPSCR_FPRF;
1591 env->crf[crfD] = ret;
1592 if (unlikely(ret == 0x01UL
1593 && (float64_is_signaling_nan(farg1.d) ||
1594 float64_is_signaling_nan(farg2.d)))) {
1595 /* sNaN comparison */
1596 fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN);
1600 void helper_fcmpo (uint64_t arg1, uint64_t arg2, uint32_t crfD)
1602 CPU_DoubleU farg1, farg2;
1607 if (unlikely(float64_is_nan(farg1.d) ||
1608 float64_is_nan(farg2.d))) {
1610 } else if (float64_lt(farg1.d, farg2.d, &env->fp_status)) {
1612 } else if (!float64_le(farg1.d, farg2.d, &env->fp_status)) {
1618 env->fpscr &= ~(0x0F << FPSCR_FPRF);
1619 env->fpscr |= ret << FPSCR_FPRF;
1620 env->crf[crfD] = ret;
1621 if (unlikely (ret == 0x01UL)) {
1622 if (float64_is_signaling_nan(farg1.d) ||
1623 float64_is_signaling_nan(farg2.d)) {
1624 /* sNaN comparison */
1625 fload_invalid_op_excp(POWERPC_EXCP_FP_VXSNAN |
1626 POWERPC_EXCP_FP_VXVC);
1628 /* qNaN comparison */
1629 fload_invalid_op_excp(POWERPC_EXCP_FP_VXVC);
1634 #if !defined (CONFIG_USER_ONLY)
1635 void helper_store_msr (target_ulong val)
1637 val = hreg_store_msr(env, val, 0);
1639 env->interrupt_request |= CPU_INTERRUPT_EXITTB;
1640 helper_raise_exception(val);
1644 static always_inline void do_rfi (target_ulong nip, target_ulong msr,
1645 target_ulong msrm, int keep_msrh)
1647 #if defined(TARGET_PPC64)
1648 if (msr & (1ULL << MSR_SF)) {
1649 nip = (uint64_t)nip;
1650 msr &= (uint64_t)msrm;
1652 nip = (uint32_t)nip;
1653 msr = (uint32_t)(msr & msrm);
1655 msr |= env->msr & ~((uint64_t)0xFFFFFFFF);
1658 nip = (uint32_t)nip;
1659 msr &= (uint32_t)msrm;
1661 /* XXX: beware: this is false if VLE is supported */
1662 env->nip = nip & ~((target_ulong)0x00000003);
1663 hreg_store_msr(env, msr, 1);
1664 #if defined (DEBUG_OP)
1665 cpu_dump_rfi(env->nip, env->msr);
1667 /* No need to raise an exception here,
1668 * as rfi is always the last insn of a TB
1670 env->interrupt_request |= CPU_INTERRUPT_EXITTB;
1673 void helper_rfi (void)
1675 do_rfi(env->spr[SPR_SRR0], env->spr[SPR_SRR1],
1676 ~((target_ulong)0xFFFF0000), 1);
1679 #if defined(TARGET_PPC64)
1680 void helper_rfid (void)
1682 do_rfi(env->spr[SPR_SRR0], env->spr[SPR_SRR1],
1683 ~((target_ulong)0xFFFF0000), 0);
1686 void helper_hrfid (void)
1688 do_rfi(env->spr[SPR_HSRR0], env->spr[SPR_HSRR1],
1689 ~((target_ulong)0xFFFF0000), 0);
1694 void helper_tw (target_ulong arg1, target_ulong arg2, uint32_t flags)
1696 if (!likely(!(((int32_t)arg1 < (int32_t)arg2 && (flags & 0x10)) ||
1697 ((int32_t)arg1 > (int32_t)arg2 && (flags & 0x08)) ||
1698 ((int32_t)arg1 == (int32_t)arg2 && (flags & 0x04)) ||
1699 ((uint32_t)arg1 < (uint32_t)arg2 && (flags & 0x02)) ||
1700 ((uint32_t)arg1 > (uint32_t)arg2 && (flags & 0x01))))) {
1701 helper_raise_exception_err(POWERPC_EXCP_PROGRAM, POWERPC_EXCP_TRAP);
1705 #if defined(TARGET_PPC64)
1706 void helper_td (target_ulong arg1, target_ulong arg2, uint32_t flags)
1708 if (!likely(!(((int64_t)arg1 < (int64_t)arg2 && (flags & 0x10)) ||
1709 ((int64_t)arg1 > (int64_t)arg2 && (flags & 0x08)) ||
1710 ((int64_t)arg1 == (int64_t)arg2 && (flags & 0x04)) ||
1711 ((uint64_t)arg1 < (uint64_t)arg2 && (flags & 0x02)) ||
1712 ((uint64_t)arg1 > (uint64_t)arg2 && (flags & 0x01)))))
1713 helper_raise_exception_err(POWERPC_EXCP_PROGRAM, POWERPC_EXCP_TRAP);
1717 /*****************************************************************************/
1718 /* PowerPC 601 specific instructions (POWER bridge) */
1720 target_ulong helper_clcs (uint32_t arg)
1724 /* Instruction cache line size */
1725 return env->icache_line_size;
1728 /* Data cache line size */
1729 return env->dcache_line_size;
1732 /* Minimum cache line size */
1733 return (env->icache_line_size < env->dcache_line_size) ?
1734 env->icache_line_size : env->dcache_line_size;
1737 /* Maximum cache line size */
1738 return (env->icache_line_size > env->dcache_line_size) ?
1739 env->icache_line_size : env->dcache_line_size;
1748 target_ulong helper_div (target_ulong arg1, target_ulong arg2)
1750 uint64_t tmp = (uint64_t)arg1 << 32 | env->spr[SPR_MQ];
1752 if (((int32_t)tmp == INT32_MIN && (int32_t)arg2 == (int32_t)-1) ||
1753 (int32_t)arg2 == 0) {
1754 env->spr[SPR_MQ] = 0;
1757 env->spr[SPR_MQ] = tmp % arg2;
1758 return tmp / (int32_t)arg2;
1762 target_ulong helper_divo (target_ulong arg1, target_ulong arg2)
1764 uint64_t tmp = (uint64_t)arg1 << 32 | env->spr[SPR_MQ];
1766 if (((int32_t)tmp == INT32_MIN && (int32_t)arg2 == (int32_t)-1) ||
1767 (int32_t)arg2 == 0) {
1768 env->xer |= (1 << XER_OV) | (1 << XER_SO);
1769 env->spr[SPR_MQ] = 0;
1772 env->spr[SPR_MQ] = tmp % arg2;
1773 tmp /= (int32_t)arg2;
1774 if ((int32_t)tmp != tmp) {
1775 env->xer |= (1 << XER_OV) | (1 << XER_SO);
1777 env->xer &= ~(1 << XER_OV);
1783 target_ulong helper_divs (target_ulong arg1, target_ulong arg2)
1785 if (((int32_t)arg1 == INT32_MIN && (int32_t)arg2 == (int32_t)-1) ||
1786 (int32_t)arg2 == 0) {
1787 env->spr[SPR_MQ] = 0;
1790 env->spr[SPR_MQ] = (int32_t)arg1 % (int32_t)arg2;
1791 return (int32_t)arg1 / (int32_t)arg2;
1795 target_ulong helper_divso (target_ulong arg1, target_ulong arg2)
1797 if (((int32_t)arg1 == INT32_MIN && (int32_t)arg2 == (int32_t)-1) ||
1798 (int32_t)arg2 == 0) {
1799 env->xer |= (1 << XER_OV) | (1 << XER_SO);
1800 env->spr[SPR_MQ] = 0;
1803 env->xer &= ~(1 << XER_OV);
1804 env->spr[SPR_MQ] = (int32_t)arg1 % (int32_t)arg2;
1805 return (int32_t)arg1 / (int32_t)arg2;
1809 #if !defined (CONFIG_USER_ONLY)
1810 target_ulong helper_rac (target_ulong addr)
1814 target_ulong ret = 0;
1816 /* We don't have to generate many instances of this instruction,
1817 * as rac is supervisor only.
1819 /* XXX: FIX THIS: Pretend we have no BAT */
1820 nb_BATs = env->nb_BATs;
1822 if (get_physical_address(env, &ctx, addr, 0, ACCESS_INT) == 0)
1824 env->nb_BATs = nb_BATs;
1828 void helper_rfsvc (void)
1830 do_rfi(env->lr, env->ctr, 0x0000FFFF, 0);
1834 /*****************************************************************************/
1835 /* 602 specific instructions */
1836 /* mfrom is the most crazy instruction ever seen, imho ! */
1837 /* Real implementation uses a ROM table. Do the same */
1838 /* Extremly decomposed:
1840 * return 256 * log10(10 + 1.0) + 0.5
1842 #if !defined (CONFIG_USER_ONLY)
1843 target_ulong helper_602_mfrom (target_ulong arg)
1845 if (likely(arg < 602)) {
1846 #include "mfrom_table.c"
1847 return mfrom_ROM_table[arg];
1854 /*****************************************************************************/
1855 /* Embedded PowerPC specific helpers */
1857 /* XXX: to be improved to check access rights when in user-mode */
1858 target_ulong helper_load_dcr (target_ulong dcrn)
1860 target_ulong val = 0;
1862 if (unlikely(env->dcr_env == NULL)) {
1863 if (loglevel != 0) {
1864 fprintf(logfile, "No DCR environment\n");
1866 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
1867 POWERPC_EXCP_INVAL | POWERPC_EXCP_INVAL_INVAL);
1868 } else if (unlikely(ppc_dcr_read(env->dcr_env, dcrn, &val) != 0)) {
1869 if (loglevel != 0) {
1870 fprintf(logfile, "DCR read error %d %03x\n", (int)dcrn, (int)dcrn);
1872 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
1873 POWERPC_EXCP_INVAL | POWERPC_EXCP_PRIV_REG);
1878 void helper_store_dcr (target_ulong dcrn, target_ulong val)
1880 if (unlikely(env->dcr_env == NULL)) {
1881 if (loglevel != 0) {
1882 fprintf(logfile, "No DCR environment\n");
1884 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
1885 POWERPC_EXCP_INVAL | POWERPC_EXCP_INVAL_INVAL);
1886 } else if (unlikely(ppc_dcr_write(env->dcr_env, dcrn, val) != 0)) {
1887 if (loglevel != 0) {
1888 fprintf(logfile, "DCR write error %d %03x\n", (int)dcrn, (int)dcrn);
1890 helper_raise_exception_err(POWERPC_EXCP_PROGRAM,
1891 POWERPC_EXCP_INVAL | POWERPC_EXCP_PRIV_REG);
1895 #if !defined(CONFIG_USER_ONLY)
1896 void helper_40x_rfci (void)
1898 do_rfi(env->spr[SPR_40x_SRR2], env->spr[SPR_40x_SRR3],
1899 ~((target_ulong)0xFFFF0000), 0);
1902 void helper_rfci (void)
1904 do_rfi(env->spr[SPR_BOOKE_CSRR0], SPR_BOOKE_CSRR1,
1905 ~((target_ulong)0x3FFF0000), 0);
1908 void helper_rfdi (void)
1910 do_rfi(env->spr[SPR_BOOKE_DSRR0], SPR_BOOKE_DSRR1,
1911 ~((target_ulong)0x3FFF0000), 0);
1914 void helper_rfmci (void)
1916 do_rfi(env->spr[SPR_BOOKE_MCSRR0], SPR_BOOKE_MCSRR1,
1917 ~((target_ulong)0x3FFF0000), 0);
1922 target_ulong helper_dlmzb (target_ulong high, target_ulong low, uint32_t update_Rc)
1928 for (mask = 0xFF000000; mask != 0; mask = mask >> 8) {
1929 if ((high & mask) == 0) {
1937 for (mask = 0xFF000000; mask != 0; mask = mask >> 8) {
1938 if ((low & mask) == 0) {
1950 env->xer = (env->xer & ~0x7F) | i;
1952 env->crf[0] |= xer_so;
1957 /*****************************************************************************/
1958 /* Altivec extension helpers */
1959 #if defined(WORDS_BIGENDIAN)
1967 #if defined(WORDS_BIGENDIAN)
1968 #define VECTOR_FOR_INORDER_I(index, element) \
1969 for (index = 0; index < ARRAY_SIZE(r->element); index++)
1971 #define VECTOR_FOR_INORDER_I(index, element) \
1972 for (index = ARRAY_SIZE(r->element)-1; index >= 0; index--)
1975 /* Saturating arithmetic helpers. */
1976 #define SATCVT(from, to, from_type, to_type, min, max, use_min, use_max) \
1977 static always_inline to_type cvt##from##to (from_type x, int *sat) \
1980 if (use_min && x < min) { \
1983 } else if (use_max && x > max) { \
1991 SATCVT(sh, sb, int16_t, int8_t, INT8_MIN, INT8_MAX, 1, 1)
1992 SATCVT(sw, sh, int32_t, int16_t, INT16_MIN, INT16_MAX, 1, 1)
1993 SATCVT(sd, sw, int64_t, int32_t, INT32_MIN, INT32_MAX, 1, 1)
1994 SATCVT(uh, ub, uint16_t, uint8_t, 0, UINT8_MAX, 0, 1)
1995 SATCVT(uw, uh, uint32_t, uint16_t, 0, UINT16_MAX, 0, 1)
1996 SATCVT(ud, uw, uint64_t, uint32_t, 0, UINT32_MAX, 0, 1)
1997 SATCVT(sh, ub, int16_t, uint8_t, 0, UINT8_MAX, 1, 1)
1998 SATCVT(sw, uh, int32_t, uint16_t, 0, UINT16_MAX, 1, 1)
1999 SATCVT(sd, uw, int64_t, uint32_t, 0, UINT32_MAX, 1, 1)
2002 #define LVE(name, access, swap, element) \
2003 void helper_##name (ppc_avr_t *r, target_ulong addr) \
2005 size_t n_elems = ARRAY_SIZE(r->element); \
2006 int adjust = HI_IDX*(n_elems-1); \
2007 int sh = sizeof(r->element[0]) >> 1; \
2008 int index = (addr & 0xf) >> sh; \
2010 r->element[LO_IDX ? index : (adjust - index)] = swap(access(addr)); \
2012 r->element[LO_IDX ? index : (adjust - index)] = access(addr); \
2016 LVE(lvebx, ldub, I, u8)
2017 LVE(lvehx, lduw, bswap16, u16)
2018 LVE(lvewx, ldl, bswap32, u32)
2022 void helper_lvsl (ppc_avr_t *r, target_ulong sh)
2024 int i, j = (sh & 0xf);
2026 VECTOR_FOR_INORDER_I (i, u8) {
2031 void helper_lvsr (ppc_avr_t *r, target_ulong sh)
2033 int i, j = 0x10 - (sh & 0xf);
2035 VECTOR_FOR_INORDER_I (i, u8) {
2040 #define STVE(name, access, swap, element) \
2041 void helper_##name (ppc_avr_t *r, target_ulong addr) \
2043 size_t n_elems = ARRAY_SIZE(r->element); \
2044 int adjust = HI_IDX*(n_elems-1); \
2045 int sh = sizeof(r->element[0]) >> 1; \
2046 int index = (addr & 0xf) >> sh; \
2048 access(addr, swap(r->element[LO_IDX ? index : (adjust - index)])); \
2050 access(addr, r->element[LO_IDX ? index : (adjust - index)]); \
2054 STVE(stvebx, stb, I, u8)
2055 STVE(stvehx, stw, bswap16, u16)
2056 STVE(stvewx, stl, bswap32, u32)
2060 void helper_vaddcuw (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2063 for (i = 0; i < ARRAY_SIZE(r->u32); i++) {
2064 r->u32[i] = ~a->u32[i] < b->u32[i];
2068 #define VARITH_DO(name, op, element) \
2069 void helper_v##name (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2072 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2073 r->element[i] = a->element[i] op b->element[i]; \
2076 #define VARITH(suffix, element) \
2077 VARITH_DO(add##suffix, +, element) \
2078 VARITH_DO(sub##suffix, -, element)
2085 #define VAVG_DO(name, element, etype) \
2086 void helper_v##name (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2089 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2090 etype x = (etype)a->element[i] + (etype)b->element[i] + 1; \
2091 r->element[i] = x >> 1; \
2095 #define VAVG(type, signed_element, signed_type, unsigned_element, unsigned_type) \
2096 VAVG_DO(avgs##type, signed_element, signed_type) \
2097 VAVG_DO(avgu##type, unsigned_element, unsigned_type)
2098 VAVG(b, s8, int16_t, u8, uint16_t)
2099 VAVG(h, s16, int32_t, u16, uint32_t)
2100 VAVG(w, s32, int64_t, u32, uint64_t)
2104 void helper_vmhaddshs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2109 for (i = 0; i < ARRAY_SIZE(r->s16); i++) {
2110 int32_t prod = a->s16[i] * b->s16[i];
2111 int32_t t = (int32_t)c->s16[i] + (prod >> 15);
2112 r->s16[i] = cvtswsh (t, &sat);
2116 env->vscr |= (1 << VSCR_SAT);
2120 void helper_vmhraddshs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2125 for (i = 0; i < ARRAY_SIZE(r->s16); i++) {
2126 int32_t prod = a->s16[i] * b->s16[i] + 0x00004000;
2127 int32_t t = (int32_t)c->s16[i] + (prod >> 15);
2128 r->s16[i] = cvtswsh (t, &sat);
2132 env->vscr |= (1 << VSCR_SAT);
2136 #define VMINMAX_DO(name, compare, element) \
2137 void helper_v##name (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2140 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2141 if (a->element[i] compare b->element[i]) { \
2142 r->element[i] = b->element[i]; \
2144 r->element[i] = a->element[i]; \
2148 #define VMINMAX(suffix, element) \
2149 VMINMAX_DO(min##suffix, >, element) \
2150 VMINMAX_DO(max##suffix, <, element)
2160 void helper_vmladduhm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2163 for (i = 0; i < ARRAY_SIZE(r->s16); i++) {
2164 int32_t prod = a->s16[i] * b->s16[i];
2165 r->s16[i] = (int16_t) (prod + c->s16[i]);
2169 #define VMRG_DO(name, element, highp) \
2170 void helper_v##name (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2174 size_t n_elems = ARRAY_SIZE(r->element); \
2175 for (i = 0; i < n_elems/2; i++) { \
2177 result.element[i*2+HI_IDX] = a->element[i]; \
2178 result.element[i*2+LO_IDX] = b->element[i]; \
2180 result.element[n_elems - i*2 - (1+HI_IDX)] = b->element[n_elems - i - 1]; \
2181 result.element[n_elems - i*2 - (1+LO_IDX)] = a->element[n_elems - i - 1]; \
2186 #if defined(WORDS_BIGENDIAN)
2193 #define VMRG(suffix, element) \
2194 VMRG_DO(mrgl##suffix, element, MRGHI) \
2195 VMRG_DO(mrgh##suffix, element, MRGLO)
2204 void helper_vmsummbm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2209 for (i = 0; i < ARRAY_SIZE(r->s8); i++) {
2210 prod[i] = (int32_t)a->s8[i] * b->u8[i];
2213 VECTOR_FOR_INORDER_I(i, s32) {
2214 r->s32[i] = c->s32[i] + prod[4*i] + prod[4*i+1] + prod[4*i+2] + prod[4*i+3];
2218 void helper_vmsumshm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2223 for (i = 0; i < ARRAY_SIZE(r->s16); i++) {
2224 prod[i] = a->s16[i] * b->s16[i];
2227 VECTOR_FOR_INORDER_I(i, s32) {
2228 r->s32[i] = c->s32[i] + prod[2*i] + prod[2*i+1];
2232 void helper_vmsumshs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2238 for (i = 0; i < ARRAY_SIZE(r->s16); i++) {
2239 prod[i] = (int32_t)a->s16[i] * b->s16[i];
2242 VECTOR_FOR_INORDER_I (i, s32) {
2243 int64_t t = (int64_t)c->s32[i] + prod[2*i] + prod[2*i+1];
2244 r->u32[i] = cvtsdsw(t, &sat);
2248 env->vscr |= (1 << VSCR_SAT);
2252 void helper_vmsumubm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2257 for (i = 0; i < ARRAY_SIZE(r->u8); i++) {
2258 prod[i] = a->u8[i] * b->u8[i];
2261 VECTOR_FOR_INORDER_I(i, u32) {
2262 r->u32[i] = c->u32[i] + prod[4*i] + prod[4*i+1] + prod[4*i+2] + prod[4*i+3];
2266 void helper_vmsumuhm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2271 for (i = 0; i < ARRAY_SIZE(r->u16); i++) {
2272 prod[i] = a->u16[i] * b->u16[i];
2275 VECTOR_FOR_INORDER_I(i, u32) {
2276 r->u32[i] = c->u32[i] + prod[2*i] + prod[2*i+1];
2280 void helper_vmsumuhs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2286 for (i = 0; i < ARRAY_SIZE(r->u16); i++) {
2287 prod[i] = a->u16[i] * b->u16[i];
2290 VECTOR_FOR_INORDER_I (i, s32) {
2291 uint64_t t = (uint64_t)c->u32[i] + prod[2*i] + prod[2*i+1];
2292 r->u32[i] = cvtuduw(t, &sat);
2296 env->vscr |= (1 << VSCR_SAT);
2300 #define VMUL_DO(name, mul_element, prod_element, evenp) \
2301 void helper_v##name (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2304 VECTOR_FOR_INORDER_I(i, prod_element) { \
2306 r->prod_element[i] = a->mul_element[i*2+HI_IDX] * b->mul_element[i*2+HI_IDX]; \
2308 r->prod_element[i] = a->mul_element[i*2+LO_IDX] * b->mul_element[i*2+LO_IDX]; \
2312 #define VMUL(suffix, mul_element, prod_element) \
2313 VMUL_DO(mule##suffix, mul_element, prod_element, 1) \
2314 VMUL_DO(mulo##suffix, mul_element, prod_element, 0)
2322 void helper_vperm (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2326 VECTOR_FOR_INORDER_I (i, u8) {
2327 int s = c->u8[i] & 0x1f;
2328 #if defined(WORDS_BIGENDIAN)
2329 int index = s & 0xf;
2331 int index = 15 - (s & 0xf);
2334 result.u8[i] = b->u8[index];
2336 result.u8[i] = a->u8[index];
2342 #if defined(WORDS_BIGENDIAN)
2347 void helper_vpkpx (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2351 #if defined(WORDS_BIGENDIAN)
2352 const ppc_avr_t *x[2] = { a, b };
2354 const ppc_avr_t *x[2] = { b, a };
2357 VECTOR_FOR_INORDER_I (i, u64) {
2358 VECTOR_FOR_INORDER_I (j, u32){
2359 uint32_t e = x[i]->u32[j];
2360 result.u16[4*i+j] = (((e >> 9) & 0xfc00) |
2361 ((e >> 6) & 0x3e0) |
2368 #define VPK(suffix, from, to, cvt, dosat) \
2369 void helper_vpk##suffix (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2374 ppc_avr_t *a0 = PKBIG ? a : b; \
2375 ppc_avr_t *a1 = PKBIG ? b : a; \
2376 VECTOR_FOR_INORDER_I (i, from) { \
2377 result.to[i] = cvt(a0->from[i], &sat); \
2378 result.to[i+ARRAY_SIZE(r->from)] = cvt(a1->from[i], &sat); \
2381 if (dosat && sat) { \
2382 env->vscr |= (1 << VSCR_SAT); \
2386 VPK(shss, s16, s8, cvtshsb, 1)
2387 VPK(shus, s16, u8, cvtshub, 1)
2388 VPK(swss, s32, s16, cvtswsh, 1)
2389 VPK(swus, s32, u16, cvtswuh, 1)
2390 VPK(uhus, u16, u8, cvtuhub, 1)
2391 VPK(uwus, u32, u16, cvtuwuh, 1)
2392 VPK(uhum, u16, u8, I, 0)
2393 VPK(uwum, u32, u16, I, 0)
2398 #define VROTATE(suffix, element) \
2399 void helper_vrl##suffix (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2402 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2403 unsigned int mask = ((1 << (3 + (sizeof (a->element[0]) >> 1))) - 1); \
2404 unsigned int shift = b->element[i] & mask; \
2405 r->element[i] = (a->element[i] << shift) | (a->element[i] >> (sizeof(a->element[0]) * 8 - shift)); \
2413 void helper_vsel (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, ppc_avr_t *c)
2415 r->u64[0] = (a->u64[0] & ~c->u64[0]) | (b->u64[0] & c->u64[0]);
2416 r->u64[1] = (a->u64[1] & ~c->u64[1]) | (b->u64[1] & c->u64[1]);
2419 #define VSL(suffix, element) \
2420 void helper_vsl##suffix (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2423 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2424 unsigned int mask = ((1 << (3 + (sizeof (a->element[0]) >> 1))) - 1); \
2425 unsigned int shift = b->element[i] & mask; \
2426 r->element[i] = a->element[i] << shift; \
2434 void helper_vsldoi (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b, uint32_t shift)
2436 int sh = shift & 0xf;
2440 #if defined(WORDS_BIGENDIAN)
2441 for (i = 0; i < ARRAY_SIZE(r->u8); i++) {
2444 result.u8[i] = b->u8[index-0x10];
2446 result.u8[i] = a->u8[index];
2450 for (i = 0; i < ARRAY_SIZE(r->u8); i++) {
2451 int index = (16 - sh) + i;
2453 result.u8[i] = a->u8[index-0x10];
2455 result.u8[i] = b->u8[index];
2462 void helper_vslo (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2464 int sh = (b->u8[LO_IDX*0xf] >> 3) & 0xf;
2466 #if defined (WORDS_BIGENDIAN)
2467 memmove (&r->u8[0], &a->u8[sh], 16-sh);
2468 memset (&r->u8[16-sh], 0, sh);
2470 memmove (&r->u8[sh], &a->u8[0], 16-sh);
2471 memset (&r->u8[0], 0, sh);
2475 /* Experimental testing shows that hardware masks the immediate. */
2476 #define _SPLAT_MASKED(element) (splat & (ARRAY_SIZE(r->element) - 1))
2477 #if defined(WORDS_BIGENDIAN)
2478 #define SPLAT_ELEMENT(element) _SPLAT_MASKED(element)
2480 #define SPLAT_ELEMENT(element) (ARRAY_SIZE(r->element)-1 - _SPLAT_MASKED(element))
2482 #define VSPLT(suffix, element) \
2483 void helper_vsplt##suffix (ppc_avr_t *r, ppc_avr_t *b, uint32_t splat) \
2485 uint32_t s = b->element[SPLAT_ELEMENT(element)]; \
2487 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2488 r->element[i] = s; \
2495 #undef SPLAT_ELEMENT
2496 #undef _SPLAT_MASKED
2498 #define VSR(suffix, element) \
2499 void helper_vsr##suffix (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b) \
2502 for (i = 0; i < ARRAY_SIZE(r->element); i++) { \
2503 unsigned int mask = ((1 << (3 + (sizeof (a->element[0]) >> 1))) - 1); \
2504 unsigned int shift = b->element[i] & mask; \
2505 r->element[i] = a->element[i] >> shift; \
2516 void helper_vsro (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2518 int sh = (b->u8[LO_IDX*0xf] >> 3) & 0xf;
2520 #if defined (WORDS_BIGENDIAN)
2521 memmove (&r->u8[sh], &a->u8[0], 16-sh);
2522 memset (&r->u8[0], 0, sh);
2524 memmove (&r->u8[0], &a->u8[sh], 16-sh);
2525 memset (&r->u8[16-sh], 0, sh);
2529 void helper_vsubcuw (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2532 for (i = 0; i < ARRAY_SIZE(r->u32); i++) {
2533 r->u32[i] = a->u32[i] >= b->u32[i];
2537 void helper_vsumsws (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2544 #if defined(WORDS_BIGENDIAN)
2545 upper = ARRAY_SIZE(r->s32)-1;
2549 t = (int64_t)b->s32[upper];
2550 for (i = 0; i < ARRAY_SIZE(r->s32); i++) {
2554 result.s32[upper] = cvtsdsw(t, &sat);
2558 env->vscr |= (1 << VSCR_SAT);
2562 void helper_vsum2sws (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2568 #if defined(WORDS_BIGENDIAN)
2573 for (i = 0; i < ARRAY_SIZE(r->u64); i++) {
2574 int64_t t = (int64_t)b->s32[upper+i*2];
2576 for (j = 0; j < ARRAY_SIZE(r->u64); j++) {
2579 result.s32[upper+i*2] = cvtsdsw(t, &sat);
2584 env->vscr |= (1 << VSCR_SAT);
2588 void helper_vsum4sbs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2593 for (i = 0; i < ARRAY_SIZE(r->s32); i++) {
2594 int64_t t = (int64_t)b->s32[i];
2595 for (j = 0; j < ARRAY_SIZE(r->s32); j++) {
2598 r->s32[i] = cvtsdsw(t, &sat);
2602 env->vscr |= (1 << VSCR_SAT);
2606 void helper_vsum4shs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2611 for (i = 0; i < ARRAY_SIZE(r->s32); i++) {
2612 int64_t t = (int64_t)b->s32[i];
2613 t += a->s16[2*i] + a->s16[2*i+1];
2614 r->s32[i] = cvtsdsw(t, &sat);
2618 env->vscr |= (1 << VSCR_SAT);
2622 void helper_vsum4ubs (ppc_avr_t *r, ppc_avr_t *a, ppc_avr_t *b)
2627 for (i = 0; i < ARRAY_SIZE(r->u32); i++) {
2628 uint64_t t = (uint64_t)b->u32[i];
2629 for (j = 0; j < ARRAY_SIZE(r->u32); j++) {
2632 r->u32[i] = cvtuduw(t, &sat);
2636 env->vscr |= (1 << VSCR_SAT);
2640 #if defined(WORDS_BIGENDIAN)
2647 #define VUPKPX(suffix, hi) \
2648 void helper_vupk##suffix (ppc_avr_t *r, ppc_avr_t *b) \
2652 for (i = 0; i < ARRAY_SIZE(r->u32); i++) { \
2653 uint16_t e = b->u16[hi ? i : i+4]; \
2654 uint8_t a = (e >> 15) ? 0xff : 0; \
2655 uint8_t r = (e >> 10) & 0x1f; \
2656 uint8_t g = (e >> 5) & 0x1f; \
2657 uint8_t b = e & 0x1f; \
2658 result.u32[i] = (a << 24) | (r << 16) | (g << 8) | b; \
2666 #define VUPK(suffix, unpacked, packee, hi) \
2667 void helper_vupk##suffix (ppc_avr_t *r, ppc_avr_t *b) \
2672 for (i = 0; i < ARRAY_SIZE(r->unpacked); i++) { \
2673 result.unpacked[i] = b->packee[i]; \
2676 for (i = ARRAY_SIZE(r->unpacked); i < ARRAY_SIZE(r->packee); i++) { \
2677 result.unpacked[i-ARRAY_SIZE(r->unpacked)] = b->packee[i]; \
2682 VUPK(hsb, s16, s8, UPKHI)
2683 VUPK(hsh, s32, s16, UPKHI)
2684 VUPK(lsb, s16, s8, UPKLO)
2685 VUPK(lsh, s32, s16, UPKLO)
2690 #undef VECTOR_FOR_INORDER_I
2694 /*****************************************************************************/
2695 /* SPE extension helpers */
2696 /* Use a table to make this quicker */
2697 static uint8_t hbrev[16] = {
2698 0x0, 0x8, 0x4, 0xC, 0x2, 0xA, 0x6, 0xE,
2699 0x1, 0x9, 0x5, 0xD, 0x3, 0xB, 0x7, 0xF,
2702 static always_inline uint8_t byte_reverse (uint8_t val)
2704 return hbrev[val >> 4] | (hbrev[val & 0xF] << 4);
2707 static always_inline uint32_t word_reverse (uint32_t val)
2709 return byte_reverse(val >> 24) | (byte_reverse(val >> 16) << 8) |
2710 (byte_reverse(val >> 8) << 16) | (byte_reverse(val) << 24);
2713 #define MASKBITS 16 // Random value - to be fixed (implementation dependant)
2714 target_ulong helper_brinc (target_ulong arg1, target_ulong arg2)
2716 uint32_t a, b, d, mask;
2718 mask = UINT32_MAX >> (32 - MASKBITS);
2721 d = word_reverse(1 + word_reverse(a | ~b));
2722 return (arg1 & ~mask) | (d & b);
2725 uint32_t helper_cntlsw32 (uint32_t val)
2727 if (val & 0x80000000)
2733 uint32_t helper_cntlzw32 (uint32_t val)
2738 /* Single-precision floating-point conversions */
2739 static always_inline uint32_t efscfsi (uint32_t val)
2743 u.f = int32_to_float32(val, &env->spe_status);
2748 static always_inline uint32_t efscfui (uint32_t val)
2752 u.f = uint32_to_float32(val, &env->spe_status);
2757 static always_inline int32_t efsctsi (uint32_t val)
2762 /* NaN are not treated the same way IEEE 754 does */
2763 if (unlikely(float32_is_nan(u.f)))
2766 return float32_to_int32(u.f, &env->spe_status);
2769 static always_inline uint32_t efsctui (uint32_t val)
2774 /* NaN are not treated the same way IEEE 754 does */
2775 if (unlikely(float32_is_nan(u.f)))
2778 return float32_to_uint32(u.f, &env->spe_status);
2781 static always_inline uint32_t efsctsiz (uint32_t val)
2786 /* NaN are not treated the same way IEEE 754 does */
2787 if (unlikely(float32_is_nan(u.f)))
2790 return float32_to_int32_round_to_zero(u.f, &env->spe_status);
2793 static always_inline uint32_t efsctuiz (uint32_t val)
2798 /* NaN are not treated the same way IEEE 754 does */
2799 if (unlikely(float32_is_nan(u.f)))
2802 return float32_to_uint32_round_to_zero(u.f, &env->spe_status);
2805 static always_inline uint32_t efscfsf (uint32_t val)
2810 u.f = int32_to_float32(val, &env->spe_status);
2811 tmp = int64_to_float32(1ULL << 32, &env->spe_status);
2812 u.f = float32_div(u.f, tmp, &env->spe_status);
2817 static always_inline uint32_t efscfuf (uint32_t val)
2822 u.f = uint32_to_float32(val, &env->spe_status);
2823 tmp = uint64_to_float32(1ULL << 32, &env->spe_status);
2824 u.f = float32_div(u.f, tmp, &env->spe_status);
2829 static always_inline uint32_t efsctsf (uint32_t val)
2835 /* NaN are not treated the same way IEEE 754 does */
2836 if (unlikely(float32_is_nan(u.f)))
2838 tmp = uint64_to_float32(1ULL << 32, &env->spe_status);
2839 u.f = float32_mul(u.f, tmp, &env->spe_status);
2841 return float32_to_int32(u.f, &env->spe_status);
2844 static always_inline uint32_t efsctuf (uint32_t val)
2850 /* NaN are not treated the same way IEEE 754 does */
2851 if (unlikely(float32_is_nan(u.f)))
2853 tmp = uint64_to_float32(1ULL << 32, &env->spe_status);
2854 u.f = float32_mul(u.f, tmp, &env->spe_status);
2856 return float32_to_uint32(u.f, &env->spe_status);
2859 #define HELPER_SPE_SINGLE_CONV(name) \
2860 uint32_t helper_e##name (uint32_t val) \
2862 return e##name(val); \
2865 HELPER_SPE_SINGLE_CONV(fscfsi);
2867 HELPER_SPE_SINGLE_CONV(fscfui);
2869 HELPER_SPE_SINGLE_CONV(fscfuf);
2871 HELPER_SPE_SINGLE_CONV(fscfsf);
2873 HELPER_SPE_SINGLE_CONV(fsctsi);
2875 HELPER_SPE_SINGLE_CONV(fsctui);
2877 HELPER_SPE_SINGLE_CONV(fsctsiz);
2879 HELPER_SPE_SINGLE_CONV(fsctuiz);
2881 HELPER_SPE_SINGLE_CONV(fsctsf);
2883 HELPER_SPE_SINGLE_CONV(fsctuf);
2885 #define HELPER_SPE_VECTOR_CONV(name) \
2886 uint64_t helper_ev##name (uint64_t val) \
2888 return ((uint64_t)e##name(val >> 32) << 32) | \
2889 (uint64_t)e##name(val); \
2892 HELPER_SPE_VECTOR_CONV(fscfsi);
2894 HELPER_SPE_VECTOR_CONV(fscfui);
2896 HELPER_SPE_VECTOR_CONV(fscfuf);
2898 HELPER_SPE_VECTOR_CONV(fscfsf);
2900 HELPER_SPE_VECTOR_CONV(fsctsi);
2902 HELPER_SPE_VECTOR_CONV(fsctui);
2904 HELPER_SPE_VECTOR_CONV(fsctsiz);
2906 HELPER_SPE_VECTOR_CONV(fsctuiz);
2908 HELPER_SPE_VECTOR_CONV(fsctsf);
2910 HELPER_SPE_VECTOR_CONV(fsctuf);
2912 /* Single-precision floating-point arithmetic */
2913 static always_inline uint32_t efsadd (uint32_t op1, uint32_t op2)
2918 u1.f = float32_add(u1.f, u2.f, &env->spe_status);
2922 static always_inline uint32_t efssub (uint32_t op1, uint32_t op2)
2927 u1.f = float32_sub(u1.f, u2.f, &env->spe_status);
2931 static always_inline uint32_t efsmul (uint32_t op1, uint32_t op2)
2936 u1.f = float32_mul(u1.f, u2.f, &env->spe_status);
2940 static always_inline uint32_t efsdiv (uint32_t op1, uint32_t op2)
2945 u1.f = float32_div(u1.f, u2.f, &env->spe_status);
2949 #define HELPER_SPE_SINGLE_ARITH(name) \
2950 uint32_t helper_e##name (uint32_t op1, uint32_t op2) \
2952 return e##name(op1, op2); \
2955 HELPER_SPE_SINGLE_ARITH(fsadd);
2957 HELPER_SPE_SINGLE_ARITH(fssub);
2959 HELPER_SPE_SINGLE_ARITH(fsmul);
2961 HELPER_SPE_SINGLE_ARITH(fsdiv);
2963 #define HELPER_SPE_VECTOR_ARITH(name) \
2964 uint64_t helper_ev##name (uint64_t op1, uint64_t op2) \
2966 return ((uint64_t)e##name(op1 >> 32, op2 >> 32) << 32) | \
2967 (uint64_t)e##name(op1, op2); \
2970 HELPER_SPE_VECTOR_ARITH(fsadd);
2972 HELPER_SPE_VECTOR_ARITH(fssub);
2974 HELPER_SPE_VECTOR_ARITH(fsmul);
2976 HELPER_SPE_VECTOR_ARITH(fsdiv);
2978 /* Single-precision floating-point comparisons */
2979 static always_inline uint32_t efststlt (uint32_t op1, uint32_t op2)
2984 return float32_lt(u1.f, u2.f, &env->spe_status) ? 4 : 0;
2987 static always_inline uint32_t efststgt (uint32_t op1, uint32_t op2)
2992 return float32_le(u1.f, u2.f, &env->spe_status) ? 0 : 4;
2995 static always_inline uint32_t efststeq (uint32_t op1, uint32_t op2)
3000 return float32_eq(u1.f, u2.f, &env->spe_status) ? 4 : 0;
3003 static always_inline uint32_t efscmplt (uint32_t op1, uint32_t op2)
3005 /* XXX: TODO: test special values (NaN, infinites, ...) */
3006 return efststlt(op1, op2);
3009 static always_inline uint32_t efscmpgt (uint32_t op1, uint32_t op2)
3011 /* XXX: TODO: test special values (NaN, infinites, ...) */
3012 return efststgt(op1, op2);
3015 static always_inline uint32_t efscmpeq (uint32_t op1, uint32_t op2)
3017 /* XXX: TODO: test special values (NaN, infinites, ...) */
3018 return efststeq(op1, op2);
3021 #define HELPER_SINGLE_SPE_CMP(name) \
3022 uint32_t helper_e##name (uint32_t op1, uint32_t op2) \
3024 return e##name(op1, op2) << 2; \
3027 HELPER_SINGLE_SPE_CMP(fststlt);
3029 HELPER_SINGLE_SPE_CMP(fststgt);
3031 HELPER_SINGLE_SPE_CMP(fststeq);
3033 HELPER_SINGLE_SPE_CMP(fscmplt);
3035 HELPER_SINGLE_SPE_CMP(fscmpgt);
3037 HELPER_SINGLE_SPE_CMP(fscmpeq);
3039 static always_inline uint32_t evcmp_merge (int t0, int t1)
3041 return (t0 << 3) | (t1 << 2) | ((t0 | t1) << 1) | (t0 & t1);
3044 #define HELPER_VECTOR_SPE_CMP(name) \
3045 uint32_t helper_ev##name (uint64_t op1, uint64_t op2) \
3047 return evcmp_merge(e##name(op1 >> 32, op2 >> 32), e##name(op1, op2)); \
3050 HELPER_VECTOR_SPE_CMP(fststlt);
3052 HELPER_VECTOR_SPE_CMP(fststgt);
3054 HELPER_VECTOR_SPE_CMP(fststeq);
3056 HELPER_VECTOR_SPE_CMP(fscmplt);
3058 HELPER_VECTOR_SPE_CMP(fscmpgt);
3060 HELPER_VECTOR_SPE_CMP(fscmpeq);
3062 /* Double-precision floating-point conversion */
3063 uint64_t helper_efdcfsi (uint32_t val)
3067 u.d = int32_to_float64(val, &env->spe_status);
3072 uint64_t helper_efdcfsid (uint64_t val)
3076 u.d = int64_to_float64(val, &env->spe_status);
3081 uint64_t helper_efdcfui (uint32_t val)
3085 u.d = uint32_to_float64(val, &env->spe_status);
3090 uint64_t helper_efdcfuid (uint64_t val)
3094 u.d = uint64_to_float64(val, &env->spe_status);
3099 uint32_t helper_efdctsi (uint64_t val)
3104 /* NaN are not treated the same way IEEE 754 does */
3105 if (unlikely(float64_is_nan(u.d)))
3108 return float64_to_int32(u.d, &env->spe_status);
3111 uint32_t helper_efdctui (uint64_t val)
3116 /* NaN are not treated the same way IEEE 754 does */
3117 if (unlikely(float64_is_nan(u.d)))
3120 return float64_to_uint32(u.d, &env->spe_status);
3123 uint32_t helper_efdctsiz (uint64_t val)
3128 /* NaN are not treated the same way IEEE 754 does */
3129 if (unlikely(float64_is_nan(u.d)))
3132 return float64_to_int32_round_to_zero(u.d, &env->spe_status);
3135 uint64_t helper_efdctsidz (uint64_t val)
3140 /* NaN are not treated the same way IEEE 754 does */
3141 if (unlikely(float64_is_nan(u.d)))
3144 return float64_to_int64_round_to_zero(u.d, &env->spe_status);
3147 uint32_t helper_efdctuiz (uint64_t val)
3152 /* NaN are not treated the same way IEEE 754 does */
3153 if (unlikely(float64_is_nan(u.d)))
3156 return float64_to_uint32_round_to_zero(u.d, &env->spe_status);
3159 uint64_t helper_efdctuidz (uint64_t val)
3164 /* NaN are not treated the same way IEEE 754 does */
3165 if (unlikely(float64_is_nan(u.d)))
3168 return float64_to_uint64_round_to_zero(u.d, &env->spe_status);
3171 uint64_t helper_efdcfsf (uint32_t val)
3176 u.d = int32_to_float64(val, &env->spe_status);
3177 tmp = int64_to_float64(1ULL << 32, &env->spe_status);
3178 u.d = float64_div(u.d, tmp, &env->spe_status);
3183 uint64_t helper_efdcfuf (uint32_t val)
3188 u.d = uint32_to_float64(val, &env->spe_status);
3189 tmp = int64_to_float64(1ULL << 32, &env->spe_status);
3190 u.d = float64_div(u.d, tmp, &env->spe_status);
3195 uint32_t helper_efdctsf (uint64_t val)
3201 /* NaN are not treated the same way IEEE 754 does */
3202 if (unlikely(float64_is_nan(u.d)))
3204 tmp = uint64_to_float64(1ULL << 32, &env->spe_status);
3205 u.d = float64_mul(u.d, tmp, &env->spe_status);
3207 return float64_to_int32(u.d, &env->spe_status);
3210 uint32_t helper_efdctuf (uint64_t val)
3216 /* NaN are not treated the same way IEEE 754 does */
3217 if (unlikely(float64_is_nan(u.d)))
3219 tmp = uint64_to_float64(1ULL << 32, &env->spe_status);
3220 u.d = float64_mul(u.d, tmp, &env->spe_status);
3222 return float64_to_uint32(u.d, &env->spe_status);
3225 uint32_t helper_efscfd (uint64_t val)
3231 u2.f = float64_to_float32(u1.d, &env->spe_status);
3236 uint64_t helper_efdcfs (uint32_t val)
3242 u2.d = float32_to_float64(u1.f, &env->spe_status);
3247 /* Double precision fixed-point arithmetic */
3248 uint64_t helper_efdadd (uint64_t op1, uint64_t op2)
3253 u1.d = float64_add(u1.d, u2.d, &env->spe_status);
3257 uint64_t helper_efdsub (uint64_t op1, uint64_t op2)
3262 u1.d = float64_sub(u1.d, u2.d, &env->spe_status);
3266 uint64_t helper_efdmul (uint64_t op1, uint64_t op2)
3271 u1.d = float64_mul(u1.d, u2.d, &env->spe_status);
3275 uint64_t helper_efddiv (uint64_t op1, uint64_t op2)
3280 u1.d = float64_div(u1.d, u2.d, &env->spe_status);
3284 /* Double precision floating point helpers */
3285 uint32_t helper_efdtstlt (uint64_t op1, uint64_t op2)
3290 return float64_lt(u1.d, u2.d, &env->spe_status) ? 4 : 0;
3293 uint32_t helper_efdtstgt (uint64_t op1, uint64_t op2)
3298 return float64_le(u1.d, u2.d, &env->spe_status) ? 0 : 4;
3301 uint32_t helper_efdtsteq (uint64_t op1, uint64_t op2)
3306 return float64_eq(u1.d, u2.d, &env->spe_status) ? 4 : 0;
3309 uint32_t helper_efdcmplt (uint64_t op1, uint64_t op2)
3311 /* XXX: TODO: test special values (NaN, infinites, ...) */
3312 return helper_efdtstlt(op1, op2);
3315 uint32_t helper_efdcmpgt (uint64_t op1, uint64_t op2)
3317 /* XXX: TODO: test special values (NaN, infinites, ...) */
3318 return helper_efdtstgt(op1, op2);
3321 uint32_t helper_efdcmpeq (uint64_t op1, uint64_t op2)
3323 /* XXX: TODO: test special values (NaN, infinites, ...) */
3324 return helper_efdtsteq(op1, op2);
3327 /*****************************************************************************/
3328 /* Softmmu support */
3329 #if !defined (CONFIG_USER_ONLY)
3331 #define MMUSUFFIX _mmu
3334 #include "softmmu_template.h"
3337 #include "softmmu_template.h"
3340 #include "softmmu_template.h"
3343 #include "softmmu_template.h"
3345 /* try to fill the TLB and return an exception if error. If retaddr is
3346 NULL, it means that the function was called in C code (i.e. not
3347 from generated code or from helper.c) */
3348 /* XXX: fix it to restore all registers */
3349 void tlb_fill (target_ulong addr, int is_write, int mmu_idx, void *retaddr)
3351 TranslationBlock *tb;
3352 CPUState *saved_env;
3356 /* XXX: hack to restore env in all cases, even if not called from
3359 env = cpu_single_env;
3360 ret = cpu_ppc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
3361 if (unlikely(ret != 0)) {
3362 if (likely(retaddr)) {
3363 /* now we have a real cpu fault */
3364 pc = (unsigned long)retaddr;
3365 tb = tb_find_pc(pc);
3367 /* the PC is inside the translated code. It means that we have
3368 a virtual CPU fault */
3369 cpu_restore_state(tb, env, pc, NULL);
3372 helper_raise_exception_err(env->exception_index, env->error_code);
3377 /* Segment registers load and store */
3378 target_ulong helper_load_sr (target_ulong sr_num)
3380 return env->sr[sr_num];
3383 void helper_store_sr (target_ulong sr_num, target_ulong val)
3385 ppc_store_sr(env, sr_num, val);
3388 /* SLB management */
3389 #if defined(TARGET_PPC64)
3390 target_ulong helper_load_slb (target_ulong slb_nr)
3392 return ppc_load_slb(env, slb_nr);
3395 void helper_store_slb (target_ulong slb_nr, target_ulong rs)
3397 ppc_store_slb(env, slb_nr, rs);
3400 void helper_slbia (void)
3402 ppc_slb_invalidate_all(env);
3405 void helper_slbie (target_ulong addr)
3407 ppc_slb_invalidate_one(env, addr);
3410 #endif /* defined(TARGET_PPC64) */
3412 /* TLB management */
3413 void helper_tlbia (void)
3415 ppc_tlb_invalidate_all(env);
3418 void helper_tlbie (target_ulong addr)
3420 ppc_tlb_invalidate_one(env, addr);
3423 /* Software driven TLBs management */
3424 /* PowerPC 602/603 software TLB load instructions helpers */
3425 static void do_6xx_tlb (target_ulong new_EPN, int is_code)
3427 target_ulong RPN, CMP, EPN;
3430 RPN = env->spr[SPR_RPA];
3432 CMP = env->spr[SPR_ICMP];
3433 EPN = env->spr[SPR_IMISS];
3435 CMP = env->spr[SPR_DCMP];
3436 EPN = env->spr[SPR_DMISS];
3438 way = (env->spr[SPR_SRR1] >> 17) & 1;
3439 #if defined (DEBUG_SOFTWARE_TLB)
3440 if (loglevel != 0) {
3441 fprintf(logfile, "%s: EPN " ADDRX " " ADDRX " PTE0 " ADDRX
3442 " PTE1 " ADDRX " way %d\n",
3443 __func__, new_EPN, EPN, CMP, RPN, way);
3446 /* Store this TLB */
3447 ppc6xx_tlb_store(env, (uint32_t)(new_EPN & TARGET_PAGE_MASK),
3448 way, is_code, CMP, RPN);
3451 void helper_6xx_tlbd (target_ulong EPN)
3456 void helper_6xx_tlbi (target_ulong EPN)
3461 /* PowerPC 74xx software TLB load instructions helpers */
3462 static void do_74xx_tlb (target_ulong new_EPN, int is_code)
3464 target_ulong RPN, CMP, EPN;
3467 RPN = env->spr[SPR_PTELO];
3468 CMP = env->spr[SPR_PTEHI];
3469 EPN = env->spr[SPR_TLBMISS] & ~0x3;
3470 way = env->spr[SPR_TLBMISS] & 0x3;
3471 #if defined (DEBUG_SOFTWARE_TLB)
3472 if (loglevel != 0) {
3473 fprintf(logfile, "%s: EPN " ADDRX " " ADDRX " PTE0 " ADDRX
3474 " PTE1 " ADDRX " way %d\n",
3475 __func__, new_EPN, EPN, CMP, RPN, way);
3478 /* Store this TLB */
3479 ppc6xx_tlb_store(env, (uint32_t)(new_EPN & TARGET_PAGE_MASK),
3480 way, is_code, CMP, RPN);
3483 void helper_74xx_tlbd (target_ulong EPN)
3485 do_74xx_tlb(EPN, 0);
3488 void helper_74xx_tlbi (target_ulong EPN)
3490 do_74xx_tlb(EPN, 1);
3493 static always_inline target_ulong booke_tlb_to_page_size (int size)
3495 return 1024 << (2 * size);
3498 static always_inline int booke_page_size_to_tlb (target_ulong page_size)
3502 switch (page_size) {
3536 #if defined (TARGET_PPC64)
3537 case 0x000100000000ULL:
3540 case 0x000400000000ULL:
3543 case 0x001000000000ULL:
3546 case 0x004000000000ULL:
3549 case 0x010000000000ULL:
3561 /* Helpers for 4xx TLB management */
3562 target_ulong helper_4xx_tlbre_lo (target_ulong entry)
3569 tlb = &env->tlb[entry].tlbe;
3571 if (tlb->prot & PAGE_VALID)
3573 size = booke_page_size_to_tlb(tlb->size);
3574 if (size < 0 || size > 0x7)
3577 env->spr[SPR_40x_PID] = tlb->PID;
3581 target_ulong helper_4xx_tlbre_hi (target_ulong entry)
3587 tlb = &env->tlb[entry].tlbe;
3589 if (tlb->prot & PAGE_EXEC)
3591 if (tlb->prot & PAGE_WRITE)
3596 void helper_4xx_tlbwe_hi (target_ulong entry, target_ulong val)
3599 target_ulong page, end;
3601 #if defined (DEBUG_SOFTWARE_TLB)
3602 if (loglevel != 0) {
3603 fprintf(logfile, "%s entry %d val " ADDRX "\n", __func__, (int)entry, val);
3607 tlb = &env->tlb[entry].tlbe;
3608 /* Invalidate previous TLB (if it's valid) */
3609 if (tlb->prot & PAGE_VALID) {
3610 end = tlb->EPN + tlb->size;
3611 #if defined (DEBUG_SOFTWARE_TLB)
3612 if (loglevel != 0) {
3613 fprintf(logfile, "%s: invalidate old TLB %d start " ADDRX
3614 " end " ADDRX "\n", __func__, (int)entry, tlb->EPN, end);
3617 for (page = tlb->EPN; page < end; page += TARGET_PAGE_SIZE)
3618 tlb_flush_page(env, page);
3620 tlb->size = booke_tlb_to_page_size((val >> 7) & 0x7);
3621 /* We cannot handle TLB size < TARGET_PAGE_SIZE.
3622 * If this ever occurs, one should use the ppcemb target instead
3623 * of the ppc or ppc64 one
3625 if ((val & 0x40) && tlb->size < TARGET_PAGE_SIZE) {
3626 cpu_abort(env, "TLB size " TARGET_FMT_lu " < %u "
3627 "are not supported (%d)\n",
3628 tlb->size, TARGET_PAGE_SIZE, (int)((val >> 7) & 0x7));
3630 tlb->EPN = val & ~(tlb->size - 1);
3632 tlb->prot |= PAGE_VALID;
3634 tlb->prot &= ~PAGE_VALID;
3636 /* XXX: TO BE FIXED */
3637 cpu_abort(env, "Little-endian TLB entries are not supported by now\n");
3639 tlb->PID = env->spr[SPR_40x_PID]; /* PID */
3640 tlb->attr = val & 0xFF;
3641 #if defined (DEBUG_SOFTWARE_TLB)
3642 if (loglevel != 0) {
3643 fprintf(logfile, "%s: set up TLB %d RPN " PADDRX " EPN " ADDRX
3644 " size " ADDRX " prot %c%c%c%c PID %d\n", __func__,
3645 (int)entry, tlb->RPN, tlb->EPN, tlb->size,
3646 tlb->prot & PAGE_READ ? 'r' : '-',
3647 tlb->prot & PAGE_WRITE ? 'w' : '-',
3648 tlb->prot & PAGE_EXEC ? 'x' : '-',
3649 tlb->prot & PAGE_VALID ? 'v' : '-', (int)tlb->PID);
3652 /* Invalidate new TLB (if valid) */
3653 if (tlb->prot & PAGE_VALID) {
3654 end = tlb->EPN + tlb->size;
3655 #if defined (DEBUG_SOFTWARE_TLB)
3656 if (loglevel != 0) {
3657 fprintf(logfile, "%s: invalidate TLB %d start " ADDRX
3658 " end " ADDRX "\n", __func__, (int)entry, tlb->EPN, end);
3661 for (page = tlb->EPN; page < end; page += TARGET_PAGE_SIZE)
3662 tlb_flush_page(env, page);
3666 void helper_4xx_tlbwe_lo (target_ulong entry, target_ulong val)
3670 #if defined (DEBUG_SOFTWARE_TLB)
3671 if (loglevel != 0) {
3672 fprintf(logfile, "%s entry %i val " ADDRX "\n", __func__, (int)entry, val);
3676 tlb = &env->tlb[entry].tlbe;
3677 tlb->RPN = val & 0xFFFFFC00;
3678 tlb->prot = PAGE_READ;
3680 tlb->prot |= PAGE_EXEC;
3682 tlb->prot |= PAGE_WRITE;
3683 #if defined (DEBUG_SOFTWARE_TLB)
3684 if (loglevel != 0) {
3685 fprintf(logfile, "%s: set up TLB %d RPN " PADDRX " EPN " ADDRX
3686 " size " ADDRX " prot %c%c%c%c PID %d\n", __func__,
3687 (int)entry, tlb->RPN, tlb->EPN, tlb->size,
3688 tlb->prot & PAGE_READ ? 'r' : '-',
3689 tlb->prot & PAGE_WRITE ? 'w' : '-',
3690 tlb->prot & PAGE_EXEC ? 'x' : '-',
3691 tlb->prot & PAGE_VALID ? 'v' : '-', (int)tlb->PID);
3696 target_ulong helper_4xx_tlbsx (target_ulong address)
3698 return ppcemb_tlb_search(env, address, env->spr[SPR_40x_PID]);
3701 /* PowerPC 440 TLB management */
3702 void helper_440_tlbwe (uint32_t word, target_ulong entry, target_ulong value)
3705 target_ulong EPN, RPN, size;
3708 #if defined (DEBUG_SOFTWARE_TLB)
3709 if (loglevel != 0) {
3710 fprintf(logfile, "%s word %d entry %d value " ADDRX "\n",
3711 __func__, word, (int)entry, value);
3716 tlb = &env->tlb[entry].tlbe;
3719 /* Just here to please gcc */
3721 EPN = value & 0xFFFFFC00;
3722 if ((tlb->prot & PAGE_VALID) && EPN != tlb->EPN)
3725 size = booke_tlb_to_page_size((value >> 4) & 0xF);
3726 if ((tlb->prot & PAGE_VALID) && tlb->size < size)
3730 tlb->attr |= (value >> 8) & 1;
3731 if (value & 0x200) {
3732 tlb->prot |= PAGE_VALID;
3734 if (tlb->prot & PAGE_VALID) {
3735 tlb->prot &= ~PAGE_VALID;
3739 tlb->PID = env->spr[SPR_440_MMUCR] & 0x000000FF;
3744 RPN = value & 0xFFFFFC0F;
3745 if ((tlb->prot & PAGE_VALID) && tlb->RPN != RPN)
3750 tlb->attr = (tlb->attr & 0x1) | (value & 0x0000FF00);
3751 tlb->prot = tlb->prot & PAGE_VALID;
3753 tlb->prot |= PAGE_READ << 4;
3755 tlb->prot |= PAGE_WRITE << 4;
3757 tlb->prot |= PAGE_EXEC << 4;
3759 tlb->prot |= PAGE_READ;
3761 tlb->prot |= PAGE_WRITE;
3763 tlb->prot |= PAGE_EXEC;
3768 target_ulong helper_440_tlbre (uint32_t word, target_ulong entry)
3775 tlb = &env->tlb[entry].tlbe;
3778 /* Just here to please gcc */
3781 size = booke_page_size_to_tlb(tlb->size);
3782 if (size < 0 || size > 0xF)
3785 if (tlb->attr & 0x1)
3787 if (tlb->prot & PAGE_VALID)
3789 env->spr[SPR_440_MMUCR] &= ~0x000000FF;
3790 env->spr[SPR_440_MMUCR] |= tlb->PID;
3796 ret = tlb->attr & ~0x1;
3797 if (tlb->prot & (PAGE_READ << 4))
3799 if (tlb->prot & (PAGE_WRITE << 4))
3801 if (tlb->prot & (PAGE_EXEC << 4))
3803 if (tlb->prot & PAGE_READ)
3805 if (tlb->prot & PAGE_WRITE)
3807 if (tlb->prot & PAGE_EXEC)
3814 target_ulong helper_440_tlbsx (target_ulong address)
3816 return ppcemb_tlb_search(env, address, env->spr[SPR_440_MMUCR] & 0xFF);
3819 #endif /* !CONFIG_USER_ONLY */