/*
 * Sources of the "INTEGER ARITHMETIC" group instructions
 */

/* $Header$ */

#include	<em_abs.h>
#include	"logging.h"
#include	"global.h"
#include	"log.h"
#include	"mem.h"
#include	"trap.h"
#include	"warn.h"
#include	"text.h"
#include	"fra.h"

PRIVATE long adi(), sbi(), dvi(), mli(), rmi(), ngi(), sli(), sri();

DoADIl2(arg)
	size arg;
{
	/* ADI w: Addition (*) */
	register size l = (L_arg_2() * arg);
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoADIl2(%ld)", l));
	spoilFRA();
	npush(adi(spop(l), t, l), l);
}

DoADIm(arg)
	size arg;
{
	/* ADI w: Addition (*) */
	register size l = arg_wi(arg);
	register long t = spop(l);

	LOG(("@I6 DoADIm(%ld)", l));
	spoilFRA();
	npush(adi(spop(l), t, l), l);
}

DoADIz()				/* argument on top of stack */
{
	/* ADI w: Addition (*) */
	register size l = uwpop();
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoADIz(%ld)", l));
	spoilFRA();
	npush(adi(spop(l), t, l), l);
}

DoSBIl2(arg)
	size arg;
{
	/* SBI w: Subtraction (*) */
	register size l = (L_arg_2() * arg);
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoSBIl2(%ld)", l));
	spoilFRA();
	npush(sbi(spop(l), t, l), l);
}

DoSBIm(arg)
	size arg;
{
	/* SBI w: Subtraction (*) */
	register size l = arg_wi(arg);
	register long t = spop(l);

	LOG(("@I6 DoSBIm(%ld)", l));
	spoilFRA();
	npush(sbi(spop(l), t, l), l);
}

DoSBIz()				/* arg on top of stack */
{
	/* SBI w: Subtraction (*) */
	register size l = uwpop();
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoSBIz(%ld)", l));
	spoilFRA();
	npush(sbi(spop(l), t, l), l);
}

DoMLIl2(arg)
	size arg;
{
	/* MLI w: Multiplication (*) */
	register size l = (L_arg_2() * arg);
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoMLIl2(%ld)", l));
	spoilFRA();
	npush(mli(spop(l), t, l), l);
}

DoMLIm(arg)
	size arg;
{
	/* MLI w: Multiplication (*) */
	register size l = arg_wi(arg);
	register long t = spop(l);

	LOG(("@I6 DoMLIm(%ld)", l));
	spoilFRA();
	npush(mli(spop(l), t, l), l);
}

DoMLIz()				/* arg on top of stack */
{
	/* MLI w: Multiplication (*) */
	register size l = uwpop();
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoMLIz(%ld)", l));
	spoilFRA();
	npush(mli(spop(l), t, l), l);
}

DoDVIl2(arg)
	size arg;
{
	/* DVI w: Division (*) */
	register size l = (L_arg_2() * arg);
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoDVIl2(%ld)", l));
	spoilFRA();
	npush(dvi(spop(l), t), l);
}

DoDVIm(arg)
	size arg;
{
	/* DVI w: Division (*) */
	register size l = arg_wi(arg);
	register long t = spop(l);

	LOG(("@I6 DoDVIm(%ld)", l));
	spoilFRA();
	npush(dvi(spop(l), t), l);
}

DoDVIz()				/* arg on top of stack */
{
	/* DVI w: Division (*) */
	register size l = uwpop();
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoDVIz(%ld)", l));
	spoilFRA();
	npush(dvi(spop(l), t), l);
}

DoRMIl2(arg)
	size arg;
{
	/* RMI w: Remainder (*) */
	register size l = (L_arg_2() * arg);
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoRMIl2(%ld)", l));
	spoilFRA();
	npush(rmi(spop(l), t), l);
}

DoRMIm(arg)
	size arg;
{
	/* RMI w: Remainder (*) */
	register size l = arg_wi(arg);
	register long t = spop(l);

	LOG(("@I6 DoRMIm(%ld)", l));
	spoilFRA();
	npush(rmi(spop(l), t), l);
}

DoRMIz()				/* arg on top of stack */
{
	/* RMI w: Remainder (*) */
	register size l = uwpop();
	register long t = spop(arg_wi(l));

	LOG(("@I6 DoRMIz(%ld)", l));
	spoilFRA();
	npush(rmi(spop(l), t), l);
}

