libisofs-legacy/libisofs/util.c

907 lines
19 KiB
C
Raw Normal View History

2006-08-15 20:37:04 +00:00
/* -*- indent-tabs-mode: t; tab-width: 8; c-basic-offset: 8; -*- */
2006-08-24 19:23:37 +00:00
/* vim: set noet ts=8 sts=8 sw=8 : */
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
/**
* Utility functions for the Libisofs library.
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
2006-08-24 19:23:37 +00:00
#include <wchar.h>
2006-08-15 20:37:04 +00:00
#include <iconv.h>
#include <stdlib.h>
2006-08-24 19:23:37 +00:00
#include <stdio.h>
2006-08-15 20:37:04 +00:00
#include <string.h>
#include <ctype.h>
#include <assert.h>
2006-08-24 19:23:37 +00:00
#include <errno.h>
#include <langinfo.h>
#include <locale.h>
#include <limits.h>
2006-08-15 20:37:04 +00:00
#include "util.h"
#include "libisofs.h"
2006-08-15 20:37:04 +00:00
2006-09-19 17:06:40 +00:00
/* avoids warning and names in iso, joliet and rockridge can't be > 255 bytes
* anyway. There are at most 31 characters in iso level 1, 255 for rockridge,
* 64 characters (* 2 since UCS) for joliet. */
#define NAME_BUFFER_SIZE 255
2006-08-24 19:23:37 +00:00
int div_up(int n, int div)
2006-08-15 20:37:04 +00:00
{
2006-08-24 19:23:37 +00:00
return (n + div - 1) / div;
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
int round_up(int n, int mul)
2006-08-15 20:37:04 +00:00
{
2006-08-24 19:23:37 +00:00
return div_up(n, mul) * mul;
2006-08-15 20:37:04 +00:00
}
/**
* Convert a string between charsets.
* This assumes '\0' means end-of-string, what is not necessarily true,
* but given there are lots of strdup around there, it will fail in other
* places anyway...
*/
char *
convert_str(const char *str, const char *icharset, const char *ocharset)
{
char *ret;
size_t inbytes;
size_t outbytes;
inbytes = strlen(str);
outbytes = (inbytes+1) * MB_LEN_MAX;
{
/* ensure enought space */
char out[outbytes];
char *src;
size_t n;
iconv_t conv = iconv_open(ocharset, icharset);
if (conv == (iconv_t)(-1)) {
printf("Can't convert from %s to %s\n", icharset, ocharset);
return NULL;
}
src = (char *)str;
ret = (char *)out;
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
if (n == -1) {
/* error just return input stream */
perror("Convert error.");
printf("Maybe string %s is not encoded in %s\n", str, icharset);
iconv_close(conv);
return strdup(str);
}
iconv_close(conv);
*ret = '\0';
ret = strdup(out);
}
return ret;
}
/**
* Convert a str in a specified codeset to WCHAR_T.
* The result must be free() when no more needed
*/
static wchar_t *str2wchar(const char *str, const char *codeset)
{
iconv_t conv;
size_t inbytes;
size_t outbytes;
char *ret;
char *src;
wchar_t *wstr;
size_t n;
conv = iconv_open("WCHAR_T", codeset);
if (conv == (iconv_t)-1) {
perror("Invalid encodings\n");
return NULL;
}
inbytes = strlen(str);
outbytes = (inbytes + 1) * sizeof(wchar_t);
/* we are sure that numchars <= inbytes */
wstr = malloc(outbytes);
ret = (char *)wstr;
src = (char *)str;
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
while (n == -1) {
if( errno != EINVAL ) {
/* error, should never occur */
iconv_close(conv);
perror("Convert error\n");
return NULL;
}
/* invalid input string charset, just log and ignore */
printf("String %s is not encoded in %s\n", str, codeset);
inbytes--;
if(!inbytes)
break;
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
}
iconv_close(conv);
*( (wchar_t *)ret )='\0';
return wstr;
}
2006-09-19 17:06:40 +00:00
/* this function must always return a name
* since the caller never checks if a NULL
* is returned. It also avoids some warnings. */
char *str2ascii(const char *src_arg, const char *icharset)
2006-08-15 20:37:04 +00:00
{
wchar_t *wsrc_;
2006-09-19 17:06:40 +00:00
char *ret;
char *ret_;
char *src;
2006-09-19 17:06:40 +00:00
iconv_t conv;
size_t numchars;
size_t outbytes;
size_t inbytes;
2006-08-24 19:23:37 +00:00
size_t n;
assert(icharset);
2006-09-19 17:06:40 +00:00
if (!src_arg)
2006-08-24 19:23:37 +00:00
return NULL;
2006-08-15 20:37:04 +00:00
2006-09-19 17:06:40 +00:00
/* convert the string to a wide character string. Note: outbytes
* is in fact the number of characters in the string and doesn't
* include the last NULL character.
*
* For now, just assume input to be in UTF-8, we can change
* this later.
*/
wsrc_ = str2wchar(src_arg, icharset);
if (!wsrc_)
2006-08-24 19:23:37 +00:00
return NULL;
src = (char *)wsrc_;
numchars = wcslen(wsrc_);
2006-08-24 19:23:37 +00:00
2006-09-19 17:06:40 +00:00
inbytes = numchars * sizeof(wchar_t);
ret_ = malloc(numchars+1);
outbytes = numchars;
ret = ret_;
2006-08-24 19:23:37 +00:00
2006-09-19 17:06:40 +00:00
/* initialize iconv */
conv = iconv_open("ASCII", "WCHAR_T");
if (conv == (iconv_t)-1) {
free(wsrc_);
2006-08-24 19:23:37 +00:00
return NULL;
}
2006-08-24 19:23:37 +00:00
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
2006-09-19 17:06:40 +00:00
while(n == -1) {
/* The destination buffer is too small. Stops here. */
if(errno == E2BIG)
break;
/* An incomplete multi bytes sequence was found. We
* can't do anything here. That's quite unlikely. */
if(errno == EINVAL)
break;
/* The last possible error is an invalid multi bytes
* sequence. Just replace the character with a "_".
* Probably the character doesn't exist in ascii like
* "é, è, à, ç, ..." in French. */
*ret++ = '_';
outbytes--;
if(!outbytes)
break;
/* There was an error with one character but some other remain
* to be converted. That's probably a multibyte character.
* See above comment. */
src += sizeof(wchar_t);
inbytes -= sizeof(wchar_t);
if(!inbytes)
break;
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
2006-08-24 19:23:37 +00:00
}
2006-09-19 17:06:40 +00:00
iconv_close(conv);
*ret='\0';
free(wsrc_);
2006-08-24 19:23:37 +00:00
return ret_;
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
/* FIXME: C&P */
uint16_t *str2ucs(const char *src_arg, const char *icharset)
2006-08-15 20:37:04 +00:00
{
wchar_t *wsrc_;
char *src;
2006-09-19 17:06:40 +00:00
char *ret_;
char *ret;
iconv_t conv;
size_t outbytes;
size_t numchars;
size_t inbytes;
size_t n;
if (!src_arg)
2006-08-24 19:23:37 +00:00
return calloc(2, 1); /* empty UCS string */
2006-08-15 20:37:04 +00:00
2006-09-19 17:06:40 +00:00
/* convert the string to a wide character string. Note: outbytes
* is in fact the number of characters in the string and doesn't
* include the last NULL character.
*/
wsrc_ = str2wchar(src_arg, icharset);
if (!wsrc_)
2006-09-19 17:06:40 +00:00
return calloc(2, 1); /* empty UCS string */
src = (char*)wsrc_;
numchars = wcslen(wsrc_);
2006-08-15 20:37:04 +00:00
2006-09-19 17:06:40 +00:00
inbytes = numchars * sizeof(wchar_t);
outbytes = numchars * sizeof(uint16_t);
ret_ = malloc ((numchars+1) * sizeof(uint16_t));
ret = ret_;
2006-08-15 20:37:04 +00:00
2006-09-19 17:06:40 +00:00
/* initialize iconv */
conv = iconv_open("UCS-2BE", "WCHAR_T");
if (conv == (iconv_t)-1)
return calloc(2, 1); /* empty UCS string */
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
2006-09-19 17:06:40 +00:00
while(n == -1) {
/* The destination buffer is too small. Stops here. */
if(errno == E2BIG)
break;
/* An incomplete multi bytes sequence was found. We
* can't do anything here. That's quite unlikely. */
if(errno == EINVAL)
break;
/* The last possible error is an invalid multi bytes
* sequence. Just replace the character with a "_".
* Probably the character doesn't exist in ascii like
* "é, è, à, ç, ..." in French. */
*((uint16_t*) ret) = '_';
ret += sizeof(uint16_t);
outbytes -= sizeof(uint16_t);
if(!outbytes)
break;
/* There was an error with one character but some other remain
* to be converted. That's probably a multibyte character.
* See above comment. */
src += sizeof(wchar_t);
inbytes -= sizeof(wchar_t);
if(!inbytes)
break;
n = iconv(conv, &src, &inbytes, &ret, &outbytes);
2006-08-24 19:23:37 +00:00
}
2006-09-19 17:06:40 +00:00
iconv_close(conv);
/* close the ucs string */
*((uint16_t*) ret) = 0;
2006-08-24 19:23:37 +00:00
return (uint16_t*)ret_;
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
static int valid_d_char(char c)
2006-08-15 20:37:04 +00:00
{
2006-08-24 19:23:37 +00:00
return (c >= '0' && c <= '9') || (c >= 'A' && c <= 'Z') || (c == '_');
}
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
static int valid_a_char(char c)
{
return (c >= ' ' && c <= '"') || (c >= '%' && c <= '?')
|| (c >= 'A' && c <= 'Z')
|| (c == '_');
}
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
static int valid_j_char(uint16_t c)
{
return !(c < (uint16_t)' ' || c == (uint16_t)'*' || c == (uint16_t)'/'
|| c == (uint16_t)':' || c == (uint16_t)';'
|| c == (uint16_t)'?' || c == (uint16_t)'\\');
}
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
/* FIXME: where are these documented? */
static int valid_p_char(char c)
{
return (c >= '0' && c <= '9') || (c >= 'A' && c <= 'Z')
|| (c >= 'a' && c <= 'z')
|| (c == '.') || (c == '_') || (c == '-');
2006-08-15 20:37:04 +00:00
}
char *str2d_char(const char *str, const char *icharset) {
2007-05-15 10:35:42 +00:00
char *ret;
size_t len, i;
if (!str)
return NULL;
ret = str2ascii(str, icharset);
2007-05-15 10:35:42 +00:00
len = strlen(ret);
for (i = 0; i < len; ++i) {
char c = toupper(ret[i]);
ret[i] = valid_d_char(c) ? c : '_';
}
return ret;
}
char *str2a_char(const char *str, const char *icharset) {
2007-05-15 10:35:42 +00:00
char *ret;
size_t len, i;
if (!str)
return NULL;
ret = str2ascii(str, icharset);
2007-05-15 10:35:42 +00:00
len = strlen(ret);
for (i = 0; i < len; ++i) {
char c = toupper(ret[i]);
ret[i] = valid_a_char(c) ? c : '_';
}
return ret;
}
static char *iso_dirid(const char *src, int size, const char *icharset)
2006-08-15 20:37:04 +00:00
{
char *ret = str2ascii(src, icharset);
2006-08-24 19:23:37 +00:00
size_t len, i;
if (!ret)
2006-08-15 20:37:04 +00:00
return NULL;
2006-08-24 19:23:37 +00:00
len = strlen(ret);
if (len > size) {
ret[size] = '\0';
len = size;
}
for (i = 0; i < len; i++) {
char c = toupper(ret[i]);
ret[i] = valid_d_char(c) ? c : '_';
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
return ret;
2006-08-15 20:37:04 +00:00
}
char *iso_1_dirid(const char *src, const char *icharset)
2006-08-15 20:37:04 +00:00
{
return iso_dirid(src, 8, icharset);
2006-08-24 19:23:37 +00:00
}
char *iso_2_dirid(const char *src, const char *icharset)
2006-08-24 19:23:37 +00:00
{
return iso_dirid(src, 31, icharset);
2006-08-24 19:23:37 +00:00
}
char *iso_r_dirid(const char *src, const char *icharset, int flags)
{
char *ret = str2ascii(src, icharset);
size_t size, len, i;
if (!ret)
return NULL;
size = flags & ECMA119_37_CHAR_FILENAMES ? 37 : 31;
len = strlen(ret);
if (len > size) {
ret[size] = '\0';
len = size;
}
if (flags & ECMA119_RELAXED_FILENAMES)
return ret;
for (i = 0; i < len; i++) {
char c = toupper(ret[i]);
ret[i] = valid_d_char(c) ? c : '_';
}
return ret;
}
char *iso_1_fileid(const char *src_arg, const char *icharset)
2006-08-24 19:23:37 +00:00
{
char *src = str2ascii(src_arg, icharset);
2006-08-24 19:23:37 +00:00
char *dest;
char *dot; /* Position of the last dot in the
2006-08-15 20:37:04 +00:00
filename, will be used to calculate
lname and lext. */
int lname, lext, pos, i;
2006-08-24 19:23:37 +00:00
if (!src)
return NULL;
dest = malloc(15); /* 15 = 8 (name) + 1 (.) + 3 (ext) + 2
(;1) + 1 (\0) */
dot = strrchr(src, '.');
2006-08-15 20:37:04 +00:00
lext = dot ? strlen(dot + 1) : 0;
lname = strlen(src) - lext - (dot ? 1 : 0);
/* If we can't build a filename, return NULL. */
if (lname == 0 && lext == 0) {
2006-08-24 19:23:37 +00:00
free(src);
2006-08-15 20:37:04 +00:00
free(dest);
return NULL;
}
pos = 0;
/* Convert up to 8 characters of the filename. */
for (i = 0; i < lname && i < 8; i++) {
char c = toupper(src[i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
/* This dot is mandatory, even if there is no extension. */
dest[pos++] = '.';
/* Convert up to 3 characters of the extension, if any. */
for (i = 0; i < lext && i < 3; i++) {
char c = toupper(src[lname + 1 + i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
/* File versions are mandatory, even if they aren't used. */
dest[pos++] = ';';
dest[pos++] = '1';
dest[pos] = '\0';
dest = (char *)realloc(dest, pos + 1);
2006-08-24 19:23:37 +00:00
free(src);
2006-08-15 20:37:04 +00:00
return dest;
}
char *iso_2_fileid(const char *src_arg, const char *icharset)
2006-08-15 20:37:04 +00:00
{
char *src = str2ascii(src_arg, icharset);
2006-08-24 19:23:37 +00:00
char *dest;
char *dot;
2006-08-15 20:37:04 +00:00
int lname, lext, lnname, lnext, pos, i;
2006-08-24 19:23:37 +00:00
if (!src)
return NULL;
dest = malloc(34); /* 34 = 30 (name + ext) + 1 (.) + 2
(;1) + 1 (\0) */
dot = strrchr(src, '.');
2006-08-15 20:37:04 +00:00
/* Since the maximum length can be divided freely over the name and
extension, we need to calculate their new lengths (lnname and
lnext). If the original filename is too long, we start by trimming
the extension, but keep a minimum extension length of 3. */
if (dot == NULL || *(dot + 1) == '\0') {
2006-08-15 20:37:04 +00:00
lname = strlen(src);
lnname = (lname > 30) ? 30 : lname;
lext = lnext = 0;
} else {
lext = strlen(dot + 1);
lname = strlen(src) - lext - 1;
2006-08-24 19:23:37 +00:00
lnext = (strlen(src) > 31 && lext > 3)
? (lname < 27 ? 30 - lname : 3) : lext;
2006-08-15 20:37:04 +00:00
lnname = (strlen(src) > 31) ? 30 - lnext : lname;
}
if (lnname == 0 && lnext == 0) {
2006-08-24 19:23:37 +00:00
free(src);
2006-08-15 20:37:04 +00:00
free(dest);
return NULL;
}
pos = 0;
/* Convert up to lnname characters of the filename. */
for (i = 0; i < lnname; i++) {
char c = toupper(src[i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
dest[pos++] = '.';
/* Convert up to lnext characters of the extension, if any. */
for (i = 0; i < lnext; i++) {
char c = toupper(src[lname + 1 + i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
dest[pos++] = ';';
dest[pos++] = '1';
dest[pos] = '\0';
dest = (char *)realloc(dest, pos + 1);
2006-08-24 19:23:37 +00:00
free(src);
return dest;
}
char *
iso_r_fileid(const char *src_arg, const char *icharset, int flag)
{
char *src = str2ascii(src_arg, icharset);
char *dest;
char *dot;
int lname, lext, lnname, lnext, pos, i;
size_t max;
size_t size = flag & (1<<1) ? 37 : 33;
if (!src)
return NULL;
dest = malloc(size+1);
if (flag & ECMA119_RELAXED_FILENAMES) {
strncpy(dest, src, size);
dest[size] = '\0'; /* ensure 37 / 33 max length */
pos = strlen(dest);
pos = pos < (size == 37 ? 37 : 31) ? pos : (size == 37 ? 37 : 31);
if ( !(flag & ECMA119_OMIT_VERSION_NUMBERS) ) {
dest[pos++] = ';';
dest[pos++] = '1';
}
dest[pos] = '\0';
return dest;
}
/* no relaxed filenames */
dot = strrchr(src, '.');
max = (size == 37 ? 36 : 30);
/* Since the maximum length can be divided freely over the name and
extension, we need to calculate their new lengths (lnname and
lnext). If the original filename is too long, we start by trimming
the extension, but keep a minimum extension length of 3. */
if (dot == NULL || *(dot + 1) == '\0') {
lname = strlen(src);
lnname = (lname > max) ? max : lname;
lext = lnext = 0;
} else {
lext = strlen(dot + 1);
lname = strlen(src) - lext - 1;
lnext = (strlen(src) > max + 1 && lext > 3)
? (lname < max - 3 ? max - lname : 3) : lext;
lnname = (strlen(src) > max +1) ? max - lnext : lname;
}
if (lnname == 0 && lnext == 0) {
free(src);
free(dest);
return NULL;
}
pos = 0;
/* Convert up to lnname characters of the filename. */
for (i = 0; i < lnname; i++) {
char c = toupper(src[i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
dest[pos++] = '.';
/* Convert up to lnext characters of the extension, if any. */
for (i = 0; i < lnext; i++) {
char c = toupper(src[lname + 1 + i]);
dest[pos++] = valid_d_char(c) ? c : '_';
}
if ( !(flag & ECMA119_OMIT_VERSION_NUMBERS) ) {
dest[pos++] = ';';
dest[pos++] = '1';
}
dest[pos] = '\0';
dest = (char *)realloc(dest, pos + 1);
free(src);
2006-08-15 20:37:04 +00:00
return dest;
}
2006-08-24 19:23:37 +00:00
char *
iso_p_fileid(const char *src, const char *icharset)
2006-08-15 20:37:04 +00:00
{
char *ret = str2ascii(src, icharset);
2006-08-24 19:23:37 +00:00
size_t i, len;
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
if (!ret)
2006-08-15 20:37:04 +00:00
return NULL;
2006-08-24 19:23:37 +00:00
len = strlen(ret);
for (i = 0; i < len; i++) {
if (!valid_p_char(ret[i])) {
ret[i] = (uint16_t)'_';
2006-08-15 20:37:04 +00:00
}
}
2006-08-24 19:23:37 +00:00
return ret;
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
uint16_t *
iso_j_id(const char *src_arg, const char *icharset)
2006-08-15 20:37:04 +00:00
{
uint16_t *j_str = str2ucs(src_arg, icharset);
2006-08-24 19:23:37 +00:00
size_t len = ucslen(j_str);
size_t n;
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
if (len > 128) {
j_str[128] = '\0';
len = 128;
2006-08-15 20:37:04 +00:00
}
2006-08-24 19:23:37 +00:00
for (n = 0; n < len; n++)
if (!valid_j_char(j_str[n]))
j_str[n] = '_';
return j_str;
2006-08-15 20:37:04 +00:00
}
void iso_lsb(uint8_t *buf, uint32_t num, int bytes)
{
int i;
assert(bytes <= 4);
for (i = 0; i < bytes; ++i)
buf[i] = (num >> (8 * i)) & 0xff;
}
void iso_msb(uint8_t *buf, uint32_t num, int bytes)
{
int i;
assert(bytes <= 4);
for (i = 0; i < bytes; ++i)
buf[bytes - 1 - i] = (num >> (8 * i)) & 0xff;
}
void iso_bb(uint8_t *buf, uint32_t num, int bytes)
{
iso_lsb(buf, num, bytes);
iso_msb(buf+bytes, num, bytes);
}
void iso_datetime_7(unsigned char *buf, time_t t)
{
static int tzsetup = 0;
int tzoffset;
2006-08-15 20:37:04 +00:00
struct tm tm;
if (!tzsetup) {
tzset();
tzsetup = 1;
}
localtime_r(&t, &tm);
buf[0] = tm.tm_year;
buf[1] = tm.tm_mon + 1;
buf[2] = tm.tm_mday;
buf[3] = tm.tm_hour;
buf[4] = tm.tm_min;
buf[5] = tm.tm_sec;
#ifdef HAVE_TM_GMTOFF
tzoffset = tm.tm_gmtoff / 60 / 15;
#else
tzoffset = timezone / 60 / 15;
#endif
if (tzoffset > 52)
tzoffset -= 101;
2006-08-15 20:37:04 +00:00
buf[6] = tzoffset;
}
time_t iso_datetime_read_7(const uint8_t *buf)
{
struct tm tm;
tm.tm_year = buf[0];
tm.tm_mon = buf[1] - 1;
2006-08-15 20:37:04 +00:00
tm.tm_mday = buf[2];
tm.tm_hour = buf[3];
tm.tm_min = buf[4];
tm.tm_sec = buf[5];
return timegm(&tm) - buf[6] * 60 * 15;
2006-08-15 20:37:04 +00:00
}
void iso_datetime_17(unsigned char *buf, time_t t)
{
static int tzsetup = 0;
static int tzoffset;
struct tm tm;
if (t == (time_t) - 1) {
/* unspecified time */
memset(buf, '0', 16);
buf[16] = 0;
} else {
if (!tzsetup) {
tzset();
tzsetup = 1;
}
localtime_r(&t, &tm);
2006-08-24 19:23:37 +00:00
sprintf((char*)&buf[0], "%04d", tm.tm_year + 1900);
sprintf((char*)&buf[4], "%02d", tm.tm_mon + 1);
sprintf((char*)&buf[6], "%02d", tm.tm_mday);
sprintf((char*)&buf[8], "%02d", tm.tm_hour);
sprintf((char*)&buf[10], "%02d", tm.tm_min);
sprintf((char*)&buf[12], "%02d", MIN(59, tm.tm_sec));
2006-08-15 20:37:04 +00:00
memcpy(&buf[14], "00", 2);
#ifdef HAVE_TM_GMTOFF
tzoffset = tm.tm_gmtoff / 60 / 15;
#else
tzoffset = timezone / 60 / 15;
#endif
if (tzoffset > 52)
tzoffset -= 101;
2006-08-15 20:37:04 +00:00
buf[16] = tzoffset;
}
}
time_t iso_datetime_read_17(const uint8_t *buf)
{
struct tm tm;
sscanf((char*)&buf[0], "%4d", &tm.tm_year);
sscanf((char*)&buf[4], "%2d", &tm.tm_mon);
sscanf((char*)&buf[6], "%2d", &tm.tm_mday);
sscanf((char*)&buf[8], "%2d", &tm.tm_hour);
sscanf((char*)&buf[10], "%2d", &tm.tm_min);
sscanf((char*)&buf[12], "%2d", &tm.tm_sec);
tm.tm_year -= 1900;
tm.tm_mon -= 1;
return timegm(&tm) - buf[16] * 60 * 15;
2006-08-15 20:37:04 +00:00
}
size_t ucslen(const uint16_t *str)
{
int i;
for (i=0; str[i]; i++)
;
return i;
}
2006-08-24 19:23:37 +00:00
/**
* Although each character is 2 bytes, we actually compare byte-by-byte
* (thats what the spec says).
*/
2006-08-15 20:37:04 +00:00
int ucscmp(const uint16_t *s1, const uint16_t *s2)
{
2006-08-24 19:23:37 +00:00
const char *s = (const char*)s1;
const char *t = (const char*)s2;
size_t len1 = ucslen(s1);
size_t len2 = ucslen(s2);
size_t i, len = MIN(len1, len2) * 2;
2006-08-15 20:37:04 +00:00
2006-08-24 19:23:37 +00:00
for (i=0; i < len; i++) {
if (s[i] < t[i]) {
2006-08-15 20:37:04 +00:00
return -1;
2006-08-24 19:23:37 +00:00
} else if (s[i] > t[i]) {
2006-08-15 20:37:04 +00:00
return 1;
}
}
2006-08-24 19:23:37 +00:00
if (len1 < len2)
return -1;
else if (len1 > len2)
return 1;
2006-08-15 20:37:04 +00:00
return 0;
}
uint32_t iso_read_lsb(const uint8_t *buf, int bytes)
{
int i;
uint32_t ret = 0;
for (i=0; i<bytes; i++) {
ret += ((uint32_t) buf[i]) << (i*8);
}
return ret;
}
uint32_t iso_read_msb(const uint8_t *buf, int bytes)
{
int i;
uint32_t ret = 0;
for (i=0; i<bytes; i++) {
ret += ((uint32_t) buf[bytes-i-1]) << (i*8);
}
return ret;
}
uint32_t iso_read_bb(const uint8_t *buf, int bytes, int *error)
2006-08-15 20:37:04 +00:00
{
uint32_t v1 = iso_read_lsb(buf, bytes);
if (error) {
uint32_t v2 = iso_read_msb(buf+bytes, bytes);
if (v1 != v2)
*error = 1;
}
2006-08-15 20:37:04 +00:00
return v1;
}
char *strcopy(const char *buf, size_t len)
{
char *str;
str = malloc( (len+1) * sizeof(char) );
strncpy(str, buf, len);
str[len] = '\0';
/* remove trailing spaces */
for (len = len-1; str[len] == ' ' && len > 0; --len)
str[len] = '\0';
return str;
}
char *ucs2str(const char *buf, size_t len)
{
size_t outbytes, inbytes;
char *str;
inbytes = len;
outbytes = (inbytes+1) * MB_LEN_MAX;
{
/* ensure enought space */
char out[outbytes];
char *src;
iconv_t conv;
size_t n;
/* convert to local charset */
setlocale(LC_CTYPE, "");
conv = iconv_open(nl_langinfo(CODESET), "UCS-2BE");
if (conv == (iconv_t)(-1)) {
printf("Can't convert from %s to %s\n", "UCS-2BE", nl_langinfo(CODESET));
return NULL;
}
src = (char *)buf;
str = (char *)out;
n = iconv(conv, &src, &inbytes, &str, &outbytes);
if (n == -1) {
/* error just return input stream */
perror("Convert error.");
printf("Maybe string is not encoded in UCS-2BE.\n");
iconv_close(conv);
return NULL;
}
iconv_close(conv);
*str = '\0';
/* remove trailing spaces */
for (len = strlen(out) - 1; out[len] == ' ' && len > 0; --len)
out[len] = '\0';
str = strdup(out);
}
return str;
}