libs/smux/OCTET_STRING.c

   1 /*-
   2  * Copyright (c) 2003, 2004, 2005, 2006 Lev Walkin <vlm@lionet.info>.
   3  * All rights reserved.
   4  * Redistribution and modifications are permitted subject to BSD license.
   5  */
   6 #include <asn_internal.h>
   7 #include <OCTET_STRING.h>
   8 #include <BIT_STRING.h> /* for .bits_unused member */
   9 #include <errno.h>
  10
  11 /*
  12  * OCTET STRING basic type description.
  13  */
  14 static ber_tlv_tag_t asn_DEF_OCTET_STRING_tags[] = {
  15         (ASN_TAG_CLASS_UNIVERSAL | (4 << 2))
  16 };
  17 static 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 };
  22 static asn_per_constraint_t asn_DEF_OCTET_STRING_constraint = {
  23         APC_SEMI_CONSTRAINED, -1, -1, 0, 0
  24 };
  25 asn_TYPE_descriptor_t asn_DEF_OCTET_STRING = {
  26         "OCTET STRING",         /* Canonical name */
  27         "OCTET_STRING",         /* XML tag name */
  28         OCTET_STRING_free,
  29         OCTET_STRING_print,     /* non-ascii stuff, generally */
  30         asn_generic_no_constraint,
  31         OCTET_STRING_decode_ber,
  32         OCTET_STRING_encode_der,
  33         OCTET_STRING_decode_xer_hex,
  34         OCTET_STRING_encode_xer,
  35         OCTET_STRING_decode_uper,       /* Unaligned PER decoder */
  36         OCTET_STRING_encode_uper,       /* Unaligned PER encoder */
  37         0, /* Use generic outmost tag fetcher */
  38         asn_DEF_OCTET_STRING_tags,
  39         sizeof(asn_DEF_OCTET_STRING_tags)
  40           / sizeof(asn_DEF_OCTET_STRING_tags[0]),
  41         asn_DEF_OCTET_STRING_tags,      /* Same as above */
  42         sizeof(asn_DEF_OCTET_STRING_tags)
  43           / sizeof(asn_DEF_OCTET_STRING_tags[0]),
  44         0,      /* No PER visible constraints */
  45         0, 0,   /* No members */
  46         &asn_DEF_OCTET_STRING_specs
  47 };
  48
  49 #undef  _CH_PHASE
  50 #undef  NEXT_PHASE
  51 #undef  PREV_PHASE
  52 #define _CH_PHASE(ctx, inc) do {                                        \
  53                 if(ctx->phase == 0)                                     \
  54                         ctx->context = 0;                               \
  55                 ctx->phase += inc;                                      \
  56         } while(0)
  57 #define NEXT_PHASE(ctx) _CH_PHASE(ctx, +1)
  58 #define PREV_PHASE(ctx) _CH_PHASE(ctx, -1)
  59
  60 #undef  ADVANCE
  61 #define ADVANCE(num_bytes)      do {                                    \
  62                 size_t num = (num_bytes);                               \
  63                 buf_ptr = ((const char *)buf_ptr) + num;                \
  64                 size -= num;                                            \
  65                 consumed_myself += num;                                 \
  66         } while(0)
  67
  68 #undef  RETURN
  69 #define RETURN(_code)   do {                                            \
  70                 asn_dec_rval_t tmprval;                                 \
  71                 tmprval.code = _code;                                   \
  72                 tmprval.consumed = consumed_myself;                     \
  73                 return tmprval;                                         \
  74         } while(0)
  75
  76 #undef  APPEND
  77 #define APPEND(bufptr, bufsize) do {                                    \
  78                 size_t _bs = (bufsize);         /* Append size */       \
  79                 size_t _ns = ctx->context;      /* Allocated now */     \
  80                 size_t _es = st->size + _bs;    /* Expected size */     \
  81                 /* int is really a typeof(st->size): */                 \
  82                 if((int)_es < 0) RETURN(RC_FAIL);                       \
  83                 if(_ns <= _es) {                                        \
  84                         void *ptr;                                      \
  85                         /* Be nice and round to the memory allocator */ \
  86                         do { _ns = _ns ? _ns << 1 : 16; }               \
  87                             while(_ns <= _es);                          \
  88                         /* int is really a typeof(st->size): */         \
  89                         if((int)_ns < 0) RETURN(RC_FAIL);               \
  90                         ptr = REALLOC(st->buf, _ns);                    \
  91                         if(ptr) {                                       \
  92                                 st->buf = (uint8_t *)ptr;               \
  93                                 ctx->context = _ns;                     \
  94                         } else {                                        \
  95                                 RETURN(RC_FAIL);                        \
  96                         }                                               \
  97                         ASN_DEBUG("Reallocating into %ld", (long)_ns);  \
  98                 }                                                       \
  99                 memcpy(st->buf + st->size, bufptr, _bs);                \
 100                 /* Convenient nul-termination */                        \
 101                 st->buf[_es] = '\0';                                    \
 102                 st->size = _es;                                         \
 103         } while(0)
 104
 105 /*
 106  * Internal variant of the OCTET STRING.
 107  */
 108 typedef enum OS_type {
 109         _TT_GENERIC     = 0,    /* Just a random OCTET STRING */
 110         _TT_BIT_STRING  = 1,    /* BIT STRING type, a special case */
 111         _TT_ANY         = 2     /* ANY type, a special case too */
 112 } OS_type_e;
 113
 114 /*
 115  * The main reason why ASN.1 is still alive is that too much time and effort
 116  * is necessary for learning it more or less adequately, thus creating a gut
 117  * necessity to demonstrate that aquired skill everywhere afterwards.
 118  * No, I am not going to explain what the following stuff is.
 119  */
 120 struct _stack_el {
 121         ber_tlv_len_t   left;   /* What's left to read (or -1) */
 122         ber_tlv_len_t   got;    /* What was actually processed */
 123         int     cont_level;     /* Depth of subcontainment */
 124         int     want_nulls;     /* Want null "end of content" octets? */
 125         int     bits_chopped;   /* Flag in BIT STRING mode */
 126         ber_tlv_tag_t   tag;    /* For debugging purposes */
 127         struct _stack_el *prev;
 128         struct _stack_el *next;
 129 };
 130 struct _stack {
 131         struct _stack_el *tail;
 132         struct _stack_el *cur_ptr;
 133 };
 134
 135 static struct _stack_el *
 136 OS__add_stack_el(struct _stack *st) {
 137         struct _stack_el *nel;
 138
 139         /*
 140          * Reuse the old stack frame or allocate a new one.
 141          */
 142         if(st->cur_ptr && st->cur_ptr->next) {
 143                 nel = st->cur_ptr->next;
 144                 nel->bits_chopped = 0;
 145                 nel->got = 0;
 146                 /* Retain the nel->cont_level, it's correct. */
 147         } else {
 148                 nel = (struct _stack_el *)CALLOC(1, sizeof(struct _stack_el));
 149                 if(nel == NULL)
 150                         return NULL;
 151
 152                 if(st->tail) {
 153                         /* Increase a subcontainment depth */
 154                         nel->cont_level = st->tail->cont_level + 1;
 155                         st->tail->next = nel;
 156                 }
 157                 nel->prev = st->tail;
 158                 st->tail = nel;
 159         }
 160
 161         st->cur_ptr = nel;
 162
 163         return nel;
 164 }
 165
 166 static struct _stack *
 167 _new_stack() {
 168         return (struct _stack *)CALLOC(1, sizeof(struct _stack));
 169 }
 170
 171 /*
 172  * Decode OCTET STRING type.
 173  */
 174 asn_dec_rval_t
 175 OCTET_STRING_decode_ber(asn_codec_ctx_t *opt_codec_ctx,
 176         asn_TYPE_descriptor_t *td,
 177         void **sptr, const void *buf_ptr, size_t size, int tag_mode) {
 178         asn_OCTET_STRING_specifics_t *specs = td->specifics
 179                                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
 180                                 : &asn_DEF_OCTET_STRING_specs;
 181         BIT_STRING_t *st = (BIT_STRING_t *)*sptr;
 182         asn_dec_rval_t rval;
 183         asn_struct_ctx_t *ctx;
 184         ssize_t consumed_myself = 0;
 185         struct _stack *stck;            /* Expectations stack structure */
 186         struct _stack_el *sel = 0;      /* Stack element */
 187         int tlv_constr;
 188         OS_type_e type_variant = (OS_type_e)specs->subvariant;
 189
 190         ASN_DEBUG("Decoding %s as %s (frame %ld)",
 191                 td->name,
 192                 (type_variant == _TT_GENERIC) ?
 193                         "OCTET STRING" : "OS-SpecialCase",
 194                 (long)size);
 195
 196         /*
 197          * Create the string if does not exist.
 198          */
 199         if(st == NULL) {
 200                 st = (BIT_STRING_t *)(*sptr = CALLOC(1, specs->struct_size));
 201                 if(st == NULL) RETURN(RC_FAIL);
 202         }
 203
 204         /* Restore parsing context */
 205         ctx = (asn_struct_ctx_t *)((char *)st + specs->ctx_offset);
 206
 207         switch(ctx->phase) {
 208         case 0:
 209                 /*
 210                  * Check tags.
 211                  */
 212                 rval = ber_check_tags(opt_codec_ctx, td, ctx,
 213                         buf_ptr, size, tag_mode, -1,
 214                         &ctx->left, &tlv_constr);
 215                 if(rval.code != RC_OK)
 216                         return rval;
 217
 218                 if(tlv_constr) {
 219                         /*
 220                          * Complex operation, requires stack of expectations.
 221                          */
 222                         ctx->ptr = _new_stack();
 223                         if(ctx->ptr) {
 224                                 stck = (struct _stack *)ctx->ptr;
 225                         } else {
 226                                 RETURN(RC_FAIL);
 227                         }
 228                 } else {
 229                         /*
 230                          * Jump into stackless primitive decoding.
 231                          */
 232                         _CH_PHASE(ctx, 3);
 233                         if(type_variant == _TT_ANY && tag_mode != 1)
 234                                 APPEND(buf_ptr, rval.consumed);
 235                         ADVANCE(rval.consumed);
 236                         goto phase3;
 237                 }
 238
 239                 NEXT_PHASE(ctx);
 240                 /* Fall through */
 241         case 1:
 242         phase1:
 243                 /*
 244                  * Fill the stack with expectations.
 245                  */
 246                 stck = (struct _stack *)ctx->ptr;
 247                 sel = stck->cur_ptr;
 248           do {
 249                 ber_tlv_tag_t tlv_tag;
 250                 ber_tlv_len_t tlv_len;
 251                 ber_tlv_tag_t expected_tag;
 252                 ssize_t tl, ll, tlvl;
 253                                 /* This one works even if (sel->left == -1) */
 254                 ssize_t Left = ((!sel||(size_t)sel->left >= size)
 255                                         ?(ssize_t)size:sel->left);
 256
 257
 258                 ASN_DEBUG("%p, s->l=%ld, s->wn=%ld, s->g=%ld\n", sel,
 259                         (long)(sel?sel->left:0),
 260                         (long)(sel?sel->want_nulls:0),
 261                         (long)(sel?sel->got:0)
 262                 );
 263                 if(sel && sel->left <= 0 && sel->want_nulls == 0) {
 264                         if(sel->prev) {
 265                                 struct _stack_el *prev = sel->prev;
 266                                 if(prev->left != -1) {
 267                                         if(prev->left < sel->got)
 268                                                 RETURN(RC_FAIL);
 269                                         prev->left -= sel->got;
 270                                 }
 271                                 prev->got += sel->got;
 272                                 sel = stck->cur_ptr = prev;
 273                                 if(!sel) break;
 274                                 tlv_constr = 1;
 275                                 continue;
 276                         } else {
 277                                 sel = stck->cur_ptr = 0;
 278                                 break;  /* Nothing to wait */
 279                         }
 280                 }
 281
 282                 tl = ber_fetch_tag(buf_ptr, Left, &tlv_tag);
 283                 ASN_DEBUG("fetch tag(size=%ld,L=%ld), %sstack, left=%ld, wn=%ld, tl=%ld",
 284                         (long)size, (long)Left, sel?"":"!",
 285                         (long)(sel?sel->left:0),
 286                         (long)(sel?sel->want_nulls:0),
 287                         (long)tl);
 288                 switch(tl) {
 289                 case -1: RETURN(RC_FAIL);
 290                 case 0: RETURN(RC_WMORE);
 291                 }
 292
 293                 tlv_constr = BER_TLV_CONSTRUCTED(buf_ptr);
 294
 295                 ll = ber_fetch_length(tlv_constr,
 296                                 (const char *)buf_ptr + tl,Left - tl,&tlv_len);
 297                 ASN_DEBUG("Got tag=%s, tc=%d, left=%ld, tl=%ld, len=%ld, ll=%ld",
 298                         ber_tlv_tag_string(tlv_tag), tlv_constr,
 299                                 (long)Left, (long)tl, (long)tlv_len, (long)ll);
 300                 switch(ll) {
 301                 case -1: RETURN(RC_FAIL);
 302                 case 0: RETURN(RC_WMORE);
 303                 }
 304
 305                 if(sel && sel->want_nulls
 306                         && ((const uint8_t *)buf_ptr)[0] == 0
 307                         && ((const uint8_t *)buf_ptr)[1] == 0)
 308                 {
 309
 310                         ASN_DEBUG("Eat EOC; wn=%d--", sel->want_nulls);
 311
 312                         if(type_variant == _TT_ANY
 313                         && (tag_mode != 1 || sel->cont_level))
 314                                 APPEND("\0\0", 2);
 315
 316                         ADVANCE(2);
 317                         sel->got += 2;
 318                         if(sel->left != -1) {
 319                                 sel->left -= 2; /* assert(sel->left >= 2) */
 320                         }
 321
 322                         sel->want_nulls--;
 323                         if(sel->want_nulls == 0) {
 324                                 /* Move to the next expectation */
 325                                 sel->left = 0;
 326                                 tlv_constr = 1;
 327                         }
 328
 329                         continue;
 330                 }
 331
 332                 /*
 333                  * Set up expected tags,
 334                  * depending on ASN.1 type being decoded.
 335                  */
 336                 switch(type_variant) {
 337                 case _TT_BIT_STRING:
 338                         /* X.690: 8.6.4.1, NOTE 2 */
 339                         /* Fall through */
 340                 case _TT_GENERIC:
 341                 default:
 342                         if(sel) {
 343                                 int level = sel->cont_level;
 344                                 if(level < td->all_tags_count) {
 345                                         expected_tag = td->all_tags[level];
 346                                         break;
 347                                 } else if(td->all_tags_count) {
 348                                         expected_tag = td->all_tags
 349                                                 [td->all_tags_count - 1];
 350                                         break;
 351                                 }
 352                                 /* else, Fall through */
 353                         }
 354                         /* Fall through */
 355                 case _TT_ANY:
 356                         expected_tag = tlv_tag;
 357                         break;
 358                 }
 359
 360
 361                 if(tlv_tag != expected_tag) {
 362                         char buf[2][32];
 363                         ber_tlv_tag_snprint(tlv_tag,
 364                                 buf[0], sizeof(buf[0]));
 365                         ber_tlv_tag_snprint(td->tags[td->tags_count-1],
 366                                 buf[1], sizeof(buf[1]));
 367                         ASN_DEBUG("Tag does not match expectation: %s != %s",
 368                                 buf[0], buf[1]);
 369                         RETURN(RC_FAIL);
 370                 }
 371
 372                 tlvl = tl + ll; /* Combined length of T and L encoding */
 373                 if((tlv_len + tlvl) < 0) {
 374                         /* tlv_len value is too big */
 375                         ASN_DEBUG("TLV encoding + length (%ld) is too big",
 376                                 (long)tlv_len);
 377                         RETURN(RC_FAIL);
 378                 }
 379
 380                 /*
 381                  * Append a new expectation.
 382                  */
 383                 sel = OS__add_stack_el(stck);
 384                 if(!sel) RETURN(RC_FAIL);
 385
 386                 sel->tag = tlv_tag;
 387
 388                 sel->want_nulls = (tlv_len==-1);
 389                 if(sel->prev && sel->prev->left != -1) {
 390                         /* Check that the parent frame is big enough */
 391                         if(sel->prev->left < tlvl + (tlv_len==-1?0:tlv_len))
 392                                 RETURN(RC_FAIL);
 393                         if(tlv_len == -1)
 394                                 sel->left = sel->prev->left - tlvl;
 395                         else
 396                                 sel->left = tlv_len;
 397                 } else {
 398                         sel->left = tlv_len;
 399                 }
 400                 if(type_variant == _TT_ANY
 401                 && (tag_mode != 1 || sel->cont_level))
 402                         APPEND(buf_ptr, tlvl);
 403                 sel->got += tlvl;
 404                 ADVANCE(tlvl);
 405
 406                 ASN_DEBUG("+EXPECT2 got=%ld left=%ld, wn=%d, clvl=%d",
 407                         (long)sel->got, (long)sel->left,
 408                         sel->want_nulls, sel->cont_level);
 409
 410           } while(tlv_constr);
 411                 if(sel == NULL) {
 412                         /* Finished operation, "phase out" */
 413                         ASN_DEBUG("Phase out");
 414                         _CH_PHASE(ctx, +3);
 415                         break;
 416                 }
 417
 418                 NEXT_PHASE(ctx);
 419                 /* Fall through */
 420         case 2:
 421                 stck = (struct _stack *)ctx->ptr;
 422                 sel = stck->cur_ptr;
 423                 ASN_DEBUG("Phase 2: Need %ld bytes, size=%ld, alrg=%ld, wn=%d",
 424                         (long)sel->left, (long)size, (long)sel->got,
 425                                 sel->want_nulls);
 426             {
 427                 ber_tlv_len_t len;
 428
 429                 assert(sel->left >= 0);
 430
 431                 len = ((ber_tlv_len_t)size < sel->left)
 432                                 ? (ber_tlv_len_t)size : sel->left;
 433                 if(len > 0) {
 434                         if(type_variant == _TT_BIT_STRING
 435                         && sel->bits_chopped == 0) {
 436                                 /* Put the unused-bits-octet away */
 437                                 st->bits_unused = *(const uint8_t *)buf_ptr;
 438                                 APPEND(((const char *)buf_ptr+1), (len - 1));
 439                                 sel->bits_chopped = 1;
 440                         } else {
 441                                 APPEND(buf_ptr, len);
 442                         }
 443                         ADVANCE(len);
 444                         sel->left -= len;
 445                         sel->got += len;
 446                 }
 447
 448                 if(sel->left) {
 449                         ASN_DEBUG("OS left %ld, size = %ld, wn=%d\n",
 450                                 (long)sel->left, (long)size, sel->want_nulls);
 451                         RETURN(RC_WMORE);
 452                 }
 453
 454                 PREV_PHASE(ctx);
 455                 goto phase1;
 456             }
 457                 break;
 458         case 3:
 459         phase3:
 460                 /*
 461                  * Primitive form, no stack required.
 462                  */
 463                 assert(ctx->left >= 0);
 464
 465                 if(size < (size_t)ctx->left) {
 466                         if(!size) RETURN(RC_WMORE);
 467                         if(type_variant == _TT_BIT_STRING && !ctx->context) {
 468                                 st->bits_unused = *(const uint8_t *)buf_ptr;
 469                                 ctx->left--;
 470                                 ADVANCE(1);
 471                         }
 472                         APPEND(buf_ptr, size);
 473                         assert(ctx->context > 0);
 474                         ctx->left -= size;
 475                         ADVANCE(size);
 476                         RETURN(RC_WMORE);
 477                 } else {
 478                         if(type_variant == _TT_BIT_STRING
 479                         && !ctx->context && ctx->left) {
 480                                 st->bits_unused = *(const uint8_t *)buf_ptr;
 481                                 ctx->left--;
 482                                 ADVANCE(1);
 483                         }
 484                         APPEND(buf_ptr, ctx->left);
 485                         ADVANCE(ctx->left);
 486                         ctx->left = 0;
 487
 488                         NEXT_PHASE(ctx);
 489                 }
 490                 break;
 491         }
 492
 493         if(sel) {
 494                 ASN_DEBUG("3sel p=%p, wn=%d, l=%ld, g=%ld, size=%ld",
 495                         sel->prev, sel->want_nulls,
 496                         (long)sel->left, (long)sel->got, (long)size);
 497                 if(sel->prev || sel->want_nulls > 1 || sel->left > 0) {
 498                         RETURN(RC_WMORE);
 499                 }
 500         }
 501
 502         /*
 503          * BIT STRING-specific processing.
 504          */
 505         if(type_variant == _TT_BIT_STRING && st->size) {
 506                 /* Finalize BIT STRING: zero out unused bits. */
 507                 st->buf[st->size-1] &= 0xff << st->bits_unused;
 508         }
 509
 510         ASN_DEBUG("Took %ld bytes to encode %s: [%s]:%ld",
 511                 (long)consumed_myself, td->name,
 512                 (type_variant == _TT_GENERIC) ? (char *)st->buf : "<data>",
 513                 (long)st->size);
 514
 515
 516         RETURN(RC_OK);
 517 }
 518
 519 /*
 520  * Encode OCTET STRING type using DER.
 521  */
 522 asn_enc_rval_t
 523 OCTET_STRING_encode_der(asn_TYPE_descriptor_t *td, void *sptr,
 524         int tag_mode, ber_tlv_tag_t tag,
 525         asn_app_consume_bytes_f *cb, void *app_key) {
 526         asn_enc_rval_t er;
 527         asn_OCTET_STRING_specifics_t *specs = td->specifics
 528                                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
 529                                 : &asn_DEF_OCTET_STRING_specs;
 530         BIT_STRING_t *st = (BIT_STRING_t *)sptr;
 531         OS_type_e type_variant = (OS_type_e)specs->subvariant;
 532         int fix_last_byte = 0;
 533
 534         ASN_DEBUG("%s %s as OCTET STRING",
 535                 cb?"Estimating":"Encoding", td->name);
 536
 537         /*
 538          * Write tags.
 539          */
 540         if(type_variant != _TT_ANY || tag_mode == 1) {
 541                 er.encoded = der_write_tags(td,
 542                                 (type_variant == _TT_BIT_STRING) + st->size,
 543                         tag_mode, type_variant == _TT_ANY, tag, cb, app_key);
 544                 if(er.encoded == -1) {
 545                         er.failed_type = td;
 546                         er.structure_ptr = sptr;
 547                         return er;
 548                 }
 549         } else {
 550                 /* Disallow: [<tag>] IMPLICIT ANY */
 551                 assert(type_variant != _TT_ANY || tag_mode != -1);
 552                 er.encoded = 0;
 553         }
 554
 555         if(!cb) {
 556                 er.encoded += (type_variant == _TT_BIT_STRING) + st->size;
 557                 _ASN_ENCODED_OK(er);
 558         }
 559
 560         /*
 561          * Prepare to deal with the last octet of BIT STRING.
 562          */
 563         if(type_variant == _TT_BIT_STRING) {
 564                 uint8_t b = st->bits_unused & 0x07;
 565                 if(b && st->size) fix_last_byte = 1;
 566                 _ASN_CALLBACK(&b, 1);
 567                 er.encoded++;
 568         }
 569
 570         /* Invoke callback for the main part of the buffer */
 571         _ASN_CALLBACK(st->buf, st->size - fix_last_byte);
 572
 573         /* The last octet should be stripped off the unused bits */
 574         if(fix_last_byte) {
 575                 uint8_t b = st->buf[st->size-1] & (0xff << st->bits_unused);
 576                 _ASN_CALLBACK(&b, 1);
 577         }
 578
 579         er.encoded += st->size;
 580         _ASN_ENCODED_OK(er);
 581 cb_failed:
 582         _ASN_ENCODE_FAILED;
 583 }
 584
 585 asn_enc_rval_t
 586 OCTET_STRING_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
 587         int ilevel, enum xer_encoder_flags_e flags,
 588                 asn_app_consume_bytes_f *cb, void *app_key) {
 589         static const char *h2c = "0123456789ABCDEF";
 590         const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
 591         asn_enc_rval_t er;
 592         char scratch[16 * 3 + 4];
 593         char *p = scratch;
 594         uint8_t *buf;
 595         uint8_t *end;
 596
 597         if(!st || !st->buf)
 598                 _ASN_ENCODE_FAILED;
 599
 600         er.encoded = 0;
 601
 602         /*
 603          * Dump the contents of the buffer in hexadecimal.
 604          */
 605         buf = st->buf;
 606         end = buf + st->size;
 607         if(flags & XER_F_CANONICAL) {
 608                 char *scend = scratch + (sizeof(scratch) - 2);
 609                 for(; buf < end; buf++) {
 610                         if(p >= scend) {
 611                                 _ASN_CALLBACK(scratch, p - scratch);
 612                                 er.encoded += p - scratch;
 613                                 p = scratch;
 614                         }
 615                         *p++ = h2c[(*buf >> 4) & 0x0F];
 616                         *p++ = h2c[*buf & 0x0F];
 617                 }
 618
 619                 _ASN_CALLBACK(scratch, p-scratch);      /* Dump the rest */
 620                 er.encoded += p - scratch;
 621         } else {
 622                 size_t i;
 623                 for(i = 0; buf < end; buf++, i++) {
 624                         if(!(i % 16) && (i || st->size > 16)) {
 625                                 _ASN_CALLBACK(scratch, p-scratch);
 626                                 er.encoded += (p-scratch);
 627                                 p = scratch;
 628                                 _i_ASN_TEXT_INDENT(1, ilevel);
 629                         }
 630                         *p++ = h2c[(*buf >> 4) & 0x0F];
 631                         *p++ = h2c[*buf & 0x0F];
 632                         *p++ = 0x20;
 633                 }
 634                 if(p - scratch) {
 635                         p--;    /* Remove the tail space */
 636                         _ASN_CALLBACK(scratch, p-scratch); /* Dump the rest */
 637                         er.encoded += p - scratch;
 638                         if(st->size > 16)
 639                                 _i_ASN_TEXT_INDENT(1, ilevel-1);
 640                 }
 641         }
 642
 643         _ASN_ENCODED_OK(er);
 644 cb_failed:
 645         _ASN_ENCODE_FAILED;
 646 }
 647
 648 static struct OCTET_STRING__xer_escape_table_s {
 649         char *string;
 650         int size;
 651 } OCTET_STRING__xer_escape_table[] = {
 652 #define OSXET(s)        { s, sizeof(s) - 1 }
 653         OSXET("\074\156\165\154\057\076"),      /* <nul/> */
 654         OSXET("\074\163\157\150\057\076"),      /* <soh/> */
 655         OSXET("\074\163\164\170\057\076"),      /* <stx/> */
 656         OSXET("\074\145\164\170\057\076"),      /* <etx/> */
 657         OSXET("\074\145\157\164\057\076"),      /* <eot/> */
 658         OSXET("\074\145\156\161\057\076"),      /* <enq/> */
 659         OSXET("\074\141\143\153\057\076"),      /* <ack/> */
 660         OSXET("\074\142\145\154\057\076"),      /* <bel/> */
 661         OSXET("\074\142\163\057\076"),          /* <bs/> */
 662         OSXET("\011"),                          /* \t */
 663         OSXET("\012"),                          /* \n */
 664         OSXET("\074\166\164\057\076"),          /* <vt/> */
 665         OSXET("\074\146\146\057\076"),          /* <ff/> */
 666         OSXET("\015"),                          /* \r */
 667         OSXET("\074\163\157\057\076"),          /* <so/> */
 668         OSXET("\074\163\151\057\076"),          /* <si/> */
 669         OSXET("\074\144\154\145\057\076"),      /* <dle/> */
 670         OSXET("\074\144\143\061\057\076"),      /* <de1/> */
 671         OSXET("\074\144\143\062\057\076"),      /* <de2/> */
 672         OSXET("\074\144\143\063\057\076"),      /* <de3/> */
 673         OSXET("\074\144\143\064\057\076"),      /* <de4/> */
 674         OSXET("\074\156\141\153\057\076"),      /* <nak/> */
 675         OSXET("\074\163\171\156\057\076"),      /* <syn/> */
 676         OSXET("\074\145\164\142\057\076"),      /* <etb/> */
 677         OSXET("\074\143\141\156\057\076"),      /* <can/> */
 678         OSXET("\074\145\155\057\076"),          /* <em/> */
 679         OSXET("\074\163\165\142\057\076"),      /* <sub/> */
 680         OSXET("\074\145\163\143\057\076"),      /* <esc/> */
 681         OSXET("\074\151\163\064\057\076"),      /* <is4/> */
 682         OSXET("\074\151\163\063\057\076"),      /* <is3/> */
 683         OSXET("\074\151\163\062\057\076"),      /* <is2/> */
 684         OSXET("\074\151\163\061\057\076"),      /* <is1/> */
 685         { 0, 0 },       /* " " */
 686         { 0, 0 },       /* ! */
 687         { 0, 0 },       /* \" */
 688         { 0, 0 },       /* # */
 689         { 0, 0 },       /* $ */
 690         { 0, 0 },       /* % */
 691         OSXET("\046\141\155\160\073"),  /* &amp; */
 692         { 0, 0 },       /* ' */
 693         {0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0}, /* ()*+,-./ */
 694         {0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0},{0,0}, /* 01234567 */
 695         {0,0},{0,0},{0,0},{0,0},                         /* 89:; */
 696         OSXET("\046\154\164\073"),      /* &lt; */
 697         { 0, 0 },       /* = */
 698         OSXET("\046\147\164\073"),      /* &gt; */
 699 };
 700
 701 static int
 702 OS__check_escaped_control_char(const void *buf, int size) {
 703         size_t i;
 704         /*
 705          * Inefficient algorithm which translates the escape sequences
 706          * defined above into characters. Returns -1 if not found.
 707          * TODO: replace by a faster algorithm (bsearch(), hash or
 708          * nested table lookups).
 709          */
 710         for(i = 0; i < 32 /* Don't spend time on the bottom half */; i++) {
 711                 struct OCTET_STRING__xer_escape_table_s *el;
 712                 el = &OCTET_STRING__xer_escape_table[i];
 713                 if(el->size == size && memcmp(buf, el->string, size) == 0)
 714                         return i;
 715         }
 716         return -1;
 717 }
 718
 719 static int
 720 OCTET_STRING__handle_control_chars(void *struct_ptr, const void *chunk_buf, size_t chunk_size) {
 721         /*
 722          * This might be one of the escape sequences
 723          * for control characters. Check it out.
 724          * #11.15.5
 725          */
 726         int control_char = OS__check_escaped_control_char(chunk_buf,chunk_size);
 727         if(control_char >= 0) {
 728                 OCTET_STRING_t *st = (OCTET_STRING_t *)struct_ptr;
 729                 void *p = REALLOC(st->buf, st->size + 2);
 730                 if(p) {
 731                         st->buf = (uint8_t *)p;
 732                         st->buf[st->size++] = control_char;
 733                         st->buf[st->size] = '\0';       /* nul-termination */
 734                         return 0;
 735                 }
 736         }
 737
 738         return -1;      /* No, it's not */
 739 }
 740
 741 asn_enc_rval_t
 742 OCTET_STRING_encode_xer_utf8(asn_TYPE_descriptor_t *td, void *sptr,
 743         int ilevel, enum xer_encoder_flags_e flags,
 744                 asn_app_consume_bytes_f *cb, void *app_key) {
 745         const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
 746         asn_enc_rval_t er;
 747         uint8_t *buf, *end;
 748         uint8_t *ss;    /* Sequence start */
 749         ssize_t encoded_len = 0;
 750
 751         (void)ilevel;   /* Unused argument */
 752         (void)flags;    /* Unused argument */
 753
 754         if(!st || !st->buf)
 755                 _ASN_ENCODE_FAILED;
 756
 757         buf = st->buf;
 758         end = buf + st->size;
 759         for(ss = buf; buf < end; buf++) {
 760                 unsigned int ch = *buf;
 761                 int s_len;      /* Special encoding sequence length */
 762
 763                 /*
 764                  * Escape certain characters: X.680/11.15
 765                  */
 766                 if(ch < sizeof(OCTET_STRING__xer_escape_table)
 767                         /sizeof(OCTET_STRING__xer_escape_table[0])
 768                 && (s_len = OCTET_STRING__xer_escape_table[ch].size)) {
 769                         if(((buf - ss) && cb(ss, buf - ss, app_key) < 0)
 770                         || cb(OCTET_STRING__xer_escape_table[ch].string, s_len,
 771                                         app_key) < 0)
 772                                 _ASN_ENCODE_FAILED;
 773                         encoded_len += (buf - ss) + s_len;
 774                         ss = buf + 1;
 775                 }
 776         }
 777
 778         encoded_len += (buf - ss);
 779         if((buf - ss) && cb(ss, buf - ss, app_key) < 0)
 780                 _ASN_ENCODE_FAILED;
 781
 782         er.encoded = encoded_len;
 783         _ASN_ENCODED_OK(er);
 784 }
 785
 786 /*
 787  * Convert from hexadecimal format (cstring): "AB CD EF"
 788  */
 789 static ssize_t OCTET_STRING__convert_hexadecimal(void *sptr, const void *chunk_buf, size_t chunk_size, int have_more) {
 790         OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
 791         const char *chunk_stop = (const char *)chunk_buf;
 792         const char *p = chunk_stop;
 793         const char *pend = p + chunk_size;
 794         unsigned int clv = 0;
 795         int half = 0;   /* Half bit */
 796         uint8_t *buf;
 797
 798         /* Reallocate buffer according to high cap estimation */
 799         ssize_t _ns = st->size + (chunk_size + 1) / 2;
 800         void *nptr = REALLOC(st->buf, _ns + 1);
 801         if(!nptr) return -1;
 802         st->buf = (uint8_t *)nptr;
 803         buf = st->buf + st->size;
 804
 805         /*
 806          * If something like " a b c " appears here, the " a b":3 will be
 807          * converted, and the rest skipped. That is, unless buf_size is greater
 808          * than chunk_size, then it'll be equivalent to "ABC0".
 809          */
 810         for(; p < pend; p++) {
 811                 int ch = *(const unsigned char *)p;
 812                 switch(ch) {
 813                 case 0x09: case 0x0a: case 0x0c: case 0x0d:
 814                 case 0x20:
 815                         /* Ignore whitespace */
 816                         continue;
 817                 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: /*01234*/
 818                 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39: /*56789*/
 819                         clv = (clv << 4) + (ch - 0x30);
 820                         break;
 821                 case 0x41: case 0x42: case 0x43:        /* ABC */
 822                 case 0x44: case 0x45: case 0x46:        /* DEF */
 823                         clv = (clv << 4) + (ch - 0x41 + 10);
 824                         break;
 825                 case 0x61: case 0x62: case 0x63:        /* abc */
 826                 case 0x64: case 0x65: case 0x66:        /* def */
 827                         clv = (clv << 4) + (ch - 0x61 + 10);
 828                         break;
 829                 default:
 830                         *buf = 0;       /* JIC */
 831                         return -1;
 832                 }
 833                 if(half++) {
 834                         half = 0;
 835                         *buf++ = clv;
 836                         chunk_stop = p + 1;
 837                 }
 838         }
 839
 840         /*
 841          * Check partial decoding.
 842          */
 843         if(half) {
 844                 if(have_more) {
 845                         /*
 846                          * Partial specification is fine,
 847                          * because no more more PXER_TEXT data is available.
 848                          */
 849                         *buf++ = clv << 4;
 850                         chunk_stop = p;
 851                 }
 852         } else {
 853                 chunk_stop = p;
 854         }
 855
 856         st->size = buf - st->buf;       /* Adjust the buffer size */
 857         assert(st->size <= _ns);
 858         st->buf[st->size] = 0;          /* Courtesy termination */
 859
 860         return (chunk_stop - (const char *)chunk_buf);  /* Converted size */
 861 }
 862
 863 /*
 864  * Convert from binary format: "00101011101"
 865  */
 866 static ssize_t OCTET_STRING__convert_binary(void *sptr, const void *chunk_buf, size_t chunk_size, int have_more) {
 867         BIT_STRING_t *st = (BIT_STRING_t *)sptr;
 868         const char *p = (const char *)chunk_buf;
 869         const char *pend = p + chunk_size;
 870         int bits_unused = st->bits_unused & 0x7;
 871         uint8_t *buf;
 872
 873         /* Reallocate buffer according to high cap estimation */
 874         ssize_t _ns = st->size + (chunk_size + 7) / 8;
 875         void *nptr = REALLOC(st->buf, _ns + 1);
 876         if(!nptr) return -1;
 877         st->buf = (uint8_t *)nptr;
 878         buf = st->buf + st->size;
 879
 880         (void)have_more;
 881
 882         if(bits_unused == 0)
 883                 bits_unused = 8;
 884         else if(st->size)
 885                 buf--;
 886
 887         /*
 888          * Convert series of 0 and 1 into the octet string.
 889          */
 890         for(; p < pend; p++) {
 891                 int ch = *(const unsigned char *)p;
 892                 switch(ch) {
 893                 case 0x09: case 0x0a: case 0x0c: case 0x0d:
 894                 case 0x20:
 895                         /* Ignore whitespace */
 896                         break;
 897                 case 0x30:
 898                 case 0x31:
 899                         if(bits_unused-- <= 0) {
 900                                 *++buf = 0;     /* Clean the cell */
 901                                 bits_unused = 7;
 902                         }
 903                         *buf |= (ch&1) << bits_unused;
 904                         break;
 905                 default:
 906                         st->bits_unused = bits_unused;
 907                         return -1;
 908                 }
 909         }
 910
 911         if(bits_unused == 8) {
 912                 st->size = buf - st->buf;
 913                 st->bits_unused = 0;
 914         } else {
 915                 st->size = buf - st->buf + 1;
 916                 st->bits_unused = bits_unused;
 917         }
 918
 919         assert(st->size <= _ns);
 920         st->buf[st->size] = 0;          /* Courtesy termination */
 921
 922         return chunk_size;      /* Converted in full */
 923 }
 924
 925 /*
 926  * Something like strtod(), but with stricter rules.
 927  */
 928 static int
 929 OS__strtoent(int base, const char *buf, const char *end, int32_t *ret_value) {
 930         int32_t val = 0;
 931         const char *p;
 932
 933         for(p = buf; p < end; p++) {
 934                 int ch = *p;
 935
 936                 /* Strange huge value */
 937                 if((val * base + base) < 0)
 938                         return -1;
 939
 940                 switch(ch) {
 941                 case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: /*01234*/
 942                 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39: /*56789*/
 943                         val = val * base + (ch - 0x30);
 944                         break;
 945                 case 0x41: case 0x42: case 0x43:        /* ABC */
 946                 case 0x44: case 0x45: case 0x46:        /* DEF */
 947                         val = val * base + (ch - 0x41 + 10);
 948                         break;
 949                 case 0x61: case 0x62: case 0x63:        /* abc */
 950                 case 0x64: case 0x65: case 0x66:        /* def */
 951                         val = val * base + (ch - 0x61 + 10);
 952                         break;
 953                 case 0x3b:      /* ';' */
 954                         *ret_value = val;
 955                         return (p - buf) + 1;
 956                 default:
 957                         return -1;      /* Character set error */
 958                 }
 959         }
 960
 961         *ret_value = -1;
 962         return (p - buf);
 963 }
 964
 965 /*
 966  * Convert from the plain UTF-8 format, expanding entity references: "2 &lt; 3"
 967  */
 968 static ssize_t OCTET_STRING__convert_entrefs(void *sptr, const void *chunk_buf, size_t chunk_size, int have_more) {
 969         OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
 970         const char *p = (const char *)chunk_buf;
 971         const char *pend = p + chunk_size;
 972         uint8_t *buf;
 973
 974         /* Reallocate buffer */
 975         ssize_t _ns = st->size + chunk_size;
 976         void *nptr = REALLOC(st->buf, _ns + 1);
 977         if(!nptr) return -1;
 978         st->buf = (uint8_t *)nptr;
 979         buf = st->buf + st->size;
 980
 981         /*
 982          * Convert series of 0 and 1 into the octet string.
 983          */
 984         for(; p < pend; p++) {
 985                 int ch = *(const unsigned char *)p;
 986                 int len;        /* Length of the rest of the chunk */
 987
 988                 if(ch != 0x26 /* '&' */) {
 989                         *buf++ = ch;
 990                         continue;       /* That was easy... */
 991                 }
 992
 993                 /*
 994                  * Process entity reference.
 995                  */
 996                 len = chunk_size - (p - (const char *)chunk_buf);
 997                 if(len == 1 /* "&" */) goto want_more;
 998                 if(p[1] == 0x23 /* '#' */) {
 999                         const char *pval;       /* Pointer to start of digits */
1000                         int32_t val = 0;        /* Entity reference value */
1001                         int base;
1002
1003                         if(len == 2 /* "&#" */) goto want_more;
1004                         if(p[2] == 0x78 /* 'x' */)
1005                                 pval = p + 3, base = 16;
1006                         else
1007                                 pval = p + 2, base = 10;
1008                         len = OS__strtoent(base, pval, p + len, &val);
1009                         if(len == -1) {
1010                                 /* Invalid charset. Just copy verbatim. */
1011                                 *buf++ = ch;
1012                                 continue;
1013                         }
1014                         if(!len || pval[len-1] != 0x3b) goto want_more;
1015                         assert(val > 0);
1016                         p += (pval - p) + len - 1; /* Advance past entref */
1017
1018                         if(val < 0x80) {
1019                                 *buf++ = (char)val;
1020                         } else if(val < 0x800) {
1021                                 *buf++ = 0xc0 | ((val >> 6));
1022                                 *buf++ = 0x80 | ((val & 0x3f));
1023                         } else if(val < 0x10000) {
1024                                 *buf++ = 0xe0 | ((val >> 12));
1025                                 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1026                                 *buf++ = 0x80 | ((val & 0x3f));
1027                         } else if(val < 0x200000) {
1028                                 *buf++ = 0xf0 | ((val >> 18));
1029                                 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1030                                 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1031                                 *buf++ = 0x80 | ((val & 0x3f));
1032                         } else if(val < 0x4000000) {
1033                                 *buf++ = 0xf8 | ((val >> 24));
1034                                 *buf++ = 0x80 | ((val >> 18) & 0x3f);
1035                                 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1036                                 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1037                                 *buf++ = 0x80 | ((val & 0x3f));
1038                         } else {
1039                                 *buf++ = 0xfc | ((val >> 30) & 0x1);
1040                                 *buf++ = 0x80 | ((val >> 24) & 0x3f);
1041                                 *buf++ = 0x80 | ((val >> 18) & 0x3f);
1042                                 *buf++ = 0x80 | ((val >> 12) & 0x3f);
1043                                 *buf++ = 0x80 | ((val >> 6) & 0x3f);
1044                                 *buf++ = 0x80 | ((val & 0x3f));
1045                         }
1046                 } else {
1047                         /*
1048                          * Ugly, limited parsing of &amp; &gt; &lt;
1049                          */
1050                         char *sc = (char *)memchr(p, 0x3b, len > 5 ? 5 : len);
1051                         if(!sc) goto want_more;
1052                         if((sc - p) == 4
1053                                 && p[1] == 0x61 /* 'a' */
1054                                 && p[2] == 0x6d /* 'm' */
1055                                 && p[3] == 0x70 /* 'p' */) {
1056                                 *buf++ = 0x26;
1057                                 p = sc;
1058                                 continue;
1059                         }
1060                         if((sc - p) == 3) {
1061                                 if(p[1] == 0x6c) {
1062                                         *buf = 0x3c;    /* '<' */
1063                                 } else if(p[1] == 0x67) {
1064                                         *buf = 0x3e;    /* '>' */
1065                                 } else {
1066                                         /* Unsupported entity reference */
1067                                         *buf++ = ch;
1068                                         continue;
1069                                 }
1070                                 if(p[2] != 0x74) {
1071                                         /* Unsupported entity reference */
1072                                         *buf++ = ch;
1073                                         continue;
1074                                 }
1075                                 buf++;
1076                                 p = sc;
1077                                 continue;
1078                         }
1079                         /* Unsupported entity reference */
1080                         *buf++ = ch;
1081                 }
1082
1083                 continue;
1084         want_more:
1085                 if(have_more) {
1086                         /*
1087                          * We know that no more data (of the same type)
1088                          * is coming. Copy the rest verbatim.
1089                          */
1090                         *buf++ = ch;
1091                         continue;
1092                 }
1093                 chunk_size = (p - (const char *)chunk_buf);
1094                 /* Processing stalled: need more data */
1095                 break;
1096         }
1097
1098         st->size = buf - st->buf;
1099         assert(st->size <= _ns);
1100         st->buf[st->size] = 0;          /* Courtesy termination */
1101
1102         return chunk_size;      /* Converted in full */
1103 }
1104
1105 /*
1106  * Decode OCTET STRING from the XML element's body.
1107  */
1108 static asn_dec_rval_t
1109 OCTET_STRING__decode_xer(asn_codec_ctx_t *opt_codec_ctx,
1110         asn_TYPE_descriptor_t *td, void **sptr,
1111         const char *opt_mname, const void *buf_ptr, size_t size,
1112         int (*opt_unexpected_tag_decoder)
1113                 (void *struct_ptr, const void *chunk_buf, size_t chunk_size),
1114         ssize_t (*body_receiver)
1115                 (void *struct_ptr, const void *chunk_buf, size_t chunk_size,
1116                         int have_more)
1117 ) {
1118         OCTET_STRING_t *st = (OCTET_STRING_t *)*sptr;
1119         asn_OCTET_STRING_specifics_t *specs = td->specifics
1120                                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1121                                 : &asn_DEF_OCTET_STRING_specs;
1122         const char *xml_tag = opt_mname ? opt_mname : td->xml_tag;
1123         asn_struct_ctx_t *ctx;          /* Per-structure parser context */
1124         asn_dec_rval_t rval;            /* Return value from the decoder */
1125         int st_allocated;
1126
1127         /*
1128          * Create the string if does not exist.
1129          */
1130         if(!st) {
1131                 st = (OCTET_STRING_t *)CALLOC(1, specs->struct_size);
1132                 *sptr = (void *)st;
1133                 if(!st) goto sta_failed;
1134                 st_allocated = 1;
1135         } else {
1136                 st_allocated = 0;
1137         }
1138         if(!st->buf) {
1139                 /* This is separate from above section */
1140                 st->buf = (uint8_t *)CALLOC(1, 1);
1141                 if(!st->buf) {
1142                         if(st_allocated) {
1143                                 *sptr = 0;
1144                                 goto stb_failed;
1145                         } else {
1146                                 goto sta_failed;
1147                         }
1148                 }
1149         }
1150
1151         /* Restore parsing context */
1152         ctx = (asn_struct_ctx_t *)(((char *)*sptr) + specs->ctx_offset);
1153
1154         return xer_decode_general(opt_codec_ctx, ctx, *sptr, xml_tag,
1155                 buf_ptr, size, opt_unexpected_tag_decoder, body_receiver);
1156
1157 stb_failed:
1158         FREEMEM(st);
1159 sta_failed:
1160         rval.code = RC_FAIL;
1161         rval.consumed = 0;
1162         return rval;
1163 }
1164
1165 /*
1166  * Decode OCTET STRING from the hexadecimal data.
1167  */
1168 asn_dec_rval_t
1169 OCTET_STRING_decode_xer_hex(asn_codec_ctx_t *opt_codec_ctx,
1170         asn_TYPE_descriptor_t *td, void **sptr,
1171                 const char *opt_mname, const void *buf_ptr, size_t size) {
1172         return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1173                 buf_ptr, size, 0, OCTET_STRING__convert_hexadecimal);
1174 }
1175
1176 /*
1177  * Decode OCTET STRING from the binary (0/1) data.
1178  */
1179 asn_dec_rval_t
1180 OCTET_STRING_decode_xer_binary(asn_codec_ctx_t *opt_codec_ctx,
1181         asn_TYPE_descriptor_t *td, void **sptr,
1182                 const char *opt_mname, const void *buf_ptr, size_t size) {
1183         return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1184                 buf_ptr, size, 0, OCTET_STRING__convert_binary);
1185 }
1186
1187 /*
1188  * Decode OCTET STRING from the string (ASCII/UTF-8) data.
1189  */
1190 asn_dec_rval_t
1191 OCTET_STRING_decode_xer_utf8(asn_codec_ctx_t *opt_codec_ctx,
1192         asn_TYPE_descriptor_t *td, void **sptr,
1193                 const char *opt_mname, const void *buf_ptr, size_t size) {
1194         return OCTET_STRING__decode_xer(opt_codec_ctx, td, sptr, opt_mname,
1195                 buf_ptr, size,
1196                 OCTET_STRING__handle_control_chars,
1197                 OCTET_STRING__convert_entrefs);
1198 }
1199
1200 asn_dec_rval_t
1201 OCTET_STRING_decode_uper(asn_codec_ctx_t *opt_codec_ctx,
1202         asn_TYPE_descriptor_t *td, asn_per_constraints_t *constraints,
1203         void **sptr, asn_per_data_t *pd) {
1204
1205         asn_OCTET_STRING_specifics_t *specs = td->specifics
1206                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1207                 : &asn_DEF_OCTET_STRING_specs;
1208         asn_per_constraint_t *ct = constraints ? &constraints->size
1209                                 : (td->per_constraints
1210                                         ? &td->per_constraints->size
1211                                         : &asn_DEF_OCTET_STRING_constraint);
1212         asn_dec_rval_t rval = { RC_OK, 0 };
1213         BIT_STRING_t *st = (BIT_STRING_t *)*sptr;
1214         ssize_t consumed_myself = 0;
1215         int repeat;
1216         int unit_bits = (specs->subvariant != 1) * 7 + 1;
1217
1218         (void)opt_codec_ctx;
1219
1220         /*
1221          * Allocate the string.
1222          */
1223         if(!st) {
1224                 st = (BIT_STRING_t *)(*sptr = CALLOC(1, specs->struct_size));
1225                 if(!st) RETURN(RC_FAIL);
1226         }
1227
1228         ASN_DEBUG("PER Decoding %s %ld .. %ld bits %d",
1229                 ct->flags & APC_EXTENSIBLE ? "extensible" : "fixed",
1230                 ct->lower_bound, ct->upper_bound, ct->effective_bits);
1231
1232         if(ct->flags & APC_EXTENSIBLE) {
1233                 int inext = per_get_few_bits(pd, 1);
1234                 if(inext < 0) RETURN(RC_WMORE);
1235                 if(inext) ct = &asn_DEF_OCTET_STRING_constraint;
1236                 consumed_myself = 0;
1237         }
1238
1239         if(ct->effective_bits >= 0
1240         && (!st->buf || st->size < ct->upper_bound)) {
1241                 FREEMEM(st->buf);
1242                 if(unit_bits == 1) {
1243                         st->size = (ct->upper_bound + 7) >> 3;
1244                 } else {
1245                         st->size = ct->upper_bound;
1246                 }
1247                 st->buf = (uint8_t *)MALLOC(st->size + 1);
1248                 if(!st->buf) { st->size = 0; RETURN(RC_FAIL); }
1249         }
1250
1251         /* X.691, #16.5: zero-length encoding */
1252         /* X.691, #16.6: short fixed length encoding (up to 2 octets) */
1253         /* X.691, #16.7: long fixed length encoding (up to 64K octets) */
1254         if(ct->effective_bits == 0) {
1255                 int ret = per_get_many_bits(pd, st->buf, 0,
1256                                             unit_bits * ct->upper_bound);
1257                 if(ret < 0) RETURN(RC_WMORE);
1258                 consumed_myself += unit_bits * ct->upper_bound;
1259                 st->buf[st->size] = 0;
1260                 if(unit_bits == 1 && (ct->upper_bound & 0x7))
1261                         st->bits_unused = 8 - (ct->upper_bound & 0x7);
1262                 RETURN(RC_OK);
1263         }
1264
1265         st->size = 0;
1266         do {
1267                 ssize_t len_bytes;
1268                 ssize_t len_bits;
1269                 void *p;
1270                 int ret;
1271
1272                 /* Get the PER length */
1273                 len_bits = uper_get_length(pd, ct->effective_bits, &repeat);
1274                 if(len_bits < 0) RETURN(RC_WMORE);
1275                 len_bits += ct->lower_bound;
1276
1277                 ASN_DEBUG("Got PER length eb %ld, len %ld, %s (%s)",
1278                         (long)ct->effective_bits, (long)len_bits,
1279                         repeat ? "repeat" : "once", td->name);
1280                 if(unit_bits == 1) {
1281                         len_bytes = (len_bits + 7) >> 3;
1282                         if(len_bits & 0x7)
1283                                 st->bits_unused = 8 - (len_bits & 0x7);
1284                         /* len_bits be multiple of 16K if repeat is set */
1285                 } else {
1286                         len_bytes = len_bits;
1287                         len_bits = len_bytes << 3;
1288                 }
1289                 p = REALLOC(st->buf, st->size + len_bytes + 1);
1290                 if(!p) RETURN(RC_FAIL);
1291                 st->buf = (uint8_t *)p;
1292
1293                 ret = per_get_many_bits(pd, &st->buf[st->size], 0, len_bits);
1294                 if(ret < 0) RETURN(RC_WMORE);
1295                 st->size += len_bytes;
1296         } while(repeat);
1297         st->buf[st->size] = 0;  /* nul-terminate */
1298
1299         return rval;
1300 }
1301
1302 asn_enc_rval_t
1303 OCTET_STRING_encode_uper(asn_TYPE_descriptor_t *td,
1304         asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) {
1305
1306         asn_OCTET_STRING_specifics_t *specs = td->specifics
1307                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1308                 : &asn_DEF_OCTET_STRING_specs;
1309         asn_per_constraint_t *ct = constraints ? &constraints->size
1310                                 : (td->per_constraints
1311                                         ? &td->per_constraints->size
1312                                         : &asn_DEF_OCTET_STRING_constraint);
1313         const BIT_STRING_t *st = (const BIT_STRING_t *)sptr;
1314         int unit_bits = (specs->subvariant != 1) * 7 + 1;
1315         asn_enc_rval_t er;
1316         int ct_extensible = ct->flags & APC_EXTENSIBLE;
1317         int inext = 0;          /* Lies not within extension root */
1318         int sizeinunits = 0;
1319         const uint8_t *buf;
1320         int ret;
1321
1322         if(!st || !st->buf)
1323                 _ASN_ENCODE_FAILED;
1324         sizeinunits = st->size;
1325
1326         if(unit_bits == 1) {
1327                 ASN_DEBUG("BIT STRING of %d bytes, %d bits unused",
1328                                 sizeinunits, st->bits_unused);
1329                 sizeinunits = sizeinunits * 8 - (st->bits_unused & 0x07);
1330         }
1331
1332         ASN_DEBUG("Encoding %s into %d units of %d bits"
1333                 " (%d..%d, effective %d)%s",
1334                 td->name, sizeinunits, unit_bits,
1335                 ct->lower_bound, ct->upper_bound,
1336                 ct->effective_bits, ct_extensible ? " EXT" : "");
1337
1338         /* Figure out wheter size lies within PER visible consrtaint */
1339
1340         if(ct->effective_bits >= 0) {
1341                 if(sizeinunits < ct->lower_bound
1342                 || sizeinunits > ct->upper_bound) {
1343                         if(ct_extensible) {
1344                                 ct = &asn_DEF_OCTET_STRING_constraint;
1345                                 inext = 1;
1346                         } else
1347                                 _ASN_ENCODE_FAILED;
1348                 }
1349         } else {
1350                 inext = 0;
1351         }
1352
1353         if(ct_extensible) {
1354                 /* Declare whether length is [not] within extension root */
1355                 if(per_put_few_bits(po, inext, 1))
1356                         _ASN_ENCODE_FAILED;
1357         }
1358
1359         /* X.691, #16.5: zero-length encoding */
1360         /* X.691, #16.6: short fixed length encoding (up to 2 octets) */
1361         /* X.691, #16.7: long fixed length encoding (up to 64K octets) */
1362         if(ct->effective_bits >= 0) {
1363                 ASN_DEBUG("Encoding %d bytes (%ld), length in %d bits",
1364                                 st->size, sizeinunits - ct->lower_bound,
1365                                 ct->effective_bits);
1366                 ret = per_put_few_bits(po, sizeinunits - ct->lower_bound,
1367                                 ct->effective_bits);
1368                 if(ret) _ASN_ENCODE_FAILED;
1369                 ret = per_put_many_bits(po, st->buf, sizeinunits * unit_bits);
1370                 if(ret) _ASN_ENCODE_FAILED;
1371                 _ASN_ENCODED_OK(er);
1372         }
1373
1374         ASN_DEBUG("Encoding %d bytes", st->size);
1375
1376         if(sizeinunits == 0) {
1377                 if(uper_put_length(po, 0))
1378                         _ASN_ENCODE_FAILED;
1379                 _ASN_ENCODED_OK(er);
1380         }
1381
1382         buf = st->buf;
1383         while(sizeinunits) {
1384                 ssize_t maySave = uper_put_length(po, sizeinunits);
1385                 if(maySave < 0) _ASN_ENCODE_FAILED;
1386
1387                 ASN_DEBUG("Encoding %d of %d", maySave, sizeinunits);
1388
1389                 ret = per_put_many_bits(po, buf, maySave * unit_bits);
1390                 if(ret) _ASN_ENCODE_FAILED;
1391
1392                 if(unit_bits == 1)
1393                         buf += maySave >> 3;
1394                 else
1395                         buf += maySave;
1396                 sizeinunits -= maySave;
1397                 assert(!(maySave & 0x07) || !sizeinunits);
1398         }
1399
1400         _ASN_ENCODED_OK(er);
1401 }
1402
1403 int
1404 OCTET_STRING_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
1405         asn_app_consume_bytes_f *cb, void *app_key) {
1406         static const char *h2c = "0123456789ABCDEF";
1407         const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
1408         char scratch[16 * 3 + 4];
1409         char *p = scratch;
1410         uint8_t *buf;
1411         uint8_t *end;
1412         size_t i;
1413
1414         (void)td;       /* Unused argument */
1415
1416         if(!st || !st->buf) return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
1417
1418         /*
1419          * Dump the contents of the buffer in hexadecimal.
1420          */
1421         buf = st->buf;
1422         end = buf + st->size;
1423         for(i = 0; buf < end; buf++, i++) {
1424                 if(!(i % 16) && (i || st->size > 16)) {
1425                         if(cb(scratch, p - scratch, app_key) < 0)
1426                                 return -1;
1427                         _i_INDENT(1);
1428                         p = scratch;
1429                 }
1430                 *p++ = h2c[(*buf >> 4) & 0x0F];
1431                 *p++ = h2c[*buf & 0x0F];
1432                 *p++ = 0x20;
1433         }
1434
1435         if(p > scratch) {
1436                 p--;    /* Remove the tail space */
1437                 if(cb(scratch, p - scratch, app_key) < 0)
1438                         return -1;
1439         }
1440
1441         return 0;
1442 }
1443
1444 int
1445 OCTET_STRING_print_utf8(asn_TYPE_descriptor_t *td, const void *sptr,
1446                 int ilevel, asn_app_consume_bytes_f *cb, void *app_key) {
1447         const OCTET_STRING_t *st = (const OCTET_STRING_t *)sptr;
1448
1449         (void)td;       /* Unused argument */
1450         (void)ilevel;   /* Unused argument */
1451
1452         if(st && st->buf) {
1453                 return (cb(st->buf, st->size, app_key) < 0) ? -1 : 0;
1454         } else {
1455                 return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
1456         }
1457 }
1458
1459 void
1460 OCTET_STRING_free(asn_TYPE_descriptor_t *td, void *sptr, int contents_only) {
1461         OCTET_STRING_t *st = (OCTET_STRING_t *)sptr;
1462         asn_OCTET_STRING_specifics_t *specs = td && td->specifics
1463                                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1464                                 : &asn_DEF_OCTET_STRING_specs;
1465         asn_struct_ctx_t *ctx = (asn_struct_ctx_t *)
1466                                         ((char *)st + specs->ctx_offset);
1467         struct _stack *stck;
1468
1469         if(!td || !st)
1470                 return;
1471
1472         ASN_DEBUG("Freeing %s as OCTET STRING", td->name);
1473
1474         if(st->buf) {
1475                 FREEMEM(st->buf);
1476         }
1477
1478         /*
1479          * Remove decode-time stack.
1480          */
1481         stck = (struct _stack *)ctx->ptr;
1482         if(stck) {
1483                 while(stck->tail) {
1484                         struct _stack_el *sel = stck->tail;
1485                         stck->tail = sel->prev;
1486                         FREEMEM(sel);
1487                 }
1488                 FREEMEM(stck);
1489         }
1490
1491         if(!contents_only) {
1492                 FREEMEM(st);
1493         }
1494 }
1495
1496 /*
1497  * Conversion routines.
1498  */
1499 int
1500 OCTET_STRING_fromBuf(OCTET_STRING_t *st, const char *str, int len) {
1501         void *buf;
1502
1503         if(st == 0 || (str == 0 && len)) {
1504                 errno = EINVAL;
1505                 return -1;
1506         }
1507
1508         /*
1509          * Clear the OCTET STRING.
1510          */
1511         if(str == NULL) {
1512                 FREEMEM(st->buf);
1513                 st->buf = 0;
1514                 st->size = 0;
1515                 return 0;
1516         }
1517
1518         /* Determine the original string size, if not explicitly given */
1519         if(len < 0)
1520                 len = strlen(str);
1521
1522         /* Allocate and fill the memory */
1523         buf = MALLOC(len + 1);
1524         if(buf == NULL)
1525                 return -1;
1526
1527         memcpy(buf, str, len);
1528         ((uint8_t *)buf)[len] = '\0';   /* Couldn't use memcpy(len+1)! */
1529         FREEMEM(st->buf);
1530         st->buf = (uint8_t *)buf;
1531         st->size = len;
1532
1533         return 0;
1534 }
1535
1536 OCTET_STRING_t *
1537 OCTET_STRING_new_fromBuf(asn_TYPE_descriptor_t *td, const char *str, int len) {
1538         asn_OCTET_STRING_specifics_t *specs = td->specifics
1539                                 ? (asn_OCTET_STRING_specifics_t *)td->specifics
1540                                 : &asn_DEF_OCTET_STRING_specs;
1541         OCTET_STRING_t *st;
1542
1543         st = (OCTET_STRING_t *)CALLOC(1, specs->struct_size);
1544         if(st && str && OCTET_STRING_fromBuf(st, str, len)) {
1545                 FREEMEM(st);
1546                 st = NULL;
1547         }
1548
1549         return st;
1550 }
1551