176 lines
		
	
	
	
		
			3.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			176 lines
		
	
	
	
		
			3.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Sources of the "UNSIGNED ARITHMETIC" group instructions
 | |
|  */
 | |
| 
 | |
| /* $Id$ */
 | |
| 
 | |
| #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"
 | |
| 
 | |
| /************************************************************************
 | |
|  *	No checking is performed, except for division by zero.		*
 | |
|  *	The operands popped from the stack are put in unsigned		*
 | |
|  *	longs. Now the required operation can be performed		*
 | |
|  *	immediately. Whether the wordsize is two or four bytes		*
 | |
|  *	doesn't matter. Alas, arithmetic is performed modulo		*
 | |
|  *	the highest unsigned number for the given size plus 1.		*
 | |
|  ************************************************************************/
 | |
| 
 | |
| #ifdef	LOGGING
 | |
| extern int must_test;
 | |
| #endif	/* LOGGING */
 | |
| 
 | |
| #define	adu(w1,w2)	(unsigned long)(w1 + w2)
 | |
| #define	sbu(w1,w2)	(unsigned long)(w1 - w2)
 | |
| #define	mlu(w1,w2)	(unsigned long)(w1 * w2)
 | |
| 
 | |
| PRIVATE unsigned long dvu(), rmu(), slu(), sru();
 | |
| 
 | |
| DoADU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* ADU w: Addition */
 | |
| 	register unsigned long t = upop(arg_wi(l));
 | |
| 
 | |
| 	LOG(("@U6 DoADU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	npush((long) adu(upop(l), t), l);
 | |
| }
 | |
| 
 | |
| DoSBU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* SBU w: Subtraction */
 | |
| 	register unsigned long t = upop(arg_wi(l));
 | |
| 
 | |
| 	LOG(("@U6 DoSBU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	npush((long) sbu(upop(l), t), l);
 | |
| }
 | |
| 
 | |
| DoMLU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* MLU w: Multiplication */
 | |
| 	register unsigned long t = upop(arg_wi(l));
 | |
| 
 | |
| 	LOG(("@U6 DoMLU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	npush((long) mlu(upop(l), t), l);
 | |
| }
 | |
| 
 | |
| DoDVU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* DVU w: Division */
 | |
| 	register unsigned long t = upop(arg_wi(l));
 | |
| 
 | |
| 	LOG(("@U6 DoDVU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	npush((long) dvu(upop(l), t), l);
 | |
| }
 | |
| 
 | |
| DoRMU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* RMU w: Remainder */
 | |
| 	register unsigned long t = upop(arg_wi(l));
 | |
| 
 | |
| 	LOG(("@U6 DoRMU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	npush((long) rmu(upop(l), t), l);
 | |
| }
 | |
| 
 | |
| DoSLU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* SLU w: Shift left */
 | |
| 	register unsigned long t = uwpop();
 | |
| 
 | |
| 	LOG(("@U6 DoSLU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	l = arg_wi(l);
 | |
| 	npush((long) slu(upop(l), t, l), l);
 | |
| }
 | |
| 
 | |
| DoSRU(l)
 | |
| 	register size l;
 | |
| {
 | |
| 	/* SRU w: Shift right */
 | |
| 	register unsigned long t = uwpop();
 | |
| 
 | |
| 	LOG(("@U6 DoSRU(%ld)", l));
 | |
| 	spoilFRA();
 | |
| 	l = arg_wi(l);
 | |
| 	npush((long) sru(upop(l), t, l), l);
 | |
| }
 | |
| 
 | |
| PRIVATE unsigned long dvu(w1, w2)
 | |
| 	unsigned long w1, w2;
 | |
| {
 | |
| 	if (w2 == 0) {
 | |
| 		if (!(IgnMask&BIT(EIDIVZ))) {
 | |
| 			trap(EIDIVZ);
 | |
| 		}
 | |
| 		else	return (0L);
 | |
| 	}
 | |
| 	return (w1 / w2);
 | |
| }
 | |
| 
 | |
| PRIVATE unsigned long rmu(w1, w2)
 | |
| 	unsigned long w1, w2;
 | |
| {
 | |
| 	if (w2 == 0) {
 | |
| 		if (!(IgnMask&BIT(EIDIVZ))) {
 | |
| 			trap(EIDIVZ);
 | |
| 		}
 | |
| 		else	return (0L);
 | |
| 	}
 | |
| 	return (w1 % w2);
 | |
| }
 | |
| 
 | |
| /*ARGSUSED*/
 | |
| PRIVATE unsigned long slu(w1, w2, nbytes)	/* w1 << w2 */
 | |
| 	unsigned long w1, w2;
 | |
| 	size nbytes;
 | |
| {
 | |
| #ifdef	LOGGING
 | |
| 	if (must_test) {
 | |
| 		/* check shift distance */
 | |
| 		if (w2 >= nbytes*8)	{
 | |
| 			warning(WSHLARGE);
 | |
| 			w2 = nbytes*8 - 1;
 | |
| 		}
 | |
| 	}
 | |
| #endif	/* LOGGING */
 | |
| 
 | |
| 	/* calculate result */
 | |
| 	return (w1 << w2);
 | |
| }
 | |
| 
 | |
| /*ARGSUSED*/
 | |
| PRIVATE unsigned long sru(w1, w2, nbytes)	/* w1 >> w2 */
 | |
| 	unsigned long w1, w2;
 | |
| 	size nbytes;
 | |
| {
 | |
| #ifdef	LOGGING
 | |
| 	if (must_test) {
 | |
| 		/* check shift distance */
 | |
| 		if (w2 >= nbytes*8)	{
 | |
| 			warning(WSHLARGE);
 | |
| 			w2 = nbytes*8 - 1;
 | |
| 		}
 | |
| 	}
 | |
| #endif	/* LOGGING */
 | |
| 
 | |
| 	/* calculate result */
 | |
| 	return (w1 >> w2);
 | |
| }
 | |
| 
 |