Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2007 Lev Walkin <vlm@lionet.info>. All rights reserved. |
| 3 | * Redistribution and modifications are permitted subject to BSD license. |
| 4 | */ |
| 5 | #include <asn_internal.h> |
| 6 | #include <per_support.h> |
| 7 | #include <constr_TYPE.h> |
| 8 | #include <per_opentype.h> |
| 9 | |
| 10 | typedef struct uper_ugot_key { |
| 11 | asn_per_data_t oldpd; /* Old per data source */ |
| 12 | size_t unclaimed; |
| 13 | size_t ot_moved; /* Number of bits moved by OT processing */ |
| 14 | int repeat; |
| 15 | } uper_ugot_key; |
| 16 | |
| 17 | static int uper_ugot_refill(asn_per_data_t *pd); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 18 | static int per_skip_bits(asn_per_data_t *pd, int skip_nbits); |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 19 | static asn_dec_rval_t uper_sot_suck(const asn_codec_ctx_t *, |
Lev Walkin | 494fb70 | 2017-08-07 20:07:00 -0700 | [diff] [blame] | 20 | asn_TYPE_descriptor_t *td, |
| 21 | const asn_per_constraints_t *constraints, |
| 22 | void **sptr, asn_per_data_t *pd); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 23 | |
| 24 | /* |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 25 | * Encode an "open type field". |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 26 | * #10.1, #10.2 |
| 27 | */ |
| 28 | int |
| 29 | uper_open_type_put(asn_TYPE_descriptor_t *td, asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) { |
| 30 | void *buf; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 31 | void *bptr; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 32 | ssize_t size; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 33 | size_t toGo; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 34 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 35 | ASN_DEBUG("Open type put %s ...", td->name); |
| 36 | |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 37 | size = uper_encode_to_new_buffer(td, constraints, sptr, &buf); |
| 38 | if(size <= 0) return -1; |
| 39 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 40 | for(bptr = buf, toGo = size; toGo;) { |
| 41 | ssize_t maySave = uper_put_length(po, toGo); |
Lev Walkin | 190419b | 2010-10-25 19:19:17 -0700 | [diff] [blame] | 42 | ASN_DEBUG("Prepending length %d to %s and allowing to save %d", |
| 43 | (int)size, td->name, (int)maySave); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 44 | if(maySave < 0) break; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 45 | if(per_put_many_bits(po, bptr, maySave * 8)) break; |
| 46 | bptr = (char *)bptr + maySave; |
| 47 | toGo -= maySave; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 48 | } |
| 49 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 50 | FREEMEM(buf); |
| 51 | if(toGo) return -1; |
| 52 | |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 53 | ASN_DEBUG("Open type put %s of length %ld + overhead (1byte?)", |
| 54 | td->name, (long)size); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 55 | |
| 56 | return 0; |
| 57 | } |
| 58 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 59 | static asn_dec_rval_t |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 60 | uper_open_type_get_simple(const asn_codec_ctx_t *ctx, asn_TYPE_descriptor_t *td, |
Lev Walkin | 494fb70 | 2017-08-07 20:07:00 -0700 | [diff] [blame] | 61 | const asn_per_constraints_t *constraints, void **sptr, asn_per_data_t *pd) { |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 62 | asn_dec_rval_t rv; |
| 63 | ssize_t chunk_bytes; |
| 64 | int repeat; |
| 65 | uint8_t *buf = 0; |
| 66 | size_t bufLen = 0; |
| 67 | size_t bufSize = 0; |
| 68 | asn_per_data_t spd; |
Lev Walkin | 55fdd99 | 2007-06-29 11:25:49 +0000 | [diff] [blame] | 69 | size_t padding; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 70 | |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 71 | ASN__STACK_OVERFLOW_CHECK(ctx); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 72 | |
Lev Walkin | 7c97b88 | 2007-06-29 11:32:25 +0000 | [diff] [blame] | 73 | ASN_DEBUG("Getting open type %s...", td->name); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 74 | |
| 75 | do { |
| 76 | chunk_bytes = uper_get_length(pd, -1, &repeat); |
| 77 | if(chunk_bytes < 0) { |
| 78 | FREEMEM(buf); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 79 | ASN__DECODE_STARVED; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 80 | } |
| 81 | if(bufLen + chunk_bytes > bufSize) { |
| 82 | void *ptr; |
| 83 | bufSize = chunk_bytes + (bufSize << 2); |
| 84 | ptr = REALLOC(buf, bufSize); |
| 85 | if(!ptr) { |
| 86 | FREEMEM(buf); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 87 | ASN__DECODE_FAILED; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 88 | } |
| 89 | buf = ptr; |
| 90 | } |
| 91 | if(per_get_many_bits(pd, buf + bufLen, 0, chunk_bytes << 3)) { |
| 92 | FREEMEM(buf); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 93 | ASN__DECODE_STARVED; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 94 | } |
| 95 | bufLen += chunk_bytes; |
| 96 | } while(repeat); |
| 97 | |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 98 | ASN_DEBUG("Getting open type %s encoded in %ld bytes", td->name, |
| 99 | (long)bufLen); |
Lev Walkin | 55fdd99 | 2007-06-29 11:25:49 +0000 | [diff] [blame] | 100 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 101 | memset(&spd, 0, sizeof(spd)); |
| 102 | spd.buffer = buf; |
| 103 | spd.nbits = bufLen << 3; |
| 104 | |
Lev Walkin | 69c73dc | 2012-02-21 02:15:08 -0800 | [diff] [blame] | 105 | ASN_DEBUG_INDENT_ADD(+4); |
Bi-Ruei, Chiu | 1f87ac0 | 2017-08-20 01:25:45 +0800 | [diff] [blame] | 106 | rv = td->op->uper_decoder(ctx, td, constraints, sptr, &spd); |
Lev Walkin | 69c73dc | 2012-02-21 02:15:08 -0800 | [diff] [blame] | 107 | ASN_DEBUG_INDENT_ADD(-4); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 108 | |
Lev Walkin | 49f510f | 2007-06-29 17:33:04 +0000 | [diff] [blame] | 109 | if(rv.code == RC_OK) { |
| 110 | /* Check padding validity */ |
| 111 | padding = spd.nbits - spd.nboff; |
Lev Walkin | 190419b | 2010-10-25 19:19:17 -0700 | [diff] [blame] | 112 | if ((padding < 8 || |
| 113 | /* X.691#10.1.3 */ |
| 114 | (spd.nboff == 0 && spd.nbits == 8 && spd.buffer == buf)) && |
Lev Walkin | a6dd57a | 2010-10-24 22:03:14 -0700 | [diff] [blame] | 115 | per_get_few_bits(&spd, padding) == 0) { |
Lev Walkin | 49f510f | 2007-06-29 17:33:04 +0000 | [diff] [blame] | 116 | /* Everything is cool */ |
| 117 | FREEMEM(buf); |
| 118 | return rv; |
| 119 | } |
| 120 | FREEMEM(buf); |
| 121 | if(padding >= 8) { |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 122 | ASN_DEBUG("Too large padding %d in open type", (int)padding); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 123 | ASN__DECODE_FAILED; |
Lev Walkin | 49f510f | 2007-06-29 17:33:04 +0000 | [diff] [blame] | 124 | } else { |
| 125 | ASN_DEBUG("Non-zero padding"); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 126 | ASN__DECODE_FAILED; |
Lev Walkin | 49f510f | 2007-06-29 17:33:04 +0000 | [diff] [blame] | 127 | } |
| 128 | } else { |
| 129 | FREEMEM(buf); |
Lev Walkin | 80515f0 | 2007-06-29 23:23:05 +0000 | [diff] [blame] | 130 | /* rv.code could be RC_WMORE, nonsense in this context */ |
| 131 | rv.code = RC_FAIL; /* Noone would give us more */ |
Lev Walkin | 55fdd99 | 2007-06-29 11:25:49 +0000 | [diff] [blame] | 132 | } |
| 133 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 134 | return rv; |
| 135 | } |
| 136 | |
| 137 | static asn_dec_rval_t GCC_NOTUSED |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 138 | uper_open_type_get_complex(const asn_codec_ctx_t *ctx, asn_TYPE_descriptor_t *td, |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 139 | asn_per_constraints_t *constraints, void **sptr, asn_per_data_t *pd) { |
| 140 | uper_ugot_key arg; |
| 141 | asn_dec_rval_t rv; |
| 142 | ssize_t padding; |
| 143 | |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 144 | ASN__STACK_OVERFLOW_CHECK(ctx); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 145 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 146 | ASN_DEBUG("Getting open type %s from %s", td->name, |
Lev Walkin | 6cd0d56 | 2017-08-25 11:57:01 -0700 | [diff] [blame] | 147 | asn_bit_data_string(pd)); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 148 | arg.oldpd = *pd; |
| 149 | arg.unclaimed = 0; |
| 150 | arg.ot_moved = 0; |
| 151 | arg.repeat = 1; |
| 152 | pd->refill = uper_ugot_refill; |
| 153 | pd->refill_key = &arg; |
| 154 | pd->nbits = pd->nboff; /* 0 good bits at this point, will refill */ |
| 155 | pd->moved = 0; /* This now counts the open type size in bits */ |
| 156 | |
Lev Walkin | 69c73dc | 2012-02-21 02:15:08 -0800 | [diff] [blame] | 157 | ASN_DEBUG_INDENT_ADD(+4); |
Bi-Ruei, Chiu | 1f87ac0 | 2017-08-20 01:25:45 +0800 | [diff] [blame] | 158 | rv = td->op->uper_decoder(ctx, td, constraints, sptr, pd); |
Lev Walkin | 69c73dc | 2012-02-21 02:15:08 -0800 | [diff] [blame] | 159 | ASN_DEBUG_INDENT_ADD(-4); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 160 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 161 | #define UPDRESTOREPD do { \ |
| 162 | /* buffer and nboff are valid, preserve them. */ \ |
| 163 | pd->nbits = arg.oldpd.nbits - (pd->moved - arg.ot_moved); \ |
| 164 | pd->moved = arg.oldpd.moved + (pd->moved - arg.ot_moved); \ |
| 165 | pd->refill = arg.oldpd.refill; \ |
| 166 | pd->refill_key = arg.oldpd.refill_key; \ |
| 167 | } while(0) |
| 168 | |
| 169 | if(rv.code != RC_OK) { |
| 170 | UPDRESTOREPD; |
| 171 | return rv; |
| 172 | } |
| 173 | |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 174 | ASN_DEBUG("OpenType %s pd%s old%s unclaimed=%d, repeat=%d", td->name, |
Lev Walkin | 6cd0d56 | 2017-08-25 11:57:01 -0700 | [diff] [blame] | 175 | asn_bit_data_string(pd), |
| 176 | asn_bit_data_string(&arg.oldpd), |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 177 | (int)arg.unclaimed, (int)arg.repeat); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 178 | |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 179 | padding = pd->moved % 8; |
| 180 | if(padding) { |
| 181 | int32_t pvalue; |
| 182 | if(padding > 7) { |
| 183 | ASN_DEBUG("Too large padding %d in open type", |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 184 | (int)padding); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 185 | rv.code = RC_FAIL; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 186 | UPDRESTOREPD; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 187 | return rv; |
| 188 | } |
| 189 | padding = 8 - padding; |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 190 | ASN_DEBUG("Getting padding of %d bits", (int)padding); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 191 | pvalue = per_get_few_bits(pd, padding); |
| 192 | switch(pvalue) { |
| 193 | case -1: |
| 194 | ASN_DEBUG("Padding skip failed"); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 195 | UPDRESTOREPD; |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 196 | ASN__DECODE_STARVED; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 197 | case 0: break; |
| 198 | default: |
| 199 | ASN_DEBUG("Non-blank padding (%d bits 0x%02x)", |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 200 | (int)padding, (int)pvalue); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 201 | UPDRESTOREPD; |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 202 | ASN__DECODE_FAILED; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 203 | } |
| 204 | } |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 205 | if(pd->nboff != pd->nbits) { |
| 206 | ASN_DEBUG("Open type %s overhead pd%s old%s", td->name, |
Lev Walkin | 6cd0d56 | 2017-08-25 11:57:01 -0700 | [diff] [blame] | 207 | asn_bit_data_string(pd), asn_bit_data_string(&arg.oldpd)); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 208 | if(1) { |
| 209 | UPDRESTOREPD; |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 210 | ASN__DECODE_FAILED; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 211 | } else { |
| 212 | arg.unclaimed += pd->nbits - pd->nboff; |
| 213 | } |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 214 | } |
| 215 | |
| 216 | /* Adjust pd back so it points to original data */ |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 217 | UPDRESTOREPD; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 218 | |
| 219 | /* Skip data not consumed by the decoder */ |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 220 | if(arg.unclaimed) { |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 221 | ASN_DEBUG("Getting unclaimed %d", (int)arg.unclaimed); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 222 | switch(per_skip_bits(pd, arg.unclaimed)) { |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 223 | case -1: |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 224 | ASN_DEBUG("Claim of %d failed", (int)arg.unclaimed); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 225 | ASN__DECODE_STARVED; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 226 | case 0: |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 227 | ASN_DEBUG("Got claim of %d", (int)arg.unclaimed); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 228 | break; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 229 | default: |
| 230 | /* Padding must be blank */ |
| 231 | ASN_DEBUG("Non-blank unconsumed padding"); |
Lev Walkin | 7c1dc05 | 2016-03-14 03:08:15 -0700 | [diff] [blame] | 232 | ASN__DECODE_FAILED; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 233 | } |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 234 | arg.unclaimed = 0; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 235 | } |
| 236 | |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 237 | if(arg.repeat) { |
| 238 | ASN_DEBUG("Not consumed the whole thing"); |
| 239 | rv.code = RC_FAIL; |
| 240 | return rv; |
| 241 | } |
| 242 | |
| 243 | return rv; |
| 244 | } |
| 245 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 246 | |
| 247 | asn_dec_rval_t |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 248 | uper_open_type_get(const asn_codec_ctx_t *ctx, asn_TYPE_descriptor_t *td, |
Lev Walkin | 494fb70 | 2017-08-07 20:07:00 -0700 | [diff] [blame] | 249 | const asn_per_constraints_t *constraints, void **sptr, |
| 250 | asn_per_data_t *pd) { |
| 251 | return uper_open_type_get_simple(ctx, td, constraints, sptr, pd); |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 252 | } |
| 253 | |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 254 | int |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 255 | uper_open_type_skip(const asn_codec_ctx_t *ctx, asn_per_data_t *pd) { |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 256 | asn_TYPE_descriptor_t s_td; |
Lev Walkin | 75b6fe4 | 2017-08-27 01:03:22 -0700 | [diff] [blame] | 257 | asn_TYPE_operation_t s_op; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 258 | asn_dec_rval_t rv; |
| 259 | |
| 260 | s_td.name = "<unknown extension>"; |
Lev Walkin | 75b6fe4 | 2017-08-27 01:03:22 -0700 | [diff] [blame] | 261 | s_td.op = &s_op; |
| 262 | s_op.uper_decoder = uper_sot_suck; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 263 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 264 | rv = uper_open_type_get(ctx, &s_td, 0, 0, pd); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 265 | if(rv.code != RC_OK) |
| 266 | return -1; |
| 267 | else |
| 268 | return 0; |
| 269 | } |
| 270 | |
| 271 | /* |
| 272 | * Internal functions. |
| 273 | */ |
| 274 | |
| 275 | static asn_dec_rval_t |
Lev Walkin | afbf2a9 | 2017-09-12 23:30:27 -0700 | [diff] [blame] | 276 | uper_sot_suck(const asn_codec_ctx_t *ctx, asn_TYPE_descriptor_t *td, |
Lev Walkin | 494fb70 | 2017-08-07 20:07:00 -0700 | [diff] [blame] | 277 | const asn_per_constraints_t *constraints, void **sptr, asn_per_data_t *pd) { |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 278 | asn_dec_rval_t rv; |
| 279 | |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 280 | (void)ctx; |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 281 | (void)td; |
| 282 | (void)constraints; |
| 283 | (void)sptr; |
| 284 | |
| 285 | while(per_get_few_bits(pd, 24) >= 0); |
| 286 | |
| 287 | rv.code = RC_OK; |
| 288 | rv.consumed = pd->moved; |
| 289 | |
| 290 | return rv; |
| 291 | } |
| 292 | |
| 293 | static int |
| 294 | uper_ugot_refill(asn_per_data_t *pd) { |
| 295 | uper_ugot_key *arg = pd->refill_key; |
| 296 | ssize_t next_chunk_bytes, next_chunk_bits; |
| 297 | ssize_t avail; |
| 298 | |
| 299 | asn_per_data_t *oldpd = &arg->oldpd; |
| 300 | |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 301 | ASN_DEBUG("REFILLING pd->moved=%ld, oldpd->moved=%ld", |
| 302 | (long)pd->moved, (long)oldpd->moved); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 303 | |
| 304 | /* Advance our position to where pd is */ |
| 305 | oldpd->buffer = pd->buffer; |
| 306 | oldpd->nboff = pd->nboff; |
| 307 | oldpd->nbits -= pd->moved - arg->ot_moved; |
| 308 | oldpd->moved += pd->moved - arg->ot_moved; |
| 309 | arg->ot_moved = pd->moved; |
| 310 | |
| 311 | if(arg->unclaimed) { |
| 312 | /* Refill the container */ |
| 313 | if(per_get_few_bits(oldpd, 1)) |
| 314 | return -1; |
| 315 | if(oldpd->nboff == 0) { |
| 316 | assert(0); |
| 317 | return -1; |
| 318 | } |
| 319 | pd->buffer = oldpd->buffer; |
| 320 | pd->nboff = oldpd->nboff - 1; |
| 321 | pd->nbits = oldpd->nbits; |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 322 | ASN_DEBUG("UNCLAIMED <- return from (pd->moved=%ld)", |
| 323 | (long)pd->moved); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 324 | return 0; |
| 325 | } |
| 326 | |
| 327 | if(!arg->repeat) { |
| 328 | ASN_DEBUG("Want more but refill doesn't have it"); |
| 329 | return -1; |
| 330 | } |
| 331 | |
| 332 | next_chunk_bytes = uper_get_length(oldpd, -1, &arg->repeat); |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 333 | ASN_DEBUG("Open type LENGTH %ld bytes at off %ld, repeat %ld", |
| 334 | (long)next_chunk_bytes, (long)oldpd->moved, (long)arg->repeat); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 335 | if(next_chunk_bytes < 0) return -1; |
| 336 | if(next_chunk_bytes == 0) { |
| 337 | pd->refill = 0; /* No more refills, naturally */ |
| 338 | assert(!arg->repeat); /* Implementation guarantee */ |
| 339 | } |
| 340 | next_chunk_bits = next_chunk_bytes << 3; |
| 341 | avail = oldpd->nbits - oldpd->nboff; |
| 342 | if(avail >= next_chunk_bits) { |
| 343 | pd->nbits = oldpd->nboff + next_chunk_bits; |
| 344 | arg->unclaimed = 0; |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 345 | ASN_DEBUG("!+Parent frame %ld bits, alloting %ld [%ld..%ld] (%ld)", |
| 346 | (long)next_chunk_bits, (long)oldpd->moved, |
| 347 | (long)oldpd->nboff, (long)oldpd->nbits, |
| 348 | (long)(oldpd->nbits - oldpd->nboff)); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 349 | } else { |
| 350 | pd->nbits = oldpd->nbits; |
| 351 | arg->unclaimed = next_chunk_bits - avail; |
Lev Walkin | fe1ffaf | 2010-10-25 21:07:59 -0700 | [diff] [blame] | 352 | ASN_DEBUG("!-Parent frame %ld, require %ld, will claim %ld", |
| 353 | (long)avail, (long)next_chunk_bits, |
| 354 | (long)arg->unclaimed); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 355 | } |
| 356 | pd->buffer = oldpd->buffer; |
| 357 | pd->nboff = oldpd->nboff; |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 358 | ASN_DEBUG("Refilled pd%s old%s", |
Lev Walkin | 6cd0d56 | 2017-08-25 11:57:01 -0700 | [diff] [blame] | 359 | asn_bit_data_string(pd), asn_bit_data_string(oldpd)); |
Lev Walkin | 9218bc1 | 2007-06-27 04:09:37 +0000 | [diff] [blame] | 360 | return 0; |
| 361 | } |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 362 | |
| 363 | static int |
| 364 | per_skip_bits(asn_per_data_t *pd, int skip_nbits) { |
| 365 | int hasNonZeroBits = 0; |
| 366 | while(skip_nbits > 0) { |
| 367 | int skip; |
Lev Walkin | da16198 | 2013-03-20 03:35:21 -0700 | [diff] [blame] | 368 | |
| 369 | /* per_get_few_bits() is more efficient when nbits <= 24 */ |
| 370 | if(skip_nbits < 24) |
Lev Walkin | 375f0e9 | 2007-06-29 02:28:50 +0000 | [diff] [blame] | 371 | skip = skip_nbits; |
| 372 | else |
| 373 | skip = 24; |
| 374 | skip_nbits -= skip; |
| 375 | |
| 376 | switch(per_get_few_bits(pd, skip)) { |
| 377 | case -1: return -1; /* Starving */ |
| 378 | case 0: continue; /* Skipped empty space */ |
| 379 | default: hasNonZeroBits = 1; continue; |
| 380 | } |
| 381 | } |
| 382 | return hasNonZeroBits; |
| 383 | } |