#include "byte_access.h"

// LSB first!
//
unsigned short int _usi(void *p)
{
  unsigned short int usi = 0;
  unsigned char c;

  c = (unsigned char)(*((unsigned char *)p));
  usi |= c;

  c = (unsigned char)(*((unsigned char *)(p+1)));
  usi |= (c<<8);

  return usi;
}

unsigned long int _uli(void *p)
{
  unsigned long int uli = 0;
  unsigned char c;

  c = (unsigned char)(*((unsigned char *)p));
  uli |= c;

  c = (unsigned char)(*((unsigned char *)(p+1)));
  uli |= (c<<8);

  c = (unsigned char)(*((unsigned char *)(p+2)));
  uli |= (c<<16);

  c = (unsigned char)(*((unsigned char *)(p+3)));
  uli |= (c<<24);

  return uli;
}

unsigned long long int _ulli(void *p)
{
  unsigned long long int ulli = 0;
  unsigned long long int t;
  unsigned char c;

  c = (unsigned char)(*((unsigned char *)p));
  ulli |= c;

  c = (unsigned char)(*((unsigned char *)(p+1)));
  t = c;
  ulli |= (t<<8);

  c = (unsigned char)(*((unsigned char *)(p+2)));
  t = c;
  ulli |= (t<<16);

  c = (unsigned char)(*((unsigned char *)(p+3)));
  t = c;
  ulli |= (t<<24);

  c = (unsigned char)(*((unsigned char *)(p+4)));
  t = c;
  ulli |= (t<<32);

  c = (unsigned char)(*((unsigned char *)(p+5)));
  t = c;
  ulli |= (t<<40);

  c = (unsigned char)(*((unsigned char *)(p+6)));
  t = c;
  ulli |= (t<<48);

  c = (unsigned char)(*((unsigned char *)(p+7)));
  t = c;
  ulli |= (t<<56);

  return ulli;
}


void _usiw(void *p, unsigned short int usi)
{
  unsigned char c;
  unsigned char *chp;

  chp = p;

  c = usi & 0xff;
  *chp++ = c;

  c = (usi >> 8) & 0xff;
  *chp++ = c;

}

void _uliw(void *p, unsigned long int uli)
{
  unsigned char c;
  unsigned char *chp;

  chp = p;

  c = uli & 0xff;
  *chp++ = c;

  c = (uli >> 8) & 0xff;
  *chp++ = c;

  c = (uli >> 16) & 0xff;
  *chp++ = c;

  c = (uli >> 24) & 0xff;
  *chp++ = c;

}

void _ulliw(void *p, unsigned long long int ulli)
{
  unsigned char c;
  unsigned char *chp;

  chp = p;

  c = ulli & 0xff;
  *chp++ = c;

  c = (ulli >> 8) & 0xff;
  *chp++ = c;

  c = (ulli >> 16) & 0xff;
  *chp++ = c;

  c = (ulli >> 24) & 0xff;
  *chp++ = c;

  c = (ulli >> 32) & 0xff;
  *chp++ = c;

  c = (ulli >> 40) & 0xff;
  *chp++ = c;

  c = (ulli >> 48) & 0xff;
  *chp++ = c;

  c = (ulli >> 56) & 0xff;
  *chp++ = c;

}