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_cifadd(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)\n", A_s, A_f1, A_f0, A_e, A_c);
2762306a36Sopenharmony_ci	printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c);
2862306a36Sopenharmony_ci#endif
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci	FP_ADD_D(R, A, B);
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci#ifdef DEBUG
3362306a36Sopenharmony_ci	printk("D: %ld %lu %lu %ld (%ld)\n", R_s, R_f1, R_f0, R_e, R_c);
3462306a36Sopenharmony_ci#endif
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	__FP_PACK_D(frD, R);
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	return FP_CUR_EXCEPTIONS;
3962306a36Sopenharmony_ci}
40