The Tcpdump Group git mirrors - tcpdump/blob - print-macsec.c

   1 /* Copyright (c) 2017, Sabrina Dubroca <sd@queasysnail.net>
   2  *
   3  * Redistribution and use in source and binary forms, with or without
   4  * modification, are permitted provided that the following conditions
   5  * are met:
   6  *
   7  *   1. Redistributions of source code must retain the above copyright
   8  *      notice, this list of conditions and the following disclaimer.
   9  *   2. Redistributions in binary form must reproduce the above copyright
  10  *      notice, this list of conditions and the following disclaimer in
  11  *      the documentation and/or other materials provided with the
  12  *      distribution.
  13  *   3. The names of the authors may not be used to endorse or promote
  14  *      products derived from this software without specific prior
  15  *      written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  18  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  19  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  20  */
  21
  22 /* \summary: MACsec printer */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include "config.h"
  26 #endif
  27
  28 #include <netdissect-stdinc.h>
  29
  30 #include <string.h>
  31
  32 #include "netdissect.h"
  33 #include "addrtoname.h"
  34 #include "ethertype.h"
  35 #include "extract.h"
  36
  37 #define MACSEC_DEFAULT_ICV_LEN 16
  38
  39 /* Header format (SecTAG), following an Ethernet header
  40  * IEEE 802.1AE-2006 9.3
  41  *
  42  * +---------------------------------+----------------+----------------+
  43  * |        (MACsec ethertype)       |     TCI_AN     |       SL       |
  44  * +---------------------------------+----------------+----------------+
  45  * |                           Packet Number                           |
  46  * +-------------------------------------------------------------------+
  47  * |                     Secure Channel Identifier                     |
  48  * |                            (optional)                             |
  49  * +-------------------------------------------------------------------+
  50  *
  51  * MACsec ethertype = 0x88e5
  52  * TCI: Tag Control Information, set of flags
  53  * AN: association number, 2 bits
  54  * SL (short length): 6-bit length of the protected payload, if < 48
  55  * Packet Number: 32-bits packet identifier
  56  * Secure Channel Identifier: 64-bit unique identifier, usually
  57  *     composed of a MAC address + 16-bit port number
  58  */
  59 struct macsec_sectag {
  60         nd_uint8_t  tci_an;
  61         nd_uint8_t  short_length;
  62         nd_uint32_t packet_number;
  63         nd_uint8_t  secure_channel_id[8]; /* optional */
  64 };
  65
  66 /* IEEE 802.1AE-2006 9.5 */
  67 #define MACSEC_TCI_VERSION 0x80
  68 #define MACSEC_TCI_ES      0x40 /* end station */
  69 #define MACSEC_TCI_SC      0x20 /* SCI present */
  70 #define MACSEC_TCI_SCB     0x10 /* epon */
  71 #define MACSEC_TCI_E       0x08 /* encryption */
  72 #define MACSEC_TCI_C       0x04 /* changed text */
  73 #define MACSEC_AN_MASK     0x03 /* association number */
  74 #define MACSEC_TCI_FLAGS   (MACSEC_TCI_ES | MACSEC_TCI_SC | MACSEC_TCI_SCB | MACSEC_TCI_E | MACSEC_TCI_C)
  75 #define MACSEC_TCI_CONFID  (MACSEC_TCI_E | MACSEC_TCI_C)
  76 #define MACSEC_SL_MASK     0x3F /* short length */
  77
  78 #define MACSEC_SECTAG_LEN_NOSCI 6  /* length of MACsec header without SCI */
  79 #define MACSEC_SECTAG_LEN_SCI   14 /* length of MACsec header with SCI */
  80
  81 #define SCI_FMT "%016" PRIx64
  82
  83 static const struct tok macsec_flag_values[] = {
  84         { MACSEC_TCI_E,   "E" },
  85         { MACSEC_TCI_C,   "C" },
  86         { MACSEC_TCI_ES,  "S" },
  87         { MACSEC_TCI_SCB, "B" },
  88         { MACSEC_TCI_SC,  "I" },
  89         { 0, NULL }
  90 };
  91
  92 /* returns < 0 iff the packet can be decoded completely */
  93 int macsec_print(netdissect_options *ndo, const u_char **bp,
  94                  u_int *lengthp, u_int *caplenp, u_int *hdrlenp)
  95 {
  96         const char *save_protocol;
  97         const u_char *p = *bp;
  98         u_int length = *lengthp;
  99         u_int caplen = *caplenp;
 100         u_int hdrlen = *hdrlenp;
 101         const struct macsec_sectag *sectag = (const struct macsec_sectag *)p;
 102         u_int sectag_len;
 103         u_int short_length;
 104
 105         save_protocol = ndo->ndo_protocol;
 106         ndo->ndo_protocol = "MACsec";
 107
 108         /* we need the full MACsec header in the capture */
 109         if (caplen < MACSEC_SECTAG_LEN_NOSCI) {
 110                 nd_print_trunc(ndo);
 111                 ndo->ndo_protocol = save_protocol;
 112                 return hdrlen + caplen;
 113         }
 114         if (length < MACSEC_SECTAG_LEN_NOSCI) {
 115                 nd_print_trunc(ndo);
 116                 ndo->ndo_protocol = save_protocol;
 117                 return hdrlen + caplen;
 118         }
 119
 120         if (GET_U_1(sectag->tci_an) & MACSEC_TCI_SC) {
 121                 sectag_len = MACSEC_SECTAG_LEN_SCI;
 122                 if (caplen < MACSEC_SECTAG_LEN_SCI) {
 123                         nd_print_trunc(ndo);
 124                         ndo->ndo_protocol = save_protocol;
 125                         return hdrlen + caplen;
 126                 }
 127                 if (length < MACSEC_SECTAG_LEN_SCI) {
 128                         nd_print_trunc(ndo);
 129                         ndo->ndo_protocol = save_protocol;
 130                         return hdrlen + caplen;
 131                 }
 132         } else
 133                 sectag_len = MACSEC_SECTAG_LEN_NOSCI;
 134
 135         if ((GET_U_1(sectag->short_length) & ~MACSEC_SL_MASK) != 0 ||
 136             GET_U_1(sectag->tci_an) & MACSEC_TCI_VERSION) {
 137                 nd_print_invalid(ndo);
 138                 ndo->ndo_protocol = save_protocol;
 139                 return hdrlen + caplen;
 140         }
 141
 142         short_length = GET_U_1(sectag->short_length) & MACSEC_SL_MASK;
 143         if (ndo->ndo_eflag) {
 144                 ND_PRINT("an %u, pn %u, flags %s",
 145                          GET_U_1(sectag->tci_an) & MACSEC_AN_MASK,
 146                          GET_BE_U_4(sectag->packet_number),
 147                          bittok2str_nosep(macsec_flag_values, "none",
 148                                           GET_U_1(sectag->tci_an) & MACSEC_TCI_FLAGS));
 149
 150                 if (short_length != 0)
 151                         ND_PRINT(", sl %u", short_length);
 152
 153                 if (GET_U_1(sectag->tci_an) & MACSEC_TCI_SC)
 154                         ND_PRINT(", sci " SCI_FMT, GET_BE_U_8(sectag->secure_channel_id));
 155
 156                 ND_PRINT(", ");
 157         }
 158
 159         /* Skip the MACsec header. */
 160         *bp += sectag_len;
 161         *hdrlenp += sectag_len;
 162
 163         /* Remove it from the lengths, as it's been processed. */
 164         *lengthp -= sectag_len;
 165         *caplenp -= sectag_len;
 166
 167         if ((GET_U_1(sectag->tci_an) & MACSEC_TCI_CONFID)) {
 168                 /*
 169                  * The payload is encrypted.  Tell our
 170                  * caller it can't be dissected.
 171                  */
 172                 ndo->ndo_protocol = save_protocol;
 173                 return 0;
 174         }
 175
 176         /*
 177          * The payload isn't encrypted; remove the
 178          * ICV length from the lengths, so our caller
 179          * doesn't treat it as payload.
 180          */
 181         if (*lengthp < MACSEC_DEFAULT_ICV_LEN) {
 182                 nd_print_trunc(ndo);
 183                 ndo->ndo_protocol = save_protocol;
 184                 return hdrlen + caplen;
 185         }
 186         if (*caplenp < MACSEC_DEFAULT_ICV_LEN) {
 187                 nd_print_trunc(ndo);
 188                 ndo->ndo_protocol = save_protocol;
 189                 return hdrlen + caplen;
 190         }
 191         *lengthp -= MACSEC_DEFAULT_ICV_LEN;
 192         *caplenp -= MACSEC_DEFAULT_ICV_LEN;
 193
 194         /*
 195          * If the SL field is non-zero, then it's the length of the
 196          * Secure Data; otherwise, the Secure Data is what's left
 197          * ver after the MACsec header and ICV are removed.
 198          */
 199         if (short_length != 0) {
 200                 /*
 201                  * If the short length is more than we *have*,
 202                  * that's an error.
 203                  */
 204                 if (short_length > *lengthp) {
 205                         nd_print_trunc(ndo);
 206                         ndo->ndo_protocol = save_protocol;
 207                         return hdrlen + caplen;
 208                 }
 209                 if (short_length > *caplenp) {
 210                         nd_print_trunc(ndo);
 211                         ndo->ndo_protocol = save_protocol;
 212                         return hdrlen + caplen;
 213                 }
 214                 if (*lengthp > short_length)
 215                         *lengthp = short_length;
 216                 if (*caplenp > short_length)
 217                         *caplenp = short_length;
 218         }
 219
 220         ndo->ndo_protocol = save_protocol;
 221         return -1;
 222 }