Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / arch / powerpc / math-emu / fsqrt.c
diff --git a/kernel/arch/powerpc/math-emu/fsqrt.c b/kernel/arch/powerpc/math-emu/fsqrt.c
new file mode 100644 (file)
index 0000000..a55fc7d
--- /dev/null
@@ -0,0 +1,40 @@
+#include <linux/types.h>
+#include <linux/errno.h>
+#include <asm/uaccess.h>
+
+#include <asm/sfp-machine.h>
+#include <math-emu/soft-fp.h>
+#include <math-emu/double.h>
+
+int
+fsqrt(void *frD, void *frB)
+{
+       FP_DECL_D(B);
+       FP_DECL_D(R);
+       FP_DECL_EX;
+
+#ifdef DEBUG
+       printk("%s: %p %p %p %p\n", __func__, frD, frB);
+#endif
+
+       FP_UNPACK_DP(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)
+               FP_SET_EXCEPTION(EFLAG_VXSQRT);
+       if (B_c == FP_CLS_NAN)
+               FP_SET_EXCEPTION(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
+
+       __FP_PACK_D(frD, R);
+
+       return FP_CUR_EXCEPTIONS;
+}