int fcmpu(u32 *ccr, int crfD, void *frA, void *frB) { FP_DECL_D(A); FP_DECL_D(B); int code[4] = { (1 << 3), (1 << 1), (1 << 2), (1 << 0) }; long cmp; #ifdef DEBUG printk("%s: %p (%08x) %d %p %p\n", __FUNCTION__, ccr, *ccr, crfD, frA, frB); #endif __FP_UNPACK_D(A, frA); __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); #endif FP_CMP_D(cmp, A, B, 2); cmp = code[(cmp + 1) & 3]; __FPU_FPSCR &= ~(0x1f000); __FPU_FPSCR |= (cmp << 12); *ccr &= ~(15 << ((7 - crfD) << 2)); *ccr |= (cmp << ((7 - crfD) << 2)); #ifdef DEBUG printk("CR: %08x\n", *ccr); #endif return 0; }
int fadds(void *frD, void *frA, void *frB) { FP_DECL_D(A); FP_DECL_D(B); FP_DECL_D(R); int ret = 0; #ifdef DEBUG printk("%s: %p %p %p\n", __FUNCTION__, frD, frA, frB); #endif __FP_UNPACK_D(A, frA); __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); #endif if (A_s != B_s && A_c == FP_CLS_INF && B_c == FP_CLS_INF) ret |= EFLAG_VXISI; FP_ADD_D(R, A, B); #ifdef DEBUG printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); #endif return (ret | __FP_PACK_DS(frD, R)); }
int fmuls(void *frD, void *frA, void *frB) { FP_DECL_D(A); FP_DECL_D(B); FP_DECL_D(R); int ret = 0; #ifdef DEBUG printk("%s: %p %p %p\n", __func__, frD, frA, frB); #endif __FP_UNPACK_D(A, frA); __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n", A_s, A_f1, A_f0, A_e, A_c, A_f1, A_f0, A_e + 1023); printk("B: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n", B_s, B_f1, B_f0, B_e, B_c, B_f1, B_f0, B_e + 1023); #endif if ((A_c == FP_CLS_INF && B_c == FP_CLS_ZERO) || (A_c == FP_CLS_ZERO && B_c == FP_CLS_INF)) ret |= EFLAG_VXIMZ; FP_MUL_D(R, A, B); #ifdef DEBUG printk("D: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n", R_s, R_f1, R_f0, R_e, R_c, R_f1, R_f0, R_e + 1023); #endif return (ret | __FP_PACK_DS(frD, R)); }
int fsqrts(void *frD, void *frB) { FP_DECL_D(B); FP_DECL_D(R); int ret = 0; #ifdef DEBUG printk("%s: %p %p %p %p\n", __FUNCTION__, frD, frB); #endif __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); #endif if (B_s && B_c != FP_CLS_ZERO) ret |= EFLAG_VXSQRT; if (B_c == FP_CLS_NAN) ret |= EFLAG_VXSNAN; FP_SQRT_D(R, B); #ifdef DEBUG printk("R: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); #endif return (ret | __FP_PACK_DS(frD, R)); }
int stfs(void *frS, void *ea) { FP_DECL_D(A); FP_DECL_S(R); float f; int err; #ifdef DEBUG printk("%s: S %p, ea %p\n", __FUNCTION__, frS, ea); #endif __FP_UNPACK_D(A, frS); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); #endif FP_CONV(S, D, 1, 2, R, A); #ifdef DEBUG printk("R: %ld %lu %ld (%ld)\n", R_s, R_f, R_e, R_c); #endif err = _FP_PACK_CANONICAL(S, 1, R); if (!err || !__FPU_TRAP_P(err)) { __FP_PACK_RAW_1(S, &f, R); if (copy_to_user(ea, &f, sizeof(float))) return -EFAULT; } return err; }
int fsel(u32 *frD, void *frA, u32 *frB, u32 *frC) { FP_DECL_D(A); #ifdef DEBUG printk("%s: %p %p %p %p\n", __FUNCTION__, frD, frA, frB, frC); #endif __FP_UNPACK_D(A, frA); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); printk("B: %08x %08x\n", frB[0], frB[1]); printk("C: %08x %08x\n", frC[0], frC[1]); #endif if (A_c == FP_CLS_NAN || (A_c != FP_CLS_ZERO && A_s)) { frD[0] = frB[0]; frD[1] = frB[1]; } else { frD[0] = frC[0]; frD[1] = frC[1]; } #ifdef DEBUG printk("D: %08x.%08x\n", frD[0], frD[1]); #endif return 0; }
int fnmsub(void *frD, void *frA, void *frB, void *frC) { FP_DECL_D(R); FP_DECL_D(A); FP_DECL_D(B); FP_DECL_D(C); FP_DECL_D(T); int ret = 0; #ifdef DEBUG printk("%s: %p %p %p %p\n", __FUNCTION__, frD, frA, frB, frC); #endif __FP_UNPACK_D(A, frA); __FP_UNPACK_D(B, frB); __FP_UNPACK_D(C, frC); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); printk("C: %ld %lu %lu %ld (%ld)\n", C_s, C_f1, C_f0, C_e, C_c); #endif if ((A_c == FP_CLS_INF && C_c == FP_CLS_ZERO) || (A_c == FP_CLS_ZERO && C_c == FP_CLS_INF)) ret |= EFLAG_VXIMZ; FP_MUL_D(T, A, C); if (B_c != FP_CLS_NAN) B_s ^= 1; if (T_s != B_s && T_c == FP_CLS_INF && B_c == FP_CLS_INF) ret |= EFLAG_VXISI; FP_ADD_D(R, T, B); if (R_c != FP_CLS_NAN) R_s ^= 1; #ifdef DEBUG printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); #endif return (ret | __FP_PACK_D(frD, R)); }
int fdiv(void *frD, void *frA, void *frB) { FP_DECL_D(A); FP_DECL_D(B); FP_DECL_D(R); int ret = 0; #ifdef DEBUG printk("%s: %p %p %p\n", __func__, frD, frA, frB); #endif __FP_UNPACK_D(A, frA); __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); #endif if (A_c == FP_CLS_ZERO && B_c == FP_CLS_ZERO) { ret |= EFLAG_VXZDZ; #ifdef DEBUG printk("%s: FPSCR_VXZDZ raised\n", __func__); #endif } if (A_c == FP_CLS_INF && B_c == FP_CLS_INF) { ret |= EFLAG_VXIDI; #ifdef DEBUG printk("%s: FPSCR_VXIDI raised\n", __func__); #endif } if (B_c == FP_CLS_ZERO && A_c != FP_CLS_ZERO) { ret |= EFLAG_DIVZERO; if (__FPU_TRAP_P(EFLAG_DIVZERO)) return ret; } FP_DIV_D(R, A, B); #ifdef DEBUG printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c); #endif return (ret | __FP_PACK_D(frD, R)); }
int FDTOI(unsigned *rd, void *rs2) { FP_DECL_D(A); unsigned r; __FP_UNPACK_D(A, rs2); FP_TO_INT_D(r, A, 32, 1); *rd = r; return 1; }
int frsp(void *frD, void *frB) { FP_DECL_D(B); #ifdef DEBUG printk("%s: D %p, B %p\n", __FUNCTION__, frD, frB); #endif __FP_UNPACK_D(B, frB); #ifdef DEBUG printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); #endif return __FP_PACK_DS(frD, B); }
int fctiw(u32 *frD, void *frB) { FP_DECL_D(B); unsigned int r; __FP_UNPACK_D(B, frB); FP_TO_INT_D(r, B, 32, 1); frD[1] = r; #ifdef DEBUG printk("%s: D %p, B %p: ", __FUNCTION__, frD, frB); dump_double(frD); printk("\n"); #endif return 0; }
int efdctsi(u32 *rD, void *rB) { FP_DECL_D(B); unsigned int r; __FP_UNPACK_D(B, rB); _FP_ROUND(2, B); FP_TO_INT_D(r, B, 32, 1); rD[1] = r; #ifdef DEBUG printk("%s: D %p, B %p: ", __FUNCTION__, rD, rB); dump_double(rD); printk("\n"); #endif return 0; }