#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;
}