DoNGIl2(arg)
	size arg;
{
	/* NGI w: Negate (two's complement) (*) */
	register size l = (L_arg_2() * arg);

	LOG(("@I6 DoNGIl2(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(ngi(spop(l), l), l);
}

DoNGIz()
{
	/* NGI w: Negate (two's complement) (*) */
	register size l = uwpop();

	LOG(("@I6 DoNGIz(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(ngi(spop(l), l), l);
}

DoSLIl2(arg)
	size arg;
{
	/* SLI w: Shift left (*) */
	register size l = (L_arg_2() * arg);
	register long t = swpop();

	LOG(("@I6 DoSLIl2(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(sli(spop(l), t, l), l);
}

DoSLIm(arg)
	size arg;
{
	/* SLI w: Shift left (*) */
	register size l = arg_wi(arg);
	register long t = swpop();

	LOG(("@I6 DoSLIm(%ld)", l));
	spoilFRA();
	npush(sli(spop(l), t, l), l);
}

DoSLIz()
{
	/* SLI w: Shift left (*) */
	register size l = uwpop();
	register long t = swpop();

	LOG(("@I6 DoSLIz(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(sli(spop(l), t, l), l);
}

DoSRIl2(arg)
	size arg;
{
	/* SRI w: Shift right (*) */
	register size l = (L_arg_2() * arg);
	register long t = swpop();

	LOG(("@I6 DoSRIl2(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(sri(spop(l), t, l), l);
}

DoSRIz()
{
	/* SRI w: Shift right (*) */
	register size l = uwpop();
	register long t = swpop();

	LOG(("@I6 DoSRIz(%ld)", l));
	spoilFRA();
	l = arg_wi(l);
	npush(sri(spop(l), t, l), l);
}

#define	i_maxs(n)		((n == 2) ? I_MAXS2 : I_MAXS4)
#define	i_mins(n)		((n == 2) ? I_MINS2 : I_MINS4)

PRIVATE long adi(w1, w2, nbytes)		/* returns w1 + w2 */
	long w1, w2;
	size nbytes;
{
	if (must_test && !(IgnMask&BIT(EIOVFL))) {
		if (w1 > 0 && w2 > 0) {
			if (i_maxs(nbytes) - w1 < w2)
				trap(EIOVFL);
		}
		else if (w1 < 0 && w2 < 0) {
			if (i_mins(nbytes) - w1 > w2)
				trap(EIOVFL);
		}
	}
	return (w1 + w2);
}

PRIVATE long sbi(w1, w2, nbytes)		/* returns w1 - w2 */
	long w1, w2;
	size nbytes;
{
	if (must_test && !(IgnMask&BIT(EIOVFL))) {
		if (w2 < 0 && w1 > 0) {
			if (i_maxs(nbytes) + w2 < w1)
				trap(EIOVFL);
		}
		else if (w2 > 0 && w1 < 0) {
			if (i_mins(nbytes) + w2 > w1) {
				trap(EIOVFL);
			}
		}
	}
	return (w1 - w2);
}

#define	labs(w)		((w < 0) ? (-w) : w)

PRIVATE long mli(w1, w2, nbytes)		/* returns w1 * w2 */
	long w1, w2;
	size nbytes;
{
	if (w1 == 0 || w2 == 0)
		return (0L);

	if (must_test && !(IgnMask&BIT(EIOVFL))) {
		if ((w1 > 0 && w2 > 0) || (w2 < 0 && w1 < 0)) {
			if (	w1 == i_mins(nbytes) || w2 == i_mins(nbytes)
			||	(i_maxs(nbytes) / labs(w1)) < labs(w2)
			) {
				trap(EIOVFL);
			}
		}
		else if (w1 > 0) {
			if (i_mins(nbytes) / w1 > w2)
				trap(EIOVFL);
		}
		else if (i_mins(nbytes) / w2 > w1) {
			trap(EIOVFL);
		}
	}
	return (w1 * w2);
}

PRIVATE long dvi(w1, w2)
	long w1, w2;
{
	if (w2 == 0) {
		if (!(IgnMask&BIT(EIDIVZ))) {
			trap(EIDIVZ);
		}
		else	return (0L);
	}
	return (w1 / w2);
}

PRIVATE long rmi(w1, w2)
	long w1, w2;
{
	if (w2 == 0) {
		if (!(IgnMask&BIT(EIDIVZ))) {
			trap(EIDIVZ);
		}
		else	return (0L);
	}
	return (w1 % w2);
}

PRIVATE long ngi(w1, nbytes)
	long w1;
	size nbytes;
{
	if (must_test && !(IgnMask&BIT(EIOVFL))) {
		if (w1 == i_mins(nbytes)) {
			trap(EIOVFL);
		}
	}
	return (-w1);
}

PRIVATE long sli(w1, w2, nbytes)	/* w1 << w2 */
	long w1, w2;
	size nbytes;
{
	if (must_test) {
#ifdef	LOGGING
		/* check shift distance */
		if (w2 < 0)	{
			warning(WSHNEG);
			w2 = 0;
		}
		if (w2 >= nbytes*8)	{
			warning(WSHLARGE);
			w2 = nbytes*8 - 1;
		}
#endif	LOGGING
	
		if (!(IgnMask&BIT(EIOVFL))) {
			/* check overflow */
			if (	(w1 >= 0 && (w1 >> (nbytes*8 - w2)) != 0)
			||	(w1 < 0 && (w1 >> (nbytes*8 - w2)) != -1)
			) {
				trap(EIOVFL);
			}
		}
	}	

	/* calculate result */
	return (w1 << w2);
}

/*ARGSUSED*/
PRIVATE long sri(w1, w2, nbytes)	/* w1 >> w2 */
	long w1, w2;
	size nbytes;
{
#ifdef	LOGGING
	if (must_test) {
		/* check shift distance */
		if (w2 < 0)	{
			warning(WSHNEG);
			w2 = 0;
		}
		if (w2 >= nbytes*8)	{
			warning(WSHLARGE);
			w2 = nbytes*8 - 1;
		}
	}
#endif	LOGGING
	
	/* calculate result */
	return (w1 >> w2);
}