1
2
3
4
5
6
7
8
9
10
11
12#include <linux/export.h>
13#include <linux/kernel.h>
14#include <linux/errno.h>
15#include <linux/module.h>
16#include <linux/asn1_decoder.h>
17#include <linux/asn1_ber_bytecode.h>
18
19static const unsigned char asn1_op_lengths[ASN1_OP__NR] = {
20
21 [ASN1_OP_MATCH] = 1 + 1,
22 [ASN1_OP_MATCH_OR_SKIP] = 1 + 1,
23 [ASN1_OP_MATCH_ACT] = 1 + 1 + 1,
24 [ASN1_OP_MATCH_ACT_OR_SKIP] = 1 + 1 + 1,
25 [ASN1_OP_MATCH_JUMP] = 1 + 1 + 1,
26 [ASN1_OP_MATCH_JUMP_OR_SKIP] = 1 + 1 + 1,
27 [ASN1_OP_MATCH_ANY] = 1,
28 [ASN1_OP_MATCH_ANY_OR_SKIP] = 1,
29 [ASN1_OP_MATCH_ANY_ACT] = 1 + 1,
30 [ASN1_OP_MATCH_ANY_ACT_OR_SKIP] = 1 + 1,
31 [ASN1_OP_COND_MATCH_OR_SKIP] = 1 + 1,
32 [ASN1_OP_COND_MATCH_ACT_OR_SKIP] = 1 + 1 + 1,
33 [ASN1_OP_COND_MATCH_JUMP_OR_SKIP] = 1 + 1 + 1,
34 [ASN1_OP_COND_MATCH_ANY] = 1,
35 [ASN1_OP_COND_MATCH_ANY_OR_SKIP] = 1,
36 [ASN1_OP_COND_MATCH_ANY_ACT] = 1 + 1,
37 [ASN1_OP_COND_MATCH_ANY_ACT_OR_SKIP] = 1 + 1,
38 [ASN1_OP_COND_FAIL] = 1,
39 [ASN1_OP_COMPLETE] = 1,
40 [ASN1_OP_ACT] = 1 + 1,
41 [ASN1_OP_MAYBE_ACT] = 1 + 1,
42 [ASN1_OP_RETURN] = 1,
43 [ASN1_OP_END_SEQ] = 1,
44 [ASN1_OP_END_SEQ_OF] = 1 + 1,
45 [ASN1_OP_END_SET] = 1,
46 [ASN1_OP_END_SET_OF] = 1 + 1,
47 [ASN1_OP_END_SEQ_ACT] = 1 + 1,
48 [ASN1_OP_END_SEQ_OF_ACT] = 1 + 1 + 1,
49 [ASN1_OP_END_SET_ACT] = 1 + 1,
50 [ASN1_OP_END_SET_OF_ACT] = 1 + 1 + 1,
51};
52
53
54
55
56
57
58
59
60
61static int asn1_find_indefinite_length(const unsigned char *data, size_t datalen,
62 size_t *_dp, size_t *_len,
63 const char **_errmsg)
64{
65 unsigned char tag, tmp;
66 size_t dp = *_dp, len, n;
67 int indef_level = 1;
68
69next_tag:
70 if (unlikely(datalen - dp < 2)) {
71 if (datalen == dp)
72 goto missing_eoc;
73 goto data_overrun_error;
74 }
75
76
77 tag = data[dp++];
78 if (tag == ASN1_EOC) {
79
80 if (data[dp++] != 0)
81 goto invalid_eoc;
82 if (--indef_level <= 0) {
83 *_len = dp - *_dp;
84 *_dp = dp;
85 return 0;
86 }
87 goto next_tag;
88 }
89
90 if (unlikely((tag & 0x1f) == ASN1_LONG_TAG)) {
91 do {
92 if (unlikely(datalen - dp < 2))
93 goto data_overrun_error;
94 tmp = data[dp++];
95 } while (tmp & 0x80);
96 }
97
98
99 len = data[dp++];
100 if (len <= 0x7f)
101 goto check_length;
102
103 if (unlikely(len == ASN1_INDEFINITE_LENGTH)) {
104
105 if (unlikely((tag & ASN1_CONS_BIT) == ASN1_PRIM << 5))
106 goto indefinite_len_primitive;
107 indef_level++;
108 goto next_tag;
109 }
110
111 n = len - 0x80;
112 if (unlikely(n > sizeof(len) - 1))
113 goto length_too_long;
114 if (unlikely(n > datalen - dp))
115 goto data_overrun_error;
116 len = 0;
117 for (; n > 0; n--) {
118 len <<= 8;
119 len |= data[dp++];
120 }
121check_length:
122 if (len > datalen - dp)
123 goto data_overrun_error;
124 dp += len;
125 goto next_tag;
126
127length_too_long:
128 *_errmsg = "Unsupported length";
129 goto error;
130indefinite_len_primitive:
131 *_errmsg = "Indefinite len primitive not permitted";
132 goto error;
133invalid_eoc:
134 *_errmsg = "Invalid length EOC";
135 goto error;
136data_overrun_error:
137 *_errmsg = "Data overrun error";
138 goto error;
139missing_eoc:
140 *_errmsg = "Missing EOC in indefinite len cons";
141error:
142 *_dp = dp;
143 return -1;
144}
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171int asn1_ber_decoder(const struct asn1_decoder *decoder,
172 void *context,
173 const unsigned char *data,
174 size_t datalen)
175{
176 const unsigned char *machine = decoder->machine;
177 const asn1_action_t *actions = decoder->actions;
178 size_t machlen = decoder->machlen;
179 enum asn1_opcode op;
180 unsigned char tag = 0, csp = 0, jsp = 0, optag = 0, hdr = 0;
181 const char *errmsg;
182 size_t pc = 0, dp = 0, tdp = 0, len = 0;
183 int ret;
184
185 unsigned char flags = 0;
186#define FLAG_INDEFINITE_LENGTH 0x01
187#define FLAG_MATCHED 0x02
188#define FLAG_LAST_MATCHED 0x04
189#define FLAG_CONS 0x20
190
191
192
193
194#define NR_CONS_STACK 10
195 unsigned short cons_dp_stack[NR_CONS_STACK];
196 unsigned short cons_datalen_stack[NR_CONS_STACK];
197 unsigned char cons_hdrlen_stack[NR_CONS_STACK];
198#define NR_JUMP_STACK 10
199 unsigned char jump_stack[NR_JUMP_STACK];
200
201 if (datalen > 65535)
202 return -EMSGSIZE;
203
204next_op:
205 pr_debug("next_op: pc=\e[32m%zu\e[m/%zu dp=\e[33m%zu\e[m/%zu C=%d J=%d\n",
206 pc, machlen, dp, datalen, csp, jsp);
207 if (unlikely(pc >= machlen))
208 goto machine_overrun_error;
209 op = machine[pc];
210 if (unlikely(pc + asn1_op_lengths[op] > machlen))
211 goto machine_overrun_error;
212
213
214
215
216 if (op <= ASN1_OP__MATCHES_TAG) {
217 unsigned char tmp;
218
219
220 if ((op & ASN1_OP_MATCH__COND && flags & FLAG_MATCHED) ||
221 (op & ASN1_OP_MATCH__SKIP && dp == datalen)) {
222 flags &= ~FLAG_LAST_MATCHED;
223 pc += asn1_op_lengths[op];
224 goto next_op;
225 }
226
227 flags = 0;
228 hdr = 2;
229
230
231 if (unlikely(datalen - dp < 2))
232 goto data_overrun_error;
233 tag = data[dp++];
234 if (unlikely((tag & 0x1f) == ASN1_LONG_TAG))
235 goto long_tag_not_supported;
236
237 if (op & ASN1_OP_MATCH__ANY) {
238 pr_debug("- any %02x\n", tag);
239 } else {
240
241
242
243
244
245 optag = machine[pc + 1];
246 flags |= optag & FLAG_CONS;
247
248
249 tmp = optag ^ tag;
250 tmp &= ~(optag & ASN1_CONS_BIT);
251 pr_debug("- match? %02x %02x %02x\n", tag, optag, tmp);
252 if (tmp != 0) {
253
254 if (op & ASN1_OP_MATCH__SKIP) {
255 pc += asn1_op_lengths[op];
256 dp--;
257 goto next_op;
258 }
259 goto tag_mismatch;
260 }
261 }
262 flags |= FLAG_MATCHED;
263
264 len = data[dp++];
265 if (len > 0x7f) {
266 if (unlikely(len == ASN1_INDEFINITE_LENGTH)) {
267
268 if (unlikely(!(tag & ASN1_CONS_BIT)))
269 goto indefinite_len_primitive;
270 flags |= FLAG_INDEFINITE_LENGTH;
271 if (unlikely(2 > datalen - dp))
272 goto data_overrun_error;
273 } else {
274 int n = len - 0x80;
275 if (unlikely(n > 2))
276 goto length_too_long;
277 if (unlikely(n > datalen - dp))
278 goto data_overrun_error;
279 hdr += n;
280 for (len = 0; n > 0; n--) {
281 len <<= 8;
282 len |= data[dp++];
283 }
284 if (unlikely(len > datalen - dp))
285 goto data_overrun_error;
286 }
287 } else {
288 if (unlikely(len > datalen - dp))
289 goto data_overrun_error;
290 }
291
292 if (flags & FLAG_CONS) {
293
294
295
296 if (unlikely(csp >= NR_CONS_STACK))
297 goto cons_stack_overflow;
298 cons_dp_stack[csp] = dp;
299 cons_hdrlen_stack[csp] = hdr;
300 if (!(flags & FLAG_INDEFINITE_LENGTH)) {
301 cons_datalen_stack[csp] = datalen;
302 datalen = dp + len;
303 } else {
304 cons_datalen_stack[csp] = 0;
305 }
306 csp++;
307 }
308
309 pr_debug("- TAG: %02x %zu%s\n",
310 tag, len, flags & FLAG_CONS ? " CONS" : "");
311 tdp = dp;
312 }
313
314
315 switch (op) {
316 case ASN1_OP_MATCH_ANY_ACT:
317 case ASN1_OP_MATCH_ANY_ACT_OR_SKIP:
318 case ASN1_OP_COND_MATCH_ANY_ACT:
319 case ASN1_OP_COND_MATCH_ANY_ACT_OR_SKIP:
320 ret = actions[machine[pc + 1]](context, hdr, tag, data + dp, len);
321 if (ret < 0)
322 return ret;
323 goto skip_data;
324
325 case ASN1_OP_MATCH_ACT:
326 case ASN1_OP_MATCH_ACT_OR_SKIP:
327 case ASN1_OP_COND_MATCH_ACT_OR_SKIP:
328 ret = actions[machine[pc + 2]](context, hdr, tag, data + dp, len);
329 if (ret < 0)
330 return ret;
331 goto skip_data;
332
333 case ASN1_OP_MATCH:
334 case ASN1_OP_MATCH_OR_SKIP:
335 case ASN1_OP_MATCH_ANY:
336 case ASN1_OP_MATCH_ANY_OR_SKIP:
337 case ASN1_OP_COND_MATCH_OR_SKIP:
338 case ASN1_OP_COND_MATCH_ANY:
339 case ASN1_OP_COND_MATCH_ANY_OR_SKIP:
340 skip_data:
341 if (!(flags & FLAG_CONS)) {
342 if (flags & FLAG_INDEFINITE_LENGTH) {
343 ret = asn1_find_indefinite_length(
344 data, datalen, &dp, &len, &errmsg);
345 if (ret < 0)
346 goto error;
347 } else {
348 dp += len;
349 }
350 pr_debug("- LEAF: %zu\n", len);
351 }
352 pc += asn1_op_lengths[op];
353 goto next_op;
354
355 case ASN1_OP_MATCH_JUMP:
356 case ASN1_OP_MATCH_JUMP_OR_SKIP:
357 case ASN1_OP_COND_MATCH_JUMP_OR_SKIP:
358 pr_debug("- MATCH_JUMP\n");
359 if (unlikely(jsp == NR_JUMP_STACK))
360 goto jump_stack_overflow;
361 jump_stack[jsp++] = pc + asn1_op_lengths[op];
362 pc = machine[pc + 2];
363 goto next_op;
364
365 case ASN1_OP_COND_FAIL:
366 if (unlikely(!(flags & FLAG_MATCHED)))
367 goto tag_mismatch;
368 pc += asn1_op_lengths[op];
369 goto next_op;
370
371 case ASN1_OP_COMPLETE:
372 if (unlikely(jsp != 0 || csp != 0)) {
373 pr_err("ASN.1 decoder error: Stacks not empty at completion (%u, %u)\n",
374 jsp, csp);
375 return -EBADMSG;
376 }
377 return 0;
378
379 case ASN1_OP_END_SET:
380 case ASN1_OP_END_SET_ACT:
381 if (unlikely(!(flags & FLAG_MATCHED)))
382 goto tag_mismatch;
383 case ASN1_OP_END_SEQ:
384 case ASN1_OP_END_SET_OF:
385 case ASN1_OP_END_SEQ_OF:
386 case ASN1_OP_END_SEQ_ACT:
387 case ASN1_OP_END_SET_OF_ACT:
388 case ASN1_OP_END_SEQ_OF_ACT:
389 if (unlikely(csp <= 0))
390 goto cons_stack_underflow;
391 csp--;
392 tdp = cons_dp_stack[csp];
393 hdr = cons_hdrlen_stack[csp];
394 len = datalen;
395 datalen = cons_datalen_stack[csp];
396 pr_debug("- end cons t=%zu dp=%zu l=%zu/%zu\n",
397 tdp, dp, len, datalen);
398 if (datalen == 0) {
399
400 datalen = len;
401 if (unlikely(datalen - dp < 2))
402 goto data_overrun_error;
403 if (data[dp++] != 0) {
404 if (op & ASN1_OP_END__OF) {
405 dp--;
406 csp++;
407 pc = machine[pc + 1];
408 pr_debug("- continue\n");
409 goto next_op;
410 }
411 goto missing_eoc;
412 }
413 if (data[dp++] != 0)
414 goto invalid_eoc;
415 len = dp - tdp - 2;
416 } else {
417 if (dp < len && (op & ASN1_OP_END__OF)) {
418 datalen = len;
419 csp++;
420 pc = machine[pc + 1];
421 pr_debug("- continue\n");
422 goto next_op;
423 }
424 if (dp != len)
425 goto cons_length_error;
426 len -= tdp;
427 pr_debug("- cons len l=%zu d=%zu\n", len, dp - tdp);
428 }
429
430 if (op & ASN1_OP_END__ACT) {
431 unsigned char act;
432 if (op & ASN1_OP_END__OF)
433 act = machine[pc + 2];
434 else
435 act = machine[pc + 1];
436 ret = actions[act](context, hdr, 0, data + tdp, len);
437 }
438 pc += asn1_op_lengths[op];
439 goto next_op;
440
441 case ASN1_OP_MAYBE_ACT:
442 if (!(flags & FLAG_LAST_MATCHED)) {
443 pc += asn1_op_lengths[op];
444 goto next_op;
445 }
446 case ASN1_OP_ACT:
447 ret = actions[machine[pc + 1]](context, hdr, tag, data + tdp, len);
448 if (ret < 0)
449 return ret;
450 pc += asn1_op_lengths[op];
451 goto next_op;
452
453 case ASN1_OP_RETURN:
454 if (unlikely(jsp <= 0))
455 goto jump_stack_underflow;
456 pc = jump_stack[--jsp];
457 flags |= FLAG_MATCHED | FLAG_LAST_MATCHED;
458 goto next_op;
459
460 default:
461 break;
462 }
463
464
465 pr_err("ASN.1 decoder error: Found reserved opcode (%u) pc=%zu\n",
466 op, pc);
467 return -EBADMSG;
468
469data_overrun_error:
470 errmsg = "Data overrun error";
471 goto error;
472machine_overrun_error:
473 errmsg = "Machine overrun error";
474 goto error;
475jump_stack_underflow:
476 errmsg = "Jump stack underflow";
477 goto error;
478jump_stack_overflow:
479 errmsg = "Jump stack overflow";
480 goto error;
481cons_stack_underflow:
482 errmsg = "Cons stack underflow";
483 goto error;
484cons_stack_overflow:
485 errmsg = "Cons stack overflow";
486 goto error;
487cons_length_error:
488 errmsg = "Cons length error";
489 goto error;
490missing_eoc:
491 errmsg = "Missing EOC in indefinite len cons";
492 goto error;
493invalid_eoc:
494 errmsg = "Invalid length EOC";
495 goto error;
496length_too_long:
497 errmsg = "Unsupported length";
498 goto error;
499indefinite_len_primitive:
500 errmsg = "Indefinite len primitive not permitted";
501 goto error;
502tag_mismatch:
503 errmsg = "Unexpected tag";
504 goto error;
505long_tag_not_supported:
506 errmsg = "Long tag not supported";
507error:
508 pr_debug("\nASN1: %s [m=%zu d=%zu ot=%02x t=%02x l=%zu]\n",
509 errmsg, pc, dp, optag, tag, len);
510 return -EBADMSG;
511}
512EXPORT_SYMBOL_GPL(asn1_ber_decoder);
513
514MODULE_LICENSE("GPL");
515