version 1.1.2.5, 2011/09/07 01:26:08
|
version 1.5.2.2, 2012/03/29 12:23:00
|
Line 12 terms:
|
Line 12 terms:
|
All of the documentation and software included in the ELWIX and AITNET |
All of the documentation and software included in the ELWIX and AITNET |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
|
|
Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 | Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012 |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
|
|
Redistribution and use in source and binary forms, with or without |
Redistribution and use in source and binary forms, with or without |
Line 47 SUCH DAMAGE.
|
Line 47 SUCH DAMAGE.
|
|
|
|
|
/* |
/* |
* io_vals2buffer() Marshaling data from array with variables to buffer | * io_vars2buffer() Marshaling data from array with variables to buffer |
| * |
* @buf = Buffer |
* @buf = Buffer |
* @buflen = Size of buffer |
* @buflen = Size of buffer |
* @vars = Variable array |
* @vars = Variable array |
* return: -1 error, 0 nothing done or >0 size of marshaled data |
* return: -1 error, 0 nothing done or >0 size of marshaled data |
*/ |
*/ |
int |
int |
io_vals2buffer(u_char *buf, int buflen, array_t *vars) | io_vars2buffer(u_char *buf, int buflen, array_t *vars) |
{ |
{ |
int Limit = 0; |
int Limit = 0; |
register int i; |
register int i; |
ait_val_t *v, *val; |
ait_val_t *v, *val; |
u_char *data; | u_char *dat; |
|
|
assert(buf); |
assert(buf); |
assert(vars); |
assert(vars); |
Line 77 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 78 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
memset(buf, 0, buflen); |
memset(buf, 0, buflen); |
|
|
v = (ait_val_t*) buf; |
v = (ait_val_t*) buf; |
data = buf + Limit; | dat = buf + Limit; |
} |
} |
|
|
/* marshaling */ |
/* marshaling */ |
Line 85 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 86 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
val = io_array(vars, i, ait_val_t*); |
val = io_array(vars, i, ait_val_t*); |
|
|
v[i].val_type = val->val_type; |
v[i].val_type = val->val_type; |
|
AIT_KEY(&v[i]) = htobe16(AIT_KEY(val)); |
AIT_LEN(&v[i]) = htobe32(AIT_LEN(val)); |
AIT_LEN(&v[i]) = htobe32(AIT_LEN(val)); |
|
|
switch (AIT_TYPE(val)) { |
switch (AIT_TYPE(val)) { |
Line 101 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 103 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
case u64: |
case u64: |
v[i].val.net = htobe64(val->val.net); |
v[i].val.net = htobe64(val->val.net); |
break; |
break; |
|
case data: |
|
if (AIT_LEN(val) > buflen - Limit) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d " |
|
"needed min %d ...\n", buflen, Limit + AIT_LEN(val)); |
|
return -1; |
|
} else |
|
Limit += AIT_LEN(val); |
|
|
|
memcpy(dat, val->val_data, AIT_LEN(val)); |
|
/* Debug:: data offset in packet, not matter for anything! */ |
|
v[i].val.net = dat - buf; |
|
dat += AIT_LEN(val); |
|
break; |
case buffer: |
case buffer: |
case string: |
case string: |
if (AIT_LEN(val) > buflen - Limit) { |
if (AIT_LEN(val) > buflen - Limit) { |
Line 110 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 125 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
} else |
} else |
Limit += AIT_LEN(val); |
Limit += AIT_LEN(val); |
|
|
memcpy(data, val->val.buffer, AIT_LEN(val)); | memcpy(dat, val->val.buffer, AIT_LEN(val)); |
/* Debug:: data offset in packet, not matter for anything! */ |
/* Debug:: data offset in packet, not matter for anything! */ |
v[i].val.net = data - buf; | v[i].val.net = dat - buf; |
data += AIT_LEN(val); | dat += AIT_LEN(val); |
break; |
break; |
default: |
default: |
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
Line 126 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 141 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
} |
} |
|
|
/* |
/* |
* io_buffer2vals() De-marshaling data from buffer to array with variables | * io_buffer2vars() De-marshaling data from buffer to array with variables |
| * |
* @buf = Buffer |
* @buf = Buffer |
* @buflen = Size of buffer |
* @buflen = Size of buffer |
* @vnum = Number of variables into buffer |
* @vnum = Number of variables into buffer |
Line 135 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
Line 151 io_vals2buffer(u_char *buf, int buflen, array_t *vars)
|
* return: =NULL error, !=NULL allocated variable array, after use must free with io_arrayDestroy() |
* return: =NULL error, !=NULL allocated variable array, after use must free with io_arrayDestroy() |
*/ |
*/ |
array_t * |
array_t * |
io_buffer2vals(u_char *buf, int buflen, int vnum, int zcpy) | io_buffer2vars(u_char *buf, int buflen, int vnum, int zcpy) |
{ |
{ |
array_t *vars; |
array_t *vars; |
int Limit = 0; |
int Limit = 0; |
register int i; |
register int i; |
ait_val_t *v, *val; |
ait_val_t *v, *val; |
u_char *data; | u_char *dat; |
|
|
assert(buf); |
assert(buf); |
if (!buf || !buflen || !vnum) |
if (!buf || !buflen || !vnum) |
Line 157 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
Line 173 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
return NULL; |
return NULL; |
|
|
v = (ait_val_t*) buf; |
v = (ait_val_t*) buf; |
data = buf + Limit; | dat = buf + Limit; |
} |
} |
|
|
/* de-marshaling */ |
/* de-marshaling */ |
Line 177 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
Line 193 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
val->val_type = v[i].val_type; |
val->val_type = v[i].val_type; |
#if defined(__OpenBSD__) |
#if defined(__OpenBSD__) |
AIT_LEN(val) = betoh32(AIT_LEN(&v[i])); |
AIT_LEN(val) = betoh32(AIT_LEN(&v[i])); |
|
AIT_KEY(val) = betoh16(AIT_KEY(&v[i])); |
#else |
#else |
AIT_LEN(val) = be32toh(AIT_LEN(&v[i])); |
AIT_LEN(val) = be32toh(AIT_LEN(&v[i])); |
|
AIT_KEY(val) = be16toh(AIT_KEY(&v[i])); |
#endif |
#endif |
|
|
switch (AIT_TYPE(val)) { |
switch (AIT_TYPE(val)) { |
Line 199 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
Line 217 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
val->val.net = be64toh(v[i].val.net); |
val->val.net = be64toh(v[i].val.net); |
#endif |
#endif |
break; |
break; |
|
case data: |
|
/* WARNING:: remap data type to buffer */ |
|
val->val_type = buffer; |
case buffer: |
case buffer: |
case string: |
case string: |
if (AIT_LEN(val) > buflen - Limit) { |
if (AIT_LEN(val) > buflen - Limit) { |
Line 219 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
Line 240 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
io_arrayDestroy(&vars); |
io_arrayDestroy(&vars); |
return NULL; |
return NULL; |
} else |
} else |
memcpy(val->val.buffer, data, AIT_LEN(val)); | memcpy(val->val.buffer, dat, AIT_LEN(val)); |
} else |
} else |
val->val.buffer = data; | val->val.buffer = dat; |
data += AIT_LEN(val); | dat += AIT_LEN(val); |
break; |
break; |
default: |
default: |
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
Line 235 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
Line 256 io_buffer2vals(u_char *buf, int buflen, int vnum, int
|
} |
} |
|
|
return vars; |
return vars; |
|
} |
|
|
|
/* buffer marshaling without swapping bytes to network order */ |
|
|
|
/* |
|
* io_vars2map() Marshaling data from array with variables to memory map |
|
* |
|
* @buf = Buffer |
|
* @buflen = Size of buffer |
|
* @vars = Variable array |
|
* return: -1 error, 0 nothing done or >0 size of marshaled data |
|
*/ |
|
int |
|
io_vars2map(u_char *buf, int buflen, array_t *vars) |
|
{ |
|
int Limit = 0; |
|
register int i; |
|
ait_val_t *v, *val; |
|
u_char *dat; |
|
|
|
assert(buf); |
|
assert(vars); |
|
if (!buf || !vars) |
|
return -1; |
|
if (!buflen || !io_arraySize(vars)) |
|
return 0; |
|
|
|
Limit = sizeof(ait_val_t) * io_arraySize(vars); |
|
if (Limit > buflen) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d needed min %d ...\n", |
|
buflen, Limit); |
|
return -1; |
|
} else { |
|
memset(buf, 0, buflen); |
|
|
|
v = (ait_val_t*) buf; |
|
dat = buf + Limit; |
|
} |
|
|
|
/* marshaling */ |
|
for (i = 0; i < io_arraySize(vars); i++) { |
|
val = io_array(vars, i, ait_val_t*); |
|
|
|
v[i].val_type = val->val_type; |
|
AIT_KEY(&v[i]) = AIT_KEY(val); |
|
AIT_LEN(&v[i]) = AIT_LEN(val); |
|
|
|
switch (AIT_TYPE(val)) { |
|
case blob: |
|
case f32: |
|
case f64: |
|
case i8: |
|
case i16: |
|
case i32: |
|
case i64: |
|
case u8: |
|
case u16: |
|
case u32: |
|
case u64: |
|
v[i].val.net = val->val.net; |
|
break; |
|
case data: |
|
if (AIT_LEN(val) > buflen - Limit) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d " |
|
"needed min %d ...\n", buflen, Limit + AIT_LEN(val)); |
|
return -1; |
|
} else |
|
Limit += AIT_LEN(val); |
|
|
|
memcpy(dat, val->val_data, AIT_LEN(val)); |
|
/* Debug:: data offset in packet, not matter for anything! */ |
|
v[i].val.net = dat - buf; |
|
dat += AIT_LEN(val); |
|
break; |
|
case buffer: |
|
case string: |
|
if (AIT_LEN(val) > buflen - Limit) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d " |
|
"needed min %d ...\n", buflen, Limit + AIT_LEN(val)); |
|
return -1; |
|
} else |
|
Limit += AIT_LEN(val); |
|
|
|
memcpy(dat, val->val.buffer, AIT_LEN(val)); |
|
/* Debug:: data offset in packet, not matter for anything! */ |
|
v[i].val.net = dat - buf; |
|
dat += AIT_LEN(val); |
|
break; |
|
default: |
|
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
|
AIT_TYPE(val), i); |
|
return -1; |
|
} |
|
} |
|
|
|
return Limit; |
|
} |
|
|
|
/* |
|
* io_map2vars() De-marshaling data from memory map to array with variables |
|
* |
|
* @buf = Buffer |
|
* @buflen = Size of buffer |
|
* @vnum = Number of variables into buffer |
|
* @zcpy = Zero-copy for variables, if !=0 don't use io_arrayFree() for free variables and |
|
*DON'T MODIFY OR DESTROY BUFFER*. =0 call io_arrayFree() before io_arrayDestroy() |
|
* return: =NULL error, !=NULL allocated variable array, after use must free with io_arrayDestroy() |
|
*/ |
|
array_t * |
|
io_map2vars(u_char *buf, int buflen, int vnum, int zcpy) |
|
{ |
|
array_t *vars; |
|
int Limit = 0; |
|
register int i; |
|
ait_val_t *v, *val; |
|
u_char *dat; |
|
|
|
assert(buf); |
|
if (!buf || !buflen || !vnum) |
|
return NULL; |
|
|
|
Limit = sizeof(ait_val_t) * vnum; |
|
if (Limit > buflen) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d needed min %d ...\n", |
|
buflen, Limit); |
|
return NULL; |
|
} else { |
|
if (!(vars = io_arrayInit(vnum))) |
|
return NULL; |
|
|
|
v = (ait_val_t*) buf; |
|
dat = buf + Limit; |
|
} |
|
|
|
/* de-marshaling */ |
|
for (i = 0; i < io_arraySize(vars); i++) { |
|
if (!zcpy) { |
|
val = malloc(sizeof(ait_val_t)); |
|
if (!val) { |
|
LOGERR; |
|
io_arrayFree(vars); |
|
io_arrayDestroy(&vars); |
|
return NULL; |
|
} |
|
} else |
|
val = v + i; |
|
io_arraySet(vars, i, val); |
|
|
|
val->val_type = v[i].val_type; |
|
AIT_KEY(val) = AIT_KEY(&v[i]); |
|
AIT_LEN(val) = AIT_LEN(&v[i]); |
|
|
|
switch (AIT_TYPE(val)) { |
|
case blob: |
|
case f32: |
|
case f64: |
|
case i8: |
|
case i16: |
|
case i32: |
|
case i64: |
|
case u8: |
|
case u16: |
|
case u32: |
|
case u64: |
|
val->val.net = v[i].val.net; |
|
break; |
|
case data: |
|
/* WARNING:: remap data type to buffer */ |
|
val->val_type = buffer; |
|
case buffer: |
|
case string: |
|
if (AIT_LEN(val) > buflen - Limit) { |
|
io_SetErr(EMSGSIZE, "Error:: too short buffer buflen=%d " |
|
"needed min %d ...\n", buflen, Limit + AIT_LEN(val)); |
|
if (!zcpy) |
|
io_arrayFree(vars); |
|
io_arrayDestroy(&vars); |
|
return NULL; |
|
} else |
|
Limit += AIT_LEN(val); |
|
|
|
if (!zcpy) { |
|
val->val.buffer = malloc(AIT_LEN(val)); |
|
if (!val->val.buffer) { |
|
LOGERR; |
|
io_arrayFree(vars); |
|
io_arrayDestroy(&vars); |
|
return NULL; |
|
} else |
|
memcpy(val->val.buffer, dat, AIT_LEN(val)); |
|
} else |
|
val->val.buffer = dat; |
|
dat += AIT_LEN(val); |
|
break; |
|
default: |
|
io_SetErr(EINVAL, "Error:: unsupported variable type=%d at element #%d ...\n", |
|
AIT_TYPE(val), i); |
|
if (!zcpy) |
|
io_arrayFree(vars); |
|
io_arrayDestroy(&vars); |
|
return NULL; |
|
} |
|
} |
|
|
|
return vars; |
|
} |
|
|
|
|
|
/* |
|
* io_allocVars() Allocate ait_val_t array |
|
* |
|
* @varnum = Number of variables |
|
* return: =NULL error or !=NULL allocated array |
|
*/ |
|
inline array_t * |
|
io_allocVars(int varnum) |
|
{ |
|
array_t *arr; |
|
register int i; |
|
ait_val_t *v; |
|
|
|
if (!varnum || !(arr = io_arrayInit(varnum))) |
|
return NULL; |
|
|
|
for (i = 0; i < io_arraySize(arr); i++) { |
|
v = malloc(sizeof(ait_val_t)); |
|
if (!v) { |
|
LOGERR; |
|
io_freeVars(&arr); |
|
return NULL; |
|
} else { |
|
memset(v, 0, sizeof(ait_val_t)); |
|
io_arraySet(arr, i, v); |
|
} |
|
} |
|
|
|
return arr; |
|
} |
|
|
|
/* |
|
* io_clrVars() Clear ait_val_t elements from array |
|
* |
|
* @vars = Variable array |
|
* return: -1 error or size of array |
|
*/ |
|
inline int |
|
io_clrVars(array_t * __restrict vars) |
|
{ |
|
register int i; |
|
ait_val_t *v; |
|
|
|
if (!vars) |
|
return -1; |
|
|
|
for (i = 0; i < io_arraySize(vars); i++) |
|
if ((v = io_array(vars, i, ait_val_t*))) |
|
AIT_FREE_VAL(v); |
|
|
|
return io_arraySize(vars); |
|
} |
|
|
|
/* |
|
* io_freeVars() Free ait_val_t array |
|
* |
|
* @vars = Variable array |
|
* return: none |
|
*/ |
|
inline void |
|
io_freeVars(array_t ** __restrict vars) |
|
{ |
|
if (!vars || !*vars) |
|
return; |
|
|
|
io_clrVars(*vars); |
|
io_arrayFree(*vars); |
|
io_arrayDestroy(vars); |
|
} |
|
|
|
/* |
|
* io_allocVar() Allocate memory for variable |
|
* |
|
* return: NULL error or new variable, after use free variable with io_freeVar() |
|
*/ |
|
inline ait_val_t * |
|
io_allocVar(void) |
|
{ |
|
ait_val_t *v = NULL; |
|
|
|
v = malloc(sizeof(ait_val_t)); |
|
if (!v) { |
|
LOGERR; |
|
return NULL; |
|
} else |
|
memset(v, 0, sizeof(ait_val_t)); |
|
v->val_type = empty; |
|
|
|
return v; |
|
} |
|
|
|
/* |
|
* io_freeVar() Free allocated memory for variable |
|
* |
|
* @val = Variable |
|
* return: none |
|
*/ |
|
inline void |
|
io_freeVar(ait_val_t * __restrict val) |
|
{ |
|
if (val) { |
|
AIT_FREE_VAL(val); |
|
free(val); |
|
val = NULL; |
|
} |
|
} |
|
|
|
static int |
|
_cmp_arr_key_asc(const void *a, const void *b) |
|
{ |
|
return AIT_KEY(*(ait_val_t**) a) - AIT_KEY(*(ait_val_t**) b); |
|
} |
|
|
|
static int |
|
_cmp_arr_key_desc(const void *a, const void *b) |
|
{ |
|
return AIT_KEY(*(ait_val_t**) b) - AIT_KEY(*(ait_val_t**) a); |
|
} |
|
|
|
/* |
|
* io_sortVars() Sorting array with variables |
|
* |
|
* @vars = Variable array |
|
* @order = Sort order. If =0 ascend or !=0 descend |
|
* @cmp = Compare function for sorting. If =NULL compare by key |
|
* return: none |
|
*/ |
|
inline void |
|
io_sortVars(array_t * __restrict vars, int order, int (*cmp)(const void*, const void*)) |
|
{ |
|
if (!vars) |
|
return; |
|
|
|
if (cmp) |
|
qsort(vars->arr_data, vars->arr_num, sizeof(void*), cmp); |
|
else if (order) |
|
qsort(vars->arr_data, vars->arr_num, sizeof(void*), _cmp_arr_key_desc); |
|
else |
|
qsort(vars->arr_data, vars->arr_num, sizeof(void*), _cmp_arr_key_asc); |
|
} |
|
|
|
/* |
|
* io_findKeyVars() Find variable by key from array |
|
* |
|
* @vars = Variables |
|
* @key = Search key |
|
* return: NULL error or not found, !=NULL valid element |
|
*/ |
|
ait_val_t * |
|
io_findKeyVars(array_t * __restrict vars, u_short key) |
|
{ |
|
array_t *tmp; |
|
ait_val_t **v = NULL; |
|
register int i; |
|
const u_char *p; |
|
|
|
if (!vars) |
|
return NULL; |
|
|
|
if (io_arrayCopy(&tmp, vars) == -1) |
|
return NULL; |
|
else |
|
qsort(tmp->arr_data, tmp->arr_num, sizeof(void*), _cmp_arr_key_asc); |
|
|
|
/* binary search */ |
|
for (p = (const u_char*) tmp->arr_data, i = io_arraySize(tmp); i; i >>= 1) { |
|
v = (ait_val_t**) (p + (i >> 1) * sizeof(void*)); |
|
if (!(key - AIT_KEY(*v))) { /* found! */ |
|
io_arrayDestroy(&tmp); |
|
return *v; |
|
} |
|
if ((key - AIT_KEY(*v)) > 0) { /* move right key > current */ |
|
p = (const u_char*) v + sizeof(void*); |
|
i--; |
|
} /* else move left */ |
|
} |
|
|
|
io_arrayDestroy(&tmp); |
|
return NULL; |
} |
} |