/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License, Version 1.0 only
 * (the "License").  You may not use this file except in compliance
 * with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 1988,2003 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#pragma ident	"%Z%%M%	%I%	%E% SMI"

/* Utility functions for Sparc FPU simulator. */

#include <sys/fpu/fpu_simulator.h>
#include <sys/fpu/globals.h>

void
_fp_read_vfreg(
	FPU_REGS_TYPE	*pf,	/* Old freg value. */
	uint_t		n,	/* Want to read register n. */
	fp_simd_type	*pfpsd)
{
	*pf = pfpsd->fp_current_pfregs->fpu_fr.fpu_regs[n];
}

void
_fp_write_vfreg(
	FPU_REGS_TYPE	*pf,	/* New freg value. */
	uint_t		n,	/* Want to read register n. */
	fp_simd_type	*pfpsd)
{
	pfpsd->fp_current_pfregs->fpu_fr.fpu_regs[n] = *pf;
}

void
_fp_read_vdreg(
	FPU_DREGS_TYPE	*pd,	/* Old dreg value. */
	uint_t		n,	/* Want to read register n. */
	fp_simd_type	*pfpsd)
{
	*pd = pfpsd->fp_current_pfregs->fpu_fr.fpu_dregs[n];
}

void
_fp_write_vdreg(
	FPU_DREGS_TYPE	*pd,	/* New dreg value. */
	uint_t		n,	/* Want to read register n. */
	fp_simd_type	*pfpsd)
{
	pfpsd->fp_current_pfregs->fpu_fr.fpu_dregs[n] = *pd;
}

/*
 * Normalize a number.  Does not affect zeros, infs, or NaNs.
 * The number will be normalized to 113 bit extended:
 *		0x0001####, 0x########, 0x########, 0x########.
 */
void
fpu_normalize(unpacked *pu)
{
	uint_t U, u0, u1, u2, u3, m, n, k;
	u0 = pu->significand[0];
	u1 = pu->significand[1];
	u2 = pu->significand[2];
	u3 = pu->significand[3];
	if ((*pu).fpclass == fp_normal) {
		if ((u0|u1|u2|u3) == 0) {
			(*pu).fpclass = fp_zero;
			return;
		}
		while (u0 == 0) {
			u0 = u1; u1 = u2; u2 = u3; u3 = 0;
			(*pu).exponent = (*pu).exponent - 32;
		}
		if (u0 >= 0x20000) { 	/* u3 should be zero */
			n = 1; U = u0 >> 1;
			while (U >= 0x20000) {
				U >>= 1;
				n += 1;
			}
			m = (1 << n)-1;
			k = 32-n;
			(*pu).exponent += n;
			u3 = ((u2&m)<<k)|(u3>>n);
			u2 = ((u1&m)<<k)|(u2>>n);
			u1 = ((u0&m)<<k)|(u1>>n);
			u0 = U;
		} else if (u0 < 0x10000) {
			n = 1; U = u0 << 1;
			while (U < 0x10000) {
				U <<= 1;
				n += 1;
			}
			k = 32-n;
			m = -(1 << k);
			(*pu).exponent -= n;
			u0 = (u0<<n)|((u1&m)>>k);
			u1 = (u1<<n)|((u2&m)>>k);
			u2 = (u2<<n)|((u3&m)>>k);
			u3 = (u3<<n);
		}
		pu->significand[0] = u0;
		pu->significand[1] = u1;
		pu->significand[2] = u2;
		pu->significand[3] = u3;
	}
}

/*
 * Right shift significand sticky by n bits.
 */
void
fpu_rightshift(unpacked *pu, int n)
{
	uint_t m, k, j, u0, u1, u2, u3;
	if (n > 113) {		/* drastic */
		if (((*pu).significand[0] | (*pu).significand[1]
			| (*pu).significand[2] | (*pu).significand[3]) == 0) {
						/* really zero */
			pu->fpclass = fp_zero;
			return;
		} else {
			pu->rounded = 0;
			pu->sticky  = 1;
			pu->significand[3] = 0;
			pu->significand[2] = 0;
			pu->significand[1] = 0;
			pu->significand[0] = 0;
			return;
		}
	}
	while (n >= 32) {	/* big shift */
		pu->sticky  |= pu->rounded | (pu->significand[3]&0x7fffffff);
		pu->rounded  = (*pu).significand[3] >> 31;
		(*pu).significand[3] = (*pu).significand[2];
		(*pu).significand[2] = (*pu).significand[1];
		(*pu).significand[1] = (*pu).significand[0];
		(*pu).significand[0] = 0;
		n -= 32;
	}
	if (n > 0) {		/* small shift */
		u0 = pu->significand[0];
		u1 = pu->significand[1];
		u2 = pu->significand[2];
		u3 = pu->significand[3];
		m = (1<<n)-1;
		k = 32 - n;
		j = (1<<(n-1))-1;
		pu->sticky |= pu->rounded | (u3&j);
		pu->rounded = (u3&m)>>(n-1);
		pu->significand[3] = ((u2&m)<<k)|(u3>>n);
		pu->significand[2] = ((u1&m)<<k)|(u2>>n);
		pu->significand[1] = ((u0&m)<<k)|(u1>>n);
		pu->significand[0] = u0>>n;
	}
}


