blob: c35588d71604064f497c99732eba7ff57de95b95 [file] [log] [blame]
vlmfa67ddc2004-06-03 03:38:44 +00001/*-
vlm72425de2004-09-13 08:31:01 +00002 * Copyright (c) 2003, 2004 Lev Walkin <vlm@lionet.info>. All rights reserved.
vlmfa67ddc2004-06-03 03:38:44 +00003 * Redistribution and modifications are permitted subject to BSD license.
4 */
vlm39ba4c42004-09-22 16:06:28 +00005#include <asn_internal.h>
vlmfa67ddc2004-06-03 03:38:44 +00006#include <OCTET_STRING.h>
vlm0f1ab762004-10-12 05:57:23 +00007#include <BIT_STRING.h> /* for .bits_unused member */
vlmfa67ddc2004-06-03 03:38:44 +00008#include <assert.h>
9#include <errno.h>
10
11/*
12 * OCTET STRING basic type description.
13 */
vlm7b75d982004-09-29 13:20:14 +000014static ber_tlv_tag_t asn_DEF_OCTET_STRING_tags[] = {
vlmfa67ddc2004-06-03 03:38:44 +000015 (ASN_TAG_CLASS_UNIVERSAL | (4 << 2))
16};
vlm0f1ab762004-10-12 05:57:23 +000017static asn_OCTET_STRING_specifics_t asn_DEF_OCTET_STRING_specs = {
18 sizeof(OCTET_STRING_t),
19 offsetof(OCTET_STRING_t, _asn_ctx),
20 0
21};
vlm7b75d982004-09-29 13:20:14 +000022asn_TYPE_descriptor_t asn_DEF_OCTET_STRING = {
vlm9de248e2004-10-20 15:50:55 +000023 "OCTET STRING", /* Canonical name */
24 "OCTET_STRING", /* XML tag name */
vlm39ba4c42004-09-22 16:06:28 +000025 OCTET_STRING_free,
26 OCTET_STRING_print, /* non-ascii stuff, generally */
vlmfa67ddc2004-06-03 03:38:44 +000027 asn_generic_no_constraint,
28 OCTET_STRING_decode_ber,
29 OCTET_STRING_encode_der,
vlm9de248e2004-10-20 15:50:55 +000030 OCTET_STRING_decode_xer_hex,
vlm39ba4c42004-09-22 16:06:28 +000031 OCTET_STRING_encode_xer,
vlmfa67ddc2004-06-03 03:38:44 +000032 0, /* Use generic outmost tag fetcher */
vlm7b75d982004-09-29 13:20:14 +000033 asn_DEF_OCTET_STRING_tags,
34 sizeof(asn_DEF_OCTET_STRING_tags)
35 / sizeof(asn_DEF_OCTET_STRING_tags[0]),
36 asn_DEF_OCTET_STRING_tags, /* Same as above */
37 sizeof(asn_DEF_OCTET_STRING_tags)
38 / sizeof(asn_DEF_OCTET_STRING_tags[0]),
vlme413c122004-08-20 13:23:42 +000039 0, 0, /* No members */
vlm0f1ab762004-10-12 05:57:23 +000040 &asn_DEF_OCTET_STRING_specs
vlmfa67ddc2004-06-03 03:38:44 +000041};
42
vlmef1b4c02004-09-23 22:06:26 +000043#undef _CH_PHASE
44#undef NEXT_PHASE
45#undef PREV_PHASE
vlmfa67ddc2004-06-03 03:38:44 +000046#define _CH_PHASE(ctx, inc) do { \
47 if(ctx->phase == 0) \
48 ctx->step = 0; \
49 ctx->phase += inc; \
50 } while(0)
51#define NEXT_PHASE(ctx) _CH_PHASE(ctx, +1)
52#define PREV_PHASE(ctx) _CH_PHASE(ctx, -1)
53
vlmef1b4c02004-09-23 22:06:26 +000054#undef ADVANCE
vlmd86c9252004-08-25 01:34:11 +000055#define ADVANCE(num_bytes) do { \
vlmb33ed682004-09-24 20:57:41 +000056 size_t num = (num_bytes); \
vlmd86c9252004-08-25 01:34:11 +000057 buf_ptr = ((char *)buf_ptr) + num; \
58 size -= num; \
59 consumed_myself += num; \
vlmfa67ddc2004-06-03 03:38:44 +000060 } while(0)
61
vlmef1b4c02004-09-23 22:06:26 +000062#undef RETURN
vlmfa67ddc2004-06-03 03:38:44 +000063#define RETURN(_code) do { \
64 rval.code = _code; \
65 rval.consumed = consumed_myself;\
66 return rval; \
67 } while(0)
68
vlmef1b4c02004-09-23 22:06:26 +000069#undef APPEND
vlmb42843a2004-06-05 08:17:50 +000070#define APPEND(bufptr, bufsize) do { \
vlmcdfdb722004-09-04 04:44:50 +000071 size_t _bs = (bufsize); \
vlmb42843a2004-06-05 08:17:50 +000072 size_t _ns = ctx->step; /* Allocated */ \
vlmcdfdb722004-09-04 04:44:50 +000073 if(_ns <= (size_t)(st->size + _bs)) { \
vlmb42843a2004-06-05 08:17:50 +000074 void *ptr; \
vlm72425de2004-09-13 08:31:01 +000075 /* Be nice and round to the memory allocator */ \
vlmb42843a2004-06-05 08:17:50 +000076 do { _ns = _ns ? _ns<<2 : 16; } \
vlmcdfdb722004-09-04 04:44:50 +000077 while(_ns <= (size_t)(st->size + _bs)); \
vlmb42843a2004-06-05 08:17:50 +000078 ptr = REALLOC(st->buf, _ns); \
79 if(ptr) { \
vlmda674682004-08-11 09:07:36 +000080 st->buf = (uint8_t *)ptr; \
vlmb42843a2004-06-05 08:17:50 +000081 ctx->step = _ns; \
82 } else { \
83 RETURN(RC_FAIL); \
84 } \
85 } \
vlmcdfdb722004-09-04 04:44:50 +000086 memcpy(st->buf + st->size, bufptr, _bs); \
87 st->size += _bs; \
vlmb42843a2004-06-05 08:17:50 +000088 if(st->size < 0) \
89 /* Why even care?.. JIC */ \
90 RETURN(RC_FAIL); \
91 /* Convenient nul-termination */ \
92 st->buf[st->size] = '\0'; \
vlmfa67ddc2004-06-03 03:38:44 +000093 } while(0)
94
95/*
vlm267b7fd2004-10-11 11:43:08 +000096 * Internal variant of the OCTET STRING.
97 */
98typedef enum OS_type {
99 _TT_GENERIC = 0, /* Just a random OCTET STRING */
100 _TT_BIT_STRING = 1, /* BIT STRING type, a special case */
101 _TT_ANY = 2, /* ANY type, a special case too */
102} OS_type_e;
103
104/*
vlmfa67ddc2004-06-03 03:38:44 +0000105 * The main reason why ASN.1 is still alive is that too much time and effort
106 * is necessary for learning it more or less adequately, thus creating a gut
107 * necessity to demonstrate that aquired skill everywhere afterwards.
108 * No, I am not going to explain what the following stuff is.
109 */
110struct _stack_el {
vlmb33ed682004-09-24 20:57:41 +0000111 ber_tlv_len_t left; /* What's left to read (or -1) */
vlmdb6b2902004-09-27 20:54:06 +0000112 ber_tlv_len_t got; /* What was actually processed */
vlm72425de2004-09-13 08:31:01 +0000113 int cont_level; /* Depth of subcontainment */
vlmfa67ddc2004-06-03 03:38:44 +0000114 int want_nulls; /* Want null "end of content" octets? */
115 int bits_chopped; /* Flag in BIT STRING mode */
vlmdb6b2902004-09-27 20:54:06 +0000116 ber_tlv_tag_t tag; /* For debugging purposes */
vlmfa67ddc2004-06-03 03:38:44 +0000117 struct _stack_el *prev;
118 struct _stack_el *next;
119};
120struct _stack {
121 struct _stack_el *tail;
122 struct _stack_el *cur_ptr;
123};
124
125static struct _stack_el *
vlmb33ed682004-09-24 20:57:41 +0000126OS__add_stack_el(struct _stack *st) {
vlmfa67ddc2004-06-03 03:38:44 +0000127 struct _stack_el *nel;
128
vlm72425de2004-09-13 08:31:01 +0000129 /*
130 * Reuse the old stack frame or allocate a new one.
131 */
vlmfa67ddc2004-06-03 03:38:44 +0000132 if(st->cur_ptr && st->cur_ptr->next) {
133 nel = st->cur_ptr->next;
vlmfa67ddc2004-06-03 03:38:44 +0000134 nel->bits_chopped = 0;
vlmdb6b2902004-09-27 20:54:06 +0000135 nel->got = 0;
136 /* Retain the nel->cont_level, it's correct. */
vlmfa67ddc2004-06-03 03:38:44 +0000137 } else {
vlmda674682004-08-11 09:07:36 +0000138 (void *)nel = CALLOC(1, sizeof(struct _stack_el));
vlmfa67ddc2004-06-03 03:38:44 +0000139 if(nel == NULL)
140 return NULL;
141
142 if(st->tail) {
vlm72425de2004-09-13 08:31:01 +0000143 /* Increase a subcontainment depth */
144 nel->cont_level = st->tail->cont_level + 1;
vlmfa67ddc2004-06-03 03:38:44 +0000145 st->tail->next = nel;
146 }
147 nel->prev = st->tail;
148 st->tail = nel;
149 }
150
151 st->cur_ptr = nel;
152
153 return nel;
154}
155
156static struct _stack *
157_new_stack() {
vlm0f1ab762004-10-12 05:57:23 +0000158 return (struct _stack *)CALLOC(1, sizeof(struct _stack));
vlmfa67ddc2004-06-03 03:38:44 +0000159}
160
161/*
162 * Decode OCTET STRING type.
163 */
vlm9de248e2004-10-20 15:50:55 +0000164asn_dec_rval_t
vlm7b75d982004-09-29 13:20:14 +0000165OCTET_STRING_decode_ber(asn_codec_ctx_t *opt_codec_ctx,
166 asn_TYPE_descriptor_t *td,
vlmfa67ddc2004-06-03 03:38:44 +0000167 void **os_structure, void *buf_ptr, size_t size, int tag_mode) {
vlm0f1ab762004-10-12 05:57:23 +0000168 asn_OCTET_STRING_specifics_t *specs = td->specifics
vlm9de248e2004-10-20 15:50:55 +0000169 ? (asn_OCTET_STRING_specifics_t *)td->specifics
170 : &asn_DEF_OCTET_STRING_specs;
vlm0f1ab762004-10-12 05:57:23 +0000171 BIT_STRING_t *st = (BIT_STRING_t *)*os_structure;
vlm9de248e2004-10-20 15:50:55 +0000172 asn_dec_rval_t rval;
vlm7b75d982004-09-29 13:20:14 +0000173 asn_struct_ctx_t *ctx;
vlmfa67ddc2004-06-03 03:38:44 +0000174 ssize_t consumed_myself = 0;
vlm0f1ab762004-10-12 05:57:23 +0000175 struct _stack *stck; /* Expectations stack structure */
vlmdb6b2902004-09-27 20:54:06 +0000176 struct _stack_el *sel = 0; /* Stack element */
vlmfa67ddc2004-06-03 03:38:44 +0000177 int tlv_constr;
vlm0f1ab762004-10-12 05:57:23 +0000178 OS_type_e type_variant = (OS_type_e)specs->subvariant;
vlmfa67ddc2004-06-03 03:38:44 +0000179
vlmef1b4c02004-09-23 22:06:26 +0000180 ASN_DEBUG("Decoding %s as %s (frame %ld)",
181 td->name,
vlm0f1ab762004-10-12 05:57:23 +0000182 (type_variant == _TT_GENERIC) ?
183 "OCTET STRING" : "OS-SpecialCase",
vlmef1b4c02004-09-23 22:06:26 +0000184 (long)size);
vlmfa67ddc2004-06-03 03:38:44 +0000185
186 /*
187 * Create the string if does not exist.
188 */
189 if(st == NULL) {
vlm0f1ab762004-10-12 05:57:23 +0000190 (void *)st = *os_structure = CALLOC(1, specs->struct_size);
vlmfa67ddc2004-06-03 03:38:44 +0000191 if(st == NULL)
192 RETURN(RC_FAIL);
193 }
194
195 /* Restore parsing context */
vlm0f1ab762004-10-12 05:57:23 +0000196 ctx = (asn_struct_ctx_t *)((char *)st + specs->ctx_offset);
vlmfa67ddc2004-06-03 03:38:44 +0000197
198 switch(ctx->phase) {
199 case 0:
200 /*
201 * Check tags.
202 */
vlm7b75d982004-09-29 13:20:14 +0000203 rval = ber_check_tags(opt_codec_ctx, td, ctx,
vlm6678cb12004-09-26 13:10:40 +0000204 buf_ptr, size, tag_mode, -1,
vlmfa67ddc2004-06-03 03:38:44 +0000205 &ctx->left, &tlv_constr);
vlmd7c2ef32004-10-05 06:35:31 +0000206 if(rval.code != RC_OK)
207 return rval;
vlmfa67ddc2004-06-03 03:38:44 +0000208
vlmfa67ddc2004-06-03 03:38:44 +0000209 if(tlv_constr) {
210 /*
211 * Complex operation, requires stack of expectations.
212 */
213 ctx->ptr = _new_stack();
214 if(ctx->ptr) {
vlmda674682004-08-11 09:07:36 +0000215 (void *)stck = ctx->ptr;
vlmfa67ddc2004-06-03 03:38:44 +0000216 } else {
217 RETURN(RC_FAIL);
218 }
219 } else {
220 /*
221 * Jump into stackless primitive decoding.
222 */
223 _CH_PHASE(ctx, 3);
vlm0f1ab762004-10-12 05:57:23 +0000224 if(type_variant == _TT_ANY && tag_mode != 1)
vlm72425de2004-09-13 08:31:01 +0000225 APPEND(buf_ptr, rval.consumed);
vlmfa67ddc2004-06-03 03:38:44 +0000226 ADVANCE(rval.consumed);
227 goto phase3;
228 }
229
vlmfa67ddc2004-06-03 03:38:44 +0000230 NEXT_PHASE(ctx);
231 /* Fall through */
232 case 1:
233 phase1:
234 /*
235 * Fill the stack with expectations.
236 */
vlmda674682004-08-11 09:07:36 +0000237 (void *)stck = ctx->ptr;
vlmfa67ddc2004-06-03 03:38:44 +0000238 sel = stck->cur_ptr;
239 do {
240 ber_tlv_tag_t tlv_tag;
241 ber_tlv_len_t tlv_len;
vlm72425de2004-09-13 08:31:01 +0000242 ber_tlv_tag_t expected_tag;
vlmdb6b2902004-09-27 20:54:06 +0000243 ssize_t tl, ll, tlvl;
vlm6678cb12004-09-26 13:10:40 +0000244 /* This one works even if (sel->left == -1) */
245 ssize_t Left = ((!sel||(size_t)sel->left >= size)
vlmdb6b2902004-09-27 20:54:06 +0000246 ?(ssize_t)size:sel->left);
vlmfa67ddc2004-06-03 03:38:44 +0000247
vlmb33ed682004-09-24 20:57:41 +0000248
vlma351c2b2004-10-26 10:12:14 +0000249 ASN_DEBUG("%p, s->l=%ld, s->wn=%ld, s->g=%ld\n", sel,
vlm13318c12004-10-26 10:56:10 +0000250 (long)(sel?sel->left:0),
251 (long)(sel?sel->want_nulls:0),
252 (long)(sel?sel->got:0)
vlmdb6b2902004-09-27 20:54:06 +0000253 );
254 if(sel && sel->left <= 0 && sel->want_nulls == 0) {
255 if(sel->prev) {
256 struct _stack_el *prev = sel->prev;
257 if(prev->left != -1) {
258 if(prev->left < sel->got)
259 RETURN(RC_FAIL);
260 prev->left -= sel->got;
261 }
262 prev->got += sel->got;
263 sel = stck->cur_ptr = prev;
264 if(!sel) break;
265 tlv_constr = 1;
266 continue;
267 } else {
268 sel = stck->cur_ptr = 0;
269 break; /* Nothing to wait */
270 }
271 }
272
vlmb33ed682004-09-24 20:57:41 +0000273 tl = ber_fetch_tag(buf_ptr, Left, &tlv_tag);
vlma351c2b2004-10-26 10:12:14 +0000274 ASN_DEBUG("fetch tag(size=%ld,L=%ld), %sstack, left=%ld, wn=%ld, tl=%ld",
275 (long)size, (long)Left, sel?"":"!",
vlm13318c12004-10-26 10:56:10 +0000276 (long)(sel?sel->left:0),
277 (long)(sel?sel->want_nulls:0),
vlma351c2b2004-10-26 10:12:14 +0000278 (long)tl);
vlmfa67ddc2004-06-03 03:38:44 +0000279 switch(tl) {
280 case -1: RETURN(RC_FAIL);
281 case 0: RETURN(RC_WMORE);
282 }
283
284 tlv_constr = BER_TLV_CONSTRUCTED(buf_ptr);
285
286 ll = ber_fetch_length(tlv_constr,
vlmb33ed682004-09-24 20:57:41 +0000287 (char *)buf_ptr + tl, Left - tl, &tlv_len);
vlmdb6b2902004-09-27 20:54:06 +0000288 ASN_DEBUG("Got tag=%s, tc=%d, left=%ld, tl=%d, len=%d, ll=%d",
vlmcdfdb722004-09-04 04:44:50 +0000289 ber_tlv_tag_string(tlv_tag), tlv_constr,
vlmdb6b2902004-09-27 20:54:06 +0000290 (long)Left, tl, tlv_len, ll);
vlmfa67ddc2004-06-03 03:38:44 +0000291 switch(ll) {
292 case -1: RETURN(RC_FAIL);
293 case 0: RETURN(RC_WMORE);
294 }
295
vlmcdfdb722004-09-04 04:44:50 +0000296 if(sel && sel->want_nulls
vlmfa67ddc2004-06-03 03:38:44 +0000297 && ((uint8_t *)buf_ptr)[0] == 0
298 && ((uint8_t *)buf_ptr)[1] == 0)
299 {
vlmcdfdb722004-09-04 04:44:50 +0000300
301 ASN_DEBUG("Eat EOC; wn=%d--", sel->want_nulls);
302
vlm0f1ab762004-10-12 05:57:23 +0000303 if(type_variant == _TT_ANY
vlm267b7fd2004-10-11 11:43:08 +0000304 && (tag_mode != 1 || sel->cont_level))
305 APPEND("\0\0", 2);
vlmdb6b2902004-09-27 20:54:06 +0000306
307 ADVANCE(2);
308 sel->got += 2;
309 if(sel->left != -1) {
310 sel->left -= 2; /* assert(sel->left >= 2) */
311 }
312
vlmfa67ddc2004-06-03 03:38:44 +0000313 sel->want_nulls--;
314 if(sel->want_nulls == 0) {
315 /* Move to the next expectation */
vlmdb6b2902004-09-27 20:54:06 +0000316 sel->left = 0;
vlmfa67ddc2004-06-03 03:38:44 +0000317 tlv_constr = 1;
vlmfa67ddc2004-06-03 03:38:44 +0000318 }
vlmcdfdb722004-09-04 04:44:50 +0000319
320 continue;
vlm72425de2004-09-13 08:31:01 +0000321 }
322
323 /*
324 * Set up expected tags,
325 * depending on ASN.1 type being decoded.
326 */
vlm0f1ab762004-10-12 05:57:23 +0000327 switch(type_variant) {
vlm72425de2004-09-13 08:31:01 +0000328 case _TT_BIT_STRING:
329 /* X.690: 8.6.4.1, NOTE 2 */
330 /* Fall through */
331 case _TT_GENERIC:
332 default:
333 if(sel) {
334 int level = sel->cont_level;
335 if(level < td->all_tags_count) {
336 expected_tag = td->all_tags[level];
337 break;
338 } else if(td->all_tags_count) {
339 expected_tag = td->all_tags
340 [td->all_tags_count - 1];
341 break;
342 }
343 /* else, Fall through */
344 }
345 /* Fall through */
346 case _TT_ANY:
347 expected_tag = tlv_tag;
348 break;
349 }
350
351
352 if(tlv_tag != expected_tag) {
vlmfa67ddc2004-06-03 03:38:44 +0000353 char buf[2][32];
354 ber_tlv_tag_snprint(tlv_tag,
355 buf[0], sizeof(buf[0]));
356 ber_tlv_tag_snprint(td->tags[td->tags_count-1],
357 buf[1], sizeof(buf[1]));
358 ASN_DEBUG("Tag does not match expectation: %s != %s",
359 buf[0], buf[1]);
360 RETURN(RC_FAIL);
361 }
362
vlm7b75d982004-09-29 13:20:14 +0000363 tlvl = tl + ll; /* Combined length of T and L encoding */
364 if((tlv_len + tlvl) < 0) {
365 /* tlv_len value is too big */
366 ASN_DEBUG("TLV encoding + length (%ld) is too big",
367 (long)tlv_len);
368 RETURN(RC_FAIL);
369 }
370
vlmfa67ddc2004-06-03 03:38:44 +0000371 /*
372 * Append a new expectation.
373 */
vlmb33ed682004-09-24 20:57:41 +0000374 sel = OS__add_stack_el(stck);
vlmdb6b2902004-09-27 20:54:06 +0000375 if(!sel) RETURN(RC_FAIL);
vlmfa67ddc2004-06-03 03:38:44 +0000376
vlmdb6b2902004-09-27 20:54:06 +0000377 sel->tag = tlv_tag;
378
379 sel->want_nulls = (tlv_len==-1);
380 if(sel->prev && sel->prev->left != -1) {
381 /* Check that the parent frame is big enough */
382 if(sel->prev->left < tlvl + (tlv_len==-1?0:tlv_len))
383 RETURN(RC_FAIL);
384 if(tlv_len == -1)
385 sel->left = sel->prev->left - tlvl;
386 else
387 sel->left = tlv_len;
388 } else {
389 sel->left = tlv_len;
390 }
vlm0f1ab762004-10-12 05:57:23 +0000391 if(type_variant == _TT_ANY
vlm267b7fd2004-10-11 11:43:08 +0000392 && (tag_mode != 1 || sel->cont_level))
393 APPEND(buf_ptr, tlvl);
vlmdb6b2902004-09-27 20:54:06 +0000394 sel->got += tlvl;
395 ADVANCE(tlvl);
396
vlma351c2b2004-10-26 10:12:14 +0000397 ASN_DEBUG("+EXPECT2 got=%ld left=%ld, wn=%d, clvl=%d",
398 (long)sel->got, (long)sel->left,
399 sel->want_nulls, sel->cont_level);
vlmdb6b2902004-09-27 20:54:06 +0000400
vlmfa67ddc2004-06-03 03:38:44 +0000401 } while(tlv_constr);
402 if(sel == NULL) {
403 /* Finished operation, "phase out" */
vlm72425de2004-09-13 08:31:01 +0000404 ASN_DEBUG("Phase out");
vlmfa67ddc2004-06-03 03:38:44 +0000405 _CH_PHASE(ctx, +3);
406 break;
407 }
408
409 NEXT_PHASE(ctx);
410 /* Fall through */
411 case 2:
vlmda674682004-08-11 09:07:36 +0000412 (void *)stck = ctx->ptr;
vlmfa67ddc2004-06-03 03:38:44 +0000413 sel = stck->cur_ptr;
vlmdb6b2902004-09-27 20:54:06 +0000414 ASN_DEBUG("Phase 2: Need %ld bytes, size=%ld, alrg=%ld, wn=%d",
415 (long)sel->left, (long)size, (long)sel->got,
416 sel->want_nulls);
vlmfa67ddc2004-06-03 03:38:44 +0000417 {
418 ber_tlv_len_t len;
419
420 assert(sel->left >= 0);
421
vlmc5190612004-08-18 04:53:32 +0000422 len = ((ber_tlv_len_t)size < sel->left)
423 ? (ber_tlv_len_t)size : sel->left;
vlmfa67ddc2004-06-03 03:38:44 +0000424 if(len > 0) {
vlm0f1ab762004-10-12 05:57:23 +0000425 if(type_variant == _TT_BIT_STRING
vlm72425de2004-09-13 08:31:01 +0000426 && sel->bits_chopped == 0) {
vlm0f1ab762004-10-12 05:57:23 +0000427 /* Put the unused-bits-octet away */
428 st->bits_unused = *(uint8_t *)buf_ptr;
vlm1ff928d2004-08-11 08:10:13 +0000429 APPEND(((char *)buf_ptr+1), (len - 1));
vlmfa67ddc2004-06-03 03:38:44 +0000430 sel->bits_chopped = 1;
431 } else {
432 APPEND(buf_ptr, len);
433 }
434 ADVANCE(len);
435 sel->left -= len;
vlmdb6b2902004-09-27 20:54:06 +0000436 sel->got += len;
vlmfa67ddc2004-06-03 03:38:44 +0000437 }
438
vlmdb6b2902004-09-27 20:54:06 +0000439 if(sel->left) {
440 ASN_DEBUG("OS left %ld, size = %ld, wn=%d\n",
441 (long)sel->left, (long)size, sel->want_nulls);
vlmfa67ddc2004-06-03 03:38:44 +0000442 RETURN(RC_WMORE);
vlmfa67ddc2004-06-03 03:38:44 +0000443 }
vlmdb6b2902004-09-27 20:54:06 +0000444
445 PREV_PHASE(ctx);
446 goto phase1;
vlmfa67ddc2004-06-03 03:38:44 +0000447 }
448 break;
449 case 3:
450 phase3:
451 /*
452 * Primitive form, no stack required.
453 */
vlm0f1ab762004-10-12 05:57:23 +0000454 assert(ctx->left >= 0);
455
vlmb42843a2004-06-05 08:17:50 +0000456 if(size < (size_t)ctx->left) {
vlm0f1ab762004-10-12 05:57:23 +0000457 if(!size) RETURN(RC_WMORE);
458 if(type_variant == _TT_BIT_STRING && ctx->step == 0) {
459 st->bits_unused = *(uint8_t *)buf_ptr;
460 ctx->left--;
461 ADVANCE(1);
462 }
vlmfa67ddc2004-06-03 03:38:44 +0000463 APPEND(buf_ptr, size);
vlm0f1ab762004-10-12 05:57:23 +0000464 assert(ctx->step);
vlmfa67ddc2004-06-03 03:38:44 +0000465 ctx->left -= size;
466 ADVANCE(size);
467 RETURN(RC_WMORE);
468 } else {
vlm0f1ab762004-10-12 05:57:23 +0000469 if(type_variant == _TT_BIT_STRING
470 && ctx->step == 0 && ctx->left) {
471 st->bits_unused = *(uint8_t *)buf_ptr;
472 ctx->left--;
473 ADVANCE(1);
474 }
vlmfa67ddc2004-06-03 03:38:44 +0000475 APPEND(buf_ptr, ctx->left);
476 ADVANCE(ctx->left);
477 ctx->left = 0;
478
479 NEXT_PHASE(ctx);
480 }
481 break;
482 }
483
vlmdb6b2902004-09-27 20:54:06 +0000484 if(sel) {
485 ASN_DEBUG("3sel p=%p, wn=%d, l=%ld, g=%ld, size=%ld",
486 sel->prev, sel->want_nulls,
487 (long)sel->left, (long)sel->got, (long)size);
488 if(sel->prev || sel->want_nulls > 1 || sel->left > 0) {
489 RETURN(RC_WMORE);
490 }
491 }
492
vlmfa67ddc2004-06-03 03:38:44 +0000493 /*
494 * BIT STRING-specific processing.
495 */
vlm0f1ab762004-10-12 05:57:23 +0000496 if(type_variant == _TT_BIT_STRING && st->size) {
vlmfa67ddc2004-06-03 03:38:44 +0000497 /* Finalize BIT STRING: zero out unused bits. */
vlm0f1ab762004-10-12 05:57:23 +0000498 st->buf[st->size-1] &= 0xff << st->bits_unused;
vlmfa67ddc2004-06-03 03:38:44 +0000499 }
500
vlma351c2b2004-10-26 10:12:14 +0000501 ASN_DEBUG("Took %ld bytes to encode %s: [%s]:%ld",
502 (long)consumed_myself, td->name,
vlm0f1ab762004-10-12 05:57:23 +0000503 (type_variant == _TT_GENERIC) ? (char *)st->buf : "<data>",
vlma351c2b2004-10-26 10:12:14 +0000504 (long)st->size);
vlmfa67ddc2004-06-03 03:38:44 +0000505
vlmfa67ddc2004-06-03 03:38:44 +0000506
vlmdb6b2902004-09-27 20:54:06 +0000507 RETURN(RC_OK);
vlmfa67ddc2004-06-03 03:38:44 +0000508}
509
510/*
511 * Encode OCTET STRING type using DER.
512 */
vlm39ba4c42004-09-22 16:06:28 +0000513asn_enc_rval_t
vlm0f1ab762004-10-12 05:57:23 +0000514OCTET_STRING_encode_der(asn_TYPE_descriptor_t *td, void *sptr,
vlmfa67ddc2004-06-03 03:38:44 +0000515 int tag_mode, ber_tlv_tag_t tag,
516 asn_app_consume_bytes_f *cb, void *app_key) {
vlm0f1ab762004-10-12 05:57:23 +0000517 asn_enc_rval_t er;
518 asn_OCTET_STRING_specifics_t *specs = td->specifics
vlm9de248e2004-10-20 15:50:55 +0000519 ? (asn_OCTET_STRING_specifics_t *)td->specifics
520 : &asn_DEF_OCTET_STRING_specs;
vlm0f1ab762004-10-12 05:57:23 +0000521 BIT_STRING_t *st = (BIT_STRING_t *)sptr;
522 OS_type_e type_variant = (OS_type_e)specs->subvariant;
523 int fix_last_byte = 0;
vlmfa67ddc2004-06-03 03:38:44 +0000524
525 ASN_DEBUG("%s %s as OCTET STRING",
vlm3e693022004-09-02 12:57:25 +0000526 cb?"Estimating":"Encoding", td->name);
vlmfa67ddc2004-06-03 03:38:44 +0000527
528 /*
vlm0f1ab762004-10-12 05:57:23 +0000529 * Write tags.
vlmfa67ddc2004-06-03 03:38:44 +0000530 */
vlm0f1ab762004-10-12 05:57:23 +0000531 if(type_variant != _TT_ANY || tag_mode == 1) {
532 er.encoded = der_write_tags(td,
533 (type_variant == _TT_BIT_STRING) + st->size,
534 tag_mode, type_variant == _TT_ANY, tag, cb, app_key);
535 if(er.encoded == -1) {
536 er.failed_type = td;
537 er.structure_ptr = sptr;
538 return er;
vlmfa67ddc2004-06-03 03:38:44 +0000539 }
vlm0f1ab762004-10-12 05:57:23 +0000540 } else {
541 /* Disallow: [<tag>] IMPLICIT ANY */
542 assert(type_variant != _TT_ANY || tag_mode != -1);
543 er.encoded = 0;
544 }
545
546 if(!cb) {
547 er.encoded += (type_variant == _TT_BIT_STRING) + st->size;
548 return er;
vlmfa67ddc2004-06-03 03:38:44 +0000549 }
550
vlm267b7fd2004-10-11 11:43:08 +0000551 /*
vlm0f1ab762004-10-12 05:57:23 +0000552 * Prepare to deal with the last octet of BIT STRING.
vlm267b7fd2004-10-11 11:43:08 +0000553 */
vlm0f1ab762004-10-12 05:57:23 +0000554 if(type_variant == _TT_BIT_STRING) {
555 uint8_t b = st->bits_unused & 0x07;
556 if(b && st->size) fix_last_byte = 1;
557 _ASN_CALLBACK(&b, 1);
558 er.encoded++;
vlmfa67ddc2004-06-03 03:38:44 +0000559 }
560
vlm0f1ab762004-10-12 05:57:23 +0000561 /* Invoke callback for the main part of the buffer */
562 _ASN_CALLBACK(st->buf, st->size - fix_last_byte);
vlmfa67ddc2004-06-03 03:38:44 +0000563
vlm0f1ab762004-10-12 05:57:23 +0000564 /* The last octet should be stripped off the unused bits */
565 if(fix_last_byte) {
566 uint8_t b = st->buf[st->size-1] & (0xff << st->bits_unused);
567 _ASN_CALLBACK(&b, 1);
vlmfa67ddc2004-06-03 03:38:44 +0000568 }
569
vlm0f1ab762004-10-12 05:57:23 +0000570 er.encoded += st->size;
571 return er;
572cb_failed:
573 _ASN_ENCODE_FAILED;
vlmfa67ddc2004-06-03 03:38:44 +0000574}
575
vlm39ba4c42004-09-22 16:06:28 +0000576asn_enc_rval_t
vlm7b75d982004-09-29 13:20:14 +0000577OCTET_STRING_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
vlm39ba4c42004-09-22 16:06:28 +0000578 int ilevel, enum xer_encoder_flags_e flags,
579 asn_app_consume_bytes_f *cb, void *app_key) {
580 static const char *h2c = "0123456789ABCDEF";
581 const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
582 asn_enc_rval_t er;
583 char scratch[16 * 3 + 4];
584 char *p = scratch;
585 uint8_t *buf;
586 uint8_t *end;
587 size_t i;
588
vlm84d551b2004-10-03 09:13:02 +0000589 if(!st || !st->buf)
590 _ASN_ENCODE_FAILED;
vlm39ba4c42004-09-22 16:06:28 +0000591
592 er.encoded = 0;
593
594 /*
595 * Dump the contents of the buffer in hexadecimal.
596 */
597 buf = st->buf;
598 end = buf + st->size;
599 if(flags & XER_F_CANONICAL) {
600 char *scend = scratch + (sizeof(scratch) - 2);
601 for(; buf < end; buf++) {
602 if(p >= scend) {
603 _ASN_CALLBACK(scratch, p - scratch);
604 er.encoded += p - scratch;
605 p = scratch;
606 }
607 *p++ = h2c[(*buf >> 4) & 0x0F];
608 *p++ = h2c[*buf & 0x0F];
609 }
vlmef1b4c02004-09-23 22:06:26 +0000610
611 _ASN_CALLBACK(scratch, p-scratch); /* Dump the rest */
612 er.encoded += p - scratch;
vlm39ba4c42004-09-22 16:06:28 +0000613 } else {
614 for(i = 0; buf < end; buf++, i++) {
615 if(!(i % 16) && (i || st->size > 16)) {
616 _ASN_CALLBACK(scratch, p-scratch);
617 er.encoded += (p-scratch);
618 p = scratch;
619 _i_ASN_TEXT_INDENT(1, ilevel);
620 }
621 *p++ = h2c[(*buf >> 4) & 0x0F];
622 *p++ = h2c[*buf & 0x0F];
623 *p++ = 0x20;
624 }
vlmef1b4c02004-09-23 22:06:26 +0000625 if(p - scratch) {
626 p--; /* Remove the tail space */
627 _ASN_CALLBACK(scratch, p-scratch); /* Dump the rest */
628 er.encoded += p - scratch;
629 if(st->size > 16)
630 _i_ASN_TEXT_INDENT(1, ilevel-1);
631 }
vlm39ba4c42004-09-22 16:06:28 +0000632 }
633
vlm39ba4c42004-09-22 16:06:28 +0000634 return er;
vlm84d551b2004-10-03 09:13:02 +0000635cb_failed:
636 _ASN_ENCODE_FAILED;
vlm39ba4c42004-09-22 16:06:28 +0000637}
638
vlm393a57a2004-10-03 10:54:25 +0000639static struct OCTET_STRING__xer_escape_table_s {
640 char *string;
641 int size;
642} OCTET_STRING__xer_escape_table[] = {
643#define OSXET(s) { s, sizeof(s) - 1 }
644 OSXET("\074\156\165\154\057\076"), /* <nul/> */
645 OSXET("\074\163\157\150\057\076"), /* <soh/> */
646 OSXET("\074\163\164\170\057\076"), /* <stx/> */
647 OSXET("\074\145\164\170\057\076"), /* <etx/> */
648 OSXET("\074\145\157\164\057\076"), /* <eot/> */
649 OSXET("\074\145\156\161\057\076"), /* <enq/> */
650 OSXET("\074\141\143\153\057\076"), /* <ack/> */
651 OSXET("\074\142\145\154\057\076"), /* <bel/> */
652 OSXET("\074\142\163\057\076"), /* <bs/> */
653 OSXET("\011"), /* \t */
654 OSXET("\012"), /* \n */
655 OSXET("\074\166\164\057\076"), /* <vt/> */
656 OSXET("\074\146\146\057\076"), /* <ff/> */
657 OSXET("\015"), /* \r */
658 OSXET("\074\163\157\057\076"), /* <so/> */
659 OSXET("\074\163\151\057\076"), /* <si/> */
660 OSXET("\074\144\154\145\057\076"), /* <dle/> */
661 OSXET("\074\144\143\061\057\076"), /* <de1/> */
662 OSXET("\074\144\143\062\057\076"), /* <de2/> */
663 OSXET("\074\144\143\063\057\076"), /* <de3/> */
664 OSXET("\074\144\143\064\057\076"), /* <de4/> */
665 OSXET("\074\156\141\153\057\076"), /* <nak/> */
666 OSXET("\074\163\171\156\057\076"), /* <syn/> */
667 OSXET("\074\145\164\142\057\076"), /* <etb/> */
668 OSXET("\074\143\141\156\057\076"), /* <can/> */
669 OSXET("\074\145\155\057\076"), /* <em/> */
670 OSXET("\074\163\165\142\057\076"), /* <sub/> */
671 OSXET("\074\145\163\143\057\076"), /* <esc/> */
672 OSXET("\074\151\163\064\057\076"), /* <is4/> */
673 OSXET("\074\151\163\063\057\076"), /* <is3/> */
674 OSXET("\074\151\163\062\057\076"), /* <is2/> */
675 OSXET("\074\151\163\061\057\076"), /* <is1/> */
676 { 0, 0 }, /* " " */
677 { 0, 0 }, /* ! */
678 { 0, 0 }, /* \" */
679 { 0, 0 }, /* # */
680 { 0, 0 }, /* $ */
681 { 0, 0 }, /* % */
682 OSXET("\046\141\155\160\073"), /* &amp; */
683 { 0, 0 }, /* ' */
684 {0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0}, /* ()*+,-./ */
685 {0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0}, /* 01234567 */
686 {0,0},{0,0},{0,0},{0,0}, /* 89:; */
687 OSXET("\046\154\164\073"), /* &lt; */
688 { 0, 0 }, /* = */
689 OSXET("\046\147\164\073"), /* &gt; */
690};
691
vlm9de248e2004-10-20 15:50:55 +0000692static int
693OS__check_escaped_control_char(void *buf, int size) {
694 size_t i;
695 /*
696 * Inefficient algorithm which translates the escape sequences
697 * defined above into characters. Returns -1 if not found.
698 * TODO: replace by a faster algorithm (bsearch(), hash or
699 * nested table lookups).
700 */
701 for(i = 0; i < 32 /* Don't spend time on the bottom half */; i++) {
702 struct OCTET_STRING__xer_escape_table_s *el;
703 el = &OCTET_STRING__xer_escape_table[i];
704 if(el->size == size && memcmp(buf, el->string, size) == 0)
705 return i;
706 }
707 return -1;
708}
709
710static int
711OCTET_STRING__handle_control_chars(void *struct_ptr, void *chunk_buf, size_t chunk_size) {
712 /*
713 * This might be one of the escape sequences
714 * for control characters. Check it out.
715 * #11.15.5
716 */
717 int control_char = OS__check_escaped_control_char(chunk_buf,chunk_size);
718 if(control_char >= 0) {
719 OCTET_STRING_t *st = (OCTET_STRING_t *)struct_ptr;
720 void *p = REALLOC(st->buf, st->size + 2);
721 if(p) {
722 st->buf = (uint8_t *)p;
723 st->buf[st->size++] = control_char;
724 st->buf[st->size] = '\0'; /* nul-termination */
725 return 0;
726 }
727 }
728
729 return -1; /* No, it's not */
730}
731
vlm39ba4c42004-09-22 16:06:28 +0000732asn_enc_rval_t
vlm9de248e2004-10-20 15:50:55 +0000733OCTET_STRING_encode_xer_utf8(asn_TYPE_descriptor_t *td, void *sptr,
vlm39ba4c42004-09-22 16:06:28 +0000734 int ilevel, enum xer_encoder_flags_e flags,
735 asn_app_consume_bytes_f *cb, void *app_key) {
736 const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
737 asn_enc_rval_t er;
vlm393a57a2004-10-03 10:54:25 +0000738 uint8_t *buf, *end;
739 uint8_t *ss; /* Sequence start */
740 ssize_t encoded_len = 0;
vlm39ba4c42004-09-22 16:06:28 +0000741
742 (void)ilevel; /* Unused argument */
743 (void)flags; /* Unused argument */
744
745 if(!st || !st->buf)
746 _ASN_ENCODE_FAILED;
747
vlm393a57a2004-10-03 10:54:25 +0000748 buf = st->buf;
749 end = buf + st->size;
750 for(ss = buf; buf < end; buf++) {
vlmd7c2ef32004-10-05 06:35:31 +0000751 unsigned int ch = *buf;
vlm393a57a2004-10-03 10:54:25 +0000752 int s_len; /* Special encoding sequence length */
vlm39ba4c42004-09-22 16:06:28 +0000753
vlm393a57a2004-10-03 10:54:25 +0000754 /*
755 * Escape certain characters: X.680/11.15
756 */
757 if(ch < sizeof(OCTET_STRING__xer_escape_table)
758 /sizeof(OCTET_STRING__xer_escape_table[0])
759 && (s_len = OCTET_STRING__xer_escape_table[ch].size)) {
760 if(((buf - ss) && cb(ss, buf - ss, app_key) < 0)
761 || cb(OCTET_STRING__xer_escape_table[ch].string, s_len,
762 app_key) < 0)
763 _ASN_ENCODE_FAILED;
764 encoded_len += (buf - ss) + s_len;
765 ss = buf + 1;
766 }
767 }
768
769 encoded_len += (buf - ss);
770 if((buf - ss) && cb(ss, buf - ss, app_key) < 0)
771 _ASN_ENCODE_FAILED;
772
773 er.encoded = encoded_len;
vlm39ba4c42004-09-22 16:06:28 +0000774 return er;
775}
776
vlm9de248e2004-10-20 15:50:55 +0000777/*
778 * Convert from hexadecimal format (cstring): "AB CD EF"
779 */
780static ssize_t OCTET_STRING__convert_hexadecimal(void *sptr, void *chunk_buf, size_t chunk_size, int have_more) {
781 OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
782 char *chunk_stop = (char *)chunk_buf;
783 char *p = chunk_stop;
784 char *pend = p + chunk_size;
785 unsigned int clv = 0;
786 int half = 0; /* Half bit */
787 uint8_t *buf;
788
789 /* Reallocate buffer according to high cap estimation */
790 ssize_t _ns = st->size + (chunk_size + 1) / 2;
791 void *nptr = REALLOC(st->buf, _ns + 1);
792 if(!nptr) return -1;
793 st->buf = (uint8_t *)nptr;
794 buf = st->buf + st->size;
795
796 /*
797 * If something like " a b c " appears here, the " a b":3 will be
798 * converted, and the rest skipped. That is, unless buf_size is greater
799 * than chunk_size, then it'll be equivalent to "ABC0".
800 */
801 for(; p < pend; p++) {
802 int ch = *(unsigned char *)p;
803 switch(ch) {
804 case 0x09: case 0x0a: case 0x0c: case 0x0d:
805 case 0x20:
806 /* Ignore whitespace */
807 continue;
808 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: /*01234*/
809 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39: /*56789*/
810 clv = (clv << 4) + (ch - 0x30);
811 break;
812 case 0x41: case 0x42: case 0x43: /* ABC */
813 case 0x44: case 0x45: case 0x46: /* DEF */
814 clv = (clv << 4) + (ch - (0x41 + 10));
815 break;
816 case 0x61: case 0x62: case 0x63: /* abc */
817 case 0x64: case 0x65: case 0x66: /* def */
818 clv = (clv << 4) + (ch - (0x61 + 10));
819 break;
820 default:
821 *buf = 0; /* JIC */
822 return -1;
823 }
824 if(half++) {
825 half = 0;
826 *buf++ = clv;
827 chunk_stop = p + 1;
828 }
829 }
830
831 /*
832 * Check partial decoding.
833 */
834 if(half) {
835 if(have_more) {
836 /*
837 * Partial specification is fine,
838 * because no more more PXER_TEXT data is available.
839 */
840 *buf++ = clv << 4;
841 chunk_stop = p;
842 }
843 } else {
844 chunk_stop = p;
845 }
846
847 st->size = buf - st->buf; /* Adjust the buffer size */
848 assert(st->size <= _ns);
849 st->buf[st->size] = 0; /* Courtesy termination */
850
851 return (chunk_stop - (char *)chunk_buf); /* Converted size */
852}
853
854/*
855 * Convert from binary format: "00101011101"
856 */
857static ssize_t OCTET_STRING__convert_binary(void *sptr, void *chunk_buf, size_t chunk_size, int have_more) {
858 BIT_STRING_t *st = (BIT_STRING_t *)sptr;
859 char *p = (char *)chunk_buf;
860 char *pend = p + chunk_size;
861 int bits_unused = st->bits_unused & 0x7;
862 uint8_t *buf;
863
864 /* Reallocate buffer according to high cap estimation */
865 ssize_t _ns = st->size + (chunk_size + 7) / 8;
866 void *nptr = REALLOC(st->buf, _ns + 1);
867 if(!nptr) return -1;
868 st->buf = (uint8_t *)nptr;
869 buf = st->buf + st->size;
870
871 (void)have_more;
872
873 if(bits_unused == 0)
874 bits_unused = 8;
875 else if(st->size)
876 buf--;
877
878 /*
879 * Convert series of 0 and 1 into the octet string.
880 */
881 for(; p < pend; p++) {
882 int ch = *(unsigned char *)p;
883 switch(ch) {
884 case 0x09: case 0x0a: case 0x0c: case 0x0d:
885 case 0x20:
886 /* Ignore whitespace */
887 break;
888 case 0x30:
889 case 0x31:
890 if(bits_unused-- <= 0) {
891 *++buf = 0; /* Clean the cell */
892 bits_unused = 7;
893 }
894 *buf |= (ch&1) << bits_unused;
895 break;
896 default:
897 st->bits_unused = bits_unused;
898 return -1;
899 }
900 }
901
902 if(bits_unused == 8) {
903 st->size = buf - st->buf;
904 st->bits_unused = 0;
905 } else {
906 st->size = buf - st->buf + 1;
907 st->bits_unused = bits_unused;
908 }
909
910 assert(st->size <= _ns);
911 st->buf[st->size] = 0; /* Courtesy termination */
912
913 return chunk_size; /* Converted in full */
914}
915
916/*
917 * Something like strtod(), but with stricter rules.
918 */
919static int
vlm6c593842004-10-26 09:03:31 +0000920OS__strtoent(int base, char *buf, char *end, int32_t *return_value) {
921 int32_t val = 0;
vlm9de248e2004-10-20 15:50:55 +0000922 char *p;
923
924 for(p = buf; p < end; p++) {
925 int ch = *p;
926 if((val * base + base) < 0) return -1; /* Strange huge value */
927 switch(ch) {
928 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: /*01234*/
929 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39: /*56789*/
930 val = val * base + (ch - 0x30);
931 break;
932 case 0x41: case 0x42: case 0x43: /* ABC */
933 case 0x44: case 0x45: case 0x46: /* DEF */
934 val = val * base + (ch - (0x41 + 10));
935 break;
936 case 0x61: case 0x62: case 0x63: /* abc */
937 case 0x64: case 0x65: case 0x66: /* def */
938 val = val * base + (ch - (0x61 + 10));
939 break;
940 case 0x3b: /* ';' */
941 *return_value = val;
942 return (p - buf) + 1;
943 default:
944 return -1; /* Character set error */
945 }
946 }
947
948 /* Do not return value. It's an error we're talking about here. */
949 return (p - buf);
950}
951
952/*
953 * Convert from the plain UTF-8 format, expanding entity references: "2 &lt; 3"
954 */
955static ssize_t OCTET_STRING__convert_entrefs(void *sptr, void *chunk_buf, size_t chunk_size, int have_more) {
956 OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
957 char *p = (char *)chunk_buf;
958 char *pend = p + chunk_size;
959 uint8_t *buf;
960
961 /* Reallocate buffer */
962 ssize_t _ns = st->size + chunk_size;
963 void *nptr = REALLOC(st->buf, _ns + 1);
964 if(!nptr) return -1;
965 st->buf = (uint8_t *)nptr;
966 buf = st->buf + st->size;
967
968 /*
969 * Convert series of 0 and 1 into the octet string.
970 */
971 for(; p < pend; p++) {
972 int ch = *(unsigned char *)p;
973 int len; /* Length of the rest of the chunk */
974
975 if(ch != 0x26 /* '&' */) {
976 *buf++ = ch;
977 continue; /* That was easy... */
978 }
979
980 /*
981 * Process entity reference.
982 */
983 len = chunk_size - (p - (char *)chunk_buf);
984 if(len == 1 /* "&" */) goto want_more;
985 if(p[1] == 0x23 /* '#' */) {
986 char *pval; /* Pointer to start of digits */
vlm6c593842004-10-26 09:03:31 +0000987 int32_t val; /* Entity reference value */
vlm9de248e2004-10-20 15:50:55 +0000988 int base;
989
990 if(len == 2 /* "&#" */) goto want_more;
991 if(p[2] == 0x78 /* 'x' */)
992 pval = p + 3, base = 16;
993 else
994 pval = p + 2, base = 10;
995 len = OS__strtoent(base, pval, p + len, &val);
996 if(len == -1) {
997 /* Invalid charset. Just copy verbatim. */
998 *buf++ = ch;
999 continue;
1000 }
1001 if(!len || pval[len-1] != 0x3b) goto want_more;
1002 assert(val > 0);
1003 p += (pval - p) + len - 1; /* Advance past entref */
1004
1005 if(val < 0x80) {
1006 *buf++ = (char)val;
1007 } else if(val < 0x800) {
1008 *buf++ = 0xc0 | ((val >> 6));
1009 *buf++ = 0x80 | ((val & 0x3f));
1010 } else if(val < 0x10000) {
1011 *buf++ = 0xe0 | ((val >> 12));
1012 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1013 *buf++ = 0x80 | ((val & 0x3f));
1014 } else if(val < 0x200000) {
1015 *buf++ = 0xf0 | ((val >> 18));
1016 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1017 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1018 *buf++ = 0x80 | ((val & 0x3f));
1019 } else if(val < 0x4000000) {
1020 *buf++ = 0xf8 | ((val >> 24));
1021 *buf++ = 0x80 | ((val >> 18) & 0x3f);
1022 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1023 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1024 *buf++ = 0x80 | ((val & 0x3f));
1025 } else {
1026 *buf++ = 0xfc | ((val >> 30) & 0x1);
1027 *buf++ = 0x80 | ((val >> 24) & 0x3f);
1028 *buf++ = 0x80 | ((val >> 18) & 0x3f);
1029 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1030 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1031 *buf++ = 0x80 | ((val & 0x3f));
1032 }
1033 } else {
1034 /*
1035 * Ugly, limited parsing of &amp; &gt; &lt;
1036 */
1037 char *sc = (char *)memchr(p, 0x3b, len > 5 ? 5 : len);
1038 if(!sc) goto want_more;
1039 if((sc - p) == 4
1040 && p[1] == 0x61 /* 'a' */
1041 && p[2] == 0x6d /* 'm' */
1042 && p[3] == 0x70 /* 'p' */) {
1043 *buf++ = 0x26;
1044 p = sc;
1045 continue;
1046 }
1047 if((sc - p) == 3) {
1048 if(p[1] == 0x6c) {
1049 *buf = 0x3c; /* '<' */
1050 } else if(p[1] == 0x67) {
1051 *buf = 0x3e; /* '>' */
1052 } else {
1053 /* Unsupported entity reference */
1054 *buf++ = ch;
1055 continue;
1056 }
1057 if(p[2] != 0x74) {
1058 /* Unsupported entity reference */
1059 *buf++ = ch;
1060 continue;
1061 }
1062 buf++;
1063 p = sc;
1064 continue;
1065 }
1066 /* Unsupported entity reference */
1067 *buf++ = ch;
1068 }
1069
1070 continue;
1071 want_more:
1072 if(have_more) {
1073 /*
1074 * We know that no more data (of the same type)
1075 * is coming. Copy the rest verbatim.
1076 */
1077 *buf++ = ch;
1078 continue;
1079 }
1080 *buf = 0; /* JIC */
1081 /* Processing stalled: need more data */
1082 return (p - (char *)chunk_buf);
1083 }
1084
1085 st->size = buf - st->buf;
1086 assert(st->size <= _ns);
1087 st->buf[st->size] = 0; /* Courtesy termination */
1088
1089 return chunk_size; /* Converted in full */
1090}
1091
1092/*
1093 * Decode OCTET STRING from the XML element's body.
1094 */
1095static asn_dec_rval_t
1096OCTET_STRING__decode_xer(asn_codec_ctx_t *opt_codec_ctx,
1097 asn_TYPE_descriptor_t *td, void **sptr,
1098 const char *opt_mname, void *buf_ptr, size_t size,
1099 int (*opt_unexpected_tag_decoder)
1100 (void *struct_ptr, void *chunk_buf, size_t chunk_size),
1101 ssize_t (*body_receiver)
1102 (void *struct_ptr, void *chunk_buf, size_t chunk_size,
1103 int have_more)
1104) {
1105 asn_OCTET_STRING_specifics_t *specs = td->specifics
1106 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1107 : &asn_DEF_OCTET_STRING_specs;
1108 const char *xml_tag = opt_mname ? opt_mname : td->xml_tag;
1109 asn_struct_ctx_t *ctx; /* Per-structure parser context */
1110
1111 /*
1112 * Create the string if does not exist.
1113 */
1114 if(!*sptr) {
vlma56a9e82004-10-23 10:20:27 +00001115 OCTET_STRING_t *st;
1116 (void *)st = *sptr = CALLOC(1, specs->struct_size);
1117 if(st) st->buf = (uint8_t *)CALLOC(1, 1);
1118 if(!*sptr || !st->buf) {
vlm9de248e2004-10-20 15:50:55 +00001119 asn_dec_rval_t rval;
vlma56a9e82004-10-23 10:20:27 +00001120 if(*sptr) FREEMEM(*sptr);
vlm9de248e2004-10-20 15:50:55 +00001121 rval.code = RC_FAIL;
1122 rval.consumed = 0;
1123 return rval;
1124 }
1125 }
1126
1127 /* Restore parsing context */
1128 ctx = (asn_struct_ctx_t *)(((char *)*sptr) + specs->ctx_offset);
1129
1130 return xer_decode_general(opt_codec_ctx, ctx, *sptr, xml_tag,
1131 buf_ptr, size, opt_unexpected_tag_decoder, body_receiver);
1132}
1133
1134/*
1135 * Decode OCTET STRING from the hexadecimal data.
1136 */
1137asn_dec_rval_t
1138OCTET_STRING_decode_xer_hex(asn_codec_ctx_t *opt_codec_ctx,
1139 asn_TYPE_descriptor_t *td, void **sptr,
1140 const char *opt_mname, void *buf_ptr, size_t size) {
1141 return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1142 buf_ptr, size, 0, OCTET_STRING__convert_hexadecimal);
1143}
1144
1145/*
1146 * Decode OCTET STRING from the binary (0/1) data.
1147 */
1148asn_dec_rval_t
1149OCTET_STRING_decode_xer_binary(asn_codec_ctx_t *opt_codec_ctx,
1150 asn_TYPE_descriptor_t *td, void **sptr,
1151 const char *opt_mname, void *buf_ptr, size_t size) {
1152 return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1153 buf_ptr, size, 0, OCTET_STRING__convert_binary);
1154}
1155
1156/*
1157 * Decode OCTET STRING from the string (ASCII/UTF-8) data.
1158 */
1159asn_dec_rval_t
1160OCTET_STRING_decode_xer_utf8(asn_codec_ctx_t *opt_codec_ctx,
1161 asn_TYPE_descriptor_t *td, void **sptr,
1162 const char *opt_mname, void *buf_ptr, size_t size) {
1163 return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1164 buf_ptr, size,
1165 OCTET_STRING__handle_control_chars,
1166 OCTET_STRING__convert_entrefs);
1167}
1168
1169
vlmfa67ddc2004-06-03 03:38:44 +00001170int
vlm7b75d982004-09-29 13:20:14 +00001171OCTET_STRING_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
vlmfa67ddc2004-06-03 03:38:44 +00001172 asn_app_consume_bytes_f *cb, void *app_key) {
vlm1ff928d2004-08-11 08:10:13 +00001173 static const char *h2c = "0123456789ABCDEF";
vlmda674682004-08-11 09:07:36 +00001174 const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
vlmfa67ddc2004-06-03 03:38:44 +00001175 char scratch[16 * 3 + 4];
1176 char *p = scratch;
1177 uint8_t *buf;
1178 uint8_t *end;
1179 size_t i;
vlmfa67ddc2004-06-03 03:38:44 +00001180
vlmb42843a2004-06-05 08:17:50 +00001181 (void)td; /* Unused argument */
1182
vlm6678cb12004-09-26 13:10:40 +00001183 if(!st || !st->buf) return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
vlmfa67ddc2004-06-03 03:38:44 +00001184
1185 /*
1186 * Dump the contents of the buffer in hexadecimal.
1187 */
1188 buf = st->buf;
1189 end = buf + st->size;
1190 for(i = 0; buf < end; buf++, i++) {
1191 if(!(i % 16) && (i || st->size > 16)) {
vlm6678cb12004-09-26 13:10:40 +00001192 if(cb(scratch, p - scratch, app_key) < 0)
vlmfa67ddc2004-06-03 03:38:44 +00001193 return -1;
vlm6678cb12004-09-26 13:10:40 +00001194 _i_INDENT(1);
vlmfa67ddc2004-06-03 03:38:44 +00001195 p = scratch;
1196 }
1197 *p++ = h2c[(*buf >> 4) & 0x0F];
1198 *p++ = h2c[*buf & 0x0F];
vlm39ba4c42004-09-22 16:06:28 +00001199 *p++ = 0x20;
vlmfa67ddc2004-06-03 03:38:44 +00001200 }
1201
vlmef1b4c02004-09-23 22:06:26 +00001202 if(p > scratch) {
1203 p--; /* Remove the tail space */
vlm6678cb12004-09-26 13:10:40 +00001204 if(cb(scratch, p - scratch, app_key) < 0)
vlmef1b4c02004-09-23 22:06:26 +00001205 return -1;
1206 }
1207
1208 return 0;
vlmfa67ddc2004-06-03 03:38:44 +00001209}
1210
1211int
vlm9de248e2004-10-20 15:50:55 +00001212OCTET_STRING_print_utf8(asn_TYPE_descriptor_t *td, const void *sptr,
vlmfa67ddc2004-06-03 03:38:44 +00001213 int ilevel, asn_app_consume_bytes_f *cb, void *app_key) {
vlmda674682004-08-11 09:07:36 +00001214 const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
vlmfa67ddc2004-06-03 03:38:44 +00001215
vlmb42843a2004-06-05 08:17:50 +00001216 (void)td; /* Unused argument */
1217 (void)ilevel; /* Unused argument */
1218
vlmfa67ddc2004-06-03 03:38:44 +00001219 if(st && st->buf) {
vlm6678cb12004-09-26 13:10:40 +00001220 return (cb(st->buf, st->size, app_key) < 0) ? -1 : 0;
vlmfa67ddc2004-06-03 03:38:44 +00001221 } else {
vlm6678cb12004-09-26 13:10:40 +00001222 return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
vlmfa67ddc2004-06-03 03:38:44 +00001223 }
1224}
1225
1226void
vlm7b75d982004-09-29 13:20:14 +00001227OCTET_STRING_free(asn_TYPE_descriptor_t *td, void *sptr, int contents_only) {
vlmda674682004-08-11 09:07:36 +00001228 OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
vlm0f1ab762004-10-12 05:57:23 +00001229 asn_OCTET_STRING_specifics_t *specs = td->specifics
vlm9de248e2004-10-20 15:50:55 +00001230 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1231 : &asn_DEF_OCTET_STRING_specs;
vlm0f1ab762004-10-12 05:57:23 +00001232 asn_struct_ctx_t *ctx = (asn_struct_ctx_t *)
1233 ((char *)st + specs->ctx_offset);
vlme2375902004-11-08 10:47:12 +00001234 struct _stack *stck;
vlmfa67ddc2004-06-03 03:38:44 +00001235
1236 if(!td || !st)
1237 return;
1238
1239 ASN_DEBUG("Freeing %s as OCTET STRING", td->name);
1240
1241 if(st->buf) {
1242 FREEMEM(st->buf);
1243 }
1244
1245 /*
1246 * Remove decode-time stack.
1247 */
vlme2375902004-11-08 10:47:12 +00001248 stck = (struct _stack *)ctx->ptr;
vlmfa67ddc2004-06-03 03:38:44 +00001249 if(stck) {
1250 while(stck->tail) {
1251 struct _stack_el *sel = stck->tail;
1252 stck->tail = sel->prev;
1253 FREEMEM(sel);
1254 }
1255 FREEMEM(stck);
1256 }
1257
1258 if(!contents_only) {
1259 FREEMEM(st);
1260 }
1261}
1262
1263/*
1264 * Conversion routines.
1265 */
1266int
1267OCTET_STRING_fromBuf(OCTET_STRING_t *st, const char *str, int len) {
1268 void *buf;
1269
1270 if(st == 0 || (str == 0 && len)) {
1271 errno = EINVAL;
1272 return -1;
1273 }
1274
1275 /*
1276 * Clear the OCTET STRING.
1277 */
1278 if(str == NULL) {
1279 if(st->buf)
1280 FREEMEM(st->buf);
1281 st->size = 0;
1282 return 0;
1283 }
1284
1285 /* Determine the original string size, if not explicitly given */
1286 if(len < 0)
1287 len = strlen(str);
1288
1289 /* Allocate and fill the memory */
1290 buf = MALLOC(len + 1);
1291 if(buf == NULL) {
1292 return -1;
1293 } else {
vlmda674682004-08-11 09:07:36 +00001294 st->buf = (uint8_t *)buf;
vlmfa67ddc2004-06-03 03:38:44 +00001295 st->size = len;
1296 }
1297
1298 memcpy(buf, str, len);
1299 st->buf[st->size] = '\0'; /* Couldn't use memcpy(len+1)! */
1300
1301 return 0;
1302}
1303
1304OCTET_STRING_t *
vlm0f1ab762004-10-12 05:57:23 +00001305OCTET_STRING_new_fromBuf(asn_TYPE_descriptor_t *td, const char *str, int len) {
1306 asn_OCTET_STRING_specifics_t *specs = td->specifics
vlm9de248e2004-10-20 15:50:55 +00001307 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1308 : &asn_DEF_OCTET_STRING_specs;
vlmfa67ddc2004-06-03 03:38:44 +00001309 OCTET_STRING_t *st;
1310
vlm0f1ab762004-10-12 05:57:23 +00001311 st = (OCTET_STRING_t *)CALLOC(1, specs->struct_size);
vlmfa67ddc2004-06-03 03:38:44 +00001312 if(st && str && OCTET_STRING_fromBuf(st, str, len)) {
1313 free(st);
1314 st = NULL;
1315 }
1316
1317 return st;
1318}
1319