/*
   Support - Provides some big and little endian abstraction functions,
             besides another things.
   Copyright (C) 1999  Roberto Arturo Tena Sanchez 

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License, or
   (at your option) any later version.

   This program is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with this program; if not, write to the Free Software
   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307  USA
 */
/*
   Arturo Tena <arturo@directmail.org>
 */
/*
  Some code was from Caolan, but I have replaced all the code,
  now all code here is mine, so I changed copyright announce in cole-1.0.0.
     Arturo Tena
 */


#include <string.h>
#include "support.h"


U16
fil_sreadU16 (U8 * in)
{
return (in[1] << 8) | in[0];
}


U32
fil_sreadU32 (U8 * in)
{
 U32 i0 = in[0], i1 = in[1], i2 = in[2], i3 = in[3];

 return (i3 << 24) | (i2 << 16) | (i1 << 8) | i0;
}


F64
fil_sreadF64 (U8 * in)
{
  F64 ret;
  #ifdef WORDS_BIGENDIAN
  *( ((U8*)(&ret)) + 7 ) = *in;
  *( ((U8*)(&ret)) + 6 ) = *(in+1);
  *( ((U8*)(&ret)) + 5 ) = *(in+2);
  *( ((U8*)(&ret)) + 4 ) = *(in+3);
  *( ((U8*)(&ret)) + 3 ) = *(in+4);
  *( ((U8*)(&ret)) + 2 ) = *(in+5);
  *( ((U8*)(&ret)) + 1 ) = *(in+6);
  *(  (U8*)(&ret)      ) = *(in+7);
#else /* !WORDS_BIGENDIAN */
 memcpy (&ret, in, 8);
#endif
return ret;
}


void
fil_swriteU16 (U8 * dest, U16 * src)
{
#ifdef WORDS_BIGENDIAN
  *(dest) = *(((U8*)src)+1);
  *(dest+1) = *((U8*)src);
#else /* !WORDS_BIGENDIAN */
  *(dest) = *((U8*)src);
  *(dest+1) = *(((U8*)src)+1);
#endif
}


void
fil_swriteU32 (U8 * dest, U32 * src)
{
#ifdef WORDS_BIGENDIAN
  fil_swriteU16 (dest, ( U16* )( ((U8*)src)+2 ) );
  fil_swriteU16 (dest+2, (U16*)src);
#else /* !WORDS_BIGENDIAN */
  fil_swriteU16 (dest, (U16*)src);
  fil_swriteU16 (dest+2, ( U16* )( ((U8*)src)+2 )  );
#endif
}


/*-*
	@func (void) __cole_dump dump the content of memory
	@param (void *) m memory position which content will be dumped
	@param (void *) start memory position from where calculate
				offset
	@param (int) length size in bytes of the dumped memory
	@param (char *) msg optional message, can be NULL
 *-*/
void
__cole_dump (void *_m, void *_start, int length, char *msg)
{
	unsigned char * pm;
	char buff[18];
	long achar;
	unsigned char * m;
	unsigned char * start;

	if (_m == NULL) {
		printf ("VERBOSE: can't dump because m is NULL\n");
		return;
	}
	if (_start == NULL) {
		printf ("VERBOSE: can't dump because start is NULL\n");
		return;
	}

	m = (unsigned char *)_m;
	start = (unsigned char *)_start;
	buff[8] = '-';
	buff[17] = 0;
	if (msg != NULL)
		printf ("VERBOSE: %s (from 0x%08tx length 0x%08x (%d)):\n",
			msg, m - start, length, length);
	for (pm = m; pm - m < length; pm++) {
		achar = (pm - m) % 16;
		/* print offset */
		if (achar == 0)
			printf ("%08tx  ", (pm - m) + (m - start));
		/* write char in the right column buffer */
		buff[achar + (achar < 8 ? 0 : 1)] = (char)((isprint (*pm) ? *pm : '.'));
		/* print next char */
		if (! ((pm - m + 1) % 16))
			/* print right column */
			printf ("%02x  %s\n", *pm, buff);
		else if (! ((pm - m + 1) % 8))
			printf ("%02x-", *pm);
		else
			printf ("%02x ", *pm);
	}
	achar = (pm - m) % 16;
	if (achar) {
		int i;
		for (i = 0; i < (16 - achar) * 3 - 1; i++)
			printf (" ");
		if (achar != 8)
			buff [achar] = 0;
		printf ("  %s\n", buff);
	}
}