/*
	Data access
*/

/* $Header$ */

#include	<em_abs.h>
#include	"logging.h"
#include	"nofloat.h"
#include	"global.h"
#include	"log.h"
#include	"trap.h"
#include	"warn.h"
#include	"alloc.h"
#include	"memdirect.h"
#include	"mem.h"
#include	"shadow.h"

#define	HEAPSIZE	1000L		/* initial heap size */

extern size maxheap;			/* from main.c */

#ifdef	LOGGING
char *data_sh;				/* shadowbytes */
#endif	LOGGING

PRIVATE warn_dtbits();

init_data(hb)
	ptr hb;
{
	HB = hb;			/* set Heap Base */
	HP = HB;			/* initialize Heap Pointer */
	HL = HB + HEAPSIZE;		/* initialize Heap Limit */

	data = Malloc((size)p2i(HL), "data space");
#ifdef	LOGGING
	data_sh = Malloc((size)p2i(HL), "shadowspace for data");
	dt_clear_area(i2p(0), HL);
#endif	LOGGING
}


/********************************************************
 *	EM-register division.				*
 ********************************************************
 *							*
 *	newHP(p)     - check and adjust HeapPointer.	*
 *							*
 ********************************************************/

newHP(ap)
	ptr ap;
{
	register ptr p = ap;

	if (in_gda(p)) {
		wtrap(WHPGDA, EHEAP);
	}
	if (in_stack(p)) {
		wtrap(WHPSTACK, EHEAP);
	}
	if (!is_aligned(p, wsize)) {
		wtrap(WHPODD, EHEAP);
	}
	if (maxheap) {
		/* more than allowed on command line */
		if (p - HB > maxheap) {
			warning(WEHEAP);
			trap(EHEAP);
		}
	}
	if (p > HL) {
		/* extend heap space */
		HL = i2p(allocfrac(p2i(p)) - 1);
		data = Realloc(data, (size)(p2i(HL) + 1), "heap space");
#ifdef	LOGGING
		data_sh = Realloc(data_sh, (size)(p2i(HL) + 1),
						"shadowspace for heap");
#endif	LOGGING
	}

#ifdef	LOGGING
	if (p > HP) {
		dt_clear_area(HP, p);
	}
#endif	LOGGING
	HP = p;
}

/************************************************************************
 *	Data store division.						*
 ************************************************************************
 *									*
 *	dt_stdp(addr, p)	- STore Data Pointer.			*
 *	dt_stn(addr, l, n)	- STore N byte integer.			*
 *	dt_stf(addr, f, n)	- STore n byte Floating point number.	*
 *									*
 ************************************************************************/

dt_stdp(addr, ap)
	ptr addr, ap;
{
	register int i;
	register long p = (long) ap;

	LOG(("@g6 dt_stdp(%lu, %lu)", addr, p));
	ch_in_data(addr, psize);
	ch_aligned(addr, wsize);
	for (i = 0; i < (int) psize; i++) {
		ch_dt_prot(addr + i);
		data_loc(addr + i) = (char) (p);
		dt_dp(addr + i);
		p = p>>8;
	}
}

dt_stip(addr, ap)
	ptr addr, ap;
{
	register int i;
	register long p = (long) ap;

	LOG(("@g6 dt_stip(%lu, %lu)", addr, p));
	ch_in_data(addr, psize);
	ch_aligned(addr, wsize);
	for (i = 0; i < (int) psize; i++) {
		ch_dt_prot(addr + i);
		data_loc(addr + i) = (char) (p);
		dt_ip(addr + i);
		p = p>>8;
	}
}

dt_stn(addr, al, n)
	ptr addr;
	long al;
	size n;
{
	register int i;
	register long l = al;

	LOG(("@g6 dt_stn(%lu, %lu, %lu)", addr, l, n));
	ch_in_data(addr, n);
	ch_aligned(addr, n);
	for (i = 0; i < (int) n; i++) {
		ch_dt_prot(addr + i);
		data_loc(addr + i) = (char) l;
#ifdef	LOGGING
		if (al == 0 && n == psize) {
			/* a psize zero, ambiguous */
			dt_sh(addr + i) = (SH_INT|SH_DATAP);
		}
		else {
			dt_sh(addr + i) = SH_INT;
		}
#endif	LOGGING
		l = l>>8;
	}
}

#ifndef	NOFLOAT
dt_stf(addr, f, n)
	ptr addr;
	double f;
	size n;
{
	register char *cp = (char *) &f;
	register int i;

	LOG(("@g6 dt_stf(%lu, %g, %lu)", addr, f, n));
	ch_in_data(addr, n);
	ch_aligned(addr, wsize);
	for (i = 0; i < (int) n; i++) {
		ch_dt_prot(addr + i);
		data_loc(addr + i) = *cp++;
		dt_fl(addr + i);
	}
}
#endif	NOFLOAT

/************************************************************************
 *	Data load division.						*
 ************************************************************************
 *									*
 *	dt_lddp(addr)      - LoaD Data Pointer from data.		*
 *	dt_ldip(addr)      - LoaD Instruction Pointer from data.	*
 *	dt_ldu(addr, n)    - LoaD n Unsigned bytes from data.		*
 *	dt_lds(addr, n)    - LoaD n Signed bytes from data.		*
 *									*
 ************************************************************************/

