2 * Copyright (c) 2005-2017 Lev Walkin <vlm@lionet.info>. All rights reserved.
3 * Redistribution and modifications are permitted subject to BSD license.
5 #include <asn_system.h>
6 #include <asn_internal.h>
7 #include <aper_support.h>
10 aper_get_align(asn_per_data_t *pd) {
13 ASN_DEBUG("Aligning %ld bits", 8 - ((unsigned long)pd->nboff & 0x7));
14 return per_get_few_bits(pd, 8 - (pd->nboff & 0x7));
20 aper_get_length(asn_per_data_t *pd, ssize_t lb, ssize_t ub,
21 int ebits, int *repeat) {
22 int constrained = (lb >= 0) && (ub >= 0);
27 if (constrained && ub < 65536) {
28 int range = ub - lb + 1;
29 return aper_get_nsnnwn(pd, range);
32 if (aper_get_align(pd) < 0)
35 if(ebits >= 0) return per_get_few_bits(pd, ebits);
37 value = per_get_few_bits(pd, 8);
38 if(value < 0) return -1;
39 if((value & 128) == 0) /* #11.9.3.6 */
40 return (value & 0x7F);
41 if((value & 64) == 0) { /* #11.9.3.7 */
42 value = ((value & 63) << 8) | per_get_few_bits(pd, 8);
43 if(value < 0) return -1;
46 value &= 63; /* this is "m" from X.691, #11.9.3.8 */
47 if(value < 1 || value > 4)
50 return (16384 * value);
54 aper_get_nslength(asn_per_data_t *pd) {
57 ASN_DEBUG("Getting normally small length");
59 if(per_get_few_bits(pd, 1) == 0) {
60 length = per_get_few_bits(pd, 6) + 1;
61 if(length <= 0) return -1;
62 ASN_DEBUG("l=%zd", length);
66 length = aper_get_length(pd, -1, -1, -1, &repeat);
67 if(length >= 0 && !repeat) return length;
68 return -1; /* Error, or do not support >16K extensions */
73 aper_get_nsnnwn(asn_per_data_t *pd, int range) {
77 ASN_DEBUG("getting nsnnwn with range %d", range);
82 if (range < 0) return -1;
84 for (i = 1; i <= 8; i++) {
89 value = per_get_few_bits(pd, i);
91 } else if (range == 256){
94 } else if (range <= 65536) {
101 /* handle indefinite range */
102 length = per_get_few_bits(pd, 1);
104 return per_get_few_bits(pd, 6);
106 if (aper_get_align(pd) < 0)
109 length = per_get_few_bits(pd, 8);
110 /* the length is not likely to be that big */
114 if (per_get_many_bits(pd, (uint8_t *)&value, 0, length * 8) < 0)
118 if (aper_get_align(pd) < 0)
120 value = per_get_few_bits(pd, 8 * bytes);
124 int aper_put_align(asn_per_outp_t *po) {
126 if(po->nboff & 0x7) {
127 ASN_DEBUG("Aligning %ld bits", 8 - ((unsigned long)po->nboff & 0x7));
128 if(per_put_few_bits(po, 0x00, (8 - (po->nboff & 0x7))))
135 aper_put_length(asn_per_outp_t *po, ssize_t lb, ssize_t ub, size_t n, int *need_eom) {
136 int constrained = (lb >= 0) && (ub >= 0);
138 if(!need_eom) need_eom = &dummy;
143 ASN_DEBUG("APER put length %zu with range (%zd..%zd)", n, lb, ub);
145 /* 11.9 X.691 Note 2 */
146 if (constrained && ub < 65536) {
147 int range = ub - lb + 1;
148 return aper_put_nsnnwn(po, range, n) ? -1 : (ssize_t)n;
151 if (aper_put_align(po) < 0)
154 if(n <= 127) { /* #11.9.3.6 */
155 return per_put_few_bits(po, n, 8)
158 else if(n < 16384) /* #11.9.3.7 */
159 return per_put_few_bits(po, n|0x8000, 16)
162 *need_eom = 0 == (n & 16383);
169 return per_put_few_bits(po, 0xC0 | n, 8)
170 ? -1 : (ssize_t)(n << 14);
175 aper_put_nslength(asn_per_outp_t *po, size_t length) {
179 if(length == 0) return -1;
180 return per_put_few_bits(po, length-1, 7) ? -1 : 0;
182 if(aper_put_length(po, -1, -1, length, NULL) != (ssize_t)length) {
183 /* This might happen in case of >16K extensions */
192 aper_put_nsnnwn(asn_per_outp_t *po, int range, int number) {
195 ASN_DEBUG("aper put nsnnwn %d with range %d", number, range);
200 int bits = 1 << (8 * i);
209 for (i = 1; i <= 8; i++) {
214 return per_put_few_bits(po, number, i);
215 } else if(range == 256) {
219 } else if(range <= 65536) {
223 } else { /* Ranges > 64K */
226 int bits = 1 << (8 * i);
233 if(aper_put_align(po) < 0) /* Aligning on octet */
235 /* if(per_put_few_bits(po, bytes, 8))
238 return per_put_few_bits(po, number, 8 * bytes);