/*
 * Set the exception bit in the current exception register.
 */
void
fpu_set_exception(pfpsd, ex)
	fp_simd_type	*pfpsd;	/* Pointer to simulator data */
	enum fp_exception_type ex;
{
	pfpsd->fp_current_exceptions |= 1 << (int)ex;
}

/*
 * Set invalid exception and error nan in *pu
 */
void
fpu_error_nan(pfpsd, pu)
	fp_simd_type	*pfpsd;	/* Pointer to simulator data */
	unpacked	*pu;
{
	fpu_set_exception(pfpsd, fp_invalid);
	pu->sign = 0;
	pu->significand[0] = 0x7fffffff;
	pu->significand[1] = 0xffffffffUL;
	pu->significand[2] = 0xffffffffUL;
	pu->significand[3] = 0xffffffffUL;
}

/*
 * the following fpu_add3wc should be inlined as
 *	.inline	_fpu_add3wc, 3
 *	ld	[%o1], %o4		! sum = x
 *	addcc	-1, %o3, %g0		! restore last carry in cc reg
 *	addxcc	%o4, %o2, %o4		! sum = sum + y + last carry
 *	st	%o4, [%o0]		! *z  = sum
 *	addx	%g0, %g0, %o0		! return new carry
 *	.end
 */
uint_t
fpu_add3wc(uint_t *z, uint_t x, uint_t y, uint_t carry)
{				/*  *z = x + y + carry, set carry; */
	if (carry == 0) {
		*z = x+y;
		return (*z < y);
	} else {
		*z = x+y+1;
		return (*z <= y);
	}
}

/*
 * The following fpu_sub3wc should be inlined as
 *	.inline	_fpu_sub3wc, 3
 *	ld	[%o1], %o4		! sum = *x
 *	addcc	-1, %o3, %g0		! restore last carry in cc reg
 *	subxcc	%o4, %o2, %o4		! sum = sum - y - last carry
 *	st	%o4, [%o0]		! *x  = sum
 *	addx	%g0, %g0, %o0		! return new carry
 *	.end
 */
uint_t
fpu_sub3wc(uint_t *z, uint_t x, uint_t y, uint_t carry)
{				/*  *z = x - y - carry, set carry; */
	if (carry == 0) {
		*z = x-y;
		return (*z > x);
	} else {
		*z = x-y-1;
		return (*z >= x);
	}
}

/*
 * the following fpu_neg2wc should be inlined as
 *	.inline	_fpu_neg2wc, 2
 *	ld	[%o1], %o3		! tmp = *x
 *	addcc	-1, %o2, %g0		! restore last carry in cc reg
 *	subxcc	%g0, %o3, %o3		! sum = 0 - tmp - last carry
 *	st	%o3, [%o0]		! *x  = sum
 *	addx	%g0, %g0, %o0		! return new carry
 *	.end
 */
uint_t
fpu_neg2wc(uint_t *z, uint_t x, uint_t carry)
{				/*  *x = 0 - *x - carry, set carry; */
	if (carry == 0) {
		*z = -x;
		return ((*z) != 0);
	} else {
		*z = -x-1;
		return (1);
	}
}

int
fpu_cmpli(uint_t *x, uint_t *y, int n)
{				/* compare two uint_t array */
	int i;
	i = 0;

	while (i < n) {
		if (x[i] > y[i])
			return (1);
		else if (x[i] < y[i])
			return (-1);
		i++;
	}
	return (0);
}

#ifdef DEBUG

#include <sys/cmn_err.h>

/*
 * Print out unpacked record.
 */
void
display_unpacked(pu)
	unpacked	*pu;
{
	(void) printf(" unpacked ");
	if (pu->sign)
		(void) printf("-");
	else
		(void) printf("+");

	switch (pu->fpclass) {
	case fp_zero:
		(void) printf("0     ");
		break;
	case fp_normal:
		(void) printf("normal");
		break;
	case fp_infinity:
		(void) printf("Inf   ");
		break;
	case fp_quiet:
	case fp_signaling:
		(void) printf("nan   ");
		break;
	}
	(void) printf(" %X %X %X %X (%X, %X) exponent %X \n",
		pu->significand[0], pu->significand[1], pu->significand[2],
		pu->significand[3], (pu->rounded != 0),
		(pu->sticky != 0), pu->exponent);
}
#endif