xref: /freebsd/contrib/tcpdump/print-fr.c (revision 6b3455a7665208c366849f0b2b3bc916fb97516e) 
1 /*
2  * Copyright (c) 1990, 1991, 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  * $FreeBSD$
22  */
23 
24 #ifndef lint
25 static  char rcsid[] =
26 	"@(#)$Header: /home/ncvs/src/contrib/tcpdump/print-fr.c,v 1.1 1997/12/31 21:50:31 pst Exp $ (LBL)";
27 #endif
28 
29 #ifdef PPP
30 #include <sys/param.h>
31 #include <sys/time.h>
32 #include <sys/socket.h>
33 #include <sys/file.h>
34 #include <sys/ioctl.h>
35 
36 #if __STDC__
37 struct mbuf;
38 struct rtentry;
39 #endif
40 #include <net/if.h>
41 #include <net/if_var.h>
42 
43 #include <netinet/in.h>
44 #include <netinet/in_systm.h>
45 #include <netinet/ip.h>
46 
47 #include <ctype.h>
48 #include <netdb.h>
49 #include <pcap.h>
50 #include <signal.h>
51 #include <stdio.h>
52 
53 #include <netinet/if_ether.h>
54 #include "ethertype.h"
55 
56 #include <net/ppp_defs.h>
57 #include "interface.h"
58 #include "addrtoname.h"
59 
60 
61 void q933_print();
62 
63 #define FR_EA_BIT(p) ((p)&0x1)
64 #define FR_DLCI(b0,b1) ((((b0)&0xFC)<<2)+(((b1)&0xF0)>>4))
65 
66 struct fr_nlpids {
67 	u_short id;
68 	char *name;
69 };
70 
71 /* find out how many bytes are there in a frame */
72 int
73 fr_addr_len(const u_char *p)
74 {
75 	int i=0;
76 
77 	while (!FR_EA_BIT(p[i]) && i++ && !FR_EA_BIT(p[i+1])) i++;
78 	return (i+1);
79 }
80 
81 /* the following is for framerelay */
82 #define NLPID_LEN	1	/* NLPID is one byte long */
83 #define NLPID_Q933      0x08
84 #define NLPID_CLNP      0x81
85 #define NLPID_ESIS      0x82
86 #define NLPID_ISIS      0x83
87 #define NLPID_CONS      0x84
88 #define NLPID_IDRP      0x85
89 #define NLPID_X25_ESIS  0x8a
90 #define NLPID_IP        0xcc
91 
92 
93 static struct fr_nlpids fr_nlpids[256];
94 static fr_nlpid_flag =0;
95 
96 void init_fr_nlpids()
97 {
98 	int i;
99 
100 	if (!fr_nlpid_flag) {
101 		for (i=0; i < 256; i++) {
102 			fr_nlpids[i].id = 0;
103 			fr_nlpids[i].name = "Not Specified";
104 		}
105 		fr_nlpids[NLPID_Q933].name = "Q.933";
106 		fr_nlpids[NLPID_CLNP].name = "CLNP";
107 		fr_nlpids[NLPID_ESIS].name = "ESIS";
108 		fr_nlpids[NLPID_ISIS].name = "ISIS";
109 		fr_nlpids[NLPID_CONS].name = "CONS";
110 		fr_nlpids[NLPID_IDRP].name = "IDRP";
111 		fr_nlpids[NLPID_X25_ESIS].name = "X25_ESIS";
112 		fr_nlpids[NLPID_IP].name = "IP";
113 	}
114 	fr_nlpid_flag = 1;
115 }
116 
117 /* Framerelay packet structure */
118 
119 /*
120                   +---------------------------+
121                   |    flag (7E hexadecimal)  |
122                   +---------------------------+
123                   |       Q.922 Address*      |
124                   +--                       --+
125                   |                           |
126                   +---------------------------+
127                   | Control (UI = 0x03)       |
128                   +---------------------------+
129                   | Optional Pad      (0x00)  |
130                   +---------------------------+
131                   | NLPID                     |
132                   +---------------------------+
133                   |             .             |
134                   |             .             |
135                   |             .             |
136                   |           Data            |
137                   |             .             |
138                   |             .             |
139                   +---------------------------+
140                   |   Frame Check Sequence    |
141                   +--           .           --+
142                   |       (two octets)        |
143                   +---------------------------+
144                   |   flag (7E hexadecimal)   |
145                   +---------------------------+
146 
147            * Q.922 addresses, as presently defined, are two octets and
148              contain a 10-bit DLCI.  In some networks Q.922 addresses
149              may optionally be increased to three or four octets.
150 
151 */
152 
153 #define FR_PROTOCOL(p) fr_protocol((p))
154 
155 int
156 fr_hdrlen(const u_char *p)
157 {
158 	int hlen;
159 	hlen = fr_addr_len(p)+1;  /* addr_len + 0x03 + padding */
160 	if( p[hlen] )
161 		return hlen;
162 	else
163 		return hlen+1;
164 }
165 
166 #define LAYER2_LEN(p) (fr_hdrlen((p))+NLPID_LEN)
167 
168 int
169 fr_protocol(const u_char *p)
170 {
171 	int hlen;
172 
173 	hlen = fr_addr_len(p) + 1;
174 	if (p[hlen])  /* check for padding */
175 		return p[hlen];
176 	else
177 		return p[hlen+1];
178 }
179 
180 void
181 fr_hdlc_print(const u_char *p, int length)
182 {
183 	int proto;
184 	int i;
185 	int hlen;
186 
187 	proto = FR_PROTOCOL(p);
188 
189 	init_fr_nlpids();
190 	/* this is kinda kludge since it assumed that DLCI is two bytes. */
191 	printf("%4d %02x%02x=DLCI(%d) ", length, p[0], p[1], FR_DLCI(p[0],p[1]));
192 	printf("%02x %6s: ", proto, fr_nlpids[proto].name);
193 }
194 
195 
196 
197 void
198 fr_if_print(u_char *user, const struct pcap_pkthdr *h,
199 	     register const u_char *p)
200 {
201 	register u_int length = h->len;
202 	register u_int caplen = h->caplen;
203 	int frame_relay = 0,
204 	  proto = FR_PROTOCOL(p);
205 
206 
207 	ts_print(&h->ts);
208 
209 	if (caplen < fr_hdrlen(p)) {
210 		printf("[|fr]");
211 		goto out;
212 	}
213 
214 	/*
215 	 * Some printers want to get back at the link level addresses,
216 	 * and/or check that they're not walking off the end of the packet.
217 	 * Rather than pass them all the way down, we set these globals.
218 	 */
219 	packetp = p;
220 	snapend = p + caplen;
221 
222 	if (eflag)
223 		fr_hdlc_print(p, length);
224 
225 	length = length - (fr_hdrlen(p) + NLPID_LEN);
226 
227 
228 	switch(FR_PROTOCOL(p)) {
229 	case NLPID_IP:
230 	case ETHERTYPE_IP:
231 		ip_print((const u_char *)(p + LAYER2_LEN(p)), length);
232 		break;
233 	case NLPID_CLNP:
234 	case NLPID_ESIS:
235 	case NLPID_ISIS:
236 		isoclns_print((const u_char *)(p + LAYER2_LEN(p)), length,
237 			      caplen, "000000", "000000");
238 		break;
239 	case NLPID_Q933:
240 		q933_print((const u_char *)(p + LAYER2_LEN(p)), length);
241 		break;
242 	default:
243 		if(!eflag)
244 			fr_hdlc_print(p, length);
245 		if(!xflag)
246 			default_print((const u_char *)(p + LAYER2_LEN(p)),
247 					caplen - LAYER2_LEN(p));
248 	}
249 
250 	if (xflag)
251 		default_print((const u_char *)(p + LAYER2_LEN(p)),
252 				caplen - LAYER2_LEN(p));
253 out:
254 	putchar('\n');
255 }
256 #else
257 #include <sys/types.h>
258 #include <sys/time.h>
259 
260 #include <stdio.h>
261 
262 #include "interface.h"
263 u_int
264 fr_if_print(const struct pcap_pkthdr *h, const u_char *p)
265 {
266 	error("not configured for ppp");
267 	/* NOTREACHED */
268 }
269 #endif
270 
271 /*
272  * Q.933 decoding portion for framerelay specific.
273  */
274 
275 /* Q.933 packet format
276                       Format of Other Protocols
277                           using Q.933 NLPID
278                   +-------------------------------+
279                   |        Q.922 Address          |
280                   +---------------+---------------+
281                   |Control  0x03  | NLPID   0x08  |
282                   +---------------+---------------+
283                   |          L2 Protocol ID       |
284                   | octet 1       |  octet 2      |
285                   +-------------------------------+
286                   |          L3 Protocol ID       |
287                   | octet 2       |  octet 2      |
288                   +-------------------------------+
289                   |         Protocol Data         |
290                   +-------------------------------+
291                   | FCS                           |
292                   +-------------------------------+
293  */
294 
295 /* L2 (Octet 1)- Call Reference Usually is 0x0 */
296 
297 /*
298  * L2 (Octet 2)- Message Types definition 1 byte long.
299  */
300 /* Call Establish */
301 #define MSG_TYPE_ESC_TO_NATIONAL  0x00
302 #define MSG_TYPE_ALERT            0x01
303 #define MSG_TYPE_CALL_PROCEEDING  0x02
304 #define MSG_TYPE_CONNECT          0x07
305 #define MSG_TYPE_CONNECT_ACK      0x0F
306 #define MSG_TYPE_PROGRESS         0x03
307 #define MSG_TYPE_SETUP            0x05
308 /* Call Clear */
309 #define MSG_TYPE_DISCONNECT       0x45
310 #define MSG_TYPE_RELEASE          0x4D
311 #define MSG_TYPE_RELEASE_COMPLETE 0x5A
312 #define MSG_TYPE_RESTART          0x46
313 #define MSG_TYPE_RESTART_ACK      0x4E
314 /* Status */
315 #define MSG_TYPE_STATUS           0x7D
316 #define MSG_TYPE_STATUS_ENQ       0x75
317 
318 #define ONE_BYTE_IE_MASK 0xF0
319 
320 /* See L2 protocol ID picture above */
321 struct q933_header {
322     u_char call_ref;  /* usually is 0 for framerelay PVC */
323     u_char msg_type;
324 };
325 
326 #define REPORT_TYPE_IE    0x01
327 #define LINK_VERIFY_IE_91 0x19
328 #define LINK_VERIFY_IE_94 0x03
329 #define PVC_STATUS_IE     0x07
330 
331 #define MAX_IE_SIZE
332 
333 struct common_ie_header {
334     u_char ie_id;
335     u_char ie_len;
336 };
337 
338 #define FULL_STATUS 0
339 #define LINK_VERIFY 1
340 #define ASYNC_PVC   2
341 
342 
343 void
344 q933_print(const u_char *p, int length)
345 {
346 	struct q933_header *header = (struct q933_header *)(p+1);
347 	const u_char *ptemp = p;
348 	int ie_type, ie_len;
349 	char *decode_str, temp_str[255];
350 	struct common_ie_header *ie_p;
351 
352 
353 	/* printing out header part */
354 	printf("Call Ref: %02x, MSG Type: %02x",
355 	       header->call_ref, header->msg_type);
356 	switch(header->msg_type) {
357 	case MSG_TYPE_STATUS:
358 	    decode_str = "STATUS REPLY";
359 	    break;
360 	case MSG_TYPE_STATUS_ENQ:
361 	    decode_str = "STATUS ENQUIRY";
362 	    break;
363 	default:
364 	    decode_str = "UNKNOWN MSG Type";
365 	}
366 	printf(" %s\n", decode_str);
367 
368 	length = length - 3;
369 	ptemp = ptemp + 3;
370 
371 	/* Loop through the rest of IE */
372 	while( length > 0 ) {
373 	    if( ptemp[0] & ONE_BYTE_IE_MASK ) {
374 		ie_len = 1;
375 		printf("\t\tOne byte IE: %02x, Content %02x\n",
376 		       (*ptemp & 0x70)>>4, (*ptemp & 0x0F));
377 		length--;
378 		ptemp++;
379 	    }
380 	    else {  /* Multi-byte IE */
381 		ie_p = (struct common_ie_header *)ptemp;
382 		switch (ie_p->ie_id) {
383 		case REPORT_TYPE_IE:
384 		    switch(ptemp[2]) {
385 		    case FULL_STATUS:
386 			decode_str = "FULL STATUS";
387 			break;
388 		    case LINK_VERIFY:
389 			decode_str = "LINK VERIFY";
390 			break;
391 		    case ASYNC_PVC:
392 			decode_str = "Async PVC Status";
393 			break;
394 		    default:
395 			decode_str = "Reserved Value";
396 		    }
397 		    break;
398 		case LINK_VERIFY_IE_91:
399 		case LINK_VERIFY_IE_94:
400 		    snprintf(temp_str, sizeof(temp_str), "TX Seq: %3d, RX Seq: %3d",
401 			    ptemp[2], ptemp[3]);
402 		    decode_str = temp_str;
403 		    break;
404 		case PVC_STATUS_IE:
405 		    snprintf(temp_str,sizeof(temp_str), "DLCI %d: status %s %s",
406 			    ((ptemp[2]&0x3f)<<4)+ ((ptemp[3]&0x78)>>3),
407 			    ptemp[4] & 0x8 ?"new,":" ",
408 			    ptemp[4] & 0x2 ?"Active":"Inactive");
409 		    break;
410 		default:
411 		    decode_str = "Non-decoded Value";
412 		}
413 		printf("\t\tIE: %02X Len: %d, %s\n",
414 		       ie_p->ie_id, ie_p->ie_len, decode_str);
415 		length = length - ie_p->ie_len - 2;
416 		ptemp = ptemp + ie_p->ie_len + 2;
417 	    }
418 	}
419 
420 }
421 
422 
423 
424 
425 
426 
427