xref: /openbmc/linux/lib/asn1_decoder.c (revision 8bd1369b)
1 /* Decoder for ASN.1 BER/DER/CER encoded bytestream
2  *
3  * Copyright (C) 2012 Red Hat, Inc. All Rights Reserved.
4  * Written by David Howells (dhowells@redhat.com)
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public Licence
8  * as published by the Free Software Foundation; either version
9  * 2 of the Licence, or (at your option) any later version.
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 
19 static const unsigned char asn1_op_lengths[ASN1_OP__NR] = {
20 	/*					OPC TAG JMP ACT */
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  * Find the length of an indefinite length object
55  * @data: The data buffer
56  * @datalen: The end of the innermost containing element in the buffer
57  * @_dp: The data parse cursor (updated before returning)
58  * @_len: Where to return the size of the element.
59  * @_errmsg: Where to return a pointer to an error message on error
60  */
61 static 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 
69 next_tag:
70 	if (unlikely(datalen - dp < 2)) {
71 		if (datalen == dp)
72 			goto missing_eoc;
73 		goto data_overrun_error;
74 	}
75 
76 	/* Extract a tag from the data */
77 	tag = data[dp++];
78 	if (tag == ASN1_EOC) {
79 		/* It appears to be an EOC. */
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 	/* Extract the length */
99 	len = data[dp++];
100 	if (len <= 0x7f)
101 		goto check_length;
102 
103 	if (unlikely(len == ASN1_INDEFINITE_LENGTH)) {
104 		/* Indefinite length */
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 	}
121 check_length:
122 	if (len > datalen - dp)
123 		goto data_overrun_error;
124 	dp += len;
125 	goto next_tag;
126 
127 length_too_long:
128 	*_errmsg = "Unsupported length";
129 	goto error;
130 indefinite_len_primitive:
131 	*_errmsg = "Indefinite len primitive not permitted";
132 	goto error;
133 invalid_eoc:
134 	*_errmsg = "Invalid length EOC";
135 	goto error;
136 data_overrun_error:
137 	*_errmsg = "Data overrun error";
138 	goto error;
139 missing_eoc:
140 	*_errmsg = "Missing EOC in indefinite len cons";
141 error:
142 	*_dp = dp;
143 	return -1;
144 }
145 
146 /**
147  * asn1_ber_decoder - Decoder BER/DER/CER ASN.1 according to pattern
148  * @decoder: The decoder definition (produced by asn1_compiler)
149  * @context: The caller's context (to be passed to the action functions)
150  * @data: The encoded data
151  * @datalen: The size of the encoded data
152  *
153  * Decode BER/DER/CER encoded ASN.1 data according to a bytecode pattern
154  * produced by asn1_compiler.  Action functions are called on marked tags to
155  * allow the caller to retrieve significant data.
156  *
157  * LIMITATIONS:
158  *
159  * To keep down the amount of stack used by this function, the following limits
160  * have been imposed:
161  *
162  *  (1) This won't handle datalen > 65535 without increasing the size of the
163  *	cons stack elements and length_too_long checking.
164  *
165  *  (2) The stack of constructed types is 10 deep.  If the depth of non-leaf
166  *	constructed types exceeds this, the decode will fail.
167  *
168  *  (3) The SET type (not the SET OF type) isn't really supported as tracking
169  *	what members of the set have been seen is a pain.
170  */
171 int 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 /* Last tag matched */
189 #define FLAG_CONS		0x20 /* Corresponds to CONS bit in the opcode tag
190 				      * - ie. whether or not we are going to parse
191 				      *   a compound type.
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 
204 next_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 	/* If this command is meant to match a tag, then do that before
214 	 * evaluating the command.
215 	 */
216 	if (op <= ASN1_OP__MATCHES_TAG) {
217 		unsigned char tmp;
218 
219 		/* Skip conditional matches if possible */
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 		/* Extract a tag from the data */
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 			/* Extract the tag from the machine
241 			 * - Either CONS or PRIM are permitted in the data if
242 			 *   CONS is not set in the op stream, otherwise CONS
243 			 *   is mandatory.
244 			 */
245 			optag = machine[pc + 1];
246 			flags |= optag & FLAG_CONS;
247 
248 			/* Determine whether the tag matched */
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 				/* All odd-numbered tags are MATCH_OR_SKIP. */
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 				/* Indefinite length */
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 			/* For expected compound forms, we stack the positions
294 			 * of the start and end of the data.
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 	/* Decide how to handle the operation */
315 	switch (op) {
316 	case ASN1_OP_MATCH:
317 	case ASN1_OP_MATCH_OR_SKIP:
318 	case ASN1_OP_MATCH_ACT:
319 	case ASN1_OP_MATCH_ACT_OR_SKIP:
320 	case ASN1_OP_MATCH_ANY:
321 	case ASN1_OP_MATCH_ANY_OR_SKIP:
322 	case ASN1_OP_MATCH_ANY_ACT:
323 	case ASN1_OP_MATCH_ANY_ACT_OR_SKIP:
324 	case ASN1_OP_COND_MATCH_OR_SKIP:
325 	case ASN1_OP_COND_MATCH_ACT_OR_SKIP:
326 	case ASN1_OP_COND_MATCH_ANY:
327 	case ASN1_OP_COND_MATCH_ANY_OR_SKIP:
328 	case ASN1_OP_COND_MATCH_ANY_ACT:
329 	case ASN1_OP_COND_MATCH_ANY_ACT_OR_SKIP:
330 
331 		if (!(flags & FLAG_CONS)) {
332 			if (flags & FLAG_INDEFINITE_LENGTH) {
333 				size_t tmp = dp;
334 
335 				ret = asn1_find_indefinite_length(
336 					data, datalen, &tmp, &len, &errmsg);
337 				if (ret < 0)
338 					goto error;
339 			}
340 			pr_debug("- LEAF: %zu\n", len);
341 		}
342 
343 		if (op & ASN1_OP_MATCH__ACT) {
344 			unsigned char act;
345 
346 			if (op & ASN1_OP_MATCH__ANY)
347 				act = machine[pc + 1];
348 			else
349 				act = machine[pc + 2];
350 			ret = actions[act](context, hdr, tag, data + dp, len);
351 			if (ret < 0)
352 				return ret;
353 		}
354 
355 		if (!(flags & FLAG_CONS))
356 			dp += len;
357 		pc += asn1_op_lengths[op];
358 		goto next_op;
359 
360 	case ASN1_OP_MATCH_JUMP:
361 	case ASN1_OP_MATCH_JUMP_OR_SKIP:
362 	case ASN1_OP_COND_MATCH_JUMP_OR_SKIP:
363 		pr_debug("- MATCH_JUMP\n");
364 		if (unlikely(jsp == NR_JUMP_STACK))
365 			goto jump_stack_overflow;
366 		jump_stack[jsp++] = pc + asn1_op_lengths[op];
367 		pc = machine[pc + 2];
368 		goto next_op;
369 
370 	case ASN1_OP_COND_FAIL:
371 		if (unlikely(!(flags & FLAG_MATCHED)))
372 			goto tag_mismatch;
373 		pc += asn1_op_lengths[op];
374 		goto next_op;
375 
376 	case ASN1_OP_COMPLETE:
377 		if (unlikely(jsp != 0 || csp != 0)) {
378 			pr_err("ASN.1 decoder error: Stacks not empty at completion (%u, %u)\n",
379 			       jsp, csp);
380 			return -EBADMSG;
381 		}
382 		return 0;
383 
384 	case ASN1_OP_END_SET:
385 	case ASN1_OP_END_SET_ACT:
386 		if (unlikely(!(flags & FLAG_MATCHED)))
387 			goto tag_mismatch;
388 	case ASN1_OP_END_SEQ:
389 	case ASN1_OP_END_SET_OF:
390 	case ASN1_OP_END_SEQ_OF:
391 	case ASN1_OP_END_SEQ_ACT:
392 	case ASN1_OP_END_SET_OF_ACT:
393 	case ASN1_OP_END_SEQ_OF_ACT:
394 		if (unlikely(csp <= 0))
395 			goto cons_stack_underflow;
396 		csp--;
397 		tdp = cons_dp_stack[csp];
398 		hdr = cons_hdrlen_stack[csp];
399 		len = datalen;
400 		datalen = cons_datalen_stack[csp];
401 		pr_debug("- end cons t=%zu dp=%zu l=%zu/%zu\n",
402 			 tdp, dp, len, datalen);
403 		if (datalen == 0) {
404 			/* Indefinite length - check for the EOC. */
405 			datalen = len;
406 			if (unlikely(datalen - dp < 2))
407 				goto data_overrun_error;
408 			if (data[dp++] != 0) {
409 				if (op & ASN1_OP_END__OF) {
410 					dp--;
411 					csp++;
412 					pc = machine[pc + 1];
413 					pr_debug("- continue\n");
414 					goto next_op;
415 				}
416 				goto missing_eoc;
417 			}
418 			if (data[dp++] != 0)
419 				goto invalid_eoc;
420 			len = dp - tdp - 2;
421 		} else {
422 			if (dp < len && (op & ASN1_OP_END__OF)) {
423 				datalen = len;
424 				csp++;
425 				pc = machine[pc + 1];
426 				pr_debug("- continue\n");
427 				goto next_op;
428 			}
429 			if (dp != len)
430 				goto cons_length_error;
431 			len -= tdp;
432 			pr_debug("- cons len l=%zu d=%zu\n", len, dp - tdp);
433 		}
434 
435 		if (op & ASN1_OP_END__ACT) {
436 			unsigned char act;
437 			if (op & ASN1_OP_END__OF)
438 				act = machine[pc + 2];
439 			else
440 				act = machine[pc + 1];
441 			ret = actions[act](context, hdr, 0, data + tdp, len);
442 			if (ret < 0)
443 				return ret;
444 		}
445 		pc += asn1_op_lengths[op];
446 		goto next_op;
447 
448 	case ASN1_OP_MAYBE_ACT:
449 		if (!(flags & FLAG_LAST_MATCHED)) {
450 			pc += asn1_op_lengths[op];
451 			goto next_op;
452 		}
453 	case ASN1_OP_ACT:
454 		ret = actions[machine[pc + 1]](context, hdr, tag, data + tdp, len);
455 		if (ret < 0)
456 			return ret;
457 		pc += asn1_op_lengths[op];
458 		goto next_op;
459 
460 	case ASN1_OP_RETURN:
461 		if (unlikely(jsp <= 0))
462 			goto jump_stack_underflow;
463 		pc = jump_stack[--jsp];
464 		flags |= FLAG_MATCHED | FLAG_LAST_MATCHED;
465 		goto next_op;
466 
467 	default:
468 		break;
469 	}
470 
471 	/* Shouldn't reach here */
472 	pr_err("ASN.1 decoder error: Found reserved opcode (%u) pc=%zu\n",
473 	       op, pc);
474 	return -EBADMSG;
475 
476 data_overrun_error:
477 	errmsg = "Data overrun error";
478 	goto error;
479 machine_overrun_error:
480 	errmsg = "Machine overrun error";
481 	goto error;
482 jump_stack_underflow:
483 	errmsg = "Jump stack underflow";
484 	goto error;
485 jump_stack_overflow:
486 	errmsg = "Jump stack overflow";
487 	goto error;
488 cons_stack_underflow:
489 	errmsg = "Cons stack underflow";
490 	goto error;
491 cons_stack_overflow:
492 	errmsg = "Cons stack overflow";
493 	goto error;
494 cons_length_error:
495 	errmsg = "Cons length error";
496 	goto error;
497 missing_eoc:
498 	errmsg = "Missing EOC in indefinite len cons";
499 	goto error;
500 invalid_eoc:
501 	errmsg = "Invalid length EOC";
502 	goto error;
503 length_too_long:
504 	errmsg = "Unsupported length";
505 	goto error;
506 indefinite_len_primitive:
507 	errmsg = "Indefinite len primitive not permitted";
508 	goto error;
509 tag_mismatch:
510 	errmsg = "Unexpected tag";
511 	goto error;
512 long_tag_not_supported:
513 	errmsg = "Long tag not supported";
514 error:
515 	pr_debug("\nASN1: %s [m=%zu d=%zu ot=%02x t=%02x l=%zu]\n",
516 		 errmsg, pc, dp, optag, tag, len);
517 	return -EBADMSG;
518 }
519 EXPORT_SYMBOL_GPL(asn1_ber_decoder);
520 
521 MODULE_LICENSE("GPL");
522