162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci#include <linux/types.h>
362306a36Sopenharmony_ci#include <linux/errno.h>
462306a36Sopenharmony_ci#include <linux/uaccess.h>
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <asm/sfp-machine.h>
762306a36Sopenharmony_ci#include <math-emu/soft-fp.h>
862306a36Sopenharmony_ci#include <math-emu/double.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ciint
1162306a36Sopenharmony_cifmul(void *frD, void *frA, void *frB)
1262306a36Sopenharmony_ci{
1362306a36Sopenharmony_ci	FP_DECL_D(A);
1462306a36Sopenharmony_ci	FP_DECL_D(B);
1562306a36Sopenharmony_ci	FP_DECL_D(R);
1662306a36Sopenharmony_ci	FP_DECL_EX;
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#ifdef DEBUG
1962306a36Sopenharmony_ci	printk("%s: %p %p %p\n", __func__, frD, frA, frB);
2062306a36Sopenharmony_ci#endif
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci	FP_UNPACK_DP(A, frA);
2362306a36Sopenharmony_ci	FP_UNPACK_DP(B, frB);
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#ifdef DEBUG
2662306a36Sopenharmony_ci	printk("A: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n",
2762306a36Sopenharmony_ci	       A_s, A_f1, A_f0, A_e, A_c, A_f1, A_f0, A_e + 1023);
2862306a36Sopenharmony_ci	printk("B: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n",
2962306a36Sopenharmony_ci	       B_s, B_f1, B_f0, B_e, B_c, B_f1, B_f0, B_e + 1023);
3062306a36Sopenharmony_ci#endif
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci	if ((A_c == FP_CLS_INF && B_c == FP_CLS_ZERO) ||
3362306a36Sopenharmony_ci	    (A_c == FP_CLS_ZERO && B_c == FP_CLS_INF))
3462306a36Sopenharmony_ci		FP_SET_EXCEPTION(EFLAG_VXIMZ);
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	FP_MUL_D(R, A, B);
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci#ifdef DEBUG
3962306a36Sopenharmony_ci	printk("D: %ld %lu %lu %ld (%ld) [%08lx.%08lx %lx]\n",
4062306a36Sopenharmony_ci	       R_s, R_f1, R_f0, R_e, R_c, R_f1, R_f0, R_e + 1023);
4162306a36Sopenharmony_ci#endif
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci	__FP_PACK_D(frD, R);
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	return FP_CUR_EXCEPTIONS;
4662306a36Sopenharmony_ci}
47