*/
#ifndef lint
-static const char rcsid[] =
- "@(#) $Header: /tcpdump/master/tcpdump/print-esp.c,v 1.6 2000-01-15 02:33:06 mcr Exp $ (LBL)";
+static const char rcsid[] _U_ =
+ "@(#) $Header: /tcpdump/master/tcpdump/print-esp.c,v 1.51 2004-04-10 08:41:22 guy Exp $ (LBL)";
#endif
#ifdef HAVE_CONFIG_H
#endif
#include <string.h>
-#include <sys/param.h>
-#include <sys/time.h>
-#include <sys/types.h>
-#include <sys/socket.h>
-
-#include <net/route.h>
-#include <net/if.h>
-
-#include <netinet/in.h>
-#include <netinet/if_ether.h>
-#include <netinet/in_systm.h>
-#include <netinet/ip.h>
-#include <netinet/ip_icmp.h>
-#include <netinet/ip_var.h>
-#include <netinet/udp.h>
-#include <netinet/udp_var.h>
-#include <netinet/tcp.h>
+
+#include <tcpdump-stdinc.h>
+
+#include <stdlib.h>
#ifdef HAVE_LIBCRYPTO
-#include <des.h>
-#include <blowfish.h>
-#ifdef HAVE_RC5_H
-#include <rc5.h>
-#endif
-#ifdef HAVE_CAST_H
-#include <cast.h>
+#ifdef HAVE_OPENSSL_EVP_H
+#include <openssl/evp.h>
#endif
#endif
#include <stdio.h>
+#include "ip.h"
+#include "esp.h"
#ifdef INET6
-#include <netinet/ip6.h>
+#include "ip6.h"
+#endif
+
+#if defined(__MINGW32__) || defined(__WATCOMC__)
+extern char *strsep(char **stringp, const char *delim); /* Missing/strsep.c */
#endif
-/* there's no standard definition so we are on our own */
-struct esp {
- u_int32_t esp_spi; /* ESP */
- /*variable size, 32bit bound*/ /* Initialization Vector */
- /*variable size*/ /* Payload data */
- /*variable size*/ /* padding */
- /*8bit*/ /* pad size */
- /*8bit*/ /* next header */
- /*8bit*/ /* next header */
- /*variable size, 32bit bound*/ /* Authentication data (new IPsec) */
+#include "netdissect.h"
+#include "addrtoname.h"
+#include "extract.h"
+
+#ifndef HAVE_SOCKADDR_STORAGE
+#ifdef INET6
+struct sockaddr_storage {
+ union {
+ struct sockaddr_in sin;
+ struct sockaddr_in6 sin6;
+ } un;
};
+#else
+#define sockaddr_storage sockaddr
+#endif
+#endif /* HAVE_SOCKADDR_STORAGE */
-struct newesp {
- u_int32_t esp_spi; /* ESP */
- u_int32_t esp_seq; /* Sequence number */
- /*variable size*/ /* (IV and) Payload data */
- /*variable size*/ /* padding */
- /*8bit*/ /* pad size */
- /*8bit*/ /* next header */
- /*8bit*/ /* next header */
- /*variable size, 32bit bound*/ /* Authentication data */
+#ifdef HAVE_LIBCRYPTO
+struct sa_list {
+ struct sa_list *next;
+ struct sockaddr_storage daddr;
+ u_int32_t spi;
+ const EVP_CIPHER *evp;
+ int ivlen;
+ int authlen;
+ char secret[256]; /* is that big enough for all secrets? */
+ int secretlen;
};
-#include "interface.h"
-#include "addrtoname.h"
+static void esp_print_addsa(netdissect_options *ndo,
+ struct sa_list *sa, int sa_def)
+{
+ /* copy the "sa" */
+
+ struct sa_list *nsa;
+
+ nsa = (struct sa_list *)malloc(sizeof(struct sa_list));
+ if (nsa == NULL)
+ (*ndo->ndo_error)(ndo, "ran out of memory to allocate sa structure");
+
+ *nsa = *sa;
+
+ if (sa_def)
+ ndo->ndo_sa_default = nsa;
+
+ nsa->next = ndo->ndo_sa_list_head;
+ ndo->ndo_sa_list_head = nsa;
+}
+
+
+static int hexdigit(netdissect_options *ndo, char hex)
+{
+ if (hex >= '0' && hex <= '9')
+ return (hex - '0');
+ else if (hex >= 'A' && hex <= 'F')
+ return (hex - 'A' + 10);
+ else if (hex >= 'a' && hex <= 'f')
+ return (hex - 'a' + 10);
+ else {
+ (*ndo->ndo_error)(ndo, "invalid hex digit %c in espsecret\n", hex);
+ return 0;
+ }
+}
+
+static int hex2byte(netdissect_options *ndo, char *hexstring)
+{
+ int byte;
+
+ byte = (hexdigit(ndo, hexstring[0]) << 4) + hexdigit(ndo, hexstring[1]);
+ return byte;
+}
+
+/*
+ * decode the form: SPINUM@IP <tab> ALGONAME:0xsecret
+ *
+ * special form: file /name
+ * causes us to go read from this file instead.
+ *
+ */
+static void esp_print_decode_onesecret(netdissect_options *ndo, char *line)
+{
+ struct sa_list sa1;
+ int sa_def;
+
+ char *spikey;
+ char *decode;
+
+ spikey = strsep(&line, " \t");
+ sa_def = 0;
+ memset(&sa1, 0, sizeof(struct sa_list));
+
+ /* if there is only one token, then it is an algo:key token */
+ if (line == NULL) {
+ decode = spikey;
+ spikey = NULL;
+ /* memset(&sa1.daddr, 0, sizeof(sa1.daddr)); */
+ /* sa1.spi = 0; */
+ sa_def = 1;
+ } else
+ decode = line;
+
+ if (spikey && strcasecmp(spikey, "file") == 0) {
+ /* open file and read it */
+ FILE *secretfile;
+ char fileline[1024];
+ char *nl;
+
+ secretfile = fopen(line, FOPEN_READ_TXT);
+ if (secretfile == NULL) {
+ perror(line);
+ exit(3);
+ }
+
+ while (fgets(fileline, sizeof(fileline)-1, secretfile) != NULL) {
+ /* remove newline from the line */
+ nl = strchr(fileline, '\n');
+ if (nl)
+ *nl = '\0';
+ if (fileline[0] == '#') continue;
+ if (fileline[0] == '\0') continue;
+
+ esp_print_decode_onesecret(ndo, fileline);
+ }
+ fclose(secretfile);
+
+ return;
+ }
+
+ if (spikey) {
+ char *spistr, *foo;
+ u_int32_t spino;
+ struct sockaddr_in *sin;
+#ifdef INET6
+ struct sockaddr_in6 *sin6;
+#endif
+
+ spistr = strsep(&spikey, "@");
+
+ spino = strtoul(spistr, &foo, 0);
+ if (spistr == foo || !spikey) {
+ (*ndo->ndo_warning)(ndo, "print_esp: failed to decode spi# %s\n", foo);
+ return;
+ }
+
+ sa1.spi = spino;
+
+ sin = (struct sockaddr_in *)&sa1.daddr;
+#ifdef INET6
+ sin6 = (struct sockaddr_in6 *)&sa1.daddr;
+ if (inet_pton(AF_INET6, spikey, &sin6->sin6_addr) == 1) {
+#ifdef HAVE_SOCKADDR_SA_LEN
+ sin6->sin6_len = sizeof(struct sockaddr_in6);
+#endif
+ sin6->sin6_family = AF_INET6;
+ } else
+#endif
+ if (inet_pton(AF_INET, spikey, &sin->sin_addr) == 1) {
+#ifdef HAVE_SOCKADDR_SA_LEN
+ sin->sin_len = sizeof(struct sockaddr_in);
+#endif
+ sin->sin_family = AF_INET;
+ } else {
+ (*ndo->ndo_warning)(ndo, "print_esp: can not decode IP# %s\n", spikey);
+ return;
+ }
+ }
+
+ if (decode) {
+ char *colon, *p;
+ char espsecret_key[256];
+ int len;
+ size_t i;
+ const EVP_CIPHER *evp;
+ int authlen = 0;
+
+ /* skip any blank spaces */
+ while (isspace((unsigned char)*decode))
+ decode++;
+
+ colon = strchr(decode, ':');
+ if (colon == NULL) {
+ (*ndo->ndo_warning)(ndo, "failed to decode espsecret: %s\n", decode);
+ return;
+ }
+ *colon = '\0';
+
+ len = colon - decode;
+ if (strlen(decode) > strlen("-hmac96") &&
+ !strcmp(decode + strlen(decode) - strlen("-hmac96"),
+ "-hmac96")) {
+ p = strstr(decode, "-hmac96");
+ *p = '\0';
+ authlen = 12;
+ }
+ if (strlen(decode) > strlen("-cbc") &&
+ !strcmp(decode + strlen(decode) - strlen("-cbc"), "-cbc")) {
+ p = strstr(decode, "-cbc");
+ *p = '\0';
+ }
+ evp = EVP_get_cipherbyname(decode);
+ if (!evp) {
+ (*ndo->ndo_warning)(ndo, "failed to find cipher algo %s\n", decode);
+ sa1.evp = NULL;
+ sa1.authlen = 0;
+ sa1.ivlen = 0;
+ return;
+ }
+
+ sa1.evp = evp;
+ sa1.authlen = authlen;
+ sa1.ivlen = EVP_CIPHER_iv_length(evp);
+
+ colon++;
+ if (colon[0] == '0' && colon[1] == 'x') {
+ /* decode some hex! */
+ colon += 2;
+ len = strlen(colon) / 2;
+
+ if (len > 256) {
+ (*ndo->ndo_warning)(ndo, "secret is too big: %d\n", len);
+ return;
+ }
+
+ i = 0;
+ while (colon[0] != '\0' && colon[1]!='\0') {
+ espsecret_key[i] = hex2byte(ndo, colon);
+ colon += 2;
+ i++;
+ }
+
+ memcpy(sa1.secret, espsecret_key, i);
+ sa1.secretlen = i;
+ } else {
+ i = strlen(colon);
+
+ if (i < sizeof(sa1.secret)) {
+ memcpy(sa1.secret, colon, i);
+ sa1.secretlen = i;
+ } else {
+ memcpy(sa1.secret, colon, sizeof(sa1.secret));
+ sa1.secretlen = sizeof(sa1.secret);
+ }
+ }
+ }
+
+ esp_print_addsa(ndo, &sa1, sa_def);
+}
+
+static void esp_print_decodesecret(netdissect_options *ndo)
+{
+ char *line;
+ char *p;
+
+ p = ndo->ndo_espsecret;
+
+ while (ndo->ndo_espsecret && ndo->ndo_espsecret[0] != '\0') {
+ /* pick out the first line or first thing until a comma */
+ if ((line = strsep(&ndo->ndo_espsecret, "\n,")) == NULL) {
+ line = ndo->ndo_espsecret;
+ ndo->ndo_espsecret = NULL;
+ }
+
+ esp_print_decode_onesecret(ndo, line);
+ }
+}
+
+static void esp_init(netdissect_options *ndo _U_)
+{
+
+ OpenSSL_add_all_algorithms();
+ EVP_add_cipher_alias(SN_des_ede3_cbc, "3des");
+}
+#endif
int
-esp_print(register const u_char *bp, register const u_char *bp2, int *nhdr)
+esp_print(netdissect_options *ndo,
+ const u_char *bp, const u_char *bp2
+#ifndef HAVE_LIBCRYPTO
+ _U_
+#endif
+ ,
+ int *nhdr
+#ifndef HAVE_LIBCRYPTO
+ _U_
+#endif
+ ,
+ int *padlen
+#ifndef HAVE_LIBCRYPTO
+ _U_
+#endif
+ )
{
- register const struct esp *esp;
+ register const struct newesp *esp;
register const u_char *ep;
- u_int32_t spi;
- enum { NONE, DESCBC, BLOWFISH, RC5, CAST128, DES3CBC } algo = NONE;
- struct ip *ip = NULL;
+#ifdef HAVE_LIBCRYPTO
+ struct ip *ip;
+ struct sa_list *sa = NULL;
+ int espsecret_keylen;
#ifdef INET6
struct ip6_hdr *ip6 = NULL;
#endif
int advance;
int len;
- char *secret = NULL;
+ char *secret;
int ivlen = 0;
u_char *ivoff;
+ u_char *p;
+ EVP_CIPHER_CTX ctx;
+ int blocksz;
+ static int initialized = 0;
+#endif
+
+ esp = (struct newesp *)bp;
- esp = (struct esp *)bp;
- spi = (u_int32_t)ntohl(esp->esp_spi);
+#ifdef HAVE_LIBCRYPTO
+ secret = NULL;
+ advance = 0;
- /* 'ep' points to the end of avaible data. */
- ep = snapend;
+ if (!initialized) {
+ esp_init(ndo);
+ initialized = 1;
+ }
+#endif
- if ((u_char *)(esp + 1) >= ep - sizeof(struct esp)) {
+#if 0
+ /* keep secret out of a register */
+ p = (u_char *)&secret;
+#endif
+
+ /* 'ep' points to the end of available data. */
+ ep = ndo->ndo_snapend;
+
+ if ((u_char *)(esp + 1) >= ep) {
fputs("[|ESP]", stdout);
goto fail;
}
- printf("ESP(spi=%u", spi);
- printf(",seq=0x%x", (u_int32_t)ntohl(*(u_int32_t *)(esp + 1)));
- printf(")");
+ (*ndo->ndo_printf)(ndo, "ESP(spi=0x%08x", EXTRACT_32BITS(&esp->esp_spi));
+ (*ndo->ndo_printf)(ndo, ",seq=0x%x)", EXTRACT_32BITS(&esp->esp_seq));
- /* if we don't have decryption key, we can't decrypt this packet. */
- if (!espsecret)
- goto fail;
+#ifndef HAVE_LIBCRYPTO
+ goto fail;
+#else
+ /* initiailize SAs */
+ if (ndo->ndo_sa_list_head == NULL) {
+ if (!ndo->ndo_espsecret)
+ goto fail;
- if (strncmp(espsecret, "des-cbc:", 8) == 0
- && strlen(espsecret + 8) == 8) {
- algo = DESCBC;
- ivlen = 8;
- secret = espsecret + 8;
- } else if (strncmp(espsecret, "blowfish-cbc:", 13) == 0) {
- algo = BLOWFISH;
- ivlen = 8;
- secret = espsecret + 13;
- } else if (strncmp(espsecret, "rc5-cbc:", 8) == 0) {
- algo = RC5;
- ivlen = 8;
- secret = espsecret + 8;
- } else if (strncmp(espsecret, "cast128-cbc:", 12) == 0) {
- algo = CAST128;
- ivlen = 8;
- secret = espsecret + 12;
- } else if (strncmp(espsecret, "3des-cbc:", 9) == 0
- && strlen(espsecret + 9) == 24) {
- algo = DES3CBC;
- ivlen = 8;
- secret = espsecret + 9;
- } else if (strncmp(espsecret, "none:", 5) == 0) {
- algo = NONE;
- ivlen = 0;
- secret = espsecret + 5;
- } else if (strlen(espsecret) == 8) {
- algo = DESCBC;
- ivlen = 8;
- secret = espsecret;
- } else {
- algo = NONE;
- ivlen = 0;
- secret = espsecret;
+ esp_print_decodesecret(ndo);
}
+ if (ndo->ndo_sa_list_head == NULL)
+ goto fail;
+
ip = (struct ip *)bp2;
- switch (ip->ip_v) {
+ switch (IP_V(ip)) {
#ifdef INET6
case 6:
ip6 = (struct ip6_hdr *)bp2;
- ip = NULL;
/* we do not attempt to decrypt jumbograms */
- if (!ntohs(ip6->ip6_plen))
+ if (!EXTRACT_16BITS(&ip6->ip6_plen))
goto fail;
/* if we can't get nexthdr, we do not need to decrypt it */
- len = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen);
+ len = sizeof(struct ip6_hdr) + EXTRACT_16BITS(&ip6->ip6_plen);
+
+ /* see if we can find the SA, and if so, decode it */
+ for (sa = ndo->ndo_sa_list_head; sa != NULL; sa = sa->next) {
+ struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&sa->daddr;
+ if (sa->spi == ntohl(esp->esp_spi) &&
+ sin6->sin6_family == AF_INET6 &&
+ memcmp(&sin6->sin6_addr, &ip6->ip6_dst,
+ sizeof(struct in6_addr)) == 0) {
+ break;
+ }
+ }
break;
#endif /*INET6*/
case 4:
-#ifdef INET6
- ip6 = NULL;
-#endif
- len = ntohs(ip->ip_len);
+ /* nexthdr & padding are in the last fragment */
+ if (EXTRACT_16BITS(&ip->ip_off) & IP_MF)
+ goto fail;
+ len = EXTRACT_16BITS(&ip->ip_len);
+
+ /* see if we can find the SA, and if so, decode it */
+ for (sa = ndo->ndo_sa_list_head; sa != NULL; sa = sa->next) {
+ struct sockaddr_in *sin = (struct sockaddr_in *)&sa->daddr;
+ if (sa->spi == ntohl(esp->esp_spi) &&
+ sin->sin_family == AF_INET &&
+ sin->sin_addr.s_addr == ip->ip_dst.s_addr) {
+ break;
+ }
+ }
break;
default:
goto fail;
}
- /* if we can't get nexthdr, we do not need to decrypt it */
- if (ep - bp2 < len)
- goto fail;
-
- if (Rflag)
- ivoff = (u_char *)(esp + 1) + sizeof(u_int32_t);
- else
- ivoff = (u_char *)(esp + 1);
-
- switch (algo) {
- case DESCBC:
-#ifdef HAVE_LIBCRYPTO
- {
- u_char iv[8];
- des_key_schedule schedule;
- u_char *p;
-
- switch (ivlen) {
- case 4:
- memcpy(iv, ivoff, 4);
- memcpy(&iv[4], ivoff, 4);
- p = &iv[4];
- *p++ ^= 0xff;
- *p++ ^= 0xff;
- *p++ ^= 0xff;
- *p++ ^= 0xff;
- break;
- case 8:
- memcpy(iv, ivoff, 8);
- break;
- default:
- goto fail;
- }
-
- des_check_key = 0;
- des_set_key((void *)secret, schedule);
-
- p = ivoff + ivlen;
- des_cbc_encrypt((void *)p, (void *)p,
- (long)(ep - p), schedule, (void *)iv,
- DES_DECRYPT);
- advance = ivoff - (u_char *)esp + ivlen;
- break;
- }
-#else
+ /* if we didn't find the specific one, then look for
+ * an unspecified one.
+ */
+ if (sa == NULL)
+ sa = ndo->ndo_sa_default;
+
+ /* if not found fail */
+ if (sa == NULL)
goto fail;
-#endif /*HAVE_LIBCRYPTO*/
- case BLOWFISH:
-#ifdef HAVE_LIBCRYPTO
- {
- BF_KEY schedule;
- u_char *p;
-
- BF_set_key(&schedule, strlen(secret), secret);
-
- p = ivoff + ivlen;
- BF_cbc_encrypt(p, p, (long)(ep - p), &schedule, ivoff,
- BF_DECRYPT);
- advance = ivoff - (u_char *)esp + ivlen;
- break;
- }
-#else
+ /* if we can't get nexthdr, we do not need to decrypt it */
+ if (ep - bp2 < len)
goto fail;
-#endif /*HAVE_LIBCRYPTO*/
-
- case RC5:
-#if defined(HAVE_LIBCRYPTO) && defined(HAVE_RC5_H)
- {
- RC5_32_KEY schedule;
- u_char *p;
-
- RC5_32_set_key(&schedule, strlen(secret), secret,
- RC5_16_ROUNDS);
+ if (ep - bp2 > len) {
+ /* FCS included at end of frame (NetBSD 1.6 or later) */
+ ep = bp2 + len;
+ }
- p = ivoff + ivlen;
- RC5_32_cbc_encrypt(p, p, (long)(ep - p), &schedule, ivoff,
- RC5_DECRYPT);
- advance = ivoff - (u_char *)esp + ivlen;
- break;
- }
-#else
- goto fail;
-#endif /*HAVE_LIBCRYPTO*/
+ ivoff = (u_char *)(esp + 1) + 0;
+ ivlen = sa->ivlen;
+ secret = sa->secret;
+ espsecret_keylen = sa->secretlen;
+ ep = ep - sa->authlen;
- case CAST128:
-#if defined(HAVE_LIBCRYPTO) && defined(HAVE_CAST_H) && !defined(HAVE_BUGGY_CAST128)
- {
- CAST_KEY schedule;
- u_char *p;
+ if (sa->evp) {
+ memset(&ctx, 0, sizeof(ctx));
+ if (EVP_CipherInit(&ctx, sa->evp, secret, NULL, 0) < 0)
+ (*ndo->ndo_warning)(ndo, "espkey init failed");
- CAST_set_key(&schedule, strlen(secret), secret);
+ blocksz = EVP_CIPHER_CTX_block_size(&ctx);
- p = ivoff + ivlen;
- CAST_cbc_encrypt(p, p, (long)(ep - p), &schedule, ivoff,
- CAST_DECRYPT);
- advance = ivoff - (u_char *)esp + ivlen;
- break;
- }
-#else
- goto fail;
-#endif /*HAVE_LIBCRYPTO*/
-
- case DES3CBC:
-#if defined(HAVE_LIBCRYPTO)
- {
- des_key_schedule s1, s2, s3;
- u_char *p;
-
- des_check_key = 0;
- des_set_key((void *)secret, s1);
- des_set_key((void *)(secret + 8), s2);
- des_set_key((void *)(secret + 16), s3);
-
- p = ivoff + ivlen;
- des_ede3_cbc_encrypt((void *)p, (void *)p,
- (long)(ep - p), s1, s2, s3, (void *)ivoff, DES_DECRYPT);
+ p = ivoff;
+ EVP_CipherInit(&ctx, NULL, NULL, p, 0);
+ EVP_Cipher(&ctx, p + ivlen, p + ivlen, ep - (p + ivlen));
advance = ivoff - (u_char *)esp + ivlen;
- break;
- }
-#else
- goto fail;
-#endif /*HAVE_LIBCRYPTO*/
-
- case NONE:
- default:
- if (Rflag)
- advance = sizeof(struct esp) + sizeof(u_int32_t);
- else
- advance = sizeof(struct esp);
- break;
- }
+ } else
+ advance = sizeof(struct newesp);
/* sanity check for pad length */
if (ep - bp < *(ep - 2))
goto fail;
+ if (padlen)
+ *padlen = *(ep - 2) + 2;
+
if (nhdr)
*nhdr = *(ep - 1);
- printf(": ");
+ (ndo->ndo_printf)(ndo, ": ");
return advance;
+#endif
fail:
- if (nhdr)
- *nhdr = -1;
- return 65536;
+ return -1;
}
+
+/*
+ * Local Variables:
+ * c-style: whitesmith
+ * c-basic-offset: 8
+ * End:
+ */
projects / tcpdump / blobdiff