Add frame-relay decode support.

1 files changed, 423 insertions, 0 deletions

diff --git a/contrib/tcpdump/print-fr.c b/contrib/tcpdump/print-fr.c
new file mode 100644
index 000000000000..f0824881f895
--- /dev/null
+++ b/contrib/tcpdump/print-fr.c
@@ -0,0 +1,423 @@
+/*
+ * Copyright (c) 1990, 1991, 1993, 1994, 1995, 1996
+ *	The Regents of the University of California.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that: (1) source code distributions
+ * retain the above copyright notice and this paragraph in its entirety, (2)
+ * distributions including binary code include the above copyright notice and
+ * this paragraph in its entirety in the documentation or other materials
+ * provided with the distribution, and (3) all advertising materials mentioning
+ * features or use of this software display the following acknowledgement:
+ * ``This product includes software developed by the University of California,
+ * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
+ * the University nor the names of its contributors may be used to endorse
+ * or promote products derived from this software without specific prior
+ * written permission.
+ * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
+ */
+
+#ifndef lint
+static  char rcsid[] =
+	"@(#)$Header: /cvs/juniper/src/freebsd/contrib/tcpdump/print-fr.c,v 1.2 1997/07/18 20:24:15 boonmark Exp $ (LBL)";
+#endif
+
+#ifdef PPP
+#include <sys/param.h>
+#include <sys/time.h>
+#include <sys/socket.h>
+#include <sys/file.h>
+#include <sys/ioctl.h>
+
+#if __STDC__
+struct mbuf;
+struct rtentry;
+#endif
+#include <net/if.h>
+
+#include <netinet/in.h>
+#include <netinet/in_systm.h>
+#include <netinet/ip.h>
+
+#include <ctype.h>
+#include <netdb.h>
+#include <pcap.h>
+#include <signal.h>
+#include <stdio.h>
+
+#include <netinet/if_ether.h>
+#include "ethertype.h"
+
+#include <net/ppp_defs.h>
+#include "interface.h"
+#include "addrtoname.h"
+
+
+void q933_print();
+
+#define FR_EA_BIT(p) ((p)&0x1)
+#define FR_DLCI(b0,b1) ((((b0)&0xFC)<<2)+(((b1)&0xF0)>>4))
+
+struct fr_nlpids {
+	u_short id;
+	char *name;
+};
+
+/* find out how many bytes are there in a frame */
+int
+fr_addr_len(const u_char *p)
+{
+	int i=0;
+	
+	while (!FR_EA_BIT(p[i]) && i++ && !FR_EA_BIT(p[i+1])) i++;
+	return (i+1);
+}
+
+/* the following is for framerelay */
+#define NLPID_LEN	1	/* NLPID is one byte long */
+#define NLPID_Q933      0x08
+#define NLPID_CLNP      0x81
+#define NLPID_ESIS      0x82
+#define NLPID_ISIS      0x83
+#define NLPID_CONS      0x84
+#define NLPID_IDRP      0x85
+#define NLPID_X25_ESIS  0x8a
+#define NLPID_IP        0xcc
+
+
+static struct fr_nlpids fr_nlpids[256];
+static fr_nlpid_flag =0;
+
+void init_fr_nlpids()
+{
+	int i;
+
+	if (!fr_nlpid_flag) {
+		for (i=0; i < 256; i++) {
+			fr_nlpids[i].id = 0;
+			fr_nlpids[i].name = "Not Specified";
+		}
+		fr_nlpids[NLPID_Q933].name = "Q.933";
+		fr_nlpids[NLPID_CLNP].name = "CLNP";
+		fr_nlpids[NLPID_ESIS].name = "ESIS";
+		fr_nlpids[NLPID_ISIS].name = "ISIS";
+		fr_nlpids[NLPID_CONS].name = "CONS";
+		fr_nlpids[NLPID_IDRP].name = "IDRP";
+		fr_nlpids[NLPID_X25_ESIS].name = "X25_ESIS";
+		fr_nlpids[NLPID_IP].name = "IP";
+	}
+	fr_nlpid_flag = 1;
+}
+
+/* Framerelay packet structure */
+
+/*
+                  +---------------------------+
+                  |    flag (7E hexadecimal)  |
+                  +---------------------------+
+                  |       Q.922 Address*      |
+                  +--                       --+
+                  |                           |
+                  +---------------------------+
+                  | Control (UI = 0x03)       |
+                  +---------------------------+
+                  | Optional Pad      (0x00)  |
+                  +---------------------------+
+                  | NLPID                     |
+                  +---------------------------+
+                  |             .             |
+                  |             .             |
+                  |             .             |
+                  |           Data            |
+                  |             .             |
+                  |             .             |
+                  +---------------------------+
+                  |   Frame Check Sequence    |
+                  +--           .           --+
+                  |       (two octets)        |
+                  +---------------------------+
+                  |   flag (7E hexadecimal)   |
+                  +---------------------------+
+
+           * Q.922 addresses, as presently defined, are two octets and
+             contain a 10-bit DLCI.  In some networks Q.922 addresses
+             may optionally be increased to three or four octets.
+
+*/
+
+#define FR_PROTOCOL(p) fr_protocol((p))
+
+int
+fr_hdrlen(const u_char *p)
+{
+	int hlen;
+	hlen = fr_addr_len(p)+1;  /* addr_len + 0x03 + padding */
+	if( p[hlen] ) 
+		return hlen;
+	else
+		return hlen+1;
+}
+
+#define LAYER2_LEN(p) (fr_hdrlen((p))+NLPID_LEN)
+
+int
+fr_protocol(const u_char *p)
+{
+	int hlen;
+	
+	hlen = fr_addr_len(p) + 1;
+	if (p[hlen])  /* check for padding */
+		return p[hlen];
+	else 
+		return p[hlen+1];
+}
+
+void
+fr_hdlc_print(const u_char *p, int length)
+{
+	int proto;
+	int i;
+	int hlen;
+
+	proto = FR_PROTOCOL(p);
+
+	init_fr_nlpids();
+	/* this is kinda kludge since it assumed that DLCI is two bytes. */
+	printf("%4d %02x%02x=DLCI(%d) ", length, p[0], p[1], FR_DLCI(p[0],p[1]));
+	printf("%02x %6s: ", proto, fr_nlpids[proto].name);
+}
+
+
+
+void
+fr_if_print(u_char *user, const struct pcap_pkthdr *h,
+	     register const u_char *p)
+{
+	register u_int length = h->len;
+	register u_int caplen = h->caplen;
+	int frame_relay = 0,
+	  proto = FR_PROTOCOL(p);
+
+
+	ts_print(&h->ts);
+
+	if (caplen < fr_hdrlen(p)) {
+		printf("[|fr]");
+		goto out;
+	}
+
+	/*
+	 * Some printers want to get back at the link level addresses,
+	 * and/or check that they're not walking off the end of the packet.
+	 * Rather than pass them all the way down, we set these globals.
+	 */
+	packetp = p;
+	snapend = p + caplen;
+
+	if (eflag)
+		fr_hdlc_print(p, length);
+
+	length = length - (fr_hdrlen(p) + NLPID_LEN);
+
+
+	switch(FR_PROTOCOL(p)) {
+	case NLPID_IP:
+	case ETHERTYPE_IP:
+		ip_print((const u_char *)(p + LAYER2_LEN(p)), length);
+		break;
+	case NLPID_CLNP:
+	case NLPID_ESIS:
+	case NLPID_ISIS:
+		isoclns_print((const u_char *)(p + LAYER2_LEN(p)), length, 
+			      caplen, "000000", "000000");
+		break;
+	case NLPID_Q933:
+		q933_print((const u_char *)(p + LAYER2_LEN(p)), length);
+		break;
+	default:
+		if(!eflag)
+			fr_hdlc_print(p, length);
+		if(!xflag)
+			default_print((const u_char *)(p + LAYER2_LEN(p)),
+					caplen - LAYER2_LEN(p));
+	}
+
+	if (xflag)
+		default_print((const u_char *)(p + LAYER2_LEN(p)),
+				caplen - LAYER2_LEN(p));
+out:
+	putchar('\n');
+}
+#else
+#include <sys/types.h>
+#include <sys/time.h>
+
+#include <stdio.h>
+
+#include "interface.h"
+void
+fr_if_print(u_char *user, const struct pcap_pkthdr *h, const u_char *p)
+{
+	error("not configured for ppp");
+	/* NOTREACHED */
+}
+#endif
+
+/*
+ * Q.933 decoding portion for framerelay specific.
+ */
+
+/* Q.933 packet format
+                      Format of Other Protocols   
+                          using Q.933 NLPID
+                  +-------------------------------+            
+                  |        Q.922 Address          | 
+                  +---------------+---------------+
+                  |Control  0x03  | NLPID   0x08  |        
+                  +---------------+---------------+        
+                  |          L2 Protocol ID       |
+                  | octet 1       |  octet 2      |
+                  +-------------------------------+
+                  |          L3 Protocol ID       |
+                  | octet 2       |  octet 2      |
+                  +-------------------------------+
+                  |         Protocol Data         |
+                  +-------------------------------+
+                  | FCS                           |
+                  +-------------------------------+
+ */
+
+/* L2 (Octet 1)- Call Reference Usually is 0x0 */
+
+/*
+ * L2 (Octet 2)- Message Types definition 1 byte long.
+ */
+/* Call Establish */
+#define MSG_TYPE_ESC_TO_NATIONAL  0x00
+#define MSG_TYPE_ALERT            0x01
+#define MSG_TYPE_CALL_PROCEEDING  0x02
+#define MSG_TYPE_CONNECT          0x07
+#define MSG_TYPE_CONNECT_ACK      0x0F
+#define MSG_TYPE_PROGRESS         0x03
+#define MSG_TYPE_SETUP            0x05
+/* Call Clear */
+#define MSG_TYPE_DISCONNECT       0x45
+#define MSG_TYPE_RELEASE          0x4D
+#define MSG_TYPE_RELEASE_COMPLETE 0x5A
+#define MSG_TYPE_RESTART          0x46
+#define MSG_TYPE_RESTART_ACK      0x4E
+/* Status */
+#define MSG_TYPE_STATUS           0x7D
+#define MSG_TYPE_STATUS_ENQ       0x75
+
+#define ONE_BYTE_IE_MASK 0xF0
+
+/* See L2 protocol ID picture above */
+struct q933_header {
+    u_char call_ref;  /* usually is 0 for framerelay PVC */
+    u_char msg_type;  
+};
+
+#define REPORT_TYPE_IE    0x01
+#define LINK_VERIFY_IE_91 0x19
+#define LINK_VERIFY_IE_94 0x03
+#define PVC_STATUS_IE     0x07
+
+#define MAX_IE_SIZE
+
+struct common_ie_header {
+    u_char ie_id;
+    u_char ie_len;
+};
+
+#define FULL_STATUS 0
+#define LINK_VERIFY 1
+#define ASYNC_PVC   2
+
+
+void
+q933_print(const u_char *p, int length)
+{
+	struct q933_header *header = (struct q933_header *)(p+1);
+	const u_char *ptemp = p;
+	int ie_type, ie_len;
+	char *decode_str, temp_str[255];
+	struct common_ie_header *ie_p;
+    
+
+	/* printing out header part */
+	printf("Call Ref: %02x, MSG Type: %02x", 
+	       header->call_ref, header->msg_type);
+	switch(header->msg_type) {
+	case MSG_TYPE_STATUS:
+	    decode_str = "STATUS REPLY";
+	    break;
+	case MSG_TYPE_STATUS_ENQ:
+	    decode_str = "STATUS ENQUIRY";
+	    break;
+	default:
+	    decode_str = "UNKNOWN MSG Type";
+	}
+	printf(" %s\n", decode_str);
+
+	length = length - 3;
+	ptemp = ptemp + 3;
+	
+	/* Loop through the rest of IE */
+	while( length > 0 ) {
+	    if( ptemp[0] & ONE_BYTE_IE_MASK ) {
+		ie_len = 1;
+		printf("\t\tOne byte IE: %02x, Content %02x\n", 
+		       (*ptemp & 0x70)>>4, (*ptemp & 0x0F));
+		length--;
+		ptemp++;
+	    }
+	    else {  /* Multi-byte IE */
+		ie_p = (struct common_ie_header *)ptemp;
+		switch (ie_p->ie_id) {
+		case REPORT_TYPE_IE:
+		    switch(ptemp[2]) {
+		    case FULL_STATUS:
+			decode_str = "FULL STATUS";
+			break;
+		    case LINK_VERIFY:
+			decode_str = "LINK VERIFY";
+			break;
+		    case ASYNC_PVC:
+			decode_str = "Async PVC Status";
+			break;
+		    default:
+			decode_str = "Reserved Value";
+		    }
+		    break;
+		case LINK_VERIFY_IE_91:
+		case LINK_VERIFY_IE_94:
+		    sprintf(temp_str,"TX Seq: %3d, RX Seq: %3d",
+			    ptemp[2], ptemp[3]);
+		    decode_str = temp_str;
+		    break;
+		case PVC_STATUS_IE:
+		    sprintf(temp_str,"DLCI %d: status %s %s",
+			    ((ptemp[2]&0x3f)<<4)+ ((ptemp[3]&0x78)>>3), 
+			    ptemp[4] & 0x8 ?"new,":" ",
+			    ptemp[4] & 0x2 ?"Active":"Inactive");
+		    break;
+		default:
+		    decode_str = "Non-decoded Value";		    
+		}
+		printf("\t\tIE: %02X Len: %d, %s\n",
+		       ie_p->ie_id, ie_p->ie_len, decode_str);
+		length = length - ie_p->ie_len - 2;
+		ptemp = ptemp + ie_p->ie_len + 2;
+	    }
+	}
+	
+}
+
+
+
+
+
+