2 * x86 FPU, MMX/3DNow!/SSE/SSE2/SSE3/SSSE3/SSE4/PNI helpers
4 * Copyright (c) 2003 Fabrice Bellard
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, see <http://www.gnu.org/licenses/>.
20 #include "qemu/osdep.h"
23 #include "exec/helper-proto.h"
24 #include "qemu/host-utils.h"
25 #include "exec/cpu_ldst.h"
27 #define FPU_RC_MASK 0xc00
28 #define FPU_RC_NEAR 0x000
29 #define FPU_RC_DOWN 0x400
30 #define FPU_RC_UP 0x800
31 #define FPU_RC_CHOP 0xc00
33 #define MAXTAN 9223372036854775808.0
35 /* the following deal with x86 long double-precision numbers */
36 #define MAXEXPD 0x7fff
38 #define EXPD(fp) (fp.l.upper & 0x7fff)
39 #define SIGND(fp) ((fp.l.upper) & 0x8000)
40 #define MANTD(fp) (fp.l.lower)
41 #define BIASEXPONENT(fp) fp.l.upper = (fp.l.upper & ~(0x7fff)) | EXPBIAS
43 #define FPUS_IE (1 << 0)
44 #define FPUS_DE (1 << 1)
45 #define FPUS_ZE (1 << 2)
46 #define FPUS_OE (1 << 3)
47 #define FPUS_UE (1 << 4)
48 #define FPUS_PE (1 << 5)
49 #define FPUS_SF (1 << 6)
50 #define FPUS_SE (1 << 7)
51 #define FPUS_B (1 << 15)
55 #define floatx80_lg2 make_floatx80(0x3ffd, 0x9a209a84fbcff799LL)
56 #define floatx80_l2e make_floatx80(0x3fff, 0xb8aa3b295c17f0bcLL)
57 #define floatx80_l2t make_floatx80(0x4000, 0xd49a784bcd1b8afeLL)
59 static inline void fpush(CPUX86State *env)
61 env->fpstt = (env->fpstt - 1) & 7;
62 env->fptags[env->fpstt] = 0; /* validate stack entry */
65 static inline void fpop(CPUX86State *env)
67 env->fptags[env->fpstt] = 1; /* invalidate stack entry */
68 env->fpstt = (env->fpstt + 1) & 7;
71 static inline floatx80 helper_fldt(CPUX86State *env, target_ulong ptr,
76 temp.l.lower = cpu_ldq_data_ra(env, ptr, retaddr);
77 temp.l.upper = cpu_lduw_data_ra(env, ptr + 8, retaddr);
81 static inline void helper_fstt(CPUX86State *env, floatx80 f, target_ulong ptr,
87 cpu_stq_data_ra(env, ptr, temp.l.lower, retaddr);
88 cpu_stw_data_ra(env, ptr + 8, temp.l.upper, retaddr);
93 static inline double floatx80_to_double(CPUX86State *env, floatx80 a)
100 u.f64 = floatx80_to_float64(a, &env->fp_status);
104 static inline floatx80 double_to_floatx80(CPUX86State *env, double a)
112 return float64_to_floatx80(u.f64, &env->fp_status);
115 static void fpu_set_exception(CPUX86State *env, int mask)
118 if (env->fpus & (~env->fpuc & FPUC_EM)) {
119 env->fpus |= FPUS_SE | FPUS_B;
123 static inline floatx80 helper_fdiv(CPUX86State *env, floatx80 a, floatx80 b)
125 if (floatx80_is_zero(b)) {
126 fpu_set_exception(env, FPUS_ZE);
128 return floatx80_div(a, b, &env->fp_status);
131 static void fpu_raise_exception(CPUX86State *env, uintptr_t retaddr)
133 if (env->cr[0] & CR0_NE_MASK) {
134 raise_exception_ra(env, EXCP10_COPR, retaddr);
136 #if !defined(CONFIG_USER_ONLY)
143 void helper_flds_FT0(CPUX86State *env, uint32_t val)
151 FT0 = float32_to_floatx80(u.f, &env->fp_status);
154 void helper_fldl_FT0(CPUX86State *env, uint64_t val)
162 FT0 = float64_to_floatx80(u.f, &env->fp_status);
165 void helper_fildl_FT0(CPUX86State *env, int32_t val)
167 FT0 = int32_to_floatx80(val, &env->fp_status);
170 void helper_flds_ST0(CPUX86State *env, uint32_t val)
178 new_fpstt = (env->fpstt - 1) & 7;
180 env->fpregs[new_fpstt].d = float32_to_floatx80(u.f, &env->fp_status);
181 env->fpstt = new_fpstt;
182 env->fptags[new_fpstt] = 0; /* validate stack entry */
185 void helper_fldl_ST0(CPUX86State *env, uint64_t val)
193 new_fpstt = (env->fpstt - 1) & 7;
195 env->fpregs[new_fpstt].d = float64_to_floatx80(u.f, &env->fp_status);
196 env->fpstt = new_fpstt;
197 env->fptags[new_fpstt] = 0; /* validate stack entry */
200 void helper_fildl_ST0(CPUX86State *env, int32_t val)
204 new_fpstt = (env->fpstt - 1) & 7;
205 env->fpregs[new_fpstt].d = int32_to_floatx80(val, &env->fp_status);
206 env->fpstt = new_fpstt;
207 env->fptags[new_fpstt] = 0; /* validate stack entry */
210 void helper_fildll_ST0(CPUX86State *env, int64_t val)
214 new_fpstt = (env->fpstt - 1) & 7;
215 env->fpregs[new_fpstt].d = int64_to_floatx80(val, &env->fp_status);
216 env->fpstt = new_fpstt;
217 env->fptags[new_fpstt] = 0; /* validate stack entry */
220 uint32_t helper_fsts_ST0(CPUX86State *env)
227 u.f = floatx80_to_float32(ST0, &env->fp_status);
231 uint64_t helper_fstl_ST0(CPUX86State *env)
238 u.f = floatx80_to_float64(ST0, &env->fp_status);
242 int32_t helper_fist_ST0(CPUX86State *env)
246 val = floatx80_to_int32(ST0, &env->fp_status);
247 if (val != (int16_t)val) {
253 int32_t helper_fistl_ST0(CPUX86State *env)
256 signed char old_exp_flags;
258 old_exp_flags = get_float_exception_flags(&env->fp_status);
259 set_float_exception_flags(0, &env->fp_status);
261 val = floatx80_to_int32(ST0, &env->fp_status);
262 if (get_float_exception_flags(&env->fp_status) & float_flag_invalid) {
265 set_float_exception_flags(get_float_exception_flags(&env->fp_status)
266 | old_exp_flags, &env->fp_status);
270 int64_t helper_fistll_ST0(CPUX86State *env)
273 signed char old_exp_flags;
275 old_exp_flags = get_float_exception_flags(&env->fp_status);
276 set_float_exception_flags(0, &env->fp_status);
278 val = floatx80_to_int64(ST0, &env->fp_status);
279 if (get_float_exception_flags(&env->fp_status) & float_flag_invalid) {
280 val = 0x8000000000000000ULL;
282 set_float_exception_flags(get_float_exception_flags(&env->fp_status)
283 | old_exp_flags, &env->fp_status);
287 int32_t helper_fistt_ST0(CPUX86State *env)
291 val = floatx80_to_int32_round_to_zero(ST0, &env->fp_status);
292 if (val != (int16_t)val) {
298 int32_t helper_fisttl_ST0(CPUX86State *env)
302 val = floatx80_to_int32_round_to_zero(ST0, &env->fp_status);
306 int64_t helper_fisttll_ST0(CPUX86State *env)
310 val = floatx80_to_int64_round_to_zero(ST0, &env->fp_status);
314 void helper_fldt_ST0(CPUX86State *env, target_ulong ptr)
318 new_fpstt = (env->fpstt - 1) & 7;
319 env->fpregs[new_fpstt].d = helper_fldt(env, ptr, GETPC());
320 env->fpstt = new_fpstt;
321 env->fptags[new_fpstt] = 0; /* validate stack entry */
324 void helper_fstt_ST0(CPUX86State *env, target_ulong ptr)
326 helper_fstt(env, ST0, ptr, GETPC());
329 void helper_fpush(CPUX86State *env)
334 void helper_fpop(CPUX86State *env)
339 void helper_fdecstp(CPUX86State *env)
341 env->fpstt = (env->fpstt - 1) & 7;
342 env->fpus &= ~0x4700;
345 void helper_fincstp(CPUX86State *env)
347 env->fpstt = (env->fpstt + 1) & 7;
348 env->fpus &= ~0x4700;
353 void helper_ffree_STN(CPUX86State *env, int st_index)
355 env->fptags[(env->fpstt + st_index) & 7] = 1;
358 void helper_fmov_ST0_FT0(CPUX86State *env)
363 void helper_fmov_FT0_STN(CPUX86State *env, int st_index)
368 void helper_fmov_ST0_STN(CPUX86State *env, int st_index)
373 void helper_fmov_STN_ST0(CPUX86State *env, int st_index)
378 void helper_fxchg_ST0_STN(CPUX86State *env, int st_index)
389 static const int fcom_ccval[4] = {0x0100, 0x4000, 0x0000, 0x4500};
391 void helper_fcom_ST0_FT0(CPUX86State *env)
395 ret = floatx80_compare(ST0, FT0, &env->fp_status);
396 env->fpus = (env->fpus & ~0x4500) | fcom_ccval[ret + 1];
399 void helper_fucom_ST0_FT0(CPUX86State *env)
403 ret = floatx80_compare_quiet(ST0, FT0, &env->fp_status);
404 env->fpus = (env->fpus & ~0x4500) | fcom_ccval[ret + 1];
407 static const int fcomi_ccval[4] = {CC_C, CC_Z, 0, CC_Z | CC_P | CC_C};
409 void helper_fcomi_ST0_FT0(CPUX86State *env)
414 ret = floatx80_compare(ST0, FT0, &env->fp_status);
415 eflags = cpu_cc_compute_all(env, CC_OP);
416 eflags = (eflags & ~(CC_Z | CC_P | CC_C)) | fcomi_ccval[ret + 1];
420 void helper_fucomi_ST0_FT0(CPUX86State *env)
425 ret = floatx80_compare_quiet(ST0, FT0, &env->fp_status);
426 eflags = cpu_cc_compute_all(env, CC_OP);
427 eflags = (eflags & ~(CC_Z | CC_P | CC_C)) | fcomi_ccval[ret + 1];
431 void helper_fadd_ST0_FT0(CPUX86State *env)
433 ST0 = floatx80_add(ST0, FT0, &env->fp_status);
436 void helper_fmul_ST0_FT0(CPUX86State *env)
438 ST0 = floatx80_mul(ST0, FT0, &env->fp_status);
441 void helper_fsub_ST0_FT0(CPUX86State *env)
443 ST0 = floatx80_sub(ST0, FT0, &env->fp_status);
446 void helper_fsubr_ST0_FT0(CPUX86State *env)
448 ST0 = floatx80_sub(FT0, ST0, &env->fp_status);
451 void helper_fdiv_ST0_FT0(CPUX86State *env)
453 ST0 = helper_fdiv(env, ST0, FT0);
456 void helper_fdivr_ST0_FT0(CPUX86State *env)
458 ST0 = helper_fdiv(env, FT0, ST0);
461 /* fp operations between STN and ST0 */
463 void helper_fadd_STN_ST0(CPUX86State *env, int st_index)
465 ST(st_index) = floatx80_add(ST(st_index), ST0, &env->fp_status);
468 void helper_fmul_STN_ST0(CPUX86State *env, int st_index)
470 ST(st_index) = floatx80_mul(ST(st_index), ST0, &env->fp_status);
473 void helper_fsub_STN_ST0(CPUX86State *env, int st_index)
475 ST(st_index) = floatx80_sub(ST(st_index), ST0, &env->fp_status);
478 void helper_fsubr_STN_ST0(CPUX86State *env, int st_index)
480 ST(st_index) = floatx80_sub(ST0, ST(st_index), &env->fp_status);
483 void helper_fdiv_STN_ST0(CPUX86State *env, int st_index)
488 *p = helper_fdiv(env, *p, ST0);
491 void helper_fdivr_STN_ST0(CPUX86State *env, int st_index)
496 *p = helper_fdiv(env, ST0, *p);
499 /* misc FPU operations */
500 void helper_fchs_ST0(CPUX86State *env)
502 ST0 = floatx80_chs(ST0);
505 void helper_fabs_ST0(CPUX86State *env)
507 ST0 = floatx80_abs(ST0);
510 void helper_fld1_ST0(CPUX86State *env)
515 void helper_fldl2t_ST0(CPUX86State *env)
520 void helper_fldl2e_ST0(CPUX86State *env)
525 void helper_fldpi_ST0(CPUX86State *env)
530 void helper_fldlg2_ST0(CPUX86State *env)
535 void helper_fldln2_ST0(CPUX86State *env)
540 void helper_fldz_ST0(CPUX86State *env)
545 void helper_fldz_FT0(CPUX86State *env)
550 uint32_t helper_fnstsw(CPUX86State *env)
552 return (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11;
555 uint32_t helper_fnstcw(CPUX86State *env)
560 void update_fp_status(CPUX86State *env)
564 /* set rounding mode */
565 switch (env->fpuc & FPU_RC_MASK) {
568 rnd_type = float_round_nearest_even;
571 rnd_type = float_round_down;
574 rnd_type = float_round_up;
577 rnd_type = float_round_to_zero;
580 set_float_rounding_mode(rnd_type, &env->fp_status);
581 switch ((env->fpuc >> 8) & 3) {
593 set_floatx80_rounding_precision(rnd_type, &env->fp_status);
596 void helper_fldcw(CPUX86State *env, uint32_t val)
598 cpu_set_fpuc(env, val);
601 void helper_fclex(CPUX86State *env)
606 void helper_fwait(CPUX86State *env)
608 if (env->fpus & FPUS_SE) {
609 fpu_raise_exception(env, GETPC());
613 void helper_fninit(CPUX86State *env)
617 cpu_set_fpuc(env, 0x37f);
630 void helper_fbld_ST0(CPUX86State *env, target_ulong ptr)
638 for (i = 8; i >= 0; i--) {
639 v = cpu_ldub_data_ra(env, ptr + i, GETPC());
640 val = (val * 100) + ((v >> 4) * 10) + (v & 0xf);
642 tmp = int64_to_floatx80(val, &env->fp_status);
643 if (cpu_ldub_data_ra(env, ptr + 9, GETPC()) & 0x80) {
644 tmp = floatx80_chs(tmp);
650 void helper_fbst_ST0(CPUX86State *env, target_ulong ptr)
653 target_ulong mem_ref, mem_end;
656 val = floatx80_to_int64(ST0, &env->fp_status);
658 mem_end = mem_ref + 9;
660 cpu_stb_data_ra(env, mem_end, 0x80, GETPC());
663 cpu_stb_data_ra(env, mem_end, 0x00, GETPC());
665 while (mem_ref < mem_end) {
671 v = ((v / 10) << 4) | (v % 10);
672 cpu_stb_data_ra(env, mem_ref++, v, GETPC());
674 while (mem_ref < mem_end) {
675 cpu_stb_data_ra(env, mem_ref++, 0, GETPC());
679 void helper_f2xm1(CPUX86State *env)
681 double val = floatx80_to_double(env, ST0);
683 val = pow(2.0, val) - 1.0;
684 ST0 = double_to_floatx80(env, val);
687 void helper_fyl2x(CPUX86State *env)
689 double fptemp = floatx80_to_double(env, ST0);
692 fptemp = log(fptemp) / log(2.0); /* log2(ST) */
693 fptemp *= floatx80_to_double(env, ST1);
694 ST1 = double_to_floatx80(env, fptemp);
697 env->fpus &= ~0x4700;
702 void helper_fptan(CPUX86State *env)
704 double fptemp = floatx80_to_double(env, ST0);
706 if ((fptemp > MAXTAN) || (fptemp < -MAXTAN)) {
709 fptemp = tan(fptemp);
710 ST0 = double_to_floatx80(env, fptemp);
713 env->fpus &= ~0x400; /* C2 <-- 0 */
714 /* the above code is for |arg| < 2**52 only */
718 void helper_fpatan(CPUX86State *env)
720 double fptemp, fpsrcop;
722 fpsrcop = floatx80_to_double(env, ST1);
723 fptemp = floatx80_to_double(env, ST0);
724 ST1 = double_to_floatx80(env, atan2(fpsrcop, fptemp));
728 void helper_fxtract(CPUX86State *env)
734 if (floatx80_is_zero(ST0)) {
735 /* Easy way to generate -inf and raising division by 0 exception */
736 ST0 = floatx80_div(floatx80_chs(floatx80_one), floatx80_zero,
743 expdif = EXPD(temp) - EXPBIAS;
744 /* DP exponent bias */
745 ST0 = int32_to_floatx80(expdif, &env->fp_status);
752 void helper_fprem1(CPUX86State *env)
754 double st0, st1, dblq, fpsrcop, fptemp;
755 CPU_LDoubleU fpsrcop1, fptemp1;
757 signed long long int q;
759 st0 = floatx80_to_double(env, ST0);
760 st1 = floatx80_to_double(env, ST1);
762 if (isinf(st0) || isnan(st0) || isnan(st1) || (st1 == 0.0)) {
763 ST0 = double_to_floatx80(env, 0.0 / 0.0); /* NaN */
764 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
772 expdif = EXPD(fpsrcop1) - EXPD(fptemp1);
775 /* optimisation? taken from the AMD docs */
776 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
777 /* ST0 is unchanged */
782 dblq = fpsrcop / fptemp;
783 /* round dblq towards nearest integer */
785 st0 = fpsrcop - fptemp * dblq;
787 /* convert dblq to q by truncating towards zero */
789 q = (signed long long int)(-dblq);
791 q = (signed long long int)dblq;
794 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
795 /* (C0,C3,C1) <-- (q2,q1,q0) */
796 env->fpus |= (q & 0x4) << (8 - 2); /* (C0) <-- q2 */
797 env->fpus |= (q & 0x2) << (14 - 1); /* (C3) <-- q1 */
798 env->fpus |= (q & 0x1) << (9 - 0); /* (C1) <-- q0 */
800 env->fpus |= 0x400; /* C2 <-- 1 */
801 fptemp = pow(2.0, expdif - 50);
802 fpsrcop = (st0 / st1) / fptemp;
803 /* fpsrcop = integer obtained by chopping */
804 fpsrcop = (fpsrcop < 0.0) ?
805 -(floor(fabs(fpsrcop))) : floor(fpsrcop);
806 st0 -= (st1 * fpsrcop * fptemp);
808 ST0 = double_to_floatx80(env, st0);
811 void helper_fprem(CPUX86State *env)
813 double st0, st1, dblq, fpsrcop, fptemp;
814 CPU_LDoubleU fpsrcop1, fptemp1;
816 signed long long int q;
818 st0 = floatx80_to_double(env, ST0);
819 st1 = floatx80_to_double(env, ST1);
821 if (isinf(st0) || isnan(st0) || isnan(st1) || (st1 == 0.0)) {
822 ST0 = double_to_floatx80(env, 0.0 / 0.0); /* NaN */
823 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
831 expdif = EXPD(fpsrcop1) - EXPD(fptemp1);
834 /* optimisation? taken from the AMD docs */
835 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
836 /* ST0 is unchanged */
841 dblq = fpsrcop / fptemp; /* ST0 / ST1 */
842 /* round dblq towards zero */
843 dblq = (dblq < 0.0) ? ceil(dblq) : floor(dblq);
844 st0 = fpsrcop - fptemp * dblq; /* fpsrcop is ST0 */
846 /* convert dblq to q by truncating towards zero */
848 q = (signed long long int)(-dblq);
850 q = (signed long long int)dblq;
853 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
854 /* (C0,C3,C1) <-- (q2,q1,q0) */
855 env->fpus |= (q & 0x4) << (8 - 2); /* (C0) <-- q2 */
856 env->fpus |= (q & 0x2) << (14 - 1); /* (C3) <-- q1 */
857 env->fpus |= (q & 0x1) << (9 - 0); /* (C1) <-- q0 */
859 int N = 32 + (expdif % 32); /* as per AMD docs */
861 env->fpus |= 0x400; /* C2 <-- 1 */
862 fptemp = pow(2.0, (double)(expdif - N));
863 fpsrcop = (st0 / st1) / fptemp;
864 /* fpsrcop = integer obtained by chopping */
865 fpsrcop = (fpsrcop < 0.0) ?
866 -(floor(fabs(fpsrcop))) : floor(fpsrcop);
867 st0 -= (st1 * fpsrcop * fptemp);
869 ST0 = double_to_floatx80(env, st0);
872 void helper_fyl2xp1(CPUX86State *env)
874 double fptemp = floatx80_to_double(env, ST0);
876 if ((fptemp + 1.0) > 0.0) {
877 fptemp = log(fptemp + 1.0) / log(2.0); /* log2(ST + 1.0) */
878 fptemp *= floatx80_to_double(env, ST1);
879 ST1 = double_to_floatx80(env, fptemp);
882 env->fpus &= ~0x4700;
887 void helper_fsqrt(CPUX86State *env)
889 if (floatx80_is_neg(ST0)) {
890 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
893 ST0 = floatx80_sqrt(ST0, &env->fp_status);
896 void helper_fsincos(CPUX86State *env)
898 double fptemp = floatx80_to_double(env, ST0);
900 if ((fptemp > MAXTAN) || (fptemp < -MAXTAN)) {
903 ST0 = double_to_floatx80(env, sin(fptemp));
905 ST0 = double_to_floatx80(env, cos(fptemp));
906 env->fpus &= ~0x400; /* C2 <-- 0 */
907 /* the above code is for |arg| < 2**63 only */
911 void helper_frndint(CPUX86State *env)
913 ST0 = floatx80_round_to_int(ST0, &env->fp_status);
916 void helper_fscale(CPUX86State *env)
918 if (floatx80_is_any_nan(ST1)) {
921 int n = floatx80_to_int32_round_to_zero(ST1, &env->fp_status);
922 ST0 = floatx80_scalbn(ST0, n, &env->fp_status);
926 void helper_fsin(CPUX86State *env)
928 double fptemp = floatx80_to_double(env, ST0);
930 if ((fptemp > MAXTAN) || (fptemp < -MAXTAN)) {
933 ST0 = double_to_floatx80(env, sin(fptemp));
934 env->fpus &= ~0x400; /* C2 <-- 0 */
935 /* the above code is for |arg| < 2**53 only */
939 void helper_fcos(CPUX86State *env)
941 double fptemp = floatx80_to_double(env, ST0);
943 if ((fptemp > MAXTAN) || (fptemp < -MAXTAN)) {
946 ST0 = double_to_floatx80(env, cos(fptemp));
947 env->fpus &= ~0x400; /* C2 <-- 0 */
948 /* the above code is for |arg| < 2**63 only */
952 void helper_fxam_ST0(CPUX86State *env)
959 env->fpus &= ~0x4700; /* (C3,C2,C1,C0) <-- 0000 */
961 env->fpus |= 0x200; /* C1 <-- 1 */
964 /* XXX: test fptags too */
966 if (expdif == MAXEXPD) {
967 if (MANTD(temp) == 0x8000000000000000ULL) {
968 env->fpus |= 0x500; /* Infinity */
970 env->fpus |= 0x100; /* NaN */
972 } else if (expdif == 0) {
973 if (MANTD(temp) == 0) {
974 env->fpus |= 0x4000; /* Zero */
976 env->fpus |= 0x4400; /* Denormal */
983 static void do_fstenv(CPUX86State *env, target_ulong ptr, int data32,
986 int fpus, fptag, exp, i;
990 fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11;
992 for (i = 7; i >= 0; i--) {
994 if (env->fptags[i]) {
997 tmp.d = env->fpregs[i].d;
1000 if (exp == 0 && mant == 0) {
1003 } else if (exp == 0 || exp == MAXEXPD
1004 || (mant & (1LL << 63)) == 0) {
1005 /* NaNs, infinity, denormal */
1012 cpu_stl_data_ra(env, ptr, env->fpuc, retaddr);
1013 cpu_stl_data_ra(env, ptr + 4, fpus, retaddr);
1014 cpu_stl_data_ra(env, ptr + 8, fptag, retaddr);
1015 cpu_stl_data_ra(env, ptr + 12, 0, retaddr); /* fpip */
1016 cpu_stl_data_ra(env, ptr + 16, 0, retaddr); /* fpcs */
1017 cpu_stl_data_ra(env, ptr + 20, 0, retaddr); /* fpoo */
1018 cpu_stl_data_ra(env, ptr + 24, 0, retaddr); /* fpos */
1021 cpu_stw_data_ra(env, ptr, env->fpuc, retaddr);
1022 cpu_stw_data_ra(env, ptr + 2, fpus, retaddr);
1023 cpu_stw_data_ra(env, ptr + 4, fptag, retaddr);
1024 cpu_stw_data_ra(env, ptr + 6, 0, retaddr);
1025 cpu_stw_data_ra(env, ptr + 8, 0, retaddr);
1026 cpu_stw_data_ra(env, ptr + 10, 0, retaddr);
1027 cpu_stw_data_ra(env, ptr + 12, 0, retaddr);
1031 void helper_fstenv(CPUX86State *env, target_ulong ptr, int data32)
1033 do_fstenv(env, ptr, data32, GETPC());
1036 static void do_fldenv(CPUX86State *env, target_ulong ptr, int data32,
1042 cpu_set_fpuc(env, cpu_lduw_data_ra(env, ptr, retaddr));
1043 fpus = cpu_lduw_data_ra(env, ptr + 4, retaddr);
1044 fptag = cpu_lduw_data_ra(env, ptr + 8, retaddr);
1046 cpu_set_fpuc(env, cpu_lduw_data_ra(env, ptr, retaddr));
1047 fpus = cpu_lduw_data_ra(env, ptr + 2, retaddr);
1048 fptag = cpu_lduw_data_ra(env, ptr + 4, retaddr);
1050 env->fpstt = (fpus >> 11) & 7;
1051 env->fpus = fpus & ~0x3800;
1052 for (i = 0; i < 8; i++) {
1053 env->fptags[i] = ((fptag & 3) == 3);
1058 void helper_fldenv(CPUX86State *env, target_ulong ptr, int data32)
1060 do_fldenv(env, ptr, data32, GETPC());
1063 void helper_fsave(CPUX86State *env, target_ulong ptr, int data32)
1068 do_fstenv(env, ptr, data32, GETPC());
1070 ptr += (14 << data32);
1071 for (i = 0; i < 8; i++) {
1073 helper_fstt(env, tmp, ptr, GETPC());
1080 cpu_set_fpuc(env, 0x37f);
1091 void helper_frstor(CPUX86State *env, target_ulong ptr, int data32)
1096 do_fldenv(env, ptr, data32, GETPC());
1097 ptr += (14 << data32);
1099 for (i = 0; i < 8; i++) {
1100 tmp = helper_fldt(env, ptr, GETPC());
1106 #if defined(CONFIG_USER_ONLY)
1107 void cpu_x86_fsave(CPUX86State *env, target_ulong ptr, int data32)
1109 helper_fsave(env, ptr, data32);
1112 void cpu_x86_frstor(CPUX86State *env, target_ulong ptr, int data32)
1114 helper_frstor(env, ptr, data32);
1118 static void do_xsave_fpu(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1123 fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11;
1125 for (i = 0; i < 8; i++) {
1126 fptag |= (env->fptags[i] << i);
1128 cpu_stw_data_ra(env, ptr, env->fpuc, ra);
1129 cpu_stw_data_ra(env, ptr + 2, fpus, ra);
1130 cpu_stw_data_ra(env, ptr + 4, fptag ^ 0xff, ra);
1132 /* In 32-bit mode this is eip, sel, dp, sel.
1133 In 64-bit mode this is rip, rdp.
1134 But in either case we don't write actual data, just zeros. */
1135 cpu_stq_data_ra(env, ptr + 0x08, 0, ra); /* eip+sel; rip */
1136 cpu_stq_data_ra(env, ptr + 0x10, 0, ra); /* edp+sel; rdp */
1139 for (i = 0; i < 8; i++) {
1140 floatx80 tmp = ST(i);
1141 helper_fstt(env, tmp, addr, ra);
1146 static void do_xsave_mxcsr(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1148 cpu_stl_data_ra(env, ptr + 0x18, env->mxcsr, ra); /* mxcsr */
1149 cpu_stl_data_ra(env, ptr + 0x1c, 0x0000ffff, ra); /* mxcsr_mask */
1152 static void do_xsave_sse(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1157 if (env->hflags & HF_CS64_MASK) {
1164 for (i = 0; i < nb_xmm_regs; i++) {
1165 cpu_stq_data_ra(env, addr, env->xmm_regs[i].ZMM_Q(0), ra);
1166 cpu_stq_data_ra(env, addr + 8, env->xmm_regs[i].ZMM_Q(1), ra);
1171 void helper_fxsave(CPUX86State *env, target_ulong ptr)
1173 uintptr_t ra = GETPC();
1175 /* The operand must be 16 byte aligned */
1177 raise_exception_ra(env, EXCP0D_GPF, ra);
1180 do_xsave_fpu(env, ptr, ra);
1182 if (env->cr[4] & CR4_OSFXSR_MASK) {
1183 do_xsave_mxcsr(env, ptr, ra);
1184 /* Fast FXSAVE leaves out the XMM registers */
1185 if (!(env->efer & MSR_EFER_FFXSR)
1186 || (env->hflags & HF_CPL_MASK)
1187 || !(env->hflags & HF_LMA_MASK)) {
1188 do_xsave_sse(env, ptr, ra);
1193 static void do_xrstor_fpu(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1198 cpu_set_fpuc(env, cpu_lduw_data_ra(env, ptr, ra));
1199 fpus = cpu_lduw_data_ra(env, ptr + 2, ra);
1200 fptag = cpu_lduw_data_ra(env, ptr + 4, ra);
1201 env->fpstt = (fpus >> 11) & 7;
1202 env->fpus = fpus & ~0x3800;
1204 for (i = 0; i < 8; i++) {
1205 env->fptags[i] = ((fptag >> i) & 1);
1209 for (i = 0; i < 8; i++) {
1210 floatx80 tmp = helper_fldt(env, addr, ra);
1216 static void do_xrstor_mxcsr(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1218 cpu_set_mxcsr(env, cpu_ldl_data_ra(env, ptr + 0x18, ra));
1221 static void do_xrstor_sse(CPUX86State *env, target_ulong ptr, uintptr_t ra)
1226 if (env->hflags & HF_CS64_MASK) {
1233 for (i = 0; i < nb_xmm_regs; i++) {
1234 env->xmm_regs[i].ZMM_Q(0) = cpu_ldq_data_ra(env, addr, ra);
1235 env->xmm_regs[i].ZMM_Q(1) = cpu_ldq_data_ra(env, addr + 8, ra);
1240 void helper_fxrstor(CPUX86State *env, target_ulong ptr)
1242 uintptr_t ra = GETPC();
1244 /* The operand must be 16 byte aligned */
1246 raise_exception_ra(env, EXCP0D_GPF, ra);
1249 do_xrstor_fpu(env, ptr, ra);
1251 if (env->cr[4] & CR4_OSFXSR_MASK) {
1252 do_xrstor_mxcsr(env, ptr, ra);
1253 /* Fast FXRSTOR leaves out the XMM registers */
1254 if (!(env->efer & MSR_EFER_FFXSR)
1255 || (env->hflags & HF_CPL_MASK)
1256 || !(env->hflags & HF_LMA_MASK)) {
1257 do_xrstor_sse(env, ptr, ra);
1262 void cpu_get_fp80(uint64_t *pmant, uint16_t *pexp, floatx80 f)
1267 *pmant = temp.l.lower;
1268 *pexp = temp.l.upper;
1271 floatx80 cpu_set_fp80(uint64_t mant, uint16_t upper)
1275 temp.l.upper = upper;
1276 temp.l.lower = mant;
1281 /* XXX: optimize by storing fptt and fptags in the static cpu state */
1283 #define SSE_DAZ 0x0040
1284 #define SSE_RC_MASK 0x6000
1285 #define SSE_RC_NEAR 0x0000
1286 #define SSE_RC_DOWN 0x2000
1287 #define SSE_RC_UP 0x4000
1288 #define SSE_RC_CHOP 0x6000
1289 #define SSE_FZ 0x8000
1291 void cpu_set_mxcsr(CPUX86State *env, uint32_t mxcsr)
1297 /* set rounding mode */
1298 switch (mxcsr & SSE_RC_MASK) {
1301 rnd_type = float_round_nearest_even;
1304 rnd_type = float_round_down;
1307 rnd_type = float_round_up;
1310 rnd_type = float_round_to_zero;
1313 set_float_rounding_mode(rnd_type, &env->sse_status);
1315 /* set denormals are zero */
1316 set_flush_inputs_to_zero((mxcsr & SSE_DAZ) ? 1 : 0, &env->sse_status);
1318 /* set flush to zero */
1319 set_flush_to_zero((mxcsr & SSE_FZ) ? 1 : 0, &env->fp_status);
1322 void cpu_set_fpuc(CPUX86State *env, uint16_t val)
1325 update_fp_status(env);
1328 void helper_ldmxcsr(CPUX86State *env, uint32_t val)
1330 cpu_set_mxcsr(env, val);
1333 void helper_enter_mmx(CPUX86State *env)
1336 *(uint32_t *)(env->fptags) = 0;
1337 *(uint32_t *)(env->fptags + 4) = 0;
1340 void helper_emms(CPUX86State *env)
1342 /* set to empty state */
1343 *(uint32_t *)(env->fptags) = 0x01010101;
1344 *(uint32_t *)(env->fptags + 4) = 0x01010101;
1348 void helper_movq(CPUX86State *env, void *d, void *s)
1350 *(uint64_t *)d = *(uint64_t *)s;
1354 #include "ops_sse.h"
1357 #include "ops_sse.h"