1471 lines
39 KiB
C
1471 lines
39 KiB
C
#include "globals.h"
|
|
#include "oscam-string.h"
|
|
|
|
/* This function encapsulates malloc. It automatically adds an error message
|
|
to the log if it failed and calls cs_exit(quiterror) if quiterror > -1.
|
|
result will be automatically filled with the new memory position or NULL
|
|
on failure. */
|
|
bool cs_malloc(void *result, size_t size)
|
|
{
|
|
void **tmp = result;
|
|
*tmp = malloc(size);
|
|
|
|
if(*tmp == NULL)
|
|
{
|
|
fprintf(stderr, "%s: ERROR: Can't allocate %zu bytes!", __func__, size);
|
|
}
|
|
else
|
|
{
|
|
memset(*tmp, 0, size);
|
|
}
|
|
return !!*tmp;
|
|
}
|
|
|
|
/* This function encapsulates realloc. It automatically adds an error message
|
|
to the log if it failed and calls cs_exit(quiterror) if quiterror > -1.
|
|
result will be automatically filled with the new memory position or NULL
|
|
on failure. If a failure occured, the existing memory in result will
|
|
be freed. */
|
|
bool cs_realloc(void *result, size_t size)
|
|
{
|
|
void **tmp = result, **tmp2 = result;
|
|
*tmp = realloc(*tmp, size);
|
|
|
|
if(*tmp == NULL)
|
|
{
|
|
fprintf(stderr, "%s: ERROR: Can't allocate %zu bytes!", __func__, size);
|
|
NULLFREE(*tmp2);
|
|
}
|
|
return !!*tmp;
|
|
}
|
|
|
|
/* strlen is wrongly used in oscam. Calling strlen directly
|
|
* e.g. strlen(somechar) can cause segmentation fault if pointer to somechar is NULL!
|
|
* This one looks better?
|
|
*/
|
|
size_t cs_strlen(const char *c)
|
|
{
|
|
return c ? strlen(c) : 0;
|
|
}
|
|
|
|
/* Allocates a new empty string and copies str into it. You need to free() the result. */
|
|
char *cs_strdup(const char *str)
|
|
{
|
|
char *newstr;
|
|
if(!str)
|
|
{ return NULL; }
|
|
|
|
if(cs_malloc(&newstr, cs_strlen(str) + 1))
|
|
{
|
|
cs_strncpy(newstr, str, cs_strlen(str) + 1);
|
|
return newstr;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
/* Ordinary strncpy does not terminate the string if the source is exactly
|
|
as long or longer as the specified size. This can raise security issues.
|
|
This function is a replacement which makes sure that a \0 is always added.
|
|
num should be the real size of char array (do not subtract -1). */
|
|
void cs_strncpy(char *destination, const char *source, size_t num)
|
|
{
|
|
if(!source)
|
|
{
|
|
destination[0] = '\0';
|
|
return;
|
|
}
|
|
|
|
uint32_t l, size = cs_strlen(source);
|
|
if(size > num - 1)
|
|
{ l = num - 1; }
|
|
else
|
|
{ l = size; }
|
|
|
|
memcpy(destination, source, l);
|
|
destination[l] = '\0';
|
|
}
|
|
|
|
bool cs_strncat(char *destination, char *source, size_t destination_size)
|
|
{
|
|
uint32_t dest_sz = 0;
|
|
uint32_t source_sz = 0;
|
|
|
|
if (!destination_size)
|
|
{
|
|
cs_log("ERROR, destination_size 0!");
|
|
return false;
|
|
}
|
|
|
|
if (destination)
|
|
{
|
|
dest_sz += cs_strlen(destination);
|
|
}
|
|
else
|
|
{
|
|
cs_log("ERROR, destination pointer NULL!");
|
|
return false;
|
|
}
|
|
|
|
if (source)
|
|
{
|
|
source_sz += cs_strlen(source);
|
|
}
|
|
else
|
|
{
|
|
cs_log("ERROR, source pointer NULL!");
|
|
return false;
|
|
}
|
|
|
|
if ((dest_sz + source_sz) == 0)
|
|
{
|
|
cs_log("ERROR, booth destination and source with zero size!");
|
|
return false;
|
|
}
|
|
|
|
if ((dest_sz + source_sz) < destination_size)
|
|
{
|
|
if (dest_sz)
|
|
{
|
|
void *dest = (void *)destination;
|
|
memcpy(destination, dest, dest_sz);
|
|
}
|
|
|
|
if (source_sz)
|
|
memcpy(destination + dest_sz, source, source_sz);
|
|
|
|
destination[dest_sz + source_sz] = '\0';
|
|
}
|
|
else
|
|
{
|
|
cs_log("ERROR, buffer overflow!");
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/* Converts the string txt to it's lower case representation. */
|
|
char *strtolower(char *txt)
|
|
{
|
|
char *p;
|
|
for(p = txt; *p; p++)
|
|
{
|
|
*p = tolower((uint8_t) *p);
|
|
}
|
|
return txt;
|
|
}
|
|
|
|
/* Converts the string txt to it's upper case representation. */
|
|
char *strtoupper(char *txt)
|
|
{
|
|
char *p;
|
|
for(p = txt; *p; p++)
|
|
{
|
|
*p = toupper((uint8_t) *p);
|
|
}
|
|
return txt;
|
|
}
|
|
|
|
char *trim(char *txt)
|
|
{
|
|
int32_t l;
|
|
char *p1, *p2;
|
|
|
|
if(*txt == ' ')
|
|
{
|
|
for(p1 = p2 = txt; (*p1 == ' ') || (*p1 == '\t') || (*p1 == '\n') || (*p1 == '\r'); p1++)
|
|
{ ; }
|
|
|
|
while(*p1)
|
|
{ *p2++ = *p1++; }
|
|
|
|
*p2 = '\0';
|
|
}
|
|
|
|
l = cs_strlen(txt);
|
|
if(l > 0)
|
|
{
|
|
for(p1 = txt + l - 1; l > 0 && ((*p1 == ' ') || (*p1 == '\t') || (*p1 == '\n') || (*p1 == '\r')); *p1-- = '\0', l--)
|
|
{ ; }
|
|
}
|
|
return txt;
|
|
}
|
|
|
|
char *trim2(char *txt)
|
|
{
|
|
int32_t i, n;
|
|
|
|
for(i = n = 0; i < (int32_t)cs_strlen(txt); i++)
|
|
{
|
|
if(txt[i] == ' ' || txt[i] == '\t') continue;
|
|
if(txt[i] == '#') {break;}
|
|
txt[n] = txt[i];
|
|
n++;
|
|
}
|
|
txt[n] = '\0';
|
|
|
|
return txt;
|
|
}
|
|
|
|
char *remove_white_chars(char *txt)
|
|
{
|
|
char *p1 = txt, *p2 = txt;
|
|
|
|
if(NULL != p1)
|
|
{
|
|
while('\0' != *p1)
|
|
{
|
|
if((' ' != *p1) && ('\t' != *p1) && ('\n' != *p1) && ('\r' != *p1))
|
|
{
|
|
*p2++ = *p1;
|
|
}
|
|
p1++;
|
|
}
|
|
*p2 = '\0';
|
|
}
|
|
return txt;
|
|
}
|
|
|
|
/* Allocates a new empty string and copies txt into it,
|
|
* then replace all newline occurances with whitspace.
|
|
* You need to free() the result. */
|
|
char *remove_newline_chars(const char *txt)
|
|
{
|
|
if(!txt)
|
|
{ return NULL; }
|
|
|
|
char *result = cs_strdup(txt), *p = NULL;
|
|
|
|
if(!result)
|
|
{ return NULL; }
|
|
for (p = result; *p; p++) *p = *p == '\r' ? ' ' : *p == '\n' ? ' ' : *p;
|
|
|
|
return result;
|
|
}
|
|
|
|
bool streq(const char *s1, const char *s2)
|
|
{
|
|
if(!s1 && s2) { return 0; }
|
|
if(s1 && !s2) { return 0; }
|
|
if(!s1 && !s2) { return 1; }
|
|
return strcmp(s1, s2) == 0;
|
|
}
|
|
|
|
char *cs_hexdump(int32_t m, const uint8_t *buf, int32_t n, char *target, int32_t len)
|
|
{
|
|
int32_t i = 0;
|
|
if(target == NULL || buf == NULL)
|
|
{
|
|
return NULL;
|
|
}
|
|
target[0] = '\0';
|
|
m = m ? 3 : 2;
|
|
|
|
if(m * n >= len)
|
|
{
|
|
n = (len / m) - 1;
|
|
}
|
|
|
|
while(i < n)
|
|
{
|
|
snprintf(target + (m * i), len - (m * i), "%02X%s", *buf++, m > 2 ? " " : "");
|
|
i++;
|
|
}
|
|
return target;
|
|
}
|
|
|
|
/*
|
|
* For using gethexval we must check if char c is within range othervise gethexval return
|
|
* negative value so we must ensure we not shift left those negative value! So before
|
|
* using gethexval function you need to check char c with function gethexval_within_range to
|
|
* ensure char c is within accepted range!
|
|
*/
|
|
bool gethexval_within_range(char c)
|
|
{
|
|
if((c >= '0' && c <= '9') || (c >= 'A' && c <= 'F') || (c >= 'a' && c <= 'f'))
|
|
{
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
int32_t gethexval(char c)
|
|
{
|
|
if(c >= '0' && c <= '9') { return c - '0'; }
|
|
if(c >= 'A' && c <= 'F') { return c - 'A' + 10; }
|
|
if(c >= 'a' && c <= 'f') { return c - 'a' + 10; }
|
|
return -1;
|
|
}
|
|
|
|
int32_t cs_atob(uint8_t *buf, char *asc, int32_t n)
|
|
{
|
|
int32_t i, rc;
|
|
if(buf == NULL || asc == NULL)
|
|
{
|
|
return -1;
|
|
}
|
|
for(i = 0; i < n; i++)
|
|
{
|
|
if(!gethexval_within_range(asc[i << 1]) || !gethexval_within_range(asc[(i << 1) + 1]))
|
|
{
|
|
return -1;
|
|
}
|
|
rc = (gethexval(asc[i << 1]) << 4) | gethexval(asc[(i << 1) + 1]);
|
|
if(rc & 0x100)
|
|
{
|
|
return -1;
|
|
}
|
|
buf[i] = rc;
|
|
}
|
|
return n;
|
|
}
|
|
|
|
uint32_t cs_atoi(char *asc, int32_t l, int32_t val_on_err)
|
|
{
|
|
int32_t i, n = 0;
|
|
uint32_t rc = 0;
|
|
if(asc == NULL)
|
|
{
|
|
errno = EINVAL;
|
|
rc = val_on_err ? 0xFFFFFFFF : 0;
|
|
return rc;
|
|
}
|
|
for(i = ((l - 1) << 1), errno = 0; i >= 0 && n < 4; i -= 2)
|
|
{
|
|
if(!gethexval_within_range(asc[i]) || !gethexval_within_range(asc[i + 1]))
|
|
{
|
|
errno = EINVAL;
|
|
rc = val_on_err ? 0xFFFFFFFF : 0;
|
|
break;
|
|
}
|
|
int32_t b = (gethexval(asc[i]) << 4) | gethexval(asc[i + 1]);
|
|
if(b < 0)
|
|
{
|
|
errno = EINVAL;
|
|
rc = val_on_err ? 0xFFFFFFFF : 0;
|
|
break;
|
|
}
|
|
rc |= b << (n << 3);
|
|
n++;
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
int32_t byte_atob(char *asc)
|
|
{
|
|
int32_t rc = (-1);
|
|
if(asc == NULL)
|
|
{
|
|
return rc;
|
|
}
|
|
if(cs_strlen(trim(asc)) != 2)
|
|
{
|
|
rc = -1;
|
|
}
|
|
else
|
|
{
|
|
if(!gethexval_within_range(asc[0]) || !gethexval_within_range(asc[1]))
|
|
{
|
|
return rc;
|
|
}
|
|
else
|
|
{
|
|
rc = (gethexval(asc[0]) << 4) | gethexval(asc[1]);
|
|
if(rc & 0x100)
|
|
{
|
|
rc = -1;
|
|
}
|
|
}
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
int32_t word_atob(char *asc)
|
|
{
|
|
int32_t rc = (-1);
|
|
|
|
if(asc == NULL)
|
|
{
|
|
return rc;
|
|
}
|
|
|
|
if(cs_strlen(trim(asc)) != 4)
|
|
{
|
|
rc = -1;
|
|
}
|
|
else
|
|
{
|
|
if(!gethexval_within_range(asc[0]) || !gethexval_within_range(asc[1]) || !gethexval_within_range(asc[2]) || !gethexval_within_range(asc[3]))
|
|
{
|
|
return rc;
|
|
}
|
|
else
|
|
{
|
|
rc = gethexval(asc[0]) << 12 | gethexval(asc[1]) << 8 | gethexval(asc[2]) << 4 | gethexval(asc[3]);
|
|
if(rc & 0x10000)
|
|
{
|
|
rc = -1;
|
|
}
|
|
}
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
/*
|
|
* dynamic word_atob
|
|
* converts an 1-6 digit asc hexstring
|
|
*/
|
|
int32_t dyn_word_atob(char *asc)
|
|
{
|
|
int32_t rc = (-1);
|
|
int32_t i, len;
|
|
|
|
if(asc == NULL)
|
|
{
|
|
return rc;
|
|
}
|
|
len = cs_strlen(trim(asc));
|
|
if(len <= 6 && len > 0)
|
|
{
|
|
for(i = 0, rc = 0; i < len; i++)
|
|
{
|
|
if(!gethexval_within_range(asc[i]))
|
|
{
|
|
return -1;
|
|
}
|
|
rc = rc << 4 | gethexval(asc[i]);
|
|
}
|
|
if(rc & 0x1000000)
|
|
{
|
|
rc = -1;
|
|
}
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
int32_t key_atob_l(char *asc, uint8_t *bin, int32_t l)
|
|
{
|
|
int32_t i, n1, n2, rc;
|
|
|
|
if(asc == NULL || bin == NULL)
|
|
{
|
|
return -1;
|
|
}
|
|
for(i = rc = 0; i < l; i += 2)
|
|
{
|
|
if(!gethexval_within_range(asc[i]) || !gethexval_within_range(asc[i + 1]))
|
|
{
|
|
rc = -1;
|
|
}
|
|
else
|
|
{
|
|
n1 = gethexval(asc[i]);
|
|
n2 = gethexval(asc[i + 1]);
|
|
bin[i >> 1] = (n1 << 4) + (n2 & 0xff);
|
|
}
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
uint32_t b2i(int32_t n, const uint8_t *b)
|
|
{
|
|
if(b == NULL)
|
|
{
|
|
return 0;
|
|
}
|
|
switch(n)
|
|
{
|
|
case 1:
|
|
return b[0];
|
|
case 2:
|
|
return (b[0] << 8) | b[1];
|
|
|
|
case 3:
|
|
return (b[0] << 16) | (b[1] << 8) | b[2];
|
|
|
|
case 4:
|
|
return ((b[0] << 24) | (b[1] << 16) | (b[2] << 8) | b[3]) & 0xffffffffL;
|
|
|
|
default:
|
|
cs_log("Error in b2i, n=%i", n);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
uint64_t b2ll(int32_t n, const uint8_t *b)
|
|
{
|
|
int32_t i;
|
|
uint64_t k = 0;
|
|
if(b == NULL)
|
|
{
|
|
return k;
|
|
}
|
|
for(i = 0; i < n; k += b[i++])
|
|
{
|
|
k <<= 8;
|
|
}
|
|
return k;
|
|
}
|
|
|
|
uint8_t *i2b_buf(int32_t n, uint32_t i, uint8_t *b)
|
|
{
|
|
switch(n)
|
|
{
|
|
case 2:
|
|
b[0] = (i >> 8) & 0xff;
|
|
b[1] = (i) & 0xff;
|
|
break;
|
|
|
|
case 3:
|
|
b[0] = (i >> 16) & 0xff;
|
|
b[1] = (i >> 8) & 0xff;
|
|
b[2] = (i) & 0xff;
|
|
break;
|
|
|
|
case 4:
|
|
b[0] = (i >> 24) & 0xff;
|
|
b[1] = (i >> 16) & 0xff;
|
|
b[2] = (i >> 8) & 0xff;
|
|
b[3] = (i) & 0xff;
|
|
break;
|
|
}
|
|
return b;
|
|
}
|
|
|
|
uint8_t *ull2b_buf(uint64_t i, uint8_t *b)
|
|
{
|
|
b[0] = (i >> 56) & 0xff;
|
|
b[1] = (i >> 48) & 0xff;
|
|
b[2] = (i >> 40) & 0xff;
|
|
b[3] = (i >> 32) & 0xff;
|
|
b[4] = (i >> 24) & 0xff;
|
|
b[5] = (i >> 16) & 0xff;
|
|
b[6] = (i >> 8) & 0xff;
|
|
b[7] = (i) & 0xff;
|
|
return b;
|
|
}
|
|
|
|
uint32_t a2i(char *asc, int32_t bytes)
|
|
{
|
|
int32_t i, n;
|
|
uint32_t rc;
|
|
if(asc == NULL)
|
|
{
|
|
errno = EINVAL;
|
|
return 0x1f1f1f;
|
|
}
|
|
for(rc = i = 0, n = cs_strlen(trim(asc)) - 1; i < abs(bytes) << 1; n--, i++)
|
|
{
|
|
if(n >= 0)
|
|
{
|
|
int32_t rcl;
|
|
if(!gethexval_within_range(asc[n]))
|
|
{
|
|
errno = EINVAL;
|
|
return 0x1f1f1f;
|
|
}
|
|
else
|
|
{
|
|
rcl = gethexval(asc[n]);
|
|
rc |= rcl << (i << 2);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if(bytes < 0)
|
|
{
|
|
rc |= 0xf << (i << 2);
|
|
}
|
|
}
|
|
}
|
|
errno = 0;
|
|
return rc;
|
|
}
|
|
|
|
int32_t boundary(int32_t exp, int32_t n)
|
|
{
|
|
return (((n - 1) >> exp) + 1) << exp;
|
|
}
|
|
|
|
/* Checks whether an array has at least one non-zero byte.
|
|
length specifies the maximum length to check for. */
|
|
int32_t array_has_nonzero_byte(uint8_t *value, int32_t length)
|
|
{
|
|
if(!value)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int32_t i;
|
|
for(i = 0; i < length; i++)
|
|
{
|
|
if(value[i] > 0)
|
|
{
|
|
return 1;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#define RAND_POOL_SIZE 64
|
|
|
|
// The last bytes are used to init random seed
|
|
static uint8_t rand_pool[RAND_POOL_SIZE + sizeof(uint32_t)];
|
|
|
|
void get_random_bytes_init(void)
|
|
{
|
|
srand(time(NULL));
|
|
int fd = open("/dev/urandom", O_RDONLY);
|
|
|
|
if(fd < 0)
|
|
{
|
|
fd = open("/dev/random", O_RDONLY);
|
|
if(fd < 0)
|
|
{
|
|
return;
|
|
}
|
|
}
|
|
|
|
if(read(fd, rand_pool, RAND_POOL_SIZE + sizeof(uint32_t)) > -1)
|
|
{
|
|
uint32_t pool_seed = b2i(4, rand_pool + RAND_POOL_SIZE);
|
|
srand(pool_seed);
|
|
}
|
|
close(fd);
|
|
}
|
|
|
|
void get_random_bytes(uint8_t *dst, uint32_t dst_len)
|
|
{
|
|
static uint32_t rand_pool_pos; // *MUST* be static
|
|
uint32_t i;
|
|
|
|
for(i = 0; i < dst_len; i++)
|
|
{
|
|
rand_pool_pos++; // Races are welcome...
|
|
dst[i] = rand() ^ rand_pool[rand_pool_pos % RAND_POOL_SIZE];
|
|
}
|
|
}
|
|
|
|
static uint32_t crc_table[256] =
|
|
{
|
|
0x00000000L, 0x77073096L, 0xee0e612cL, 0x990951baL, 0x076dc419L,
|
|
0x706af48fL, 0xe963a535L, 0x9e6495a3L, 0x0edb8832L, 0x79dcb8a4L,
|
|
0xe0d5e91eL, 0x97d2d988L, 0x09b64c2bL, 0x7eb17cbdL, 0xe7b82d07L,
|
|
0x90bf1d91L, 0x1db71064L, 0x6ab020f2L, 0xf3b97148L, 0x84be41deL,
|
|
0x1adad47dL, 0x6ddde4ebL, 0xf4d4b551L, 0x83d385c7L, 0x136c9856L,
|
|
0x646ba8c0L, 0xfd62f97aL, 0x8a65c9ecL, 0x14015c4fL, 0x63066cd9L,
|
|
0xfa0f3d63L, 0x8d080df5L, 0x3b6e20c8L, 0x4c69105eL, 0xd56041e4L,
|
|
0xa2677172L, 0x3c03e4d1L, 0x4b04d447L, 0xd20d85fdL, 0xa50ab56bL,
|
|
0x35b5a8faL, 0x42b2986cL, 0xdbbbc9d6L, 0xacbcf940L, 0x32d86ce3L,
|
|
0x45df5c75L, 0xdcd60dcfL, 0xabd13d59L, 0x26d930acL, 0x51de003aL,
|
|
0xc8d75180L, 0xbfd06116L, 0x21b4f4b5L, 0x56b3c423L, 0xcfba9599L,
|
|
0xb8bda50fL, 0x2802b89eL, 0x5f058808L, 0xc60cd9b2L, 0xb10be924L,
|
|
0x2f6f7c87L, 0x58684c11L, 0xc1611dabL, 0xb6662d3dL, 0x76dc4190L,
|
|
0x01db7106L, 0x98d220bcL, 0xefd5102aL, 0x71b18589L, 0x06b6b51fL,
|
|
0x9fbfe4a5L, 0xe8b8d433L, 0x7807c9a2L, 0x0f00f934L, 0x9609a88eL,
|
|
0xe10e9818L, 0x7f6a0dbbL, 0x086d3d2dL, 0x91646c97L, 0xe6635c01L,
|
|
0x6b6b51f4L, 0x1c6c6162L, 0x856530d8L, 0xf262004eL, 0x6c0695edL,
|
|
0x1b01a57bL, 0x8208f4c1L, 0xf50fc457L, 0x65b0d9c6L, 0x12b7e950L,
|
|
0x8bbeb8eaL, 0xfcb9887cL, 0x62dd1ddfL, 0x15da2d49L, 0x8cd37cf3L,
|
|
0xfbd44c65L, 0x4db26158L, 0x3ab551ceL, 0xa3bc0074L, 0xd4bb30e2L,
|
|
0x4adfa541L, 0x3dd895d7L, 0xa4d1c46dL, 0xd3d6f4fbL, 0x4369e96aL,
|
|
0x346ed9fcL, 0xad678846L, 0xda60b8d0L, 0x44042d73L, 0x33031de5L,
|
|
0xaa0a4c5fL, 0xdd0d7cc9L, 0x5005713cL, 0x270241aaL, 0xbe0b1010L,
|
|
0xc90c2086L, 0x5768b525L, 0x206f85b3L, 0xb966d409L, 0xce61e49fL,
|
|
0x5edef90eL, 0x29d9c998L, 0xb0d09822L, 0xc7d7a8b4L, 0x59b33d17L,
|
|
0x2eb40d81L, 0xb7bd5c3bL, 0xc0ba6cadL, 0xedb88320L, 0x9abfb3b6L,
|
|
0x03b6e20cL, 0x74b1d29aL, 0xead54739L, 0x9dd277afL, 0x04db2615L,
|
|
0x73dc1683L, 0xe3630b12L, 0x94643b84L, 0x0d6d6a3eL, 0x7a6a5aa8L,
|
|
0xe40ecf0bL, 0x9309ff9dL, 0x0a00ae27L, 0x7d079eb1L, 0xf00f9344L,
|
|
0x8708a3d2L, 0x1e01f268L, 0x6906c2feL, 0xf762575dL, 0x806567cbL,
|
|
0x196c3671L, 0x6e6b06e7L, 0xfed41b76L, 0x89d32be0L, 0x10da7a5aL,
|
|
0x67dd4accL, 0xf9b9df6fL, 0x8ebeeff9L, 0x17b7be43L, 0x60b08ed5L,
|
|
0xd6d6a3e8L, 0xa1d1937eL, 0x38d8c2c4L, 0x4fdff252L, 0xd1bb67f1L,
|
|
0xa6bc5767L, 0x3fb506ddL, 0x48b2364bL, 0xd80d2bdaL, 0xaf0a1b4cL,
|
|
0x36034af6L, 0x41047a60L, 0xdf60efc3L, 0xa867df55L, 0x316e8eefL,
|
|
0x4669be79L, 0xcb61b38cL, 0xbc66831aL, 0x256fd2a0L, 0x5268e236L,
|
|
0xcc0c7795L, 0xbb0b4703L, 0x220216b9L, 0x5505262fL, 0xc5ba3bbeL,
|
|
0xb2bd0b28L, 0x2bb45a92L, 0x5cb36a04L, 0xc2d7ffa7L, 0xb5d0cf31L,
|
|
0x2cd99e8bL, 0x5bdeae1dL, 0x9b64c2b0L, 0xec63f226L, 0x756aa39cL,
|
|
0x026d930aL, 0x9c0906a9L, 0xeb0e363fL, 0x72076785L, 0x05005713L,
|
|
0x95bf4a82L, 0xe2b87a14L, 0x7bb12baeL, 0x0cb61b38L, 0x92d28e9bL,
|
|
0xe5d5be0dL, 0x7cdcefb7L, 0x0bdbdf21L, 0x86d3d2d4L, 0xf1d4e242L,
|
|
0x68ddb3f8L, 0x1fda836eL, 0x81be16cdL, 0xf6b9265bL, 0x6fb077e1L,
|
|
0x18b74777L, 0x88085ae6L, 0xff0f6a70L, 0x66063bcaL, 0x11010b5cL,
|
|
0x8f659effL, 0xf862ae69L, 0x616bffd3L, 0x166ccf45L, 0xa00ae278L,
|
|
0xd70dd2eeL, 0x4e048354L, 0x3903b3c2L, 0xa7672661L, 0xd06016f7L,
|
|
0x4969474dL, 0x3e6e77dbL, 0xaed16a4aL, 0xd9d65adcL, 0x40df0b66L,
|
|
0x37d83bf0L, 0xa9bcae53L, 0xdebb9ec5L, 0x47b2cf7fL, 0x30b5ffe9L,
|
|
0xbdbdf21cL, 0xcabac28aL, 0x53b39330L, 0x24b4a3a6L, 0xbad03605L,
|
|
0xcdd70693L, 0x54de5729L, 0x23d967bfL, 0xb3667a2eL, 0xc4614ab8L,
|
|
0x5d681b02L, 0x2a6f2b94L, 0xb40bbe37L, 0xc30c8ea1L, 0x5a05df1bL,
|
|
0x2d02ef8dL
|
|
};
|
|
|
|
/*
|
|
* crc32 -- compute the CRC-32 of a data stream
|
|
* Copyright (C) 1995-1996 Mark Adler
|
|
* For conditions of distribution and use, see copyright notice in zlib.h
|
|
*/
|
|
#define DO1(buf) crc = crc_table[((int)crc ^ (*buf++)) & 0xff] ^ (crc >> 8);
|
|
#define DO2(buf) DO1(buf); DO1(buf);
|
|
#define DO4(buf) DO2(buf); DO2(buf);
|
|
#define DO8(buf) DO4(buf); DO4(buf);
|
|
|
|
uint32_t crc32(uint32_t crc, const uint8_t *buf, uint32_t len)
|
|
{
|
|
if(!buf)
|
|
{
|
|
return 0L;
|
|
}
|
|
crc = crc ^ 0xffffffffL;
|
|
while(len >= 8)
|
|
{
|
|
DO8(buf);
|
|
len -= 8;
|
|
}
|
|
if(len)
|
|
{
|
|
do
|
|
{
|
|
DO1(buf);
|
|
}
|
|
while(--len);
|
|
}
|
|
return crc ^ 0xffffffffL;
|
|
}
|
|
|
|
static uint16_t ccitt_crc_table [256] =
|
|
{
|
|
0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50a5,
|
|
0x60c6, 0x70e7, 0x8108, 0x9129, 0xa14a, 0xb16b,
|
|
0xc18c, 0xd1ad, 0xe1ce, 0xf1ef, 0x1231, 0x0210,
|
|
0x3273, 0x2252, 0x52b5, 0x4294, 0x72f7, 0x62d6,
|
|
0x9339, 0x8318, 0xb37b, 0xa35a, 0xd3bd, 0xc39c,
|
|
0xf3ff, 0xe3de, 0x2462, 0x3443, 0x0420, 0x1401,
|
|
0x64e6, 0x74c7, 0x44a4, 0x5485, 0xa56a, 0xb54b,
|
|
0x8528, 0x9509, 0xe5ee, 0xf5cf, 0xc5ac, 0xd58d,
|
|
0x3653, 0x2672, 0x1611, 0x0630, 0x76d7, 0x66f6,
|
|
0x5695, 0x46b4, 0xb75b, 0xa77a, 0x9719, 0x8738,
|
|
0xf7df, 0xe7fe, 0xd79d, 0xc7bc, 0x48c4, 0x58e5,
|
|
0x6886, 0x78a7, 0x0840, 0x1861, 0x2802, 0x3823,
|
|
0xc9cc, 0xd9ed, 0xe98e, 0xf9af, 0x8948, 0x9969,
|
|
0xa90a, 0xb92b, 0x5af5, 0x4ad4, 0x7ab7, 0x6a96,
|
|
0x1a71, 0x0a50, 0x3a33, 0x2a12, 0xdbfd, 0xcbdc,
|
|
0xfbbf, 0xeb9e, 0x9b79, 0x8b58, 0xbb3b, 0xab1a,
|
|
0x6ca6, 0x7c87, 0x4ce4, 0x5cc5, 0x2c22, 0x3c03,
|
|
0x0c60, 0x1c41, 0xedae, 0xfd8f, 0xcdec, 0xddcd,
|
|
0xad2a, 0xbd0b, 0x8d68, 0x9d49, 0x7e97, 0x6eb6,
|
|
0x5ed5, 0x4ef4, 0x3e13, 0x2e32, 0x1e51, 0x0e70,
|
|
0xff9f, 0xefbe, 0xdfdd, 0xcffc, 0xbf1b, 0xaf3a,
|
|
0x9f59, 0x8f78, 0x9188, 0x81a9, 0xb1ca, 0xa1eb,
|
|
0xd10c, 0xc12d, 0xf14e, 0xe16f, 0x1080, 0x00a1,
|
|
0x30c2, 0x20e3, 0x5004, 0x4025, 0x7046, 0x6067,
|
|
0x83b9, 0x9398, 0xa3fb, 0xb3da, 0xc33d, 0xd31c,
|
|
0xe37f, 0xf35e, 0x02b1, 0x1290, 0x22f3, 0x32d2,
|
|
0x4235, 0x5214, 0x6277, 0x7256, 0xb5ea, 0xa5cb,
|
|
0x95a8, 0x8589, 0xf56e, 0xe54f, 0xd52c, 0xc50d,
|
|
0x34e2, 0x24c3, 0x14a0, 0x0481, 0x7466, 0x6447,
|
|
0x5424, 0x4405, 0xa7db, 0xb7fa, 0x8799, 0x97b8,
|
|
0xe75f, 0xf77e, 0xc71d, 0xd73c, 0x26d3, 0x36f2,
|
|
0x0691, 0x16b0, 0x6657, 0x7676, 0x4615, 0x5634,
|
|
0xd94c, 0xc96d, 0xf90e, 0xe92f, 0x99c8, 0x89e9,
|
|
0xb98a, 0xa9ab, 0x5844, 0x4865, 0x7806, 0x6827,
|
|
0x18c0, 0x08e1, 0x3882, 0x28a3, 0xcb7d, 0xdb5c,
|
|
0xeb3f, 0xfb1e, 0x8bf9, 0x9bd8, 0xabbb, 0xbb9a,
|
|
0x4a75, 0x5a54, 0x6a37, 0x7a16, 0x0af1, 0x1ad0,
|
|
0x2ab3, 0x3a92, 0xfd2e, 0xed0f, 0xdd6c, 0xcd4d,
|
|
0xbdaa, 0xad8b, 0x9de8, 0x8dc9, 0x7c26, 0x6c07,
|
|
0x5c64, 0x4c45, 0x3ca2, 0x2c83, 0x1ce0, 0x0cc1,
|
|
0xef1f, 0xff3e, 0xcf5d, 0xdf7c, 0xaf9b, 0xbfba,
|
|
0x8fd9, 0x9ff8, 0x6e17, 0x7e36, 0x4e55, 0x5e74,
|
|
0x2e93, 0x3eb2, 0x0ed1, 0x1ef0
|
|
};
|
|
|
|
uint16_t ccitt_crc(uint8_t *data, size_t length, uint16_t seed, uint16_t final)
|
|
{
|
|
size_t count;
|
|
uint32_t crc = seed;
|
|
uint32_t temp;
|
|
|
|
for (count = 0; count < length; ++count)
|
|
{
|
|
temp = (*data++ ^ (crc >> 8)) & 0xff;
|
|
crc = ccitt_crc_table[temp] ^ (crc << 8);
|
|
}
|
|
return (uint16_t)(crc ^ final);
|
|
}
|
|
|
|
static const uint32_t ccitt32_crc_table[256] =
|
|
{
|
|
0x00000000, 0x04c11db7, 0x09823b6e, 0x0d4326d9, 0x130476dc, 0x17c56b6b, 0x1a864db2, 0x1e475005,
|
|
0x2608edb8, 0x22c9f00f, 0x2f8ad6d6, 0x2b4bcb61, 0x350c9b64, 0x31cd86d3, 0x3c8ea00a, 0x384fbdbd,
|
|
0x4c11db70, 0x48d0c6c7, 0x4593e01e, 0x4152fda9, 0x5f15adac, 0x5bd4b01b, 0x569796c2, 0x52568b75,
|
|
0x6a1936c8, 0x6ed82b7f, 0x639b0da6, 0x675a1011, 0x791d4014, 0x7ddc5da3, 0x709f7b7a, 0x745e66cd,
|
|
0x9823b6e0, 0x9ce2ab57, 0x91a18d8e, 0x95609039, 0x8b27c03c, 0x8fe6dd8b, 0x82a5fb52, 0x8664e6e5,
|
|
0xbe2b5b58, 0xbaea46ef, 0xb7a96036, 0xb3687d81, 0xad2f2d84, 0xa9ee3033, 0xa4ad16ea, 0xa06c0b5d,
|
|
0xd4326d90, 0xd0f37027, 0xddb056fe, 0xd9714b49, 0xc7361b4c, 0xc3f706fb, 0xceb42022, 0xca753d95,
|
|
0xf23a8028, 0xf6fb9d9f, 0xfbb8bb46, 0xff79a6f1, 0xe13ef6f4, 0xe5ffeb43, 0xe8bccd9a, 0xec7dd02d,
|
|
0x34867077, 0x30476dc0, 0x3d044b19, 0x39c556ae, 0x278206ab, 0x23431b1c, 0x2e003dc5, 0x2ac12072,
|
|
0x128e9dcf, 0x164f8078, 0x1b0ca6a1, 0x1fcdbb16, 0x018aeb13, 0x054bf6a4, 0x0808d07d, 0x0cc9cdca,
|
|
0x7897ab07, 0x7c56b6b0, 0x71159069, 0x75d48dde, 0x6b93dddb, 0x6f52c06c, 0x6211e6b5, 0x66d0fb02,
|
|
0x5e9f46bf, 0x5a5e5b08, 0x571d7dd1, 0x53dc6066, 0x4d9b3063, 0x495a2dd4, 0x44190b0d, 0x40d816ba,
|
|
0xaca5c697, 0xa864db20, 0xa527fdf9, 0xa1e6e04e, 0xbfa1b04b, 0xbb60adfc, 0xb6238b25, 0xb2e29692,
|
|
0x8aad2b2f, 0x8e6c3698, 0x832f1041, 0x87ee0df6, 0x99a95df3, 0x9d684044, 0x902b669d, 0x94ea7b2a,
|
|
0xe0b41de7, 0xe4750050, 0xe9362689, 0xedf73b3e, 0xf3b06b3b, 0xf771768c, 0xfa325055, 0xfef34de2,
|
|
0xc6bcf05f, 0xc27dede8, 0xcf3ecb31, 0xcbffd686, 0xd5b88683, 0xd1799b34, 0xdc3abded, 0xd8fba05a,
|
|
0x690ce0ee, 0x6dcdfd59, 0x608edb80, 0x644fc637, 0x7a089632, 0x7ec98b85, 0x738aad5c, 0x774bb0eb,
|
|
0x4f040d56, 0x4bc510e1, 0x46863638, 0x42472b8f, 0x5c007b8a, 0x58c1663d, 0x558240e4, 0x51435d53,
|
|
0x251d3b9e, 0x21dc2629, 0x2c9f00f0, 0x285e1d47, 0x36194d42, 0x32d850f5, 0x3f9b762c, 0x3b5a6b9b,
|
|
0x0315d626, 0x07d4cb91, 0x0a97ed48, 0x0e56f0ff, 0x1011a0fa, 0x14d0bd4d, 0x19939b94, 0x1d528623,
|
|
0xf12f560e, 0xf5ee4bb9, 0xf8ad6d60, 0xfc6c70d7, 0xe22b20d2, 0xe6ea3d65, 0xeba91bbc, 0xef68060b,
|
|
0xd727bbb6, 0xd3e6a601, 0xdea580d8, 0xda649d6f, 0xc423cd6a, 0xc0e2d0dd, 0xcda1f604, 0xc960ebb3,
|
|
0xbd3e8d7e, 0xb9ff90c9, 0xb4bcb610, 0xb07daba7, 0xae3afba2, 0xaafbe615, 0xa7b8c0cc, 0xa379dd7b,
|
|
0x9b3660c6, 0x9ff77d71, 0x92b45ba8, 0x9675461f, 0x8832161a, 0x8cf30bad, 0x81b02d74, 0x857130c3,
|
|
0x5d8a9099, 0x594b8d2e, 0x5408abf7, 0x50c9b640, 0x4e8ee645, 0x4a4ffbf2, 0x470cdd2b, 0x43cdc09c,
|
|
0x7b827d21, 0x7f436096, 0x7200464f, 0x76c15bf8, 0x68860bfd, 0x6c47164a, 0x61043093, 0x65c52d24,
|
|
0x119b4be9, 0x155a565e, 0x18197087, 0x1cd86d30, 0x029f3d35, 0x065e2082, 0x0b1d065b, 0x0fdc1bec,
|
|
0x3793a651, 0x3352bbe6, 0x3e119d3f, 0x3ad08088, 0x2497d08d, 0x2056cd3a, 0x2d15ebe3, 0x29d4f654,
|
|
0xc5a92679, 0xc1683bce, 0xcc2b1d17, 0xc8ea00a0, 0xd6ad50a5, 0xd26c4d12, 0xdf2f6bcb, 0xdbee767c,
|
|
0xe3a1cbc1, 0xe760d676, 0xea23f0af, 0xeee2ed18, 0xf0a5bd1d, 0xf464a0aa, 0xf9278673, 0xfde69bc4,
|
|
0x89b8fd09, 0x8d79e0be, 0x803ac667, 0x84fbdbd0, 0x9abc8bd5, 0x9e7d9662, 0x933eb0bb, 0x97ffad0c,
|
|
0xafb010b1, 0xab710d06, 0xa6322bdf, 0xa2f33668, 0xbcb4666d, 0xb8757bda, 0xb5365d03, 0xb1f740b4,
|
|
};
|
|
|
|
uint32_t ccitt32_crc(uint8_t *data, size_t len)
|
|
{
|
|
uint32_t crc = 0xffffffff;
|
|
while(len--)
|
|
{
|
|
crc = ((crc << 8) & 0xffffff00) ^ ccitt32_crc_table[((crc >> 24) & 0xff) ^ *data++];
|
|
}
|
|
return(crc);
|
|
}
|
|
|
|
// https://en.wikipedia.org/wiki/Jenkins_hash_function
|
|
uint32_t jhash(const char *key, size_t len)
|
|
{
|
|
uint32_t hash, i;
|
|
for(hash = i = 0; i < len; i++)
|
|
{
|
|
hash += key[i];
|
|
hash += (hash << 10);
|
|
hash ^= (hash >> 6);
|
|
}
|
|
hash += (hash << 3);
|
|
hash ^= (hash >> 11);
|
|
hash += (hash << 15);
|
|
return hash;
|
|
}
|
|
|
|
/* Converts a char to it's hex representation. See char_to_hex on how to use it. */
|
|
char to_hex(char code)
|
|
{
|
|
static const char hex[] = "0123456789abcdef";
|
|
return hex[(int)code & 15];
|
|
}
|
|
|
|
/* Converts a char array to a char array with hex values (needed for example for md5).
|
|
Note that result needs to be at least (p_array_len * 2) + 1 large. */
|
|
void char_to_hex(const uint8_t *p_array, uint32_t p_array_len, uint8_t *result)
|
|
{
|
|
result[p_array_len * 2] = '\0';
|
|
const uint8_t *p_end = p_array + p_array_len;
|
|
uint32_t pos = 0;
|
|
const uint8_t *p;
|
|
|
|
for(p = p_array; p != p_end; p++, pos += 2)
|
|
{
|
|
result[pos] = to_hex(*p >> 4);
|
|
result[pos + 1] = to_hex(*p & 15);
|
|
}
|
|
}
|
|
|
|
static inline uint8_t to_uchar(char ch)
|
|
{
|
|
return ch;
|
|
}
|
|
|
|
void base64_encode(const char *in, size_t inlen, char *out, size_t outlen)
|
|
{
|
|
static const char b64str[64]
|
|
#if defined(__STDC_VERSION__) && __STDC_VERSION__ >= 202311L //gcc-15+
|
|
__attribute__((nonstring))
|
|
#endif
|
|
= "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
|
|
|
|
while(inlen && outlen)
|
|
{
|
|
*out++ = b64str[(to_uchar(in[0]) >> 2) & 0x3f];
|
|
if(!--outlen) { break; }
|
|
*out++ = b64str[((to_uchar(in[0]) << 4) + (--inlen ? to_uchar(in[1]) >> 4 : 0)) & 0x3f];
|
|
if(!--outlen) { break; }
|
|
*out++ = (inlen ? b64str[((to_uchar(in[1]) << 2) + (--inlen ? to_uchar(in[2]) >> 6 : 0)) & 0x3f] : '=');
|
|
if(!--outlen) { break; }
|
|
*out++ = inlen ? b64str[to_uchar(in[2]) & 0x3f] : '=';
|
|
if(!--outlen) { break; }
|
|
if(inlen) { inlen--; }
|
|
if(inlen) { in += 3; }
|
|
if(outlen) { *out = '\0'; }
|
|
}
|
|
}
|
|
|
|
size_t b64encode(const char *in, size_t inlen, char **out)
|
|
{
|
|
size_t outlen = 1 + BASE64_LENGTH(inlen);
|
|
if(inlen > outlen)
|
|
{
|
|
*out = NULL;
|
|
return 0;
|
|
}
|
|
if(!cs_malloc(out, outlen))
|
|
{
|
|
return -1;
|
|
}
|
|
base64_encode(in, inlen, *out, outlen);
|
|
return outlen - 1;
|
|
}
|
|
|
|
static int8_t b64decoder[256];
|
|
|
|
/* Prepares the base64 decoding array */
|
|
void b64prepare(void)
|
|
{
|
|
const uint8_t alphabet[64]
|
|
#if defined(__STDC_VERSION__) && __STDC_VERSION__ >= 202311L //gcc-15+
|
|
__attribute__((nonstring))
|
|
#endif
|
|
= "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
|
|
int32_t i;
|
|
|
|
for(i = sizeof(b64decoder) - 1; i >= 0; --i)
|
|
{
|
|
b64decoder[i] = -1;
|
|
}
|
|
|
|
for(i = sizeof(alphabet) - 1; i >= 0; --i)
|
|
{
|
|
b64decoder[alphabet[i]] = i;
|
|
}
|
|
}
|
|
|
|
/* Decodes a base64-encoded string. The given array will be used directly for output and is thus modified! */
|
|
int32_t b64decode(uint8_t *result)
|
|
{
|
|
int32_t i, len = cs_strlen((char *)result), j = 0, bits = 0, char_count = 0;
|
|
|
|
if(!b64decoder[0])
|
|
{
|
|
b64prepare();
|
|
}
|
|
|
|
for(i = 0; i < len; ++i)
|
|
{
|
|
if(result[i] == '=') { break; }
|
|
int8_t tmp = b64decoder[result[i]];
|
|
if(tmp == -1) { continue; }
|
|
bits += tmp;
|
|
++char_count;
|
|
if(char_count == 4)
|
|
{
|
|
result[j++] = bits >> 16;
|
|
result[j++] = (bits >> 8) & 0xff;
|
|
result[j++] = bits & 0xff;
|
|
bits = 0;
|
|
char_count = 0;
|
|
}
|
|
else
|
|
{
|
|
bits <<= 6;
|
|
}
|
|
}
|
|
if(i == len)
|
|
{
|
|
if(char_count)
|
|
{
|
|
result[j] = '\0';
|
|
return 0;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
switch(char_count)
|
|
{
|
|
case 1:
|
|
result[j] = '\0';
|
|
return 0;
|
|
case 2:
|
|
result[j++] = bits >> 10;
|
|
result[j] = '\0';
|
|
break;
|
|
case 3:
|
|
result[j++] = bits >> 16;
|
|
result[j++] = (bits >> 8) & 0xff;
|
|
result[j] = '\0';
|
|
break;
|
|
}
|
|
}
|
|
return j;
|
|
}
|
|
|
|
|
|
#ifdef READ_SDT_CHARSETS
|
|
|
|
// ISO_6937 function taken from VLC
|
|
/*****************************************************************************
|
|
* Local conversion routine from ISO_6937 to UTF-8 charset. Support for this
|
|
* is still missing in libiconv, hence multiple operating systems lack it.
|
|
* The conversion table adds Euro sign (0xA4) as per ETSI EN 300 468 Annex A
|
|
*****************************************************************************/
|
|
|
|
static const uint16_t iso_6937_to_ucs4[128] =
|
|
{
|
|
/* 0x80 */ 0x0080, 0x0081, 0x0082, 0x0083, 0x0084, 0x0085, 0x0086, 0x0087,
|
|
/* 0x88 */ 0x0088, 0x0089, 0x008a, 0x008b, 0x008c, 0x008d, 0x008e, 0x008f,
|
|
/* 0x90 */ 0x0090, 0x0091, 0x0092, 0x0093, 0x0094, 0x0095, 0x0096, 0x0097,
|
|
/* 0x98 */ 0x0098, 0x0099, 0x009a, 0x009b, 0x009c, 0x009d, 0x009e, 0x009f,
|
|
/* 0xa0 */ 0x00a0, 0x00a1, 0x00a2, 0x00a3, 0x20ac, 0x00a5, 0x0000, 0x00a7,
|
|
/* 0xa8 */ 0x00a4, 0x2018, 0x201c, 0x00ab, 0x2190, 0x2191, 0x2192, 0x2193,
|
|
/* 0xb0 */ 0x00b0, 0x00b1, 0x00b2, 0x00b3, 0x00d7, 0x00b5, 0x00b6, 0x00b7,
|
|
/* 0xb8 */ 0x00f7, 0x2019, 0x201d, 0x00bb, 0x00bc, 0x00bd, 0x00be, 0x00bf,
|
|
/* 0xc0 */ 0x0000, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
|
|
/* 0xc8 */ 0xffff, 0x0000, 0xffff, 0xffff, 0x0000, 0xffff, 0xffff, 0xffff,
|
|
/* 0xd0 */ 0x2014, 0x00b9, 0x00ae, 0x00a9, 0x2122, 0x266a, 0x00ac, 0x00a6,
|
|
/* 0xd8 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x215b, 0x215c, 0x215d, 0x215e,
|
|
/* 0xe0 */ 0x2126, 0x00c6, 0x00d0, 0x00aa, 0x0126, 0x0000, 0x0132, 0x013f,
|
|
/* 0xe8 */ 0x0141, 0x00d8, 0x0152, 0x00ba, 0x00de, 0x0166, 0x014a, 0x0149,
|
|
/* 0xf0 */ 0x0138, 0x00e6, 0x0111, 0x00f0, 0x0127, 0x0131, 0x0133, 0x0140,
|
|
/* 0xf8 */ 0x0142, 0x00f8, 0x0153, 0x00df, 0x00fe, 0x0167, 0x014b, 0x00ad
|
|
};
|
|
|
|
/* The outer array range runs from 0xc1 to 0xcf, the inner range from 0x40
|
|
to 0x7f. */
|
|
static const uint16_t iso_6937_to_ucs4_comb[15][64] =
|
|
{
|
|
/* 0xc1 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c0, 0x0000, 0x0000, 0x0000, 0x00c8, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x00cc, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00d2,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00d9, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e0, 0x0000, 0x0000, 0x0000, 0x00e8, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x00ec, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00f2,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00f9, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc2 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c1, 0x0000, 0x0106, 0x0000, 0x00c9, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x00cd, 0x0000, 0x0000, 0x0139, 0x0000, 0x0143, 0x00d3,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0154, 0x015a, 0x0000, 0x00da, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x00dd, 0x0179, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e1, 0x0000, 0x0107, 0x0000, 0x00e9, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x00ed, 0x0000, 0x0000, 0x013a, 0x0000, 0x0144, 0x00f3,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0155, 0x015b, 0x0000, 0x00fa, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x00fd, 0x017a, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc3 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c2, 0x0000, 0x0108, 0x0000, 0x00ca, 0x0000, 0x011c,
|
|
/* 0x48 */ 0x0124, 0x00ce, 0x0134, 0x0000, 0x0000, 0x0000, 0x0000, 0x00d4,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x015c, 0x0000, 0x00db, 0x0000, 0x0174,
|
|
/* 0x58 */ 0x0000, 0x0176, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e2, 0x0000, 0x0109, 0x0000, 0x00ea, 0x0000, 0x011d,
|
|
/* 0x68 */ 0x0125, 0x00ee, 0x0135, 0x0000, 0x0000, 0x0000, 0x0000, 0x00f4,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x015d, 0x0000, 0x00fb, 0x0000, 0x0175,
|
|
/* 0x78 */ 0x0000, 0x0177, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc4 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c3, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x0128, 0x0000, 0x0000, 0x0000, 0x0000, 0x00d1, 0x00d5,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0168, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e3, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x0129, 0x0000, 0x0000, 0x0000, 0x0000, 0x00f1, 0x00f5,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0169, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc5 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0100, 0x0000, 0x0000, 0x0000, 0x0112, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x012a, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x014c,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016a, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0101, 0x0000, 0x0000, 0x0000, 0x0113, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x012b, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x014d,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016b, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc6 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0102, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x011e,
|
|
/* 0x48 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016c, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0103, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x011f,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016d, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc7 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0000, 0x0000, 0x010a, 0x0000, 0x0116, 0x0000, 0x0120,
|
|
/* 0x48 */ 0x0000, 0x0130, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x017b, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0000, 0x0000, 0x010b, 0x0000, 0x0117, 0x0000, 0x0121,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x017c, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc8 */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c4, 0x0000, 0x0000, 0x0000, 0x00cb, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x00cf, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00d6,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00dc, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0178, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e4, 0x0000, 0x0000, 0x0000, 0x00eb, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x00ef, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00f6,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x00fc, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x00ff, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xc9 */
|
|
{
|
|
0x0000,
|
|
},
|
|
/* 0xca */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x00c5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016e, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x00e5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x016f, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xcb */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0000, 0x0000, 0x00c7, 0x0000, 0x0000, 0x0000, 0x0122,
|
|
/* 0x48 */ 0x0000, 0x0000, 0x0000, 0x0136, 0x013b, 0x0000, 0x0145, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0156, 0x015e, 0x0162, 0x0000, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0000, 0x0000, 0x00e7, 0x0000, 0x0000, 0x0000, 0x0123,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0137, 0x013c, 0x0000, 0x0146, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0157, 0x015f, 0x0163, 0x0000, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xcc */
|
|
{
|
|
0x0000,
|
|
},
|
|
/* 0xcd */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0150,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0170, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0151,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0171, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xce */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0104, 0x0000, 0x0000, 0x0000, 0x0118, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x012e, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0172, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0105, 0x0000, 0x0000, 0x0000, 0x0119, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x012f, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0173, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
},
|
|
/* 0xcf */
|
|
{
|
|
/* 0x40 */ 0x0000, 0x0000, 0x0000, 0x010c, 0x010e, 0x011a, 0x0000, 0x0000,
|
|
/* 0x48 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x013d, 0x0000, 0x0147, 0x0000,
|
|
/* 0x50 */ 0x0000, 0x0000, 0x0158, 0x0160, 0x0164, 0x0000, 0x0000, 0x0000,
|
|
/* 0x58 */ 0x0000, 0x0000, 0x017d, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* 0x60 */ 0x0000, 0x0000, 0x0000, 0x010d, 0x010f, 0x011b, 0x0000, 0x0000,
|
|
/* 0x68 */ 0x0000, 0x0000, 0x0000, 0x0000, 0x013e, 0x0000, 0x0148, 0x0000,
|
|
/* 0x70 */ 0x0000, 0x0000, 0x0159, 0x0161, 0x0165, 0x0000, 0x0000, 0x0000,
|
|
/* 0x78 */ 0x0000, 0x0000, 0x017e, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
|
|
}
|
|
};
|
|
|
|
size_t ISO6937toUTF8(const uint8_t **inbuf, size_t *inbytesleft, uint8_t **outbuf, size_t *outbytesleft)
|
|
{
|
|
if(!inbuf || !(*inbuf))
|
|
{
|
|
return (size_t)(0); /* Reset state requested */
|
|
}
|
|
|
|
const uint8_t *iptr = *inbuf;
|
|
const uint8_t *iend = iptr + *inbytesleft;
|
|
uint8_t *optr = *outbuf;
|
|
uint8_t *oend = optr + *outbytesleft;
|
|
uint16_t ch;
|
|
int err = 0;
|
|
|
|
while (iptr < iend)
|
|
{
|
|
if(*iptr < 0x80)
|
|
{
|
|
if(optr >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf */
|
|
}
|
|
*optr++ = *iptr++;
|
|
continue;
|
|
}
|
|
|
|
if (optr + 2 >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for multibyte char */
|
|
}
|
|
ch = iso_6937_to_ucs4[*iptr - 0x80];
|
|
|
|
if(ch == 0xffff)
|
|
{
|
|
/* Composed character */
|
|
if (iptr + 1 >= iend)
|
|
{
|
|
err = EINVAL;
|
|
break; /* No next character */
|
|
}
|
|
if (iptr[1] < 0x40 || iptr[1] >= 0x80 || !(ch = iso_6937_to_ucs4_comb[iptr[0] - 0xc1][iptr[1] - 0x40]))
|
|
{
|
|
err = EILSEQ;
|
|
break; /* Illegal combination */
|
|
}
|
|
iptr += 2;
|
|
}
|
|
else
|
|
{
|
|
if (!ch)
|
|
{
|
|
err = EILSEQ;
|
|
break;
|
|
}
|
|
iptr++;
|
|
}
|
|
|
|
if (ch < 0x800)
|
|
{
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xc0 | (ch >> 6);
|
|
optr +=2;
|
|
}
|
|
else
|
|
{
|
|
optr[2] = 0x80 | (ch & 0x3f);
|
|
ch >>= 6;
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xe0 | (ch >> 6);
|
|
optr += 3;
|
|
}
|
|
|
|
}
|
|
*inbuf = iptr;
|
|
*outbuf = optr;
|
|
*inbytesleft = iend - iptr;
|
|
*outbytesleft = oend - optr;
|
|
if(err)
|
|
{
|
|
errno = err;
|
|
return (size_t)(-1);
|
|
}
|
|
return (size_t)(0);
|
|
}
|
|
|
|
#include "oscam-string-isotables.h"
|
|
|
|
static const uint16_t *get_iso8859_table(int8_t iso_table_number)
|
|
{
|
|
if(iso_table_number > 1 && iso_table_number < 17 && iso_table_number != 12)
|
|
{
|
|
if(iso_table_number < 12)
|
|
{
|
|
return iso_8859_to_unicode[iso_table_number - 2];
|
|
}
|
|
else
|
|
{
|
|
return iso_8859_to_unicode[iso_table_number - 3];
|
|
}
|
|
}
|
|
else
|
|
{
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
size_t ISO8859toUTF8(int8_t iso_table_number, const uint8_t **inbuf, size_t *inbytesleft, uint8_t **outbuf, size_t *outbytesleft)
|
|
{
|
|
if(!inbuf || !(*inbuf))
|
|
{
|
|
return (size_t)(0); /* Reset state requested */
|
|
}
|
|
|
|
const uint8_t *iptr = *inbuf;
|
|
const uint8_t *iend = iptr + *inbytesleft;
|
|
uint8_t *optr = *outbuf;
|
|
uint8_t *oend = optr + *outbytesleft;
|
|
uint16_t ch;
|
|
int err = 0;
|
|
const uint16_t *iso_table = NULL;
|
|
|
|
if( iso_table_number != 1 )
|
|
{
|
|
iso_table = get_iso8859_table(iso_table_number);
|
|
if ( iso_table == NULL )
|
|
{
|
|
errno = EINVAL;
|
|
return (size_t)(-1);
|
|
}
|
|
}
|
|
|
|
while (iptr < iend)
|
|
{
|
|
if(*iptr < 0x80)
|
|
{
|
|
if(optr >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf */
|
|
}
|
|
*optr++ = *iptr++;
|
|
continue;
|
|
}
|
|
|
|
if( iso_table_number == 1 || *iptr < 0xA1 )
|
|
{
|
|
ch = *iptr;
|
|
}
|
|
else
|
|
{
|
|
ch = iso_table[*iptr - 0xA1];
|
|
}
|
|
iptr++;
|
|
|
|
if (ch < 0x80)
|
|
{
|
|
if (optr >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for char */
|
|
}
|
|
optr[0] = ch & 0xff;
|
|
optr += 1;
|
|
}
|
|
else if (ch < 0x800)
|
|
{
|
|
if (optr + 1 >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for multibyte char */
|
|
}
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xc0 | (ch >> 6);
|
|
optr += 2;
|
|
}
|
|
else
|
|
{
|
|
if (optr + 2 >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for multibyte char */
|
|
}
|
|
optr[2] = 0x80 | (ch & 0x3f);
|
|
ch >>= 6;
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xe0 | (ch >> 6);
|
|
optr += 3;
|
|
}
|
|
}
|
|
*inbuf = iptr;
|
|
*outbuf = optr;
|
|
*inbytesleft = iend - iptr;
|
|
*outbytesleft = oend - optr;
|
|
|
|
if(err)
|
|
{
|
|
errno = err;
|
|
return (size_t)(-1);
|
|
}
|
|
return (size_t)(0);
|
|
}
|
|
|
|
#endif
|
|
|
|
size_t UnicodetoUTF8(const uint8_t **inbuf, size_t *inbytesleft, uint8_t **outbuf, size_t *outbytesleft)
|
|
{
|
|
if(!inbuf || !(*inbuf))
|
|
{
|
|
return (size_t)(0); /* Reset state requested */
|
|
}
|
|
|
|
const uint8_t *iptr = *inbuf;
|
|
const uint8_t *iend = iptr + *inbytesleft;
|
|
uint8_t*optr = *outbuf;
|
|
uint8_t *oend = optr + *outbytesleft;
|
|
uint16_t ch;
|
|
int err = 0;
|
|
|
|
while (iptr + 1 < iend)
|
|
{
|
|
ch = (iptr[0] << 8) | iptr[1];
|
|
iptr += 2;
|
|
|
|
if (ch < 0x80)
|
|
{
|
|
if (optr >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for char */
|
|
}
|
|
optr[0] = ch & 0xff;
|
|
optr += 1;
|
|
}
|
|
else if (ch < 0x800)
|
|
{
|
|
if (optr + 1 >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for multibyte char */
|
|
}
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xc0 | (ch >> 6);
|
|
optr += 2;
|
|
}
|
|
else
|
|
{
|
|
if (optr + 2 >= oend)
|
|
{
|
|
err = E2BIG;
|
|
break; /* No space in outbuf for multibyte char */
|
|
}
|
|
optr[2] = 0x80 | (ch & 0x3f);
|
|
ch >>= 6;
|
|
optr[1] = 0x80 | (ch & 0x3f);
|
|
optr[0] = 0xe0 | (ch >> 6);
|
|
optr += 3;
|
|
}
|
|
}
|
|
|
|
*inbuf = iptr;
|
|
*outbuf = optr;
|
|
*inbytesleft = iend - iptr;
|
|
*outbytesleft = oend - optr;
|
|
|
|
if(err)
|
|
{
|
|
errno = err;
|
|
return (size_t)(-1);
|
|
}
|
|
return (size_t)(0);
|
|
}
|