#include "project.h"

void
hexdump (FILE * f, uint8_t * data, int s, int l)
{
  int e = s + l - 1;
  int b = s & ~15;
  int a = (e | 15) + 1;
  int i, j;

  for (i = b; i < a; i += 16)
    {
      fprintf (f, "      %04x: ", i);
      for (j = i; j < (i + 16); ++j)
        {
          if (j == (i + 8))
            fprintf (f, " ");

          if ((j >= s) && (j <= e))
            {
              fprintf (f, "%02x ", data[j]);
            }
          else
            {
              fprintf (f, "   ");
            }
        }

      for (j = i; j < (i + 16); ++j)
        {

          if (j == (i + 8))
            fprintf (f, " ");


          if ((j >= s) && (j <= e))
            {
              uint8_t c = data[j];
              if ((c < ' ') || (c > 126))
                c = '.';
              fprintf (f, "%c", c);
            }
          else
            {
              fprintf (f, " ");
            }
        }


      fprintf (f, "\n");
    }

}

void
utf16_to_ascii (void *_u16, int u16_len, void *_u8, int u8_len)
{
  uint16_t *u16 = (uint16_t *) _u16;
  uint8_t *u8 = (uint8_t *) _u8;

  u16_len >>= 1;

  if (u8_len == 1)
    {
      *u8 = 0;
      return;
    }
  while (*u16 && u16_len)
    {
      *(u8++) = *(u16++);
      u16_len--;
      u8_len--;

      if (u8_len == 1)
        {
          *u8 = 0;
          return;
        }
    }

  *u8 = 0;
  return;
}

void
ascii_to_utf16 (void *_u8, int u8_len, void *_u16, int u16_len)
{
  uint16_t *u16 = (uint16_t *) _u16;
  uint8_t *u8 = (uint8_t *) _u8;

  u16_len >>= 1;

  if (u16_len == 1)
    {
      *u16 = 0;
      return;
    }
  while (*u8 && u8_len)
    {
      *(u16++) = *(u8++);
      u16_len--;
      u8_len--;

      if (u16_len == 1)
        {
          *u16 = 0;
          return;
        }
    }

  *u16 = 0;
  return;
}