1 /*
2  * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996,
3  *	1997, 2000, 2011, 2012
4  *	The Regents of the University of California.  All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that: (1) source code distributions
8  * retain the above copyright notice and this paragraph in its entirety, (2)
9  * distributions including binary code include the above copyright notice and
10  * this paragraph in its entirety in the documentation or other materials
11  * provided with the distribution, and (3) all advertising materials mentioning
12  * features or use of this software display the following acknowledgement:
13  * ``This product includes software developed by the University of California,
14  * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
15  * the University nor the names of its contributors may be used to endorse
16  * or promote products derived from this software without specific prior
17  * written permission.
18  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
19  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
20  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
21  */
22 /*
23  * Copyright (c) 2011, 2016, Oracle and/or its affiliates. All rights reserved.
24  */
25 
26 /* \summary: IP-over-InfiniBand (IPoIB) printer */
27 
28 #ifdef HAVE_CONFIG_H
29 #include <config.h>
30 #endif
31 
32 #include "netdissect-stdinc.h"
33 
34 #include "netdissect.h"
35 #include "extract.h"
36 #include "addrtoname.h"
37 
38 
39 extern const struct tok ethertype_values[];
40 
41 #define	IPOIB_HDRLEN	44
42 
43 static inline void
ipoib_hdr_print(netdissect_options * ndo,const u_char * bp,u_int length)44 ipoib_hdr_print(netdissect_options *ndo, const u_char *bp, u_int length)
45 {
46 	uint16_t ether_type;
47 
48 	ether_type = GET_BE_U_2(bp + 40);
49 	if (!ndo->ndo_qflag) {
50 		ND_PRINT(", ethertype %s (0x%04x)",
51 			     tok2str(ethertype_values,"Unknown", ether_type),
52 			     ether_type);
53 	} else {
54 		ND_PRINT(", ethertype %s",
55 			     tok2str(ethertype_values,"Unknown", ether_type));
56 	}
57 
58 	ND_PRINT(", length %u: ", length);
59 }
60 
61 /*
62  * Print an InfiniBand frame.
63  * This might be encapsulated within another frame; we might be passed
64  * a pointer to a function that can print header information for that
65  * frame's protocol, and an argument to pass to that function.
66  */
67 static void
ipoib_print(netdissect_options * ndo,const u_char * p,u_int length,u_int caplen,void (* print_encap_header)(const u_char *),const u_char * encap_header_arg)68 ipoib_print(netdissect_options *ndo, const u_char *p, u_int length, u_int caplen,
69     void (*print_encap_header)(const u_char *), const u_char *encap_header_arg)
70 {
71 	const u_char *orig_hdr = p;
72 	u_int orig_length;
73 	u_short ether_type;
74 
75 	if (caplen < IPOIB_HDRLEN) {
76 		nd_print_trunc(ndo);
77 		ndo->ndo_ll_hdr_len += caplen;
78 		return;
79 	}
80 
81 	if (length < IPOIB_HDRLEN) {
82 		nd_print_trunc(ndo);
83 		ndo->ndo_ll_hdr_len += length;
84 		return;
85 	}
86 
87 	if (ndo->ndo_eflag) {
88 		nd_print_protocol_caps(ndo);
89 		if (print_encap_header != NULL)
90 			(*print_encap_header)(encap_header_arg);
91 		ipoib_hdr_print(ndo, p, length);
92 	}
93 	orig_length = length;
94 
95 	ndo->ndo_ll_hdr_len += IPOIB_HDRLEN;
96 	length -= IPOIB_HDRLEN;
97 	caplen -= IPOIB_HDRLEN;
98 	ether_type = GET_BE_U_2(p + 40);
99 	p += IPOIB_HDRLEN;
100 
101 	if (ethertype_print(ndo, ether_type, p, length, caplen, NULL, NULL) == 0) {
102 		/* ether_type not known, print raw packet */
103 		if (!ndo->ndo_eflag) {
104 			if (print_encap_header != NULL)
105 				(*print_encap_header)(encap_header_arg);
106 			ipoib_hdr_print(ndo, orig_hdr , orig_length);
107 		}
108 
109 		if (!ndo->ndo_suppress_default_print)
110 			ND_DEFAULTPRINT(p, caplen);
111 	}
112 }
113 
114 /*
115  * This is the top level routine of the printer.  'p' points
116  * to the ether header of the packet, 'h->ts' is the timestamp,
117  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
118  * is the number of bytes actually captured.
119  */
120 void
ipoib_if_print(netdissect_options * ndo,const struct pcap_pkthdr * h,const u_char * p)121 ipoib_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
122 {
123 	ndo->ndo_protocol = "ipoib";
124 	ipoib_print(ndo, p, h->len, h->caplen, NULL, NULL);
125 }
126