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