]> The Tcpdump Group git mirrors - tcpdump/blob - print-esp.c
31630100cde1ccebe0677dfa9a1d929730485e25
[tcpdump] / print-esp.c
1 /* $NetBSD: print-ah.c,v 1.4 1996/05/20 00:41:16 fvdl Exp $ */
2
3 /*
4 * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994
5 * The Regents of the University of California. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that: (1) source code distributions
9 * retain the above copyright notice and this paragraph in its entirety, (2)
10 * distributions including binary code include the above copyright notice and
11 * this paragraph in its entirety in the documentation or other materials
12 * provided with the distribution, and (3) all advertising materials mentioning
13 * features or use of this software display the following acknowledgement:
14 * ``This product includes software developed by the University of California,
15 * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
16 * the University nor the names of its contributors may be used to endorse
17 * or promote products derived from this software without specific prior
18 * written permission.
19 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
20 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
21 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
22 */
23
24 /* \summary: IPSEC Encapsulating Security Payload (ESP) printer */
25
26 #ifdef HAVE_CONFIG_H
27 #include <config.h>
28 #endif
29
30 #include "netdissect-stdinc.h"
31
32 #include <string.h>
33 #include <stdlib.h>
34
35 /* Any code in this file that depends on HAVE_LIBCRYPTO depends on
36 * HAVE_OPENSSL_EVP_H too. Undefining the former when the latter isn't defined
37 * is the simplest way of handling the dependency.
38 */
39 #ifdef HAVE_LIBCRYPTO
40 #ifdef HAVE_OPENSSL_EVP_H
41 #include <openssl/evp.h>
42 #else
43 #undef HAVE_LIBCRYPTO
44 #endif
45 #endif
46
47 #include "netdissect.h"
48 #include "strtoaddr.h"
49 #include "extract.h"
50
51 #include "ascii_strcasecmp.h"
52
53 #include "ip.h"
54 #include "ip6.h"
55
56 /*
57 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
58 * All rights reserved.
59 *
60 * Redistribution and use in source and binary forms, with or without
61 * modification, are permitted provided that the following conditions
62 * are met:
63 * 1. Redistributions of source code must retain the above copyright
64 * notice, this list of conditions and the following disclaimer.
65 * 2. Redistributions in binary form must reproduce the above copyright
66 * notice, this list of conditions and the following disclaimer in the
67 * documentation and/or other materials provided with the distribution.
68 * 3. Neither the name of the project nor the names of its contributors
69 * may be used to endorse or promote products derived from this software
70 * without specific prior written permission.
71 *
72 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
73 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
74 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
75 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
76 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
77 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
78 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
79 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
80 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
81 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
82 * SUCH DAMAGE.
83 */
84
85 /*
86 * RFC1827/2406 Encapsulated Security Payload.
87 */
88
89 struct newesp {
90 nd_uint32_t esp_spi; /* ESP */
91 nd_uint32_t esp_seq; /* Sequence number */
92 /*variable size*/ /* (IV and) Payload data */
93 /*variable size*/ /* padding */
94 /*8bit*/ /* pad size */
95 /*8bit*/ /* next header */
96 /*8bit*/ /* next header */
97 /*variable size, 32bit bound*/ /* Authentication data */
98 };
99
100 #ifdef HAVE_LIBCRYPTO
101 union inaddr_u {
102 struct in_addr in4;
103 struct in6_addr in6;
104 };
105 struct sa_list {
106 struct sa_list *next;
107 u_int daddr_version;
108 union inaddr_u daddr;
109 uint32_t spi; /* if == 0, then IKEv2 */
110 int initiator;
111 u_char spii[8]; /* for IKEv2 */
112 u_char spir[8];
113 const EVP_CIPHER *evp;
114 int ivlen;
115 int authlen;
116 u_char authsecret[256];
117 int authsecret_len;
118 u_char secret[256]; /* is that big enough for all secrets? */
119 int secretlen;
120 };
121
122 #ifndef HAVE_EVP_CIPHER_CTX_NEW
123 /*
124 * Allocate an EVP_CIPHER_CTX.
125 * Used if we have an older version of OpenSSL that doesn't provide
126 * routines to allocate and free them.
127 */
128 static EVP_CIPHER_CTX *
129 EVP_CIPHER_CTX_new(void)
130 {
131 EVP_CIPHER_CTX *ctx;
132
133 ctx = malloc(sizeof(*ctx));
134 if (ctx == NULL)
135 return (NULL);
136 memset(ctx, 0, sizeof(*ctx));
137 return (ctx);
138 }
139
140 static void
141 EVP_CIPHER_CTX_free(EVP_CIPHER_CTX *ctx)
142 {
143 EVP_CIPHER_CTX_cleanup(ctx);
144 free(ctx);
145 }
146 #endif
147
148 #ifdef HAVE_EVP_CIPHERINIT_EX
149 /*
150 * Initialize the cipher by calling EVP_CipherInit_ex(), because
151 * calling EVP_CipherInit() will reset the cipher context, clearing
152 * the cipher, so calling it twice, with the second call having a
153 * null cipher, will clear the already-set cipher. EVP_CipherInit_ex(),
154 * however, won't reset the cipher context, so you can use it to specify
155 * the IV oin a second call after a first call to EVP_CipherInit_ex()
156 * to set the cipher and the key.
157 *
158 * XXX - is there some reason why we need to make two calls?
159 */
160 static int
161 set_cipher_parameters(EVP_CIPHER_CTX *ctx, const EVP_CIPHER *cipher,
162 const unsigned char *key,
163 const unsigned char *iv, int enc)
164 {
165 return EVP_CipherInit_ex(ctx, cipher, NULL, key, iv, enc);
166 }
167 #else
168 /*
169 * Initialize the cipher by calling EVP_CipherInit(), because we don't
170 * have EVP_CipherInit_ex(); we rely on it not trashing the context.
171 */
172 static int
173 set_cipher_parameters(EVP_CIPHER_CTX *ctx, const EVP_CIPHER *cipher,
174 const unsigned char *key,
175 const unsigned char *iv, int enc)
176 {
177 return EVP_CipherInit(ctx, cipher, key, iv, enc);
178 }
179 #endif
180
181 /*
182 * this will adjust ndo_packetp and ndo_snapend to new buffer!
183 */
184 USES_APPLE_DEPRECATED_API
185 int esp_print_decrypt_buffer_by_ikev2(netdissect_options *ndo,
186 int initiator,
187 const u_char spii[8],
188 const u_char spir[8],
189 const u_char *buf, const u_char *end)
190 {
191 struct sa_list *sa;
192 const u_char *iv;
193 unsigned int len;
194 EVP_CIPHER_CTX *ctx;
195 unsigned int block_size, output_buffer_size;
196 u_char *output_buffer;
197
198 /* initiator arg is any non-zero value */
199 if(initiator) initiator=1;
200
201 /* see if we can find the SA, and if so, decode it */
202 for (sa = ndo->ndo_sa_list_head; sa != NULL; sa = sa->next) {
203 if (sa->spi == 0
204 && initiator == sa->initiator
205 && memcmp(spii, sa->spii, 8) == 0
206 && memcmp(spir, sa->spir, 8) == 0)
207 break;
208 }
209
210 if(sa == NULL) return 0;
211 if(sa->evp == NULL) return 0;
212
213 /*
214 * remove authenticator, and see if we still have something to
215 * work with
216 */
217 end = end - sa->authlen;
218 iv = buf;
219 buf = buf + sa->ivlen;
220 len = end-buf;
221
222 if(end <= buf) return 0;
223
224 ctx = EVP_CIPHER_CTX_new();
225 if (ctx == NULL)
226 return 0;
227 if (set_cipher_parameters(ctx, sa->evp, sa->secret, NULL, 0) < 0)
228 (*ndo->ndo_warning)(ndo, "espkey init failed");
229 set_cipher_parameters(ctx, NULL, NULL, iv, 0);
230 /*
231 * Allocate a buffer for the decrypted data.
232 * The output buffer must be separate from the input buffer, and
233 * its size must be a multiple of the cipher block size.
234 */
235 block_size = (unsigned int)EVP_CIPHER_CTX_block_size(ctx);
236 output_buffer_size = len + (block_size - len % block_size);
237 output_buffer = (u_char *)malloc(output_buffer_size);
238 if (output_buffer == NULL) {
239 (*ndo->ndo_error)(ndo, S_ERR_ND_MEM_ALLOC,
240 "can't allocate memory for decryption buffer");
241 EVP_CIPHER_CTX_free(ctx);
242 return 0;
243 }
244 EVP_Cipher(ctx, output_buffer, buf, len);
245 EVP_CIPHER_CTX_free(ctx);
246
247 /*
248 * XXX - of course this is wrong, because buf is a const buffer,
249 * but changing this would require a more complicated fix.
250 */
251 memcpy(buf, output_buffer, len);
252 free(output_buffer);
253
254 ndo->ndo_packetp = buf;
255 ndo->ndo_snapend = end;
256
257 return 1;
258 }
259 USES_APPLE_RST
260
261 static void esp_print_addsa(netdissect_options *ndo,
262 struct sa_list *sa, int sa_def)
263 {
264 /* copy the "sa" */
265
266 struct sa_list *nsa;
267
268 /* malloc() return used in a 'struct sa_list': do not free() */
269 nsa = (struct sa_list *)malloc(sizeof(struct sa_list));
270 if (nsa == NULL)
271 (*ndo->ndo_error)(ndo, S_ERR_ND_MEM_ALLOC,
272 "esp_print_addsa: malloc");
273
274 *nsa = *sa;
275
276 if (sa_def)
277 ndo->ndo_sa_default = nsa;
278
279 nsa->next = ndo->ndo_sa_list_head;
280 ndo->ndo_sa_list_head = nsa;
281 }
282
283
284 static u_int hexdigit(netdissect_options *ndo, char hex)
285 {
286 if (hex >= '0' && hex <= '9')
287 return (hex - '0');
288 else if (hex >= 'A' && hex <= 'F')
289 return (hex - 'A' + 10);
290 else if (hex >= 'a' && hex <= 'f')
291 return (hex - 'a' + 10);
292 else {
293 (*ndo->ndo_error)(ndo, S_ERR_ND_ESP_SECRET,
294 "invalid hex digit %c in espsecret\n", hex);
295 return 0;
296 }
297 }
298
299 static u_int hex2byte(netdissect_options *ndo, char *hexstring)
300 {
301 u_int byte;
302
303 byte = (hexdigit(ndo, hexstring[0]) << 4) + hexdigit(ndo, hexstring[1]);
304 return byte;
305 }
306
307 /*
308 * returns size of binary, 0 on failure.
309 */
310 static
311 int espprint_decode_hex(netdissect_options *ndo,
312 u_char *binbuf, unsigned int binbuf_len,
313 char *hex)
314 {
315 unsigned int len;
316 int i;
317
318 len = strlen(hex) / 2;
319
320 if (len > binbuf_len) {
321 (*ndo->ndo_warning)(ndo, "secret is too big: %u\n", len);
322 return 0;
323 }
324
325 i = 0;
326 while (hex[0] != '\0' && hex[1]!='\0') {
327 binbuf[i] = hex2byte(ndo, hex);
328 hex += 2;
329 i++;
330 }
331
332 return i;
333 }
334
335 /*
336 * decode the form: SPINUM@IP <tab> ALGONAME:0xsecret
337 */
338
339 USES_APPLE_DEPRECATED_API
340 static int
341 espprint_decode_encalgo(netdissect_options *ndo,
342 char *decode, struct sa_list *sa)
343 {
344 size_t i;
345 const EVP_CIPHER *evp;
346 int authlen = 0;
347 char *colon, *p;
348
349 colon = strchr(decode, ':');
350 if (colon == NULL) {
351 (*ndo->ndo_warning)(ndo, "failed to decode espsecret: %s\n", decode);
352 return 0;
353 }
354 *colon = '\0';
355
356 if (strlen(decode) > strlen("-hmac96") &&
357 !strcmp(decode + strlen(decode) - strlen("-hmac96"),
358 "-hmac96")) {
359 p = strstr(decode, "-hmac96");
360 *p = '\0';
361 authlen = 12;
362 }
363 if (strlen(decode) > strlen("-cbc") &&
364 !strcmp(decode + strlen(decode) - strlen("-cbc"), "-cbc")) {
365 p = strstr(decode, "-cbc");
366 *p = '\0';
367 }
368 evp = EVP_get_cipherbyname(decode);
369
370 if (!evp) {
371 (*ndo->ndo_warning)(ndo, "failed to find cipher algo %s\n", decode);
372 sa->evp = NULL;
373 sa->authlen = 0;
374 sa->ivlen = 0;
375 return 0;
376 }
377
378 sa->evp = evp;
379 sa->authlen = authlen;
380 sa->ivlen = EVP_CIPHER_iv_length(evp);
381
382 colon++;
383 if (colon[0] == '0' && colon[1] == 'x') {
384 /* decode some hex! */
385
386 colon += 2;
387 sa->secretlen = espprint_decode_hex(ndo, sa->secret, sizeof(sa->secret), colon);
388 if(sa->secretlen == 0) return 0;
389 } else {
390 i = strlen(colon);
391
392 if (i < sizeof(sa->secret)) {
393 memcpy(sa->secret, colon, i);
394 sa->secretlen = i;
395 } else {
396 memcpy(sa->secret, colon, sizeof(sa->secret));
397 sa->secretlen = sizeof(sa->secret);
398 }
399 }
400
401 return 1;
402 }
403 USES_APPLE_RST
404
405 /*
406 * for the moment, ignore the auth algorith, just hard code the authenticator
407 * length. Need to research how openssl looks up HMAC stuff.
408 */
409 static int
410 espprint_decode_authalgo(netdissect_options *ndo,
411 char *decode, struct sa_list *sa)
412 {
413 char *colon;
414
415 colon = strchr(decode, ':');
416 if (colon == NULL) {
417 (*ndo->ndo_warning)(ndo, "failed to decode espsecret: %s\n", decode);
418 return 0;
419 }
420 *colon = '\0';
421
422 if(ascii_strcasecmp(colon,"sha1") == 0 ||
423 ascii_strcasecmp(colon,"md5") == 0) {
424 sa->authlen = 12;
425 }
426 return 1;
427 }
428
429 static void esp_print_decode_ikeline(netdissect_options *ndo, char *line,
430 const char *file, int lineno)
431 {
432 /* it's an IKEv2 secret, store it instead */
433 struct sa_list sa1;
434
435 char *init;
436 char *icookie, *rcookie;
437 int ilen, rlen;
438 char *authkey;
439 char *enckey;
440
441 init = strsep(&line, " \t");
442 icookie = strsep(&line, " \t");
443 rcookie = strsep(&line, " \t");
444 authkey = strsep(&line, " \t");
445 enckey = strsep(&line, " \t");
446
447 /* if any fields are missing */
448 if(!init || !icookie || !rcookie || !authkey || !enckey) {
449 (*ndo->ndo_warning)(ndo, "print_esp: failed to find all fields for ikev2 at %s:%u",
450 file, lineno);
451
452 return;
453 }
454
455 ilen = strlen(icookie);
456 rlen = strlen(rcookie);
457
458 if((init[0]!='I' && init[0]!='R')
459 || icookie[0]!='0' || icookie[1]!='x'
460 || rcookie[0]!='0' || rcookie[1]!='x'
461 || ilen!=18
462 || rlen!=18) {
463 (*ndo->ndo_warning)(ndo, "print_esp: line %s:%u improperly formatted.",
464 file, lineno);
465
466 (*ndo->ndo_warning)(ndo, "init=%s icookie=%s(%u) rcookie=%s(%u)",
467 init, icookie, ilen, rcookie, rlen);
468
469 return;
470 }
471
472 sa1.spi = 0;
473 sa1.initiator = (init[0] == 'I');
474 if(espprint_decode_hex(ndo, sa1.spii, sizeof(sa1.spii), icookie+2)!=8)
475 return;
476
477 if(espprint_decode_hex(ndo, sa1.spir, sizeof(sa1.spir), rcookie+2)!=8)
478 return;
479
480 if(!espprint_decode_encalgo(ndo, enckey, &sa1)) return;
481
482 if(!espprint_decode_authalgo(ndo, authkey, &sa1)) return;
483
484 esp_print_addsa(ndo, &sa1, FALSE);
485 }
486
487 /*
488 *
489 * special form: file /name
490 * causes us to go read from this file instead.
491 *
492 */
493 static void esp_print_decode_onesecret(netdissect_options *ndo, char *line,
494 const char *file, int lineno)
495 {
496 struct sa_list sa1;
497 int sa_def;
498
499 char *spikey;
500 char *decode;
501
502 spikey = strsep(&line, " \t");
503 sa_def = 0;
504 memset(&sa1, 0, sizeof(struct sa_list));
505
506 /* if there is only one token, then it is an algo:key token */
507 if (line == NULL) {
508 decode = spikey;
509 spikey = NULL;
510 /* sa1.daddr.version = 0; */
511 /* memset(&sa1.daddr, 0, sizeof(sa1.daddr)); */
512 /* sa1.spi = 0; */
513 sa_def = 1;
514 } else
515 decode = line;
516
517 if (spikey && ascii_strcasecmp(spikey, "file") == 0) {
518 /* open file and read it */
519 FILE *secretfile;
520 char fileline[1024];
521 int subfile_lineno=0;
522 char *nl;
523 char *filename = line;
524
525 secretfile = fopen(filename, FOPEN_READ_TXT);
526 if (secretfile == NULL) {
527 (*ndo->ndo_error)(ndo, S_ERR_ND_OPEN_FILE,
528 "print_esp: can't open %s: %s\n",
529 filename, strerror(errno));
530 return;
531 }
532
533 while (fgets(fileline, sizeof(fileline)-1, secretfile) != NULL) {
534 subfile_lineno++;
535 /* remove newline from the line */
536 nl = strchr(fileline, '\n');
537 if (nl)
538 *nl = '\0';
539 if (fileline[0] == '#') continue;
540 if (fileline[0] == '\0') continue;
541
542 esp_print_decode_onesecret(ndo, fileline, filename, subfile_lineno);
543 }
544 fclose(secretfile);
545
546 return;
547 }
548
549 if (spikey && ascii_strcasecmp(spikey, "ikev2") == 0) {
550 esp_print_decode_ikeline(ndo, line, file, lineno);
551 return;
552 }
553
554 if (spikey) {
555
556 char *spistr, *foo;
557 uint32_t spino;
558
559 spistr = strsep(&spikey, "@");
560
561 spino = strtoul(spistr, &foo, 0);
562 if (spistr == foo || !spikey) {
563 (*ndo->ndo_warning)(ndo, "print_esp: failed to decode spi# %s\n", foo);
564 return;
565 }
566
567 sa1.spi = spino;
568
569 if (strtoaddr6(spikey, &sa1.daddr.in6) == 1) {
570 sa1.daddr_version = 6;
571 } else if (strtoaddr(spikey, &sa1.daddr.in4) == 1) {
572 sa1.daddr_version = 4;
573 } else {
574 (*ndo->ndo_warning)(ndo, "print_esp: can not decode IP# %s\n", spikey);
575 return;
576 }
577 }
578
579 if (decode) {
580 /* skip any blank spaces */
581 while (isspace((unsigned char)*decode))
582 decode++;
583
584 if(!espprint_decode_encalgo(ndo, decode, &sa1)) {
585 return;
586 }
587 }
588
589 esp_print_addsa(ndo, &sa1, sa_def);
590 }
591
592 USES_APPLE_DEPRECATED_API
593 static void esp_init(netdissect_options *ndo _U_)
594 {
595 /*
596 * 0.9.6 doesn't appear to define OPENSSL_API_COMPAT, so
597 * we check whether it's undefined or it's less than the
598 * value for 1.1.0.
599 */
600 #if !defined(OPENSSL_API_COMPAT) || OPENSSL_API_COMPAT < 0x10100000L
601 OpenSSL_add_all_algorithms();
602 #endif
603 EVP_add_cipher_alias(SN_des_ede3_cbc, "3des");
604 }
605 USES_APPLE_RST
606
607 void esp_print_decodesecret(netdissect_options *ndo)
608 {
609 char *line;
610 char *p;
611 static int initialized = 0;
612
613 if (!initialized) {
614 esp_init(ndo);
615 initialized = 1;
616 }
617
618 p = ndo->ndo_espsecret;
619
620 while (p && p[0] != '\0') {
621 /* pick out the first line or first thing until a comma */
622 if ((line = strsep(&p, "\n,")) == NULL) {
623 line = p;
624 p = NULL;
625 }
626
627 esp_print_decode_onesecret(ndo, line, "cmdline", 0);
628 }
629
630 ndo->ndo_espsecret = NULL;
631 }
632
633 #endif
634
635 #ifdef HAVE_LIBCRYPTO
636 USES_APPLE_DEPRECATED_API
637 #endif
638 int
639 esp_print(netdissect_options *ndo,
640 const u_char *bp, const int length, const u_char *bp2
641 #ifndef HAVE_LIBCRYPTO
642 _U_
643 #endif
644 ,
645 u_int *nhdr
646 #ifndef HAVE_LIBCRYPTO
647 _U_
648 #endif
649 ,
650 u_int *padlen
651 #ifndef HAVE_LIBCRYPTO
652 _U_
653 #endif
654 )
655 {
656 const struct newesp *esp;
657 const u_char *ep;
658 #ifdef HAVE_LIBCRYPTO
659 const struct ip *ip;
660 struct sa_list *sa = NULL;
661 const struct ip6_hdr *ip6 = NULL;
662 int advance;
663 int len;
664 u_char *secret;
665 int ivlen = 0;
666 const u_char *ivoff;
667 const u_char *p;
668 EVP_CIPHER_CTX *ctx;
669 unsigned int block_size, output_buffer_size;
670 u_char *output_buffer;
671 #endif
672
673 esp = (const struct newesp *)bp;
674
675 #ifdef HAVE_LIBCRYPTO
676 secret = NULL;
677 advance = 0;
678 #endif
679
680 #if 0
681 /* keep secret out of a register */
682 p = (u_char *)&secret;
683 #endif
684
685 /* 'ep' points to the end of available data. */
686 ep = ndo->ndo_snapend;
687
688 if ((const u_char *)(esp + 1) >= ep) {
689 ND_PRINT("[|ESP]");
690 goto fail;
691 }
692 ND_PRINT("ESP(spi=0x%08x", EXTRACT_BE_U_4(esp->esp_spi));
693 ND_PRINT(",seq=0x%x)", EXTRACT_BE_U_4(esp->esp_seq));
694 ND_PRINT(", length %u", length);
695
696 #ifndef HAVE_LIBCRYPTO
697 goto fail;
698 #else
699 /* initiailize SAs */
700 if (ndo->ndo_sa_list_head == NULL) {
701 if (!ndo->ndo_espsecret)
702 goto fail;
703
704 esp_print_decodesecret(ndo);
705 }
706
707 if (ndo->ndo_sa_list_head == NULL)
708 goto fail;
709
710 ip = (const struct ip *)bp2;
711 switch (IP_V(ip)) {
712 case 6:
713 ip6 = (const struct ip6_hdr *)bp2;
714 /* we do not attempt to decrypt jumbograms */
715 if (!EXTRACT_BE_U_2(ip6->ip6_plen))
716 goto fail;
717 /* if we can't get nexthdr, we do not need to decrypt it */
718 len = sizeof(struct ip6_hdr) + EXTRACT_BE_U_2(ip6->ip6_plen);
719
720 /* see if we can find the SA, and if so, decode it */
721 for (sa = ndo->ndo_sa_list_head; sa != NULL; sa = sa->next) {
722 if (sa->spi == EXTRACT_BE_U_4(esp->esp_spi) &&
723 sa->daddr_version == 6 &&
724 UNALIGNED_MEMCMP(&sa->daddr.in6, &ip6->ip6_dst,
725 sizeof(nd_ipv6)) == 0) {
726 break;
727 }
728 }
729 break;
730 case 4:
731 /* nexthdr & padding are in the last fragment */
732 if (EXTRACT_BE_U_2(ip->ip_off) & IP_MF)
733 goto fail;
734 len = EXTRACT_BE_U_2(ip->ip_len);
735
736 /* see if we can find the SA, and if so, decode it */
737 for (sa = ndo->ndo_sa_list_head; sa != NULL; sa = sa->next) {
738 if (sa->spi == EXTRACT_BE_U_4(esp->esp_spi) &&
739 sa->daddr_version == 4 &&
740 UNALIGNED_MEMCMP(&sa->daddr.in4, &ip->ip_dst,
741 sizeof(nd_ipv4)) == 0) {
742 break;
743 }
744 }
745 break;
746 default:
747 goto fail;
748 }
749
750 /* if we didn't find the specific one, then look for
751 * an unspecified one.
752 */
753 if (sa == NULL)
754 sa = ndo->ndo_sa_default;
755
756 /* if not found fail */
757 if (sa == NULL)
758 goto fail;
759
760 /* if we can't get nexthdr, we do not need to decrypt it */
761 if (ep - bp2 < len)
762 goto fail;
763 if (ep - bp2 > len) {
764 /* FCS included at end of frame (NetBSD 1.6 or later) */
765 ep = bp2 + len;
766 }
767
768 /* pointer to the IV, if there is one */
769 ivoff = (const u_char *)(esp + 1) + 0;
770 /* length of the IV, if there is one; 0, if there isn't */
771 ivlen = sa->ivlen;
772 secret = sa->secret;
773 ep = ep - sa->authlen;
774
775 if (sa->evp) {
776 ctx = EVP_CIPHER_CTX_new();
777 if (ctx != NULL) {
778 if (set_cipher_parameters(ctx, sa->evp, secret, NULL, 0) < 0)
779 (*ndo->ndo_warning)(ndo, "espkey init failed");
780
781 p = ivoff;
782 set_cipher_parameters(ctx, NULL, NULL, p, 0);
783 len = ep - (p + ivlen);
784
785 /*
786 * Allocate a buffer for the decrypted data.
787 * The output buffer must be separate from the
788 * input buffer, and its size must be a multiple
789 * of the cipher block size.
790 */
791 block_size = (unsigned int)EVP_CIPHER_CTX_block_size(ctx);
792 output_buffer_size = len + (block_size - len % block_size);
793 output_buffer = (u_char *)malloc(output_buffer_size);
794 if (output_buffer == NULL) {
795 (*ndo->ndo_error)(ndo, S_ERR_ND_MEM_ALLOC,
796 "esp_print: malloc decryption buffer");
797 EVP_CIPHER_CTX_free(ctx);
798 return -1;
799 }
800
801 EVP_Cipher(ctx, output_buffer, p + ivlen, len);
802 EVP_CIPHER_CTX_free(ctx);
803 /*
804 * XXX - of course this is wrong, because buf is a
805 * const buffer, but changing this would require a
806 * more complicated fix.
807 */
808 memcpy(p + ivlen, output_buffer, len);
809 free(output_buffer);
810 advance = ivoff - (const u_char *)esp + ivlen;
811 } else
812 advance = sizeof(struct newesp);
813 } else
814 advance = sizeof(struct newesp);
815
816 /* sanity check for pad length */
817 if (ep - bp < EXTRACT_U_1(ep - 2))
818 goto fail;
819
820 if (padlen)
821 *padlen = EXTRACT_U_1(ep - 2) + 2;
822
823 if (nhdr)
824 *nhdr = EXTRACT_U_1(ep - 1);
825
826 ND_PRINT(": ");
827 return advance;
828 #endif
829
830 fail:
831 return -1;
832 }
833 #ifdef HAVE_LIBCRYPTO
834 USES_APPLE_RST
835 #endif
836
837 /*
838 * Local Variables:
839 * c-style: whitesmith
840 * c-basic-offset: 8
841 * End:
842 */