18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci#include <linux/types.h>
38c2ecf20Sopenharmony_ci#include <linux/errno.h>
48c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <asm/sfp-machine.h>
78c2ecf20Sopenharmony_ci#include <math-emu/soft-fp.h>
88c2ecf20Sopenharmony_ci#include <math-emu/double.h>
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ciint
118c2ecf20Sopenharmony_cifsqrt(void *frD, void *frB)
128c2ecf20Sopenharmony_ci{
138c2ecf20Sopenharmony_ci	FP_DECL_D(B);
148c2ecf20Sopenharmony_ci	FP_DECL_D(R);
158c2ecf20Sopenharmony_ci	FP_DECL_EX;
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_ci#ifdef DEBUG
188c2ecf20Sopenharmony_ci	printk("%s: %p %p %p %p\n", __func__, frD, frB);
198c2ecf20Sopenharmony_ci#endif
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci	FP_UNPACK_DP(B, frB);
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_ci#ifdef DEBUG
248c2ecf20Sopenharmony_ci	printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c);
258c2ecf20Sopenharmony_ci#endif
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci	if (B_s && B_c != FP_CLS_ZERO)
288c2ecf20Sopenharmony_ci		FP_SET_EXCEPTION(EFLAG_VXSQRT);
298c2ecf20Sopenharmony_ci	if (B_c == FP_CLS_NAN)
308c2ecf20Sopenharmony_ci		FP_SET_EXCEPTION(EFLAG_VXSNAN);
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	FP_SQRT_D(R, B);
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci#ifdef DEBUG
358c2ecf20Sopenharmony_ci	printk("R: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c);
368c2ecf20Sopenharmony_ci#endif
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci	__FP_PACK_D(frD, R);
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci	return FP_CUR_EXCEPTIONS;
418c2ecf20Sopenharmony_ci}
42