SIM-115: update simulator to use latest E2SM KPM version 3

[sim/e2-interface.git] / e2sim / asn1c / constr_SEQUENCE_OF_ber.c

diff --git a/e2sim/asn1c/constr_SEQUENCE_OF_ber.c b/e2sim/asn1c/constr_SEQUENCE_OF_ber.c
new file mode 100644 (file)
index 0000000..178f865
--- /dev/null
+++ b/e2sim/asn1c/constr_SEQUENCE_OF_ber.c
@@ -0,0 +1,88 @@
+/*
+ * Copyright (c) 2017 Lev Walkin <vlm@lionet.info>.
+ * All rights reserved.
+ * Redistribution and modifications are permitted subject to BSD license.
+ */
+#include <asn_internal.h>
+#include <constr_SEQUENCE_OF.h>
+#include <asn_SEQUENCE_OF.h>
+
+/*
+ * The DER encoder of the SEQUENCE OF type.
+ */
+asn_enc_rval_t
+SEQUENCE_OF_encode_der(const asn_TYPE_descriptor_t *td, const void *ptr,
+                       int tag_mode, ber_tlv_tag_t tag,
+                       asn_app_consume_bytes_f *cb, void *app_key) {
+    asn_TYPE_member_t *elm = td->elements;
+    const asn_anonymous_sequence_ *list = _A_CSEQUENCE_FROM_VOID(ptr);
+    size_t computed_size = 0;
+    ssize_t encoding_size = 0;
+    asn_enc_rval_t erval = {0,0,0};
+    int edx;
+
+    ASN_DEBUG("Estimating size of SEQUENCE OF %s", td->name);
+
+    /*
+     * Gather the length of the underlying members sequence.
+     */
+    for(edx = 0; edx < list->count; edx++) {
+        void *memb_ptr = list->array[edx];
+        if(!memb_ptr) continue;
+        erval = elm->type->op->der_encoder(elm->type, memb_ptr,
+                                           0, elm->tag,
+                                           0, 0);
+        if(erval.encoded == -1)
+            return erval;
+        computed_size += erval.encoded;
+    }
+
+    /*
+     * Encode the TLV for the sequence itself.
+     */
+    encoding_size = der_write_tags(td, computed_size, tag_mode, 1, tag,
+                                   cb, app_key);
+    if(encoding_size == -1) {
+        erval.encoded = -1;
+        erval.failed_type = td;
+        erval.structure_ptr = ptr;
+        return erval;
+    }
+
+    computed_size += encoding_size;
+    if(!cb) {
+        erval.encoded = computed_size;
+        ASN__ENCODED_OK(erval);
+    }
+
+    ASN_DEBUG("Encoding members of SEQUENCE OF %s", td->name);
+
+    /*
+     * Encode all members.
+     */
+    for(edx = 0; edx < list->count; edx++) {
+        void *memb_ptr = list->array[edx];
+        if(!memb_ptr) continue;
+        erval = elm->type->op->der_encoder(elm->type, memb_ptr,
+                                           0, elm->tag,
+                                           cb, app_key);
+        if(erval.encoded == -1)
+            return erval;
+        encoding_size += erval.encoded;
+    }
+
+    if(computed_size != (size_t)encoding_size) {
+        /*
+         * Encoded size is not equal to the computed size.
+         */
+        erval.encoded = -1;
+        erval.failed_type = td;
+        erval.structure_ptr = ptr;
+    } else {
+        erval.encoded = computed_size;
+        erval.structure_ptr = 0;
+        erval.failed_type = 0;
+    }
+
+    return erval;
+}