#include <stdio.h>
#include <ctype.h>
#include "global.h"
#include "mbuf.h"
#include "iface.h"
#include "trace.h"

FILE *trfp = stdout;			/* file pointer used for tracing */
int trcount = 0;			/* used to close file for flushing */
char trname[40];			/* name if not stdout */

/* Redefined here so that programs calling dump in the library won't pull
 * in the rest of the package
 */
static char nospace[] = "No space!!\n";

dump(interface,direction,type,bp)
register struct interface *interface;
int direction;
unsigned type;
struct mbuf *bp;
{
	struct mbuf *tbp;
	void ascii_dump(),hex_dump();
	int ax25_dump(),ether_dump(),ip_dump();
	int (*func)();
	int16 size;
	long trtime;

	if((interface->trace & direction) == 0)
		return; /* Nothing to trace */

	time(&trtime);			/* get time to show it in trace */
	fprintf(trfp,"%.15s %s ",ctime(&trtime) + 4,interface->name);

	switch(direction){
	case IF_TRACE_IN:
		fprintf(trfp,"recv:\n");
		break;
	case IF_TRACE_OUT:
		fprintf(trfp,"sent:\n");
		break;
	}
	if(bp == NULLBUF || (size = len_mbuf(bp)) == 0){
		fprintf(trfp,"empty packet!!\n");
		goto trdone;
	}

	if(type < NTRACE)
		func = tracef[type];
	else
		func = NULLFP;

	dup_p(&tbp,bp,0,size);
	if(tbp == NULLBUF){
		fprintf(trfp,nospace);
		if (trfp != stdout)
			printf(nospace);
		goto trdone;
	}
	if(func != NULLFP)
		(*func)(&tbp,1);
	if(interface->trace & IF_TRACE_ASCII){
		/* Dump only data portion of packet in ascii */
		ascii_dump(&tbp);
	} else if(interface->trace & IF_TRACE_HEX){
		/* Dump entire packet in hex/ascii */
		free_p(tbp);
		dup_p(&tbp,bp,0,len_mbuf(bp));
		if(tbp != NULLBUF)
			hex_dump(&tbp);
		else {
			fprintf(trfp,nospace);
			if (trfp != stdout)
				printf(nospace);
		}
	}
	free_p(tbp);
trdone:
	if(trfp != stdout){
#ifndef ATARI_ST
		fflush(trfp);
#endif
#if (defined(MSDOS) || defined(ATARI_ST))
		if(++trcount > 25){
			fclose(trfp);
			trfp = fopen(trname,"a");
			trcount = 0;
		}
#endif
		if(trfp == NULLFILE || ferror(trfp)){
			printf("Error on %s - trace to console\n",trname);
			if(trfp != NULLFILE && trfp != stdout)
				fclose(trfp);
			trfp = stdout;
		}
	}
	fflush(stdout);
}

/* Dump an mbuf in hex */
void
hex_dump(bpp)
register struct mbuf **bpp;
{
	int16 n;
	int16 address;
	void fmtline();
	char buf[16];

	if(bpp == NULLBUFP || *bpp == NULLBUF)
		return;

	address = 0;
	while((n = pullup(bpp,buf,sizeof(buf))) != 0){
		fmtline(address,buf,n);
		address += n;
	}
}
/* Dump an mbuf in ascii */
void
ascii_dump(bpp)
register struct mbuf **bpp;
{
	char c;
	register int16 tot;

	if(bpp == NULLBUFP || *bpp == NULLBUF)
		return;

	tot = 0;
	while(pullup(bpp,&c,1) == 1){
		if((tot % 64) == 0)
			fprintf(trfp,"%04x  ",tot);
		putc(((!isascii(c) || isprint(c)) ? c : '.'),trfp);
		if((++tot % 64) == 0)
			fprintf(trfp,"\n");
	}
	if((tot % 64) != 0)
		fprintf(trfp,"\n");
}
/* Print a buffer up to 16 bytes long in formatted hex with ascii
 * translation, e.g.,
 * 0000: 30 31 32 33 34 35 36 37 38 39 3a 3b 3c 3d 3e 3f  0123456789:;<=>?
 */
void
fmtline(addr,buf,len)
int16 addr;
char *buf;
int16 len;
{
	char line[80];
	register char *aptr,*cptr;
	register char c;
	void ctohex();

	memset(line,' ',sizeof(line));
	ctohex(line,hibyte(addr));
	ctohex(line+2,lobyte(addr));
	aptr = &line[6];
	cptr = &line[55];
	while(len-- != 0){
		c = *buf++;
		ctohex(aptr,(int16)uchar(c));
		aptr += 3;
		c &= 0x7f;
		*cptr++ = (!isascii(c) || isprint(c)) ? c : '.';
	}
	*cptr = '\0';
	fprintf(trfp,"%s\n",line);
}
/* Convert byte to two ascii-hex characters */
static
void
ctohex(buf,c)
register char *buf;
register int16 c;
{
	static char hex[] = "0123456789abcdef";

	*buf++ = hex[hinibble(c)];
	*buf = hex[lonibble(c)];
}