nexmon – Blame information for rev 1

Subversion Repositories:
Rev:
Rev Author Line No. Line
1 office 1 /*
2 * Copyright (c) 2013, Petar Alilovic,
3 * Faculty of Electrical Engineering and Computing, University of Zagreb
4 * All rights reserved
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions are met:
8 *
9 * * Redistributions of source code must retain the above copyright notice,
10 * this list of conditions and the following disclaimer.
11 * * Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY
16 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY
19 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
20 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
22 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
25 * DAMAGE.
26 */
27  
28 #define NETDISSECT_REWORKED
29 #ifdef HAVE_CONFIG_H
30 #include "config.h"
31 #endif
32  
33 #include <tcpdump-stdinc.h>
34  
35 #include "interface.h"
36  
37 #if defined(DLT_NFLOG) && defined(HAVE_PCAP_NFLOG_H)
38 #include <pcap/nflog.h>
39  
40 static const struct tok nflog_values[] = {
41 { AF_INET, "IPv4" },
42 #ifdef INET6
43 { AF_INET6, "IPv6" },
44 #endif /*INET6*/
45 { 0, NULL }
46 };
47  
48 static inline void
49 nflog_hdr_print(netdissect_options *ndo, const nflog_hdr_t *hdr, u_int length)
50 {
51 ND_PRINT((ndo, "version %d, resource ID %d", hdr->nflog_version, ntohs(hdr->nflog_rid)));
52  
53 if (!ndo->ndo_qflag) {
54 ND_PRINT((ndo,", family %s (%d)",
55 tok2str(nflog_values, "Unknown",
56 hdr->nflog_family),
57 hdr->nflog_family));
58 } else {
59 ND_PRINT((ndo,", %s",
60 tok2str(nflog_values,
61 "Unknown NFLOG (0x%02x)",
62 hdr->nflog_family)));
63 }
64  
65 ND_PRINT((ndo, ", length %u: ", length));
66 }
67  
68 u_int
69 nflog_if_print(netdissect_options *ndo,
70 const struct pcap_pkthdr *h, const u_char *p)
71 {
72 const nflog_hdr_t *hdr = (const nflog_hdr_t *)p;
73 const nflog_tlv_t *tlv;
74 uint16_t size;
75 uint16_t h_size = sizeof(nflog_hdr_t);
76 u_int caplen = h->caplen;
77 u_int length = h->len;
78  
79 if (caplen < (int) sizeof(nflog_hdr_t) || length < (int) sizeof(nflog_hdr_t)) {
80 ND_PRINT((ndo, "[|nflog]"));
81 return h_size;
82 }
83  
84 if (hdr->nflog_version != 0) {
85 ND_PRINT((ndo, "version %u (unknown)", hdr->nflog_version));
86 return h_size;
87 }
88  
89 if (ndo->ndo_eflag)
90 nflog_hdr_print(ndo, hdr, length);
91  
92 p += sizeof(nflog_hdr_t);
93 length -= sizeof(nflog_hdr_t);
94 caplen -= sizeof(nflog_hdr_t);
95  
96 while (length > 0) {
97 /* We have some data. Do we have enough for the TLV header? */
98 if (caplen < sizeof(nflog_tlv_t) || length < sizeof(nflog_tlv_t)) {
99 /* No. */
100 ND_PRINT((ndo, "[|nflog]"));
101 return h_size;
102 }
103  
104 tlv = (const nflog_tlv_t *) p;
105 size = tlv->tlv_length;
106 if (size % 4 != 0)
107 size += 4 - size % 4;
108  
109 /* Is the TLV's length less than the minimum? */
110 if (size < sizeof(nflog_tlv_t)) {
111 /* Yes. Give up now. */
112 ND_PRINT((ndo, "[|nflog]"));
113 return h_size;
114 }
115  
116 /* Do we have enough data for the full TLV? */
117 if (caplen < size || length < size) {
118 /* No. */
119 ND_PRINT((ndo, "[|nflog]"));
120 return h_size;
121 }
122  
123 if (tlv->tlv_type == NFULA_PAYLOAD) {
124 /*
125 * This TLV's data is the packet payload.
126 * Skip past the TLV header, and break out
127 * of the loop so we print the packet data.
128 */
129 p += sizeof(nflog_tlv_t);
130 h_size += sizeof(nflog_tlv_t);
131 length -= sizeof(nflog_tlv_t);
132 caplen -= sizeof(nflog_tlv_t);
133 break;
134 }
135  
136 p += size;
137 h_size += size;
138 length -= size;
139 caplen -= size;
140 }
141  
142 switch (hdr->nflog_family) {
143  
144 case AF_INET:
145 ip_print(ndo, p, length);
146 break;
147  
148 #ifdef AF_INET6
149 case AF_INET6:
150 ip6_print(ndo, p, length);
151 break;
152 #endif /* AF_INET6 */
153  
154 default:
155 if (!ndo->ndo_eflag)
156 nflog_hdr_print(ndo, hdr,
157 length + sizeof(nflog_hdr_t));
158  
159 if (!ndo->ndo_suppress_default_print)
160 ND_DEFAULTPRINT(p, caplen);
161 break;
162 }
163  
164 return h_size;
165 }
166  
167 #endif /* defined(DLT_NFLOG) && defined(HAVE_PCAP_NFLOG_H) */