ptr dt_lddp(addr)
	ptr addr;
{
	register ptr p;

	LOG(("@g6 dt_lddp(%lu)", addr));

	ch_in_data(addr, psize);
	ch_aligned(addr, wsize);
#ifdef	LOGGING
	if (!is_dt_set(addr, psize, SH_DATAP)) {
		warning(WGDPEXP);
		warn_dtbits(addr, psize);
	}
#endif	LOGGING

	p = p_in_data(addr);
	LOG(("@g6 dt_lddp() returns %lu", p));
	return (p);
}

ptr dt_ldip(addr)
	ptr addr;
{
	register ptr p;

	LOG(("@g6 dt_ldip(%lu)", addr));

	ch_in_data(addr, psize);
	ch_aligned(addr, wsize);
#ifdef	LOGGING
	if (!is_dt_set(addr, psize, SH_INSP)) {
		warning(WGIPEXP);
		warn_dtbits(addr, psize);
	}
#endif	LOGGING

	p = p_in_data(addr);
	LOG(("@g6 dt_ldip() returns %lu", p));
	return (p);
}

unsigned long dt_ldu(addr, n)
	ptr addr;
	size n;
{
	register int i;
	register unsigned long u = 0;

	LOG(("@g6 dt_ldu(%lu, %lu)", addr, n));

	ch_in_data(addr, n);
	ch_aligned(addr, n);
#ifdef	LOGGING
	if (!is_dt_set(addr, n, SH_INT)) {
		warning(n == 1 ? WGCEXP : WGIEXP);
		warn_dtbits(addr, n);
	}
#endif	LOGGING

	for (i = (int) n-1; i >= 0; i--) {
		u = (u<<8) | btou(data_loc(addr + i));
	}
	LOG(("@g6 dt_ldu() returns %lu", u));
	return (u);
}

long dt_lds(addr, n)
	ptr addr;
	size n;
{
	register int i;
	register long l;

	LOG(("@g6 dt_lds(%lu, %lu)", addr, n));

	ch_in_data(addr, n);
	ch_aligned(addr, n);
#ifdef	LOGGING
	if (!is_dt_set(addr, n, SH_INT)) {
		warning(n == 1 ? WGCEXP : WGIEXP);
		warn_dtbits(addr, n);
	}
#endif	LOGGING

	l = btos(data_loc(addr + n - 1));
	for (i = n - 2; i >= 0; i--) {
		l = (l<<8) | btol(data_loc(addr + i));
	}
	LOG(("@g6 dt_lds() returns %lu", l));
	return (l);
}

/************************************************************************
 *	Data move division						*
 ************************************************************************
 *									*
 *	dt_mvd(d2, d1, n) - Move n bytes in data from d1 to d2.		*
 *	dt_mvs(d, s, n)   - Move n bytes from s in stack to d in data.	*
 *									*
 *	See st_mvs() in stack.c for a description.			*
 *									*
 ************************************************************************/

dt_mvd(d2, d1, n)			/* d1 -> d2 */
	ptr d2, d1;
	size n;
{
	register int i;

	ch_in_data(d1, n);
	ch_aligned(d1, wsize);
	ch_in_data(d2, n);
	ch_aligned(d2, wsize);

	for (i = 0; i < (int) n; i++) {
		ch_dt_prot(d2 + i);
		data_loc(d2 + i) = data_loc(d1 + i);
#ifdef	LOGGING
		dt_sh(d2 + i) = dt_sh(d1 + i) & ~SH_PROT;
#endif	LOGGING
	}
}

dt_mvs(d, s, n)				/* s -> d */
	ptr d, s;
	size n;
{
	register int i;

	ch_in_stack(s, n);
	ch_aligned(s, wsize);
	ch_in_data(d, n);
	ch_aligned(d, wsize);

	for (i = 0; i < (int) n; i++) {
		ch_dt_prot(d + i);
		ch_st_prot(s + i);
		data_loc(d + i) = stack_loc(s + i);
#ifdef	LOGGING
		dt_sh(d + i) = st_sh(s + i) & ~SH_PROT;
#endif	LOGGING
	}
}

#ifdef	LOGGING

PRIVATE warn_dtbits(addr, n)
	ptr addr;
	size n;
{
	register int or_bits = 0;
	register int and_bits = 0xff;

	while (n--) {
		or_bits |= dt_sh(addr);
		and_bits &= dt_sh(addr);
		addr++;
	}

	if (or_bits != and_bits) {
		/* no use trying to diagnose */
		warningcont(WWASMISC);
		return;
	}
	if (or_bits == 0)
		warningcont(WWASUND);
	if (or_bits & SH_INT)
		warningcont(WWASINT);
	if (or_bits & SH_FLOAT)
		warningcont(WWASFLOAT);
	if (or_bits & SH_DATAP)
		warningcont(WWASDATAP);
	if (or_bits & SH_INSP)
		warningcont(WWASINSP);
}

#endif	LOGGING