162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/* IEEE754 floating point arithmetic
362306a36Sopenharmony_ci * double precision: common utilities
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci/*
662306a36Sopenharmony_ci * MIPS floating point support
762306a36Sopenharmony_ci * Copyright (C) 1994-2000 Algorithmics Ltd.
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include "ieee754dp.h"
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ciint ieee754dp_tint(union ieee754dp x)
1362306a36Sopenharmony_ci{
1462306a36Sopenharmony_ci	u64 residue;
1562306a36Sopenharmony_ci	int round;
1662306a36Sopenharmony_ci	int sticky;
1762306a36Sopenharmony_ci	int odd;
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci	COMPXDP;
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci	ieee754_clearcx();
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci	EXPLODEXDP;
2462306a36Sopenharmony_ci	FLUSHXDP;
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci	switch (xc) {
2762306a36Sopenharmony_ci	case IEEE754_CLASS_SNAN:
2862306a36Sopenharmony_ci	case IEEE754_CLASS_QNAN:
2962306a36Sopenharmony_ci		ieee754_setcx(IEEE754_INVALID_OPERATION);
3062306a36Sopenharmony_ci		return ieee754si_indef();
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci	case IEEE754_CLASS_INF:
3362306a36Sopenharmony_ci		ieee754_setcx(IEEE754_INVALID_OPERATION);
3462306a36Sopenharmony_ci		return ieee754si_overflow(xs);
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	case IEEE754_CLASS_ZERO:
3762306a36Sopenharmony_ci		return 0;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci	case IEEE754_CLASS_DNORM:
4062306a36Sopenharmony_ci	case IEEE754_CLASS_NORM:
4162306a36Sopenharmony_ci		break;
4262306a36Sopenharmony_ci	}
4362306a36Sopenharmony_ci	if (xe > 31) {
4462306a36Sopenharmony_ci		/* Set invalid. We will only use overflow for floating
4562306a36Sopenharmony_ci		   point overflow */
4662306a36Sopenharmony_ci		ieee754_setcx(IEEE754_INVALID_OPERATION);
4762306a36Sopenharmony_ci		return ieee754si_overflow(xs);
4862306a36Sopenharmony_ci	}
4962306a36Sopenharmony_ci	/* oh gawd */
5062306a36Sopenharmony_ci	if (xe > DP_FBITS) {
5162306a36Sopenharmony_ci		xm <<= xe - DP_FBITS;
5262306a36Sopenharmony_ci	} else if (xe < DP_FBITS) {
5362306a36Sopenharmony_ci		if (xe < -1) {
5462306a36Sopenharmony_ci			residue = xm;
5562306a36Sopenharmony_ci			round = 0;
5662306a36Sopenharmony_ci			sticky = residue != 0;
5762306a36Sopenharmony_ci			xm = 0;
5862306a36Sopenharmony_ci		} else {
5962306a36Sopenharmony_ci			residue = xm << (64 - DP_FBITS + xe);
6062306a36Sopenharmony_ci			round = (residue >> 63) != 0;
6162306a36Sopenharmony_ci			sticky = (residue << 1) != 0;
6262306a36Sopenharmony_ci			xm >>= DP_FBITS - xe;
6362306a36Sopenharmony_ci		}
6462306a36Sopenharmony_ci		/* Note: At this point upper 32 bits of xm are guaranteed
6562306a36Sopenharmony_ci		   to be zero */
6662306a36Sopenharmony_ci		odd = (xm & 0x1) != 0x0;
6762306a36Sopenharmony_ci		switch (ieee754_csr.rm) {
6862306a36Sopenharmony_ci		case FPU_CSR_RN:
6962306a36Sopenharmony_ci			if (round && (sticky || odd))
7062306a36Sopenharmony_ci				xm++;
7162306a36Sopenharmony_ci			break;
7262306a36Sopenharmony_ci		case FPU_CSR_RZ:
7362306a36Sopenharmony_ci			break;
7462306a36Sopenharmony_ci		case FPU_CSR_RU:	/* toward +Infinity */
7562306a36Sopenharmony_ci			if ((round || sticky) && !xs)
7662306a36Sopenharmony_ci				xm++;
7762306a36Sopenharmony_ci			break;
7862306a36Sopenharmony_ci		case FPU_CSR_RD:	/* toward -Infinity */
7962306a36Sopenharmony_ci			if ((round || sticky) && xs)
8062306a36Sopenharmony_ci				xm++;
8162306a36Sopenharmony_ci			break;
8262306a36Sopenharmony_ci		}
8362306a36Sopenharmony_ci		/* look for valid corner case 0x80000000 */
8462306a36Sopenharmony_ci		if ((xm >> 31) != 0 && (xs == 0 || xm != 0x80000000)) {
8562306a36Sopenharmony_ci			/* This can happen after rounding */
8662306a36Sopenharmony_ci			ieee754_setcx(IEEE754_INVALID_OPERATION);
8762306a36Sopenharmony_ci			return ieee754si_overflow(xs);
8862306a36Sopenharmony_ci		}
8962306a36Sopenharmony_ci		if (round || sticky)
9062306a36Sopenharmony_ci			ieee754_setcx(IEEE754_INEXACT);
9162306a36Sopenharmony_ci	}
9262306a36Sopenharmony_ci	if (xs)
9362306a36Sopenharmony_ci		return -xm;
9462306a36Sopenharmony_ci	else
9562306a36Sopenharmony_ci		return xm;
9662306a36Sopenharmony_ci}
97