]> git.stg.codes - stg.git/blob - libs/smux/NativeInteger.c
Merge remote-tracking branch 'github/master'
[stg.git] / libs / smux / NativeInteger.c
1 /*-
2  * Copyright (c) 2004, 2005, 2006 Lev Walkin <vlm@lionet.info>.
3  * All rights reserved.
4  * Redistribution and modifications are permitted subject to BSD license.
5  */
6 /*
7  * Read the NativeInteger.h for the explanation wrt. differences between
8  * INTEGER and NativeInteger.
9  * Basically, both are decoders and encoders of ASN.1 INTEGER type, but this
10  * implementation deals with the standard (machine-specific) representation
11  * of them instead of using the platform-independent buffer.
12  */
13 #include <asn_internal.h>
14 #include <NativeInteger.h>
15
16 /*
17  * NativeInteger basic type description.
18  */
19 static const ber_tlv_tag_t asn_DEF_NativeInteger_tags[] = {
20         (ASN_TAG_CLASS_UNIVERSAL | (2 << 2))
21 };
22 asn_TYPE_descriptor_t asn_DEF_NativeInteger = {
23         "INTEGER",                      /* The ASN.1 type is still INTEGER */
24         "INTEGER",
25         NativeInteger_free,
26         NativeInteger_print,
27         asn_generic_no_constraint,
28         NativeInteger_decode_ber,
29         NativeInteger_encode_der,
30         NativeInteger_decode_xer,
31         NativeInteger_encode_xer,
32         NativeInteger_decode_uper,      /* Unaligned PER decoder */
33         NativeInteger_encode_uper,      /* Unaligned PER encoder */
34         0, /* Use generic outmost tag fetcher */
35         asn_DEF_NativeInteger_tags,
36         sizeof(asn_DEF_NativeInteger_tags) / sizeof(asn_DEF_NativeInteger_tags[0]),
37         asn_DEF_NativeInteger_tags,     /* Same as above */
38         sizeof(asn_DEF_NativeInteger_tags) / sizeof(asn_DEF_NativeInteger_tags[0]),
39         0,      /* No PER visible constraints */
40         0, 0,   /* No members */
41         0       /* No specifics */
42 };
43
44 /*
45  * Decode INTEGER type.
46  */
47 asn_dec_rval_t
48 NativeInteger_decode_ber(asn_codec_ctx_t *opt_codec_ctx,
49         asn_TYPE_descriptor_t *td,
50         void **nint_ptr, const void *buf_ptr, size_t size, int tag_mode) {
51         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
52         long *native = (long *)*nint_ptr;
53         asn_dec_rval_t rval;
54         ber_tlv_len_t length;
55
56         /*
57          * If the structure is not there, allocate it.
58          */
59         if(native == NULL) {
60                 native = (long *)(*nint_ptr = CALLOC(1, sizeof(*native)));
61                 if(native == NULL) {
62                         rval.code = RC_FAIL;
63                         rval.consumed = 0;
64                         return rval;
65                 }
66         }
67
68         ASN_DEBUG("Decoding %s as INTEGER (tm=%d)",
69                 td->name, tag_mode);
70
71         /*
72          * Check tags.
73          */
74         rval = ber_check_tags(opt_codec_ctx, td, 0, buf_ptr, size,
75                         tag_mode, 0, &length, 0);
76         if(rval.code != RC_OK)
77                 return rval;
78
79         ASN_DEBUG("%s length is %d bytes", td->name, (int)length);
80
81         /*
82          * Make sure we have this length.
83          */
84         buf_ptr = ((const char *)buf_ptr) + rval.consumed;
85         size -= rval.consumed;
86         if(length > (ber_tlv_len_t)size) {
87                 rval.code = RC_WMORE;
88                 rval.consumed = 0;
89                 return rval;
90         }
91
92         /*
93          * ASN.1 encoded INTEGER: buf_ptr, length
94          * Fill the native, at the same time checking for overflow.
95          * If overflow occured, return with RC_FAIL.
96          */
97         {
98                 INTEGER_t tmp;
99                 union {
100                         const void *constbuf;
101                         void *nonconstbuf;
102                 } unconst_buf;
103                 long l;
104
105                 unconst_buf.constbuf = buf_ptr;
106                 tmp.buf = (uint8_t *)unconst_buf.nonconstbuf;
107                 tmp.size = length;
108
109                 if((specs&&specs->field_unsigned)
110                         ? asn_INTEGER2ulong(&tmp, (unsigned long *)&l) /* sic */
111                         : asn_INTEGER2long(&tmp, &l)) {
112                         rval.code = RC_FAIL;
113                         rval.consumed = 0;
114                         return rval;
115                 }
116
117                 *native = l;
118         }
119
120         rval.code = RC_OK;
121         rval.consumed += length;
122
123         ASN_DEBUG("Took %ld/%ld bytes to encode %s (%ld)",
124                 (long)rval.consumed, (long)length, td->name, (long)*native);
125
126         return rval;
127 }
128
129 /*
130  * Encode the NativeInteger using the standard INTEGER type DER encoder.
131  */
132 asn_enc_rval_t
133 NativeInteger_encode_der(asn_TYPE_descriptor_t *sd, void *ptr,
134         int tag_mode, ber_tlv_tag_t tag,
135         asn_app_consume_bytes_f *cb, void *app_key) {
136         unsigned long native = *(unsigned long *)ptr;   /* Disable sign ext. */
137         asn_enc_rval_t erval;
138         INTEGER_t tmp;
139
140 #ifdef  WORDS_BIGENDIAN         /* Opportunistic optimization */
141
142         tmp.buf = (uint8_t *)&native;
143         tmp.size = sizeof(native);
144
145 #else   /* Works even if WORDS_BIGENDIAN is not set where should've been */
146         uint8_t buf[sizeof(native)];
147         uint8_t *p;
148
149         /* Prepare a fake INTEGER */
150         for(p = buf + sizeof(buf) - 1; p >= buf; p--, native >>= 8)
151                 *p = (uint8_t)native;
152
153         tmp.buf = buf;
154         tmp.size = sizeof(buf);
155 #endif  /* WORDS_BIGENDIAN */
156         
157         /* Encode fake INTEGER */
158         erval = INTEGER_encode_der(sd, &tmp, tag_mode, tag, cb, app_key);
159         if(erval.encoded == -1) {
160                 assert(erval.structure_ptr == &tmp);
161                 erval.structure_ptr = ptr;
162         }
163         return erval;
164 }
165
166 /*
167  * Decode the chunk of XML text encoding INTEGER.
168  */
169 asn_dec_rval_t
170 NativeInteger_decode_xer(asn_codec_ctx_t *opt_codec_ctx,
171         asn_TYPE_descriptor_t *td, void **sptr, const char *opt_mname,
172                 const void *buf_ptr, size_t size) {
173         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
174         asn_dec_rval_t rval;
175         INTEGER_t st;
176         void *st_ptr = (void *)&st;
177         long *native = (long *)*sptr;
178
179         if(!native) {
180                 native = (long *)(*sptr = CALLOC(1, sizeof(*native)));
181                 if(!native) ASN__DECODE_FAILED;
182         }
183
184         memset(&st, 0, sizeof(st));
185         rval = INTEGER_decode_xer(opt_codec_ctx, td, &st_ptr, 
186                 opt_mname, buf_ptr, size);
187         if(rval.code == RC_OK) {
188                 long l;
189                 if((specs&&specs->field_unsigned)
190                         ? asn_INTEGER2ulong(&st, (unsigned long *)&l) /* sic */
191                         : asn_INTEGER2long(&st, &l)) {
192                         rval.code = RC_FAIL;
193                         rval.consumed = 0;
194                 } else {
195                         *native = l;
196                 }
197         } else {
198                 /*
199                  * Cannot restart from the middle;
200                  * there is no place to save state in the native type.
201                  * Request a continuation from the very beginning.
202                  */
203                 rval.consumed = 0;
204         }
205         ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_INTEGER, &st);
206         return rval;
207 }
208
209
210 asn_enc_rval_t
211 NativeInteger_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
212         int ilevel, enum xer_encoder_flags_e flags,
213                 asn_app_consume_bytes_f *cb, void *app_key) {
214         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
215         char scratch[32];       /* Enough for 64-bit int */
216         asn_enc_rval_t er;
217         const long *native = (const long *)sptr;
218
219         (void)ilevel;
220         (void)flags;
221
222         if(!native) ASN__ENCODE_FAILED;
223
224         er.encoded = snprintf(scratch, sizeof(scratch),
225                         (specs && specs->field_unsigned)
226                         ? "%lu" : "%ld", *native);
227         if(er.encoded <= 0 || (size_t)er.encoded >= sizeof(scratch)
228                 || cb(scratch, er.encoded, app_key) < 0)
229                 ASN__ENCODE_FAILED;
230
231         ASN__ENCODED_OK(er);
232 }
233
234 asn_dec_rval_t
235 NativeInteger_decode_uper(asn_codec_ctx_t *opt_codec_ctx,
236         asn_TYPE_descriptor_t *td,
237         asn_per_constraints_t *constraints, void **sptr, asn_per_data_t *pd) {
238
239         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
240         asn_dec_rval_t rval;
241         long *native = (long *)*sptr;
242         INTEGER_t tmpint;
243         void *tmpintptr = &tmpint;
244
245         (void)opt_codec_ctx;
246         ASN_DEBUG("Decoding NativeInteger %s (UPER)", td->name);
247
248         if(!native) {
249                 native = (long *)(*sptr = CALLOC(1, sizeof(*native)));
250                 if(!native) ASN__DECODE_FAILED;
251         }
252
253         memset(&tmpint, 0, sizeof tmpint);
254         rval = INTEGER_decode_uper(opt_codec_ctx, td, constraints,
255                                    &tmpintptr, pd);
256         if(rval.code == RC_OK) {
257                 if((specs&&specs->field_unsigned)
258                         ? asn_INTEGER2ulong(&tmpint, (unsigned long *)native)
259                         : asn_INTEGER2long(&tmpint, native))
260                         rval.code = RC_FAIL;
261                 else
262                         ASN_DEBUG("NativeInteger %s got value %ld",
263                                 td->name, *native);
264         }
265         ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_INTEGER, &tmpint);
266
267         return rval;
268 }
269
270 asn_enc_rval_t
271 NativeInteger_encode_uper(asn_TYPE_descriptor_t *td,
272         asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) {
273         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
274         asn_enc_rval_t er;
275         long native;
276         INTEGER_t tmpint;
277
278         if(!sptr) ASN__ENCODE_FAILED;
279
280         native = *(long *)sptr;
281
282         ASN_DEBUG("Encoding NativeInteger %s %ld (UPER)", td->name, native);
283
284         memset(&tmpint, 0, sizeof(tmpint));
285         if((specs&&specs->field_unsigned)
286                 ? asn_ulong2INTEGER(&tmpint, native)
287                 : asn_long2INTEGER(&tmpint, native))
288                 ASN__ENCODE_FAILED;
289         er = INTEGER_encode_uper(td, constraints, &tmpint, po);
290         ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_INTEGER, &tmpint);
291         return er;
292 }
293
294 /*
295  * INTEGER specific human-readable output.
296  */
297 int
298 NativeInteger_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
299         asn_app_consume_bytes_f *cb, void *app_key) {
300         asn_INTEGER_specifics_t *specs=(asn_INTEGER_specifics_t *)td->specifics;
301         const long *native = (const long *)sptr;
302         char scratch[32];       /* Enough for 64-bit int */
303         int ret;
304
305         (void)td;       /* Unused argument */
306         (void)ilevel;   /* Unused argument */
307
308         if(native) {
309                 ret = snprintf(scratch, sizeof(scratch),
310                         (specs && specs->field_unsigned)
311                         ? "%lu" : "%ld", *native);
312                 assert(ret > 0 && (size_t)ret < sizeof(scratch));
313                 return (cb(scratch, ret, app_key) < 0) ? -1 : 0;
314         } else {
315                 return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
316         }
317 }
318
319 void
320 NativeInteger_free(asn_TYPE_descriptor_t *td, void *ptr, int contents_only) {
321
322         if(!td || !ptr)
323                 return;
324
325         ASN_DEBUG("Freeing %s as INTEGER (%d, %p, Native)",
326                 td->name, contents_only, ptr);
327
328         if(!contents_only) {
329                 FREEMEM(ptr);
330         }
331 }
332