451 lines
10 KiB
C
451 lines
10 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2004-2017 Lev Walkin <vlm@lionet.info>. All rights reserved.
|
||
|
|
* Redistribution and modifications are permitted subject to BSD license.
|
||
|
|
*/
|
||
|
|
#include <asn_internal.h>
|
||
|
|
#include <ANY.h>
|
||
|
|
#include <errno.h>
|
||
|
|
|
||
|
|
asn_OCTET_STRING_specifics_t asn_SPC_ANY_specs = {
|
||
|
|
sizeof(ANY_t),
|
||
|
|
offsetof(ANY_t, _asn_ctx),
|
||
|
|
ASN_OSUBV_ANY
|
||
|
|
};
|
||
|
|
asn_TYPE_operation_t asn_OP_ANY = {
|
||
|
|
OCTET_STRING_free,
|
||
|
|
OCTET_STRING_print,
|
||
|
|
OCTET_STRING_compare,
|
||
|
|
OCTET_STRING_decode_ber,
|
||
|
|
OCTET_STRING_encode_der,
|
||
|
|
OCTET_STRING_decode_xer_hex,
|
||
|
|
ANY_encode_xer,
|
||
|
|
#ifdef ASN_DISABLE_OER_SUPPORT
|
||
|
|
0,
|
||
|
|
0,
|
||
|
|
#else
|
||
|
|
0,
|
||
|
|
0,
|
||
|
|
#endif /* ASN_DISABLE_OER_SUPPORT */
|
||
|
|
#ifdef ASN_DISABLE_PER_SUPPORT
|
||
|
|
0, 0, 0, 0,
|
||
|
|
#else
|
||
|
|
ANY_decode_uper,
|
||
|
|
ANY_encode_uper,
|
||
|
|
ANY_decode_aper,
|
||
|
|
ANY_encode_aper,
|
||
|
|
#endif /* ASN_DISABLE_PER_SUPPORT */
|
||
|
|
0, /* Random fill is not defined for ANY type */
|
||
|
|
0 /* Use generic outmost tag fetcher */
|
||
|
|
};
|
||
|
|
asn_TYPE_descriptor_t asn_DEF_ANY = {
|
||
|
|
"ANY",
|
||
|
|
"ANY",
|
||
|
|
&asn_OP_ANY,
|
||
|
|
0, 0, 0, 0,
|
||
|
|
{ 0, 0, asn_generic_no_constraint }, /* No constraints */
|
||
|
|
0, 0, /* No members */
|
||
|
|
&asn_SPC_ANY_specs,
|
||
|
|
};
|
||
|
|
|
||
|
|
#undef RETURN
|
||
|
|
#define RETURN(_code) \
|
||
|
|
do { \
|
||
|
|
asn_dec_rval_t tmprval; \
|
||
|
|
tmprval.code = _code; \
|
||
|
|
tmprval.consumed = consumed_myself; \
|
||
|
|
return tmprval; \
|
||
|
|
} while(0)
|
||
|
|
|
||
|
|
asn_enc_rval_t
|
||
|
|
ANY_encode_xer(const asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
|
||
|
|
enum xer_encoder_flags_e flags, asn_app_consume_bytes_f *cb,
|
||
|
|
void *app_key) {
|
||
|
|
if(flags & XER_F_CANONICAL) {
|
||
|
|
/*
|
||
|
|
* Canonical XER-encoding of ANY type is not supported.
|
||
|
|
*/
|
||
|
|
ASN__ENCODE_FAILED;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Dump as binary */
|
||
|
|
return OCTET_STRING_encode_xer(td, sptr, ilevel, flags, cb, app_key);
|
||
|
|
}
|
||
|
|
|
||
|
|
struct _callback_arg {
|
||
|
|
uint8_t *buffer;
|
||
|
|
size_t offset;
|
||
|
|
size_t size;
|
||
|
|
};
|
||
|
|
|
||
|
|
static int ANY__consume_bytes(const void *buffer, size_t size, void *key);
|
||
|
|
|
||
|
|
int
|
||
|
|
ANY_fromType(ANY_t *st, asn_TYPE_descriptor_t *td, void *sptr) {
|
||
|
|
struct _callback_arg arg;
|
||
|
|
asn_enc_rval_t erval = {0,0,0};
|
||
|
|
|
||
|
|
if(!st || !td) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if(!sptr) {
|
||
|
|
if(st->buf) FREEMEM(st->buf);
|
||
|
|
st->size = 0;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
arg.offset = arg.size = 0;
|
||
|
|
arg.buffer = 0;
|
||
|
|
|
||
|
|
erval = der_encode(td, sptr, ANY__consume_bytes, &arg);
|
||
|
|
if(erval.encoded == -1) {
|
||
|
|
if(arg.buffer) FREEMEM(arg.buffer);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
assert((size_t)erval.encoded == arg.offset);
|
||
|
|
|
||
|
|
if(st->buf) FREEMEM(st->buf);
|
||
|
|
st->buf = arg.buffer;
|
||
|
|
st->size = arg.offset;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int
|
||
|
|
ANY_fromType_aper(ANY_t *st, asn_TYPE_descriptor_t *td, void *sptr) {
|
||
|
|
uint8_t *buffer = NULL;
|
||
|
|
ssize_t erval;
|
||
|
|
|
||
|
|
if(!st || !td) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if(!sptr) {
|
||
|
|
if(st->buf) FREEMEM(st->buf);
|
||
|
|
st->size = 0;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
erval = aper_encode_to_new_buffer(td, td->encoding_constraints.per_constraints, sptr, (void**)&buffer);
|
||
|
|
|
||
|
|
if(erval == -1) {
|
||
|
|
if(buffer) FREEMEM(buffer);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
assert((size_t)erval > 0);
|
||
|
|
|
||
|
|
if(st->buf) FREEMEM(st->buf);
|
||
|
|
st->buf = buffer;
|
||
|
|
st->size = erval;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
ANY_t *
|
||
|
|
ANY_new_fromType(asn_TYPE_descriptor_t *td, void *sptr) {
|
||
|
|
ANY_t tmp;
|
||
|
|
ANY_t *st;
|
||
|
|
|
||
|
|
if(!td || !sptr) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
memset(&tmp, 0, sizeof(tmp));
|
||
|
|
|
||
|
|
if(ANY_fromType(&tmp, td, sptr)) return 0;
|
||
|
|
|
||
|
|
st = (ANY_t *)CALLOC(1, sizeof(ANY_t));
|
||
|
|
if(st) {
|
||
|
|
*st = tmp;
|
||
|
|
return st;
|
||
|
|
} else {
|
||
|
|
FREEMEM(tmp.buf);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
ANY_t *
|
||
|
|
ANY_new_fromType_aper(asn_TYPE_descriptor_t *td, void *sptr) {
|
||
|
|
ANY_t tmp;
|
||
|
|
ANY_t *st;
|
||
|
|
|
||
|
|
if(!td || !sptr) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
memset(&tmp, 0, sizeof(tmp));
|
||
|
|
|
||
|
|
if(ANY_fromType_aper(&tmp, td, sptr)) return 0;
|
||
|
|
|
||
|
|
st = (ANY_t *)CALLOC(1, sizeof(ANY_t));
|
||
|
|
if(st) {
|
||
|
|
*st = tmp;
|
||
|
|
return st;
|
||
|
|
} else {
|
||
|
|
FREEMEM(tmp.buf);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int
|
||
|
|
ANY_to_type(ANY_t *st, asn_TYPE_descriptor_t *td, void **struct_ptr) {
|
||
|
|
asn_dec_rval_t rval;
|
||
|
|
void *newst = 0;
|
||
|
|
|
||
|
|
if(!st || !td || !struct_ptr) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if(st->buf == 0) {
|
||
|
|
/* Nothing to convert, make it empty. */
|
||
|
|
*struct_ptr = (void *)0;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
rval = ber_decode(0, td, (void **)&newst, st->buf, st->size);
|
||
|
|
if(rval.code == RC_OK) {
|
||
|
|
*struct_ptr = newst;
|
||
|
|
return 0;
|
||
|
|
} else {
|
||
|
|
/* Remove possibly partially decoded data. */
|
||
|
|
ASN_STRUCT_FREE(*td, newst);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int
|
||
|
|
ANY_to_type_aper(ANY_t *st, asn_TYPE_descriptor_t *td, void **struct_ptr) {
|
||
|
|
asn_dec_rval_t rval;
|
||
|
|
void *newst = 0;
|
||
|
|
|
||
|
|
if(!st || !td || !struct_ptr) {
|
||
|
|
errno = EINVAL;
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if(st->buf == 0) {
|
||
|
|
/* Nothing to convert, make it empty. */
|
||
|
|
*struct_ptr = (void *)0;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
rval = aper_decode(0, td, (void **)&newst, st->buf, st->size, 0, 0);
|
||
|
|
if(rval.code == RC_OK) {
|
||
|
|
*struct_ptr = newst;
|
||
|
|
return 0;
|
||
|
|
} else {
|
||
|
|
/* Remove possibly partially decoded data. */
|
||
|
|
ASN_STRUCT_FREE(*td, newst);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static int ANY__consume_bytes(const void *buffer, size_t size, void *key) {
|
||
|
|
struct _callback_arg *arg = (struct _callback_arg *)key;
|
||
|
|
|
||
|
|
if((arg->offset + size) >= arg->size) {
|
||
|
|
size_t nsize = (arg->size ? arg->size << 2 : 16) + size;
|
||
|
|
void *p = REALLOC(arg->buffer, nsize);
|
||
|
|
if(!p) return -1;
|
||
|
|
arg->buffer = (uint8_t *)p;
|
||
|
|
arg->size = nsize;
|
||
|
|
}
|
||
|
|
|
||
|
|
memcpy(arg->buffer + arg->offset, buffer, size);
|
||
|
|
arg->offset += size;
|
||
|
|
assert(arg->offset < arg->size);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifndef ASN_DISABLE_PER_SUPPORT
|
||
|
|
|
||
|
|
asn_dec_rval_t
|
||
|
|
ANY_decode_uper(const asn_codec_ctx_t *opt_codec_ctx,
|
||
|
|
const asn_TYPE_descriptor_t *td,
|
||
|
|
const asn_per_constraints_t *constraints, void **sptr,
|
||
|
|
asn_per_data_t *pd) {
|
||
|
|
const asn_OCTET_STRING_specifics_t *specs =
|
||
|
|
td->specifics ? (const asn_OCTET_STRING_specifics_t *)td->specifics
|
||
|
|
: &asn_SPC_ANY_specs;
|
||
|
|
size_t consumed_myself = 0;
|
||
|
|
int repeat;
|
||
|
|
ANY_t *st = (ANY_t *)*sptr;
|
||
|
|
|
||
|
|
(void)opt_codec_ctx;
|
||
|
|
(void)constraints;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Allocate the structure.
|
||
|
|
*/
|
||
|
|
if(!st) {
|
||
|
|
st = (ANY_t *)(*sptr = CALLOC(1, specs->struct_size));
|
||
|
|
if(!st) RETURN(RC_FAIL);
|
||
|
|
}
|
||
|
|
|
||
|
|
ASN_DEBUG("UPER Decoding ANY type");
|
||
|
|
|
||
|
|
st->size = 0;
|
||
|
|
do {
|
||
|
|
ssize_t raw_len;
|
||
|
|
ssize_t len_bytes;
|
||
|
|
ssize_t len_bits;
|
||
|
|
void *p;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
/* Get the PER length */
|
||
|
|
raw_len = uper_get_length(pd, -1, 0, &repeat);
|
||
|
|
if(raw_len < 0) RETURN(RC_WMORE);
|
||
|
|
if(raw_len == 0 && st->buf) break;
|
||
|
|
|
||
|
|
ASN_DEBUG("Got PER length len %" ASN_PRI_SIZE ", %s (%s)", raw_len,
|
||
|
|
repeat ? "repeat" : "once", td->name);
|
||
|
|
len_bytes = raw_len;
|
||
|
|
len_bits = len_bytes * 8;
|
||
|
|
|
||
|
|
p = REALLOC(st->buf, st->size + len_bytes + 1);
|
||
|
|
if(!p) RETURN(RC_FAIL);
|
||
|
|
st->buf = (uint8_t *)p;
|
||
|
|
|
||
|
|
ret = per_get_many_bits(pd, &st->buf[st->size], 0, len_bits);
|
||
|
|
if(ret < 0) RETURN(RC_WMORE);
|
||
|
|
consumed_myself += len_bits;
|
||
|
|
st->size += len_bytes;
|
||
|
|
} while(repeat);
|
||
|
|
st->buf[st->size] = 0; /* nul-terminate */
|
||
|
|
|
||
|
|
RETURN(RC_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
asn_enc_rval_t
|
||
|
|
ANY_encode_uper(const asn_TYPE_descriptor_t *td,
|
||
|
|
const asn_per_constraints_t *constraints, const void *sptr,
|
||
|
|
asn_per_outp_t *po) {
|
||
|
|
const ANY_t *st = (const ANY_t *)sptr;
|
||
|
|
asn_enc_rval_t er = {0, 0, 0};
|
||
|
|
const uint8_t *buf;
|
||
|
|
size_t size;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
(void)constraints;
|
||
|
|
|
||
|
|
if(!st || (!st->buf && st->size)) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
buf = st->buf;
|
||
|
|
size = st->size;
|
||
|
|
do {
|
||
|
|
int need_eom = 0;
|
||
|
|
ssize_t may_save = uper_put_length(po, size, &need_eom);
|
||
|
|
if(may_save < 0) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
ret = per_put_many_bits(po, buf, may_save * 8);
|
||
|
|
if(ret) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
buf += may_save;
|
||
|
|
size -= may_save;
|
||
|
|
assert(!(may_save & 0x07) || !size);
|
||
|
|
if(need_eom && uper_put_length(po, 0, 0))
|
||
|
|
ASN__ENCODE_FAILED; /* End of Message length */
|
||
|
|
} while(size);
|
||
|
|
|
||
|
|
ASN__ENCODED_OK(er);
|
||
|
|
}
|
||
|
|
|
||
|
|
asn_dec_rval_t
|
||
|
|
ANY_decode_aper(const asn_codec_ctx_t *opt_codec_ctx,
|
||
|
|
const asn_TYPE_descriptor_t *td,
|
||
|
|
const asn_per_constraints_t *constraints, void **sptr,
|
||
|
|
asn_per_data_t *pd) {
|
||
|
|
const asn_OCTET_STRING_specifics_t *specs =
|
||
|
|
td->specifics ? (const asn_OCTET_STRING_specifics_t *)td->specifics
|
||
|
|
: &asn_SPC_ANY_specs;
|
||
|
|
size_t consumed_myself = 0;
|
||
|
|
int repeat;
|
||
|
|
ANY_t *st = (ANY_t *)*sptr;
|
||
|
|
|
||
|
|
(void)opt_codec_ctx;
|
||
|
|
(void)constraints;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Allocate the structure.
|
||
|
|
*/
|
||
|
|
if(!st) {
|
||
|
|
st = (ANY_t *)(*sptr = CALLOC(1, specs->struct_size));
|
||
|
|
if(!st) RETURN(RC_FAIL);
|
||
|
|
}
|
||
|
|
|
||
|
|
ASN_DEBUG("APER Decoding ANY type");
|
||
|
|
|
||
|
|
st->size = 0;
|
||
|
|
do {
|
||
|
|
ssize_t raw_len;
|
||
|
|
ssize_t len_bytes;
|
||
|
|
ssize_t len_bits;
|
||
|
|
void *p;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
/* Get the PER length */
|
||
|
|
raw_len = aper_get_length(pd, -1, 0, &repeat);
|
||
|
|
if(raw_len < 0) RETURN(RC_WMORE);
|
||
|
|
if(raw_len == 0 && st->buf) break;
|
||
|
|
|
||
|
|
ASN_DEBUG("Got PER length len %" ASN_PRI_SIZE ", %s (%s)", raw_len,
|
||
|
|
repeat ? "repeat" : "once", td->name);
|
||
|
|
len_bytes = raw_len;
|
||
|
|
len_bits = len_bytes * 8;
|
||
|
|
|
||
|
|
p = REALLOC(st->buf, st->size + len_bytes + 1);
|
||
|
|
if(!p) RETURN(RC_FAIL);
|
||
|
|
st->buf = (uint8_t *)p;
|
||
|
|
|
||
|
|
ret = per_get_many_bits(pd, &st->buf[st->size], 0, len_bits);
|
||
|
|
if(ret < 0) RETURN(RC_WMORE);
|
||
|
|
consumed_myself += len_bits;
|
||
|
|
st->size += len_bytes;
|
||
|
|
} while(repeat);
|
||
|
|
st->buf[st->size] = 0; /* nul-terminate */
|
||
|
|
|
||
|
|
RETURN(RC_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
asn_enc_rval_t
|
||
|
|
ANY_encode_aper(const asn_TYPE_descriptor_t *td,
|
||
|
|
const asn_per_constraints_t *constraints, const void *sptr,
|
||
|
|
asn_per_outp_t *po) {
|
||
|
|
const ANY_t *st = (const ANY_t *)sptr;
|
||
|
|
asn_enc_rval_t er = {0, 0, 0};
|
||
|
|
const uint8_t *buf;
|
||
|
|
size_t size;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
(void)constraints;
|
||
|
|
|
||
|
|
if(!st || (!st->buf && st->size)) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
buf = st->buf;
|
||
|
|
size = st->size;
|
||
|
|
do {
|
||
|
|
int need_eom = 0;
|
||
|
|
ssize_t may_save = uper_put_length(po, size, &need_eom);
|
||
|
|
if(may_save < 0) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
ret = per_put_many_bits(po, buf, may_save * 8);
|
||
|
|
if(ret) ASN__ENCODE_FAILED;
|
||
|
|
|
||
|
|
buf += may_save;
|
||
|
|
size -= may_save;
|
||
|
|
assert(!(may_save & 0x07) || !size);
|
||
|
|
if(need_eom && uper_put_length(po, 0, 0))
|
||
|
|
ASN__ENCODE_FAILED; /* End of Message length */
|
||
|
|
} while(size);
|
||
|
|
|
||
|
|
ASN__ENCODED_OK(er);
|
||
|
|
}
|
||
|
|
#endif /* ASN_DISABLE_PER_SUPPORT */
|
||
|
|
|