--- /dev/null
+#include <asn_application.h>\r
+#include <asn_internal.h>\r
+#include <per_encoder.h>\r
+\r
+static int _uper_encode_flush_outp(asn_per_outp_t *po);\r
+\r
+static int\r
+ignore_output(const void *data, size_t size, void *app_key) {\r
+ (void)data;\r
+ (void)size;\r
+ (void)app_key;\r
+ return 0;\r
+}\r
+\r
+asn_enc_rval_t\r
+uper_encode(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints, const void *sptr,\r
+ asn_app_consume_bytes_f *cb, void *app_key) {\r
+ asn_per_outp_t po;\r
+ asn_enc_rval_t er = {0,0,0};\r
+\r
+ /*\r
+ * Invoke type-specific encoder.\r
+ */\r
+ if(!td || !td->op->uper_encoder)\r
+ ASN__ENCODE_FAILED; /* PER is not compiled in */\r
+\r
+ po.buffer = po.tmpspace;\r
+ po.nboff = 0;\r
+ po.nbits = 8 * sizeof(po.tmpspace);\r
+ po.output = cb ? cb : ignore_output;\r
+ po.op_key = app_key;\r
+ po.flushed_bytes = 0;\r
+\r
+ er = td->op->uper_encoder(td, constraints, sptr, &po);\r
+ if(er.encoded != -1) {\r
+ size_t bits_to_flush;\r
+\r
+ bits_to_flush = ((po.buffer - po.tmpspace) << 3) + po.nboff;\r
+\r
+ /* Set number of bits encoded to a firm value */\r
+ er.encoded = (po.flushed_bytes << 3) + bits_to_flush;\r
+\r
+ if(_uper_encode_flush_outp(&po)) ASN__ENCODE_FAILED;\r
+ }\r
+\r
+ return er;\r
+}\r
+\r
+/*\r
+ * Argument type and callback necessary for uper_encode_to_buffer().\r
+ */\r
+typedef struct enc_to_buf_arg {\r
+ void *buffer;\r
+ size_t left;\r
+} enc_to_buf_arg;\r
+static int encode_to_buffer_cb(const void *buffer, size_t size, void *key) {\r
+ enc_to_buf_arg *arg = (enc_to_buf_arg *)key;\r
+\r
+ if(arg->left < size)\r
+ return -1; /* Data exceeds the available buffer size */\r
+\r
+ memcpy(arg->buffer, buffer, size);\r
+ arg->buffer = ((char *)arg->buffer) + size;\r
+ arg->left -= size;\r
+\r
+ return 0;\r
+}\r
+\r
+asn_enc_rval_t\r
+uper_encode_to_buffer(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints,\r
+ const void *sptr, void *buffer, size_t buffer_size) {\r
+ enc_to_buf_arg key;\r
+\r
+ key.buffer = buffer;\r
+ key.left = buffer_size;\r
+\r
+ if(td) ASN_DEBUG("Encoding \"%s\" using UNALIGNED PER", td->name);\r
+\r
+ return uper_encode(td, constraints, sptr, encode_to_buffer_cb, &key);\r
+}\r
+\r
+typedef struct enc_dyn_arg {\r
+ void *buffer;\r
+ size_t length;\r
+ size_t allocated;\r
+} enc_dyn_arg;\r
+static int\r
+encode_dyn_cb(const void *buffer, size_t size, void *key) {\r
+ enc_dyn_arg *arg = key;\r
+ if(arg->length + size >= arg->allocated) {\r
+ size_t new_size = arg->allocated ? arg->allocated : 8;\r
+ void *p;\r
+\r
+ do {\r
+ new_size <<= 2;\r
+ } while(arg->length + size >= new_size);\r
+\r
+ p = REALLOC(arg->buffer, new_size);\r
+ if(!p) {\r
+ FREEMEM(arg->buffer);\r
+ memset(arg, 0, sizeof(*arg));\r
+ return -1;\r
+ }\r
+ arg->buffer = p;\r
+ arg->allocated = new_size;\r
+ }\r
+ memcpy(((char *)arg->buffer) + arg->length, buffer, size);\r
+ arg->length += size;\r
+ return 0;\r
+}\r
+ssize_t\r
+uper_encode_to_new_buffer(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints,\r
+ const void *sptr, void **buffer_r) {\r
+ asn_enc_rval_t er = {0,0,0};\r
+ enc_dyn_arg key;\r
+\r
+ memset(&key, 0, sizeof(key));\r
+\r
+ er = uper_encode(td, constraints, sptr, encode_dyn_cb, &key);\r
+ switch(er.encoded) {\r
+ case -1:\r
+ FREEMEM(key.buffer);\r
+ return -1;\r
+ case 0:\r
+ FREEMEM(key.buffer);\r
+ key.buffer = MALLOC(1);\r
+ if(key.buffer) {\r
+ *(char *)key.buffer = '\0';\r
+ *buffer_r = key.buffer;\r
+ return 1;\r
+ } else {\r
+ return -1;\r
+ }\r
+ default:\r
+ *buffer_r = key.buffer;\r
+ ASN_DEBUG("Complete encoded in %ld bits", (long)er.encoded);\r
+ return ((er.encoded + 7) >> 3);\r
+ }\r
+}\r
+\r
+/*\r
+ * Internally useful functions.\r
+ */\r
+\r
+/* Flush partially filled buffer */\r
+static int\r
+_uper_encode_flush_outp(asn_per_outp_t *po) {\r
+ uint8_t *buf;\r
+\r
+ if(po->nboff == 0 && po->buffer == po->tmpspace)\r
+ return 0;\r
+\r
+ buf = po->buffer + (po->nboff >> 3);\r
+ /* Make sure we account for the last, partially filled */\r
+ if(po->nboff & 0x07) {\r
+ buf[0] &= 0xff << (8 - (po->nboff & 0x07));\r
+ buf++;\r
+ }\r
+\r
+ return po->output(po->tmpspace, buf - po->tmpspace, po->op_key);\r
+}\r
+\r
+asn_enc_rval_t\r
+aper_encode_to_buffer(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints,\r
+ const void *sptr, void *buffer, size_t buffer_size) {\r
+ enc_to_buf_arg key;\r
+\r
+ key.buffer = buffer;\r
+ key.left = buffer_size;\r
+\r
+ if(td) ASN_DEBUG("Encoding \"%s\" using ALIGNED PER", td->name);\r
+\r
+ return aper_encode(td, constraints, sptr, encode_to_buffer_cb, &key);\r
+}\r
+\r
+ssize_t\r
+aper_encode_to_new_buffer(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints,\r
+ const void *sptr, void **buffer_r) {\r
+ asn_enc_rval_t er = {0,0,0};\r
+ enc_dyn_arg key;\r
+\r
+ memset(&key, 0, sizeof(key));\r
+\r
+ er = aper_encode(td, constraints, sptr, encode_dyn_cb, &key);\r
+ switch(er.encoded) {\r
+ case -1:\r
+ FREEMEM(key.buffer);\r
+ return -1;\r
+ case 0:\r
+ FREEMEM(key.buffer);\r
+ key.buffer = MALLOC(1);\r
+ if(key.buffer) {\r
+ *(char *)key.buffer = '\0';\r
+ *buffer_r = key.buffer;\r
+ return 1;\r
+ } else {\r
+ return -1;\r
+ }\r
+ default:\r
+ *buffer_r = key.buffer;\r
+ ASN_DEBUG("Complete encoded in %ld bits", (long)er.encoded);\r
+ return ((er.encoded + 7) >> 3);\r
+ }\r
+}\r
+\r
+static int\r
+_aper_encode_flush_outp(asn_per_outp_t *po) {\r
+ uint8_t *buf;\r
+\r
+ if(po->nboff == 0 && po->buffer == po->tmpspace)\r
+ return 0;\r
+\r
+ buf = po->buffer + (po->nboff >> 3);\r
+ /* Make sure we account for the last, partially filled */\r
+ if(po->nboff & 0x07) {\r
+ buf[0] &= 0xff << (8 - (po->nboff & 0x07));\r
+ buf++;\r
+ }\r
+\r
+ if (po->output) {\r
+ return po->output(po->tmpspace, buf - po->tmpspace, po->op_key);\r
+ }\r
+ return 0;\r
+}\r
+\r
+asn_enc_rval_t\r
+aper_encode(const asn_TYPE_descriptor_t *td,\r
+ const asn_per_constraints_t *constraints,\r
+ const void *sptr, asn_app_consume_bytes_f *cb, void *app_key) {\r
+ asn_per_outp_t po;\r
+ asn_enc_rval_t er = {0,0,0};\r
+\r
+ /*\r
+ * Invoke type-specific encoder.\r
+ */\r
+ if(!td || !td->op->aper_encoder)\r
+ ASN__ENCODE_FAILED; /* PER is not compiled in */\r
+\r
+ po.buffer = po.tmpspace;\r
+ po.nboff = 0;\r
+ po.nbits = 8 * sizeof(po.tmpspace);\r
+ po.output = cb;\r
+ po.op_key = app_key;\r
+ po.flushed_bytes = 0;\r
+\r
+ er = td->op->aper_encoder(td, constraints, sptr, &po);\r
+ if(er.encoded != -1) {\r
+ size_t bits_to_flush;\r
+\r
+ bits_to_flush = ((po.buffer - po.tmpspace) << 3) + po.nboff;\r
+\r
+ /* Set number of bits encoded to a firm value */\r
+ er.encoded = (po.flushed_bytes << 3) + bits_to_flush;\r
+\r
+ if(_aper_encode_flush_outp(&po))\r
+ ASN__ENCODE_FAILED;\r
+ }\r
+\r
+ return er;\r
+}\r
Code Review / ric-app / kpimon.git / blobdiff