xref: /freebsd/contrib/tcpdump/print-sl.c (revision cfd6422a5217410fbd66f7a7a8a64d9d85e61229)
1 /*
2  * Copyright (c) 1989, 1990, 1991, 1993, 1994, 1995, 1996, 1997
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 
22 /* \summary: Compressed Serial Line Internet Protocol printer */
23 
24 #ifdef HAVE_CONFIG_H
25 #include "config.h"
26 #endif
27 
28 #include <netdissect-stdinc.h>
29 
30 #include "netdissect.h"
31 #include "extract.h"
32 
33 #include "ip.h"
34 #include "tcp.h"
35 #include "slcompress.h"
36 
37 /*
38  * definitions of the pseudo- link-level header attached to slip
39  * packets grabbed by the packet filter (bpf) traffic monitor.
40  */
41 #define SLIP_HDRLEN 16
42 
43 #define SLX_DIR 0
44 #define SLX_CHDR 1
45 #define CHDR_LEN 15
46 
47 #define SLIPDIR_IN 0
48 #define SLIPDIR_OUT 1
49 
50 static const char tstr[] = "[|slip]";
51 
52 static u_int lastlen[2][256];
53 static u_int lastconn = 255;
54 
55 static int sliplink_print(netdissect_options *, const u_char *, const struct ip *, u_int);
56 static int compressed_sl_print(netdissect_options *, const u_char *, const struct ip *, u_int, int);
57 
58 u_int
59 sl_if_print(netdissect_options *ndo,
60             const struct pcap_pkthdr *h, const u_char *p)
61 {
62 	register u_int caplen = h->caplen;
63 	register u_int length = h->len;
64 	register const struct ip *ip;
65 
66 	if (caplen < SLIP_HDRLEN || length < SLIP_HDRLEN) {
67 		ND_PRINT((ndo, "%s", tstr));
68 		return (caplen);
69 	}
70 
71 	caplen -= SLIP_HDRLEN;
72 	length -= SLIP_HDRLEN;
73 
74 	ip = (const struct ip *)(p + SLIP_HDRLEN);
75 
76 	if (ndo->ndo_eflag)
77 		if (sliplink_print(ndo, p, ip, length) == -1) {
78 			ND_PRINT((ndo, "%s", tstr));
79 			return (caplen + SLIP_HDRLEN);
80 	}
81 
82 	if (caplen < 1 || length < 1) {
83 		ND_PRINT((ndo, "%s", tstr));
84 		return (caplen + SLIP_HDRLEN);
85 	}
86 
87 	switch (IP_V(ip)) {
88 	case 4:
89 	        ip_print(ndo, (const u_char *)ip, length);
90 		break;
91 	case 6:
92 		ip6_print(ndo, (const u_char *)ip, length);
93 		break;
94 	default:
95 		ND_PRINT((ndo, "ip v%d", IP_V(ip)));
96 	}
97 
98 	return (SLIP_HDRLEN);
99 }
100 
101 u_int
102 sl_bsdos_if_print(netdissect_options *ndo,
103                   const struct pcap_pkthdr *h, const u_char *p)
104 {
105 	register u_int caplen = h->caplen;
106 	register u_int length = h->len;
107 	register const struct ip *ip;
108 
109 	if (caplen < SLIP_HDRLEN) {
110 		ND_PRINT((ndo, "%s", tstr));
111 		return (caplen);
112 	}
113 
114 	length -= SLIP_HDRLEN;
115 
116 	ip = (const struct ip *)(p + SLIP_HDRLEN);
117 
118 #ifdef notdef
119 	if (ndo->ndo_eflag)
120 		sliplink_print(ndo, p, ip, length);
121 #endif
122 
123 	ip_print(ndo, (const u_char *)ip, length);
124 
125 	return (SLIP_HDRLEN);
126 }
127 
128 static int
129 sliplink_print(netdissect_options *ndo,
130                register const u_char *p, register const struct ip *ip,
131                register u_int length)
132 {
133 	int dir;
134 	u_int hlen;
135 
136 	dir = p[SLX_DIR];
137 	switch (dir) {
138 
139 	case SLIPDIR_IN:
140 		ND_PRINT((ndo, "I "));
141 		break;
142 
143 	case SLIPDIR_OUT:
144 		ND_PRINT((ndo, "O "));
145 		break;
146 
147 	default:
148 		ND_PRINT((ndo, "Invalid direction %d ", dir));
149 		dir = -1;
150 		break;
151 	}
152 	if (ndo->ndo_nflag) {
153 		/* XXX just dump the header */
154 		register int i;
155 
156 		for (i = SLX_CHDR; i < SLX_CHDR + CHDR_LEN - 1; ++i)
157 			ND_PRINT((ndo, "%02x.", p[i]));
158 		ND_PRINT((ndo, "%02x: ", p[SLX_CHDR + CHDR_LEN - 1]));
159 		return 0;
160 	}
161 	switch (p[SLX_CHDR] & 0xf0) {
162 
163 	case TYPE_IP:
164 		ND_PRINT((ndo, "ip %d: ", length + SLIP_HDRLEN));
165 		break;
166 
167 	case TYPE_UNCOMPRESSED_TCP:
168 		/*
169 		 * The connection id is stored in the IP protocol field.
170 		 * Get it from the link layer since sl_uncompress_tcp()
171 		 * has restored the IP header copy to IPPROTO_TCP.
172 		 */
173 		lastconn = ((const struct ip *)&p[SLX_CHDR])->ip_p;
174 		ND_PRINT((ndo, "utcp %d: ", lastconn));
175 		if (dir == -1) {
176 			/* Direction is bogus, don't use it */
177 			return 0;
178 		}
179 		ND_TCHECK(*ip);
180 		hlen = IP_HL(ip);
181 		ND_TCHECK(*((const struct tcphdr *)&((const int *)ip)[hlen]));
182 		hlen += TH_OFF((const struct tcphdr *)&((const int *)ip)[hlen]);
183 		lastlen[dir][lastconn] = length - (hlen << 2);
184 		break;
185 
186 	default:
187 		if (dir == -1) {
188 			/* Direction is bogus, don't use it */
189 			return 0;
190 		}
191 		if (p[SLX_CHDR] & TYPE_COMPRESSED_TCP) {
192 			if (compressed_sl_print(ndo, &p[SLX_CHDR], ip,
193 						length, dir) == -1)
194 				goto trunc;
195 			ND_PRINT((ndo, ": "));
196 		} else
197 			ND_PRINT((ndo, "slip-%d!: ", p[SLX_CHDR]));
198 	}
199 	return 0;
200 trunc:
201 	return -1;
202 }
203 
204 static const u_char *
205 print_sl_change(netdissect_options *ndo,
206                 const char *str, register const u_char *cp)
207 {
208 	register u_int i;
209 
210 	if ((i = *cp++) == 0) {
211 		i = EXTRACT_16BITS(cp);
212 		cp += 2;
213 	}
214 	ND_PRINT((ndo, " %s%d", str, i));
215 	return (cp);
216 }
217 
218 static const u_char *
219 print_sl_winchange(netdissect_options *ndo,
220                    register const u_char *cp)
221 {
222 	register short i;
223 
224 	if ((i = *cp++) == 0) {
225 		i = EXTRACT_16BITS(cp);
226 		cp += 2;
227 	}
228 	if (i >= 0)
229 		ND_PRINT((ndo, " W+%d", i));
230 	else
231 		ND_PRINT((ndo, " W%d", i));
232 	return (cp);
233 }
234 
235 static int
236 compressed_sl_print(netdissect_options *ndo,
237                     const u_char *chdr, const struct ip *ip,
238                     u_int length, int dir)
239 {
240 	register const u_char *cp = chdr;
241 	register u_int flags, hlen;
242 
243 	flags = *cp++;
244 	if (flags & NEW_C) {
245 		lastconn = *cp++;
246 		ND_PRINT((ndo, "ctcp %d", lastconn));
247 	} else
248 		ND_PRINT((ndo, "ctcp *"));
249 
250 	/* skip tcp checksum */
251 	cp += 2;
252 
253 	switch (flags & SPECIALS_MASK) {
254 	case SPECIAL_I:
255 		ND_PRINT((ndo, " *SA+%d", lastlen[dir][lastconn]));
256 		break;
257 
258 	case SPECIAL_D:
259 		ND_PRINT((ndo, " *S+%d", lastlen[dir][lastconn]));
260 		break;
261 
262 	default:
263 		if (flags & NEW_U)
264 			cp = print_sl_change(ndo, "U=", cp);
265 		if (flags & NEW_W)
266 			cp = print_sl_winchange(ndo, cp);
267 		if (flags & NEW_A)
268 			cp = print_sl_change(ndo, "A+", cp);
269 		if (flags & NEW_S)
270 			cp = print_sl_change(ndo, "S+", cp);
271 		break;
272 	}
273 	if (flags & NEW_I)
274 		cp = print_sl_change(ndo, "I+", cp);
275 
276 	/*
277 	 * 'hlen' is the length of the uncompressed TCP/IP header (in words).
278 	 * 'cp - chdr' is the length of the compressed header.
279 	 * 'length - hlen' is the amount of data in the packet.
280 	 */
281 	ND_TCHECK(*ip);
282 	hlen = IP_HL(ip);
283 	ND_TCHECK(*((const struct tcphdr *)&((const int32_t *)ip)[hlen]));
284 	hlen += TH_OFF((const struct tcphdr *)&((const int32_t *)ip)[hlen]);
285 	lastlen[dir][lastconn] = length - (hlen << 2);
286 	ND_PRINT((ndo, " %d (%ld)", lastlen[dir][lastconn], (long)(cp - chdr)));
287 	return 0;
288 trunc:
289 	return -1;
290 }
291