external/bsd/tcpdump/dist/print-token.c

   1 /*
   2  * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that: (1) source code distributions
   7  * retain the above copyright notice and this paragraph in its entirety, (2)
   8  * distributions including binary code include the above copyright notice and
   9  * this paragraph in its entirety in the documentation or other materials
  10  * provided with the distribution, and (3) all advertising materials mentioning
  11  * features or use of this software display the following acknowledgement:
  12  * ``This product includes software developed by the University of California,
  13  * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
  14  * the University nor the names of its contributors may be used to endorse
  15  * or promote products derived from this software without specific prior
  16  * written permission.
  17  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
  18  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  19  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  20  *
  21  * Hacked version of print-ether.c  Larry Lile <lile@stdio.com>
  22  *
  23  * Further tweaked to more closely resemble print-fddi.c
  24  *      Guy Harris <guy@alum.mit.edu>
  25  */
  26
  27 #include <sys/cdefs.h>
  28 #ifndef lint
  29 __RCSID("$NetBSD: print-token.c,v 1.4 2014/11/20 03:05:03 christos Exp $");
  30 #endif
  31
  32 #define NETDISSECT_REWORKED
  33 #ifdef HAVE_CONFIG_H
  34 #include "config.h"
  35 #endif
  36
  37 #include <tcpdump-stdinc.h>
  38
  39 #include <string.h>
  40
  41 #include "interface.h"
  42 #include "extract.h"
  43 #include "addrtoname.h"
  44 #include "ether.h"
  45
  46 /*
  47  * Copyright (c) 1998, Larry Lile
  48  * All rights reserved.
  49  *
  50  * Redistribution and use in source and binary forms, with or without
  51  * modification, are permitted provided that the following conditions
  52  * are met:
  53  * 1. Redistributions of source code must retain the above copyright
  54  *    notice unmodified, this list of conditions, and the following
  55  *    disclaimer.
  56  * 2. Redistributions in binary form must reproduce the above copyright
  57  *    notice, this list of conditions and the following disclaimer in the
  58  *    documentation and/or other materials provided with the distribution.
  59  *
  60  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  61  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  62  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  63  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  64  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  65  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  66  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  67  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  68  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  69  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  70  * SUCH DAMAGE.
  71  *
  72  */
  73
  74 #define TOKEN_HDRLEN            14
  75 #define TOKEN_RING_MAC_LEN      6
  76 #define ROUTING_SEGMENT_MAX     16
  77 #define IS_SOURCE_ROUTED(trp)   ((trp)->token_shost[0] & 0x80)
  78 #define FRAME_TYPE(trp)         (((trp)->token_fc & 0xC0) >> 6)
  79 #define TOKEN_FC_LLC            1
  80
  81 #define BROADCAST(trp)          ((EXTRACT_16BITS(&(trp)->token_rcf) & 0xE000) >> 13)
  82 #define RIF_LENGTH(trp)         ((EXTRACT_16BITS(&(trp)->token_rcf) & 0x1f00) >> 8)
  83 #define DIRECTION(trp)          ((EXTRACT_16BITS(&(trp)->token_rcf) & 0x0080) >> 7)
  84 #define LARGEST_FRAME(trp)      ((EXTRACT_16BITS(&(trp)->token_rcf) & 0x0070) >> 4)
  85 #define RING_NUMBER(trp, x)     ((EXTRACT_16BITS(&(trp)->token_rseg[x]) & 0xfff0) >> 4)
  86 #define BRIDGE_NUMBER(trp, x)   ((EXTRACT_16BITS(&(trp)->token_rseg[x]) & 0x000f))
  87 #define SEGMENT_COUNT(trp)      ((int)((RIF_LENGTH(trp) - 2) / 2))
  88
  89 struct token_header {
  90         uint8_t  token_ac;
  91         uint8_t  token_fc;
  92         uint8_t  token_dhost[TOKEN_RING_MAC_LEN];
  93         uint8_t  token_shost[TOKEN_RING_MAC_LEN];
  94         uint16_t token_rcf;
  95         uint16_t token_rseg[ROUTING_SEGMENT_MAX];
  96 };
  97
  98 static const char tstr[] = "[|token-ring]";
  99
 100 /* Extract src, dst addresses */
 101 static inline void
 102 extract_token_addrs(const struct token_header *trp, char *fsrc, char *fdst)
 103 {
 104         memcpy(fdst, (const char *)trp->token_dhost, 6);
 105         memcpy(fsrc, (const char *)trp->token_shost, 6);
 106 }
 107
 108 /*
 109  * Print the TR MAC header
 110  */
 111 static inline void
 112 token_hdr_print(netdissect_options *ndo,
 113                 register const struct token_header *trp, register u_int length,
 114                 register const u_char *fsrc, register const u_char *fdst)
 115 {
 116         const char *srcname, *dstname;
 117
 118         srcname = etheraddr_string(ndo, fsrc);
 119         dstname = etheraddr_string(ndo, fdst);
 120
 121         if (ndo->ndo_vflag)
 122                 ND_PRINT((ndo, "%02x %02x %s %s %d: ",
 123                        trp->token_ac,
 124                        trp->token_fc,
 125                        srcname, dstname,
 126                        length));
 127         else
 128                 ND_PRINT((ndo, "%s %s %d: ", srcname, dstname, length));
 129 }
 130
 131 static const char *broadcast_indicator[] = {
 132         "Non-Broadcast", "Non-Broadcast",
 133         "Non-Broadcast", "Non-Broadcast",
 134         "All-routes",    "All-routes",
 135         "Single-route",  "Single-route"
 136 };
 137
 138 static const char *direction[] = {
 139         "Forward", "Backward"
 140 };
 141
 142 static const char *largest_frame[] = {
 143         "516",
 144         "1500",
 145         "2052",
 146         "4472",
 147         "8144",
 148         "11407",
 149         "17800",
 150         "??"
 151 };
 152
 153 u_int
 154 token_print(netdissect_options *ndo, const u_char *p, u_int length, u_int caplen)
 155 {
 156         const struct token_header *trp;
 157         u_short extracted_ethertype;
 158         struct ether_header ehdr;
 159         u_int route_len = 0, hdr_len = TOKEN_HDRLEN;
 160         int seg;
 161
 162         trp = (const struct token_header *)p;
 163
 164         if (caplen < TOKEN_HDRLEN) {
 165                 ND_PRINT((ndo, "%s", tstr));
 166                 return hdr_len;
 167         }
 168
 169         /*
 170          * Get the TR addresses into a canonical form
 171          */
 172         extract_token_addrs(trp, (char*)ESRC(&ehdr), (char*)EDST(&ehdr));
 173
 174         /* Adjust for source routing information in the MAC header */
 175         if (IS_SOURCE_ROUTED(trp)) {
 176                 /* Clear source-routed bit */
 177                 *ESRC(&ehdr) &= 0x7f;
 178
 179                 if (ndo->ndo_eflag)
 180                         token_hdr_print(ndo, trp, length, ESRC(&ehdr), EDST(&ehdr));
 181
 182                 if (caplen < TOKEN_HDRLEN + 2) {
 183                         ND_PRINT((ndo, "%s", tstr));
 184                         return hdr_len;
 185                 }
 186                 route_len = RIF_LENGTH(trp);
 187                 hdr_len += route_len;
 188                 if (caplen < hdr_len) {
 189                         ND_PRINT((ndo, "%s", tstr));
 190                         return hdr_len;
 191                 }
 192                 if (ndo->ndo_vflag) {
 193                         ND_PRINT((ndo, "%s ", broadcast_indicator[BROADCAST(trp)]));
 194                         ND_PRINT((ndo, "%s", direction[DIRECTION(trp)]));
 195
 196                         for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)
 197                                 ND_PRINT((ndo, " [%d:%d]", RING_NUMBER(trp, seg),
 198                                     BRIDGE_NUMBER(trp, seg)));
 199                 } else {
 200                         ND_PRINT((ndo, "rt = %x", EXTRACT_16BITS(&trp->token_rcf)));
 201
 202                         for (seg = 0; seg < SEGMENT_COUNT(trp); seg++)
 203                                 ND_PRINT((ndo, ":%x", EXTRACT_16BITS(&trp->token_rseg[seg])));
 204                 }
 205                 ND_PRINT((ndo, " (%s) ", largest_frame[LARGEST_FRAME(trp)]));
 206         } else {
 207                 if (ndo->ndo_eflag)
 208                         token_hdr_print(ndo, trp, length, ESRC(&ehdr), EDST(&ehdr));
 209         }
 210
 211         /* Skip over token ring MAC header and routing information */
 212         length -= hdr_len;
 213         p += hdr_len;
 214         caplen -= hdr_len;
 215
 216         /* Frame Control field determines interpretation of packet */
 217         if (FRAME_TYPE(trp) == TOKEN_FC_LLC) {
 218                 /* Try to print the LLC-layer header & higher layers */
 219                 if (llc_print(ndo, p, length, caplen, ESRC(&ehdr), EDST(&ehdr),
 220                     &extracted_ethertype) == 0) {
 221                         /* ether_type not known, print raw packet */
 222                         if (!ndo->ndo_eflag)
 223                                 token_hdr_print(ndo, trp,
 224                                     length + TOKEN_HDRLEN + route_len,
 225                                     ESRC(&ehdr), EDST(&ehdr));
 226                         if (extracted_ethertype) {
 227                                 ND_PRINT((ndo, "(LLC %s) ",
 228                         etherproto_string(htons(extracted_ethertype))));
 229                         }
 230                         if (!ndo->ndo_suppress_default_print)
 231                                 ND_DEFAULTPRINT(p, caplen);
 232                 }
 233         } else {
 234                 /* Some kinds of TR packet we cannot handle intelligently */
 235                 /* XXX - dissect MAC packets if frame type is 0 */
 236                 if (!ndo->ndo_eflag)
 237                         token_hdr_print(ndo, trp, length + TOKEN_HDRLEN + route_len,
 238                             ESRC(&ehdr), EDST(&ehdr));
 239                 if (!ndo->ndo_suppress_default_print)
 240                         ND_DEFAULTPRINT(p, caplen);
 241         }
 242         return (hdr_len);
 243 }
 244
 245 /*
 246  * This is the top level routine of the printer.  'p' points
 247  * to the TR header of the packet, 'h->ts' is the timestamp,
 248  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
 249  * is the number of bytes actually captured.
 250  */
 251 u_int
 252 token_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
 253 {
 254         return (token_print(ndo, p, h->len, h->caplen));
 255 }