]> The Tcpdump Group git mirrors - tcpdump/commitdiff
compilable AH/ESP patches
authormcr <mcr>
Sun, 17 Oct 1999 22:18:00 +0000 (22:18 +0000)
committermcr <mcr>
Sun, 17 Oct 1999 22:18:00 +0000 (22:18 +0000)
interface.h
print-ah.c
print-esp.c
print-ip.c
print-isakmp.c
print-snmp.c

index efe98e98273712388618a00abf96a0d76e155593..e4534625b47b59373be7b3f11149c0e2cb31e1b8 100644 (file)
@@ -1,7 +1,5 @@
-/*     $NetBSD: interface.h,v 1.2 1995/03/06 19:10:18 mycroft Exp $    */
-
 /*
- * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994
+ * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997
  *     The Regents of the University of California.  All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  *
- * @(#) $Header: /tcpdump/master/tcpdump/interface.h,v 1.107 1999-10-17 21:56:53 mcr Exp $ (LBL)
+ * @(#) $Header: /tcpdump/master/tcpdump/interface.h,v 1.108 1999-10-17 22:18:00 mcr Exp $ (LBL)
  */
 
-#ifdef __GNUC__
-#define inline __inline
-#ifndef __dead
-#define __dead volatile
-#endif
-#else
-#define inline
-#define __dead
-#endif
-
-#include "os.h"                        /* operating system stuff */
-#include "md.h"                        /* machine dependent stuff */
+#ifndef tcpdump_interface_h
+#define tcpdump_interface_h
 
-#ifndef SIGRET
-#define SIGRET void            /* default */
+#include "gnuc.h"
+#ifdef HAVE_OS_PROTO_H
+#include "os-proto.h"
 #endif
 
-struct token {
+struct tok {
        int v;                  /* value */
        char *s;                /* string */
 };
 
+extern int aflag;              /* translate network and broadcast addresses */
 extern int dflag;              /* print filter code */
 extern int eflag;              /* print ethernet header */
+extern int fflag;              /* don't translate "foreign" IP address */
 extern int nflag;              /* leave addresses as numbers */
 extern int Nflag;              /* remove domains from printed host names */
 extern int qflag;              /* quick (shorter) output */
@@ -118,38 +109,47 @@ extern int packettype;            /* as specified by -T */
 
 extern char *program_name;     /* used to generate self-identifying messages */
 
+extern int32_t thiszone;       /* seconds offset from gmt to local time */
+
 extern int snaplen;
 /* global pointers to beginning and end of current packet (during printing) */
 extern const u_char *packetp;
 extern const u_char *snapend;
 
-extern int fddipad;    /* alignment offset for FDDI headers, in bytes */
+/* True if  "l" bytes of "var" were captured */
+#define TTEST2(var, l) ((u_char *)&(var) <= snapend - (l))
 
-/* Eliminate some bogus warnings. */
-struct timeval;
+/* True if "var" was captured */
+#define TTEST(var) TTEST2(var, sizeof(var))
+
+/* Bail if "l" bytes of "var" were not captured */
+#define TCHECK2(var, l) if (!TTEST2(var, l)) goto trunc
 
-typedef void (*printfunc)(u_char *, struct timeval *, int, int);
+/* Bail if "var" was not captured */
+#define TCHECK(var) TCHECK2(var, sizeof(var))
+
+#ifdef __STDC__
+struct timeval;
+#endif
 
 extern void ts_print(const struct timeval *);
-extern int clock_sigfigs(void);
-int gmt2local(void);
 
 extern int fn_print(const u_char *, const u_char *);
 extern int fn_printn(const u_char *, u_int, const u_char *);
-extern const char *tok2str(const struct token *, const char *, int);
+extern const char *tok2str(const struct tok *, const char *, int);
 extern char *dnaddr_string(u_short);
-extern char *savestr(const char *);
 
-extern int initdevice(char *, int, int *);
 extern void wrapup(int);
 
-extern __dead void error(char *, ...);
-extern void warning(char *, ...);
+#if __STDC__
+extern __dead void error(const char *, ...)
+    __attribute__((volatile, format (printf, 1, 2)));
+extern void warning(const char *, ...) __attribute__ ((format (printf, 1, 2)));
+#endif
 
 extern char *read_infile(char *);
 extern char *copy_argv(char **);
 
-extern void usage(void);
 extern char *isonsap_string(const u_char *);
 extern char *llcsap_string(u_char);
 extern char *protoid_string(const u_char *);
@@ -158,57 +158,52 @@ extern char *dnnum_string(u_short);
 
 /* The printer routines. */
 
+#ifdef __STDC__
 struct pcap_pkthdr;
+#endif
 
+extern int ether_encap_print(u_short, const u_char *, u_int, u_int);
+extern int llc_print(const u_char *, u_int, u_int, const u_char *,
+       const u_char *);
+extern void aarp_print(const u_char *, u_int);
+extern void arp_print(const u_char *, u_int, u_int);
+extern void atalk_print(const u_char *, u_int);
+extern void atm_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
+extern void bootp_print(const u_char *, u_int, u_short, u_short);
+extern void decnet_print(const u_char *, u_int, u_int);
+extern void default_print(const u_char *, u_int);
+extern void default_print_unaligned(const u_char *, u_int);
+extern void dvmrp_print(const u_char *, u_int);
+extern void egp_print(const u_char *, u_int, const u_char *);
 extern void ether_if_print(u_char *, const struct pcap_pkthdr *,
-                          const u_char *);
-extern void fddi_if_print(u_char *, const struct pcap_pkthdr *, const u_char*);
-extern void null_if_print(u_char *, const struct pcap_pkthdr *, const u_char*);
+       const u_char *);
+extern void fddi_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
+extern void gre_print(const u_char *, u_int);
+extern void icmp_print(const u_char *, const u_char *);
+extern void igrp_print(const u_char *, u_int, const u_char *);
+extern void ip_print(const u_char *, u_int);
+extern void ipx_print(const u_char *, u_int);
+extern void isoclns_print(const u_char *, u_int, u_int, const u_char *,
+       const u_char *);
+extern void krb_print(const u_char *, u_int);
+extern void nfsreply_print(const u_char *, u_int, const u_char *);
+extern void nfsreq_print(const u_char *, u_int, const u_char *);
+extern void ns_print(const u_char *, u_int);
+extern void ntp_print(const u_char *, u_int);
+extern void null_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
+extern void ospf_print(const u_char *, u_int, const u_char *);
+extern void pim_print(const u_char *, u_int);
 extern void ppp_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
+extern void ppp_bsdos_if_print(u_char *, const struct pcap_pkthdr *,
+       const u_char *);
+extern void raw_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
+extern void rip_print(const u_char *, u_int);
 extern void sl_if_print(u_char *, const struct pcap_pkthdr *, const u_char *);
-
-extern void arp_print(const u_char *, int, int);
-extern void ip_print(const u_char *, int);
-extern void tcp_print(const u_char *, int, const u_char *);
-extern void udp_print(const u_char *, int, const u_char *);
-extern void icmp_print(const u_char *, const u_char *);
-extern void default_print(const u_char *, int);
-extern void default_print_unaligned(const u_char *, int);
-
-extern void aarp_print(const u_char *, int);
-extern void atalk_print(const u_char *, int);
-extern void bootp_print(const u_char *, int, u_short, u_short);
-extern void decnet_print(const u_char *, int, int);
-extern void egp_print(const u_char *, int, const u_char *);
-extern int ether_encap_print(u_short, const u_char *, int, int);
-extern void ipx_print(const u_char *, int length);
-extern void isoclns_print(const u_char *, int, int,
-                         const u_char *, const u_char *);
-extern int llc_print(const u_char *, int, int, const u_char *, const u_char *);
-extern void nfsreply_print(const u_char *, int, const u_char *);
-extern void nfsreq_print(const u_char *, int, const u_char *);
-extern void ns_print(const u_char *, int);
-extern void ntp_print(const u_char *, int);
-extern void ospf_print(const u_char *, int, const u_char *);
-extern void rip_print(const u_char *, int);
-extern void snmp_print(const u_char *, int);
-extern void sunrpcrequest_print(const u_char *, int, const u_char *);
-extern void tftp_print(const u_char *, int);
-extern void wb_print(const void *, int);
-extern void print_ipproto(u_int proto, const struct ip *ip, const u_char *cp,  int len);
-
-#define min(a,b) ((a)>(b)?(b):(a))
-#define max(a,b) ((b)>(a)?(b):(a))
-
-/*
- * The default snapshot length.  This value allows most printers to print
- * useful information while keeping the amount of unwanted data down.
- * In particular, it allows for an ethernet header, tcp/ip header, and
- * 14 bytes of data (assuming no ip options).
- */
-#define DEFAULT_SNAPLEN 512
-
-#ifndef BIG_ENDIAN
-#define BIG_ENDIAN 4321
-#define LITTLE_ENDIAN 1234
-#endif
+extern void sl_bsdos_if_print(u_char *, const struct pcap_pkthdr *,
+    const u_char *);
+extern void snmp_print(const u_char *, u_int);
+extern void sunrpcrequest_print(const u_char *, u_int, const u_char *);
+extern void tcp_print(const u_char *, u_int, const u_char *);
+extern void tftp_print(const u_char *, u_int);
+extern void udp_print(const u_char *, u_int, const u_char *);
+extern void wb_print(const void *, u_int);
index 61bdf91c7ba9ac198a09c51571e9654930b25ed5..b4fae2eb338f152a47cf811d10a08c5646a3c98c 100644 (file)
@@ -52,10 +52,6 @@ static char rcsid[] =
 
 #include "interface.h"
 #include "addrtoname.h"
-#include "appletalk.h"
-
-#include "nfs.h"
-#include "bootp.h"
 
 extern int packettype;
 
@@ -96,6 +92,9 @@ ah_print(register const u_char *bp, int length, register const u_char *bp2)
   (void)printf("spi:%08x seqno:%d authlen: %d authdata: ", spi,
               seqno, authlen);
   (void)default_print_unaligned(bp+12, authlen);
-  
-  (void)print_ipproto(nextheader, ip, nh, length-authlen);
+
+  /* PRINT rest of packet, requires some reorg of print-ip.c */
+#if XXX  
+  (void)ip_print(nextheader, ip, nh, length-authlen);
+#endif
 }
index 97ab366e2a80ba73e39a86f0595623685a3076ca..07d192cb980967091bd9569b8a44c4b32958125e 100644 (file)
@@ -52,10 +52,6 @@ static char rcsid[] =
 
 #include "interface.h"
 #include "addrtoname.h"
-#include "appletalk.h"
-
-#include "nfs.h"
-#include "bootp.h"
 
 extern int packettype;
 
index 2951875ee970c90f6b778887172671c48f3abc86..0d8f9308a43eac837a5a4578948e2677e1d1fb59 100644 (file)
@@ -1,7 +1,5 @@
-/*     $NetBSD: print-ip.c,v 1.4 1995/04/24 13:27:43 cgd Exp $ */
-
 /*
- * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994
+ * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997
  *     The Regents of the University of California.  All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
 
 #ifndef lint
 static const char rcsid[] =
-    "@(#) $Header: /tcpdump/master/tcpdump/print-ip.c,v 1.68 1999-10-17 21:56:54 mcr Exp $ (LBL)";
+    "@(#) $Header: /tcpdump/master/tcpdump/print-ip.c,v 1.69 1999-10-17 22:18:01 mcr Exp $ (LBL)";
 #endif
 
 #include <sys/param.h>
 #include <sys/time.h>
-#include <sys/types.h>
 #include <sys/socket.h>
 
 #include <netinet/in.h>
@@ -37,49 +34,160 @@ static const char rcsid[] =
 #include <netinet/udp.h>
 #include <netinet/tcp.h>
 
+#ifdef HAVE_MALLOC_H
+#include <malloc.h>
+#endif
 #include <stdio.h>
-#ifdef __STDC__
 #include <stdlib.h>
-#endif
+#include <string.h>
 #include <unistd.h>
 
-#include "interface.h"
 #include "addrtoname.h"
+#include "interface.h"
+#include "extract.h"                   /* must come after interface.h */
+
+/* Compatibility */
+#ifndef        IPPROTO_ND
+#define        IPPROTO_ND      77
+#endif
+
+#ifndef IN_CLASSD
+#define IN_CLASSD(i) (((int32_t)(i) & 0xf0000000) == 0xe0000000)
+#endif
+
+/* (following from ipmulti/mrouted/prune.h) */
+
+/*
+ * The packet format for a traceroute request.
+ */
+struct tr_query {
+       u_int  tr_src;                  /* traceroute source */
+       u_int  tr_dst;                  /* traceroute destination */
+       u_int  tr_raddr;                /* traceroute response address */
+#ifdef WORDS_BIGENDIAN
+       struct {
+               u_int   ttl : 8;        /* traceroute response ttl */
+               u_int   qid : 24;       /* traceroute query id */
+       } q;
+#else
+       struct {
+               u_int   qid : 24;       /* traceroute query id */
+               u_int   ttl : 8;        /* traceroute response ttl */
+       } q;
+#endif
+};
+
+#define tr_rttl q.ttl
+#define tr_qid  q.qid
+
+/*
+ * Traceroute response format.  A traceroute response has a tr_query at the
+ * beginning, followed by one tr_resp for each hop taken.
+ */
+struct tr_resp {
+       u_int tr_qarr;                  /* query arrival time */
+       u_int tr_inaddr;                /* incoming interface address */
+       u_int tr_outaddr;               /* outgoing interface address */
+       u_int tr_rmtaddr;               /* parent address in source tree */
+       u_int tr_vifin;                 /* input packet count on interface */
+       u_int tr_vifout;                /* output packet count on interface */
+       u_int tr_pktcnt;                /* total incoming packets for src-grp */
+       u_char  tr_rproto;              /* routing proto deployed on router */
+       u_char  tr_fttl;                /* ttl required to forward on outvif */
+       u_char  tr_smask;               /* subnet mask for src addr */
+       u_char  tr_rflags;              /* forwarding error codes */
+};
+
+/* defs within mtrace */
+#define TR_QUERY 1
+#define TR_RESP        2
+
+/* fields for tr_rflags (forwarding error codes) */
+#define TR_NO_ERR      0
+#define TR_WRONG_IF    1
+#define TR_PRUNED      2
+#define TR_OPRUNED     3
+#define TR_SCOPED      4
+#define TR_NO_RTE      5
+#define TR_NO_FWD      7
+#define TR_NO_SPACE    0x81
+#define TR_OLD_ROUTER  0x82
+
+/* fields for tr_rproto (routing protocol) */
+#define TR_PROTO_DVMRP 1
+#define TR_PROTO_MOSPF 2
+#define TR_PROTO_PIM   3
+#define TR_PROTO_CBT   4
+
+static void print_mtrace(register const u_char *bp, register u_int len)
+{
+       register struct tr_query *tr = (struct tr_query *)(bp + 8);
+
+       printf("mtrace %d: %s to %s reply-to %s", tr->tr_qid,
+               ipaddr_string(&tr->tr_src), ipaddr_string(&tr->tr_dst),
+               ipaddr_string(&tr->tr_raddr));
+       if (IN_CLASSD(ntohl(tr->tr_raddr)))
+               printf(" with-ttl %d", tr->tr_rttl);
+}
+
+static void print_mresp(register const u_char *bp, register u_int len)
+{
+       register struct tr_query *tr = (struct tr_query *)(bp + 8);
+
+       printf("mresp %d: %s to %s reply-to %s", tr->tr_qid,
+               ipaddr_string(&tr->tr_src), ipaddr_string(&tr->tr_dst),
+               ipaddr_string(&tr->tr_raddr));
+       if (IN_CLASSD(ntohl(tr->tr_raddr)))
+               printf(" with-ttl %d", tr->tr_rttl);
+}
 
 static void
-igmp_print(register const u_char *bp, register int len,
+igmp_print(register const u_char *bp, register u_int len,
           register const u_char *bp2)
 {
        register const struct ip *ip;
-       register const u_char *ep;
 
        ip = (const struct ip *)bp2;
-       ep = (const u_char *)snapend;
         (void)printf("%s > %s: ",
                ipaddr_string(&ip->ip_src),
                ipaddr_string(&ip->ip_dst));
 
-       if (bp + 7 > ep) {
-               (void)printf("[|igmp]");
-               return;
-       }
-       switch (bp[0] & 0xf) {
-       case 1:
+       TCHECK2(bp[0], 8);
+       switch (bp[0]) {
+       case 0x11:
                (void)printf("igmp query");
                if (*(int *)&bp[4])
                        (void)printf(" [gaddr %s]", ipaddr_string(&bp[4]));
                if (len != 8)
                        (void)printf(" [len %d]", len);
                break;
-       case 2:
+       case 0x12:
                (void)printf("igmp report %s", ipaddr_string(&bp[4]));
                if (len != 8)
                        (void)printf(" [len %d]", len);
                break;
-       case 3:
-               (void)printf("igmp dvmrp %s", ipaddr_string(&bp[4]));
+       case 0x16:
+               (void)printf("igmp nreport %s", ipaddr_string(&bp[4]));
+               break;
+       case 0x17:
+               (void)printf("igmp leave %s", ipaddr_string(&bp[4]));
+               break;
+       case 0x13:
+               (void)printf("igmp dvmrp");
                if (len < 8)
                        (void)printf(" [len %d]", len);
+               else
+                       dvmrp_print(bp, len);
+               break;
+       case 0x14:
+               (void)printf("igmp pim");
+               pim_print(bp, len);
+               break;
+       case 0x1e:
+               print_mresp(bp, len);
+               break;
+       case 0x1f:
+               print_mtrace(bp, len);
                break;
        default:
                (void)printf("igmp-%d", bp[0] & 0xf);
@@ -87,18 +195,37 @@ igmp_print(register const u_char *bp, register int len,
        }
        if ((bp[0] >> 4) != 1)
                (void)printf(" [v%d]", bp[0] >> 4);
-       if (bp[1])
-               (void)printf(" [b1=0x%x]", bp[1]);
+
+       TCHECK2(bp[0], len);
+       if (vflag) {
+               /* Check the IGMP checksum */
+               u_int32_t sum = 0;
+               int count;
+               const u_short *sp = (u_short *)bp;
+               
+               for (count = len / 2; --count >= 0; )
+                       sum += *sp++;
+               if (len & 1)
+                       sum += ntohs(*(u_char *) sp << 8);
+               while (sum >> 16)
+                       sum = (sum & 0xffff) + (sum >> 16);
+               sum = 0xffff & ~sum;
+               if (sum != 0)
+                       printf(" bad igmp cksum %x!", EXTRACT_16BITS(&bp[2]));
+       }
+       return;
+trunc:
+       fputs("[|igmp]", stdout);
 }
 
 /*
  * print the recorded route in an IP RR, LSRR or SSRR option.
  */
 static void
-ip_printroute(const char *type, register const u_char *cp, int length)
+ip_printroute(const char *type, register const u_char *cp, u_int length)
 {
-       int ptr = cp[2] - 1;
-       int len;
+       register u_int ptr = cp[2] - 1;
+       register u_int len;
 
        printf(" %s{", type);
        if ((length + 1) & 3)
@@ -110,15 +237,7 @@ ip_printroute(const char *type, register const u_char *cp, int length)
        for (len = 3; len < length; len += 4) {
                if (ptr == len)
                        type = "#";
-#ifdef TCPDUMP_ALIGN
-               {
-               struct in_addr addr;
-               bcopy((char *)&cp[len], (char *)&addr, sizeof(addr));
-               printf("%s%s", type, ipaddr_string(&addr));
-               }
-#else
                printf("%s%s", type, ipaddr_string(&cp[len]));
-#endif
                type = " ";
        }
        printf("%s}", ptr == len? "#" : "");
@@ -128,14 +247,18 @@ ip_printroute(const char *type, register const u_char *cp, int length)
  * print IP options.
  */
 static void
-ip_optprint(register const u_char *cp, int length)
+ip_optprint(register const u_char *cp, u_int length)
 {
-       int len;
+       register u_int len;
 
        for (; length > 0; cp += len, length -= len) {
                int tt = *cp;
 
                len = (tt == IPOPT_NOP || tt == IPOPT_EOL) ? 1 : cp[1];
+               if (len <= 0) {
+                       printf("[|ip op len %d]", len);
+                       return;
+               }
                if (&cp[1] >= snapend || cp + len > snapend) {
                        printf("[|ip]");
                        return;
@@ -188,7 +311,7 @@ static int
 in_cksum(const struct ip *ip)
 {
        register const u_short *sp = (u_short *)ip;
-       register u_int32 sum = 0;
+       register u_int32_t sum = 0;
        register int count;
 
        /*
@@ -203,107 +326,41 @@ in_cksum(const struct ip *ip)
        return (sum);
 }
 
-
-void
-print_ipproto(u_int proto, const struct ip *ip,
-             const u_char *cp,  int len)
-{
-  switch (proto) {
-  case IPPROTO_TCP:
-    tcp_print(cp, len, (const u_char *)ip);
-    break;
-  case IPPROTO_UDP:
-    udp_print(cp, len, (const u_char *)ip);
-    break;
-  case IPPROTO_ICMP:
-    icmp_print(cp, (const u_char *)ip);
-    break;
-  case IPPROTO_ND:
-    (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
-                ipaddr_string(&ip->ip_dst));
-    (void)printf(" nd %d", len);
-    break;
-  case IPPROTO_EGP:
-    egp_print(cp, len, (const u_char *)ip);
-    break;
-#ifndef IPPROTO_OSPF
-#define IPPROTO_OSPF 89
-#endif
-  case IPPROTO_OSPF:
-    ospf_print(cp, len, (const u_char *)ip);
-    break;
-#ifndef IPPROTO_IGMP
-#define IPPROTO_IGMP 2
-#endif
-  case IPPROTO_IGMP:
-    igmp_print(cp, len, (const u_char *)ip);
-    break;
-#ifndef IPPROTO_ENCAP
-#define IPPROTO_ENCAP 4
-#endif
-  case IPPROTO_ENCAP:
-    /* ip-in-ip encapsulation */
-    if (vflag)
-      (void)printf("%s > %s: ",
-                  ipaddr_string(&ip->ip_src),
-                  ipaddr_string(&ip->ip_dst));
-    ip_print(cp, len);
-    if (! vflag) {
-      printf(" (encap)");
-      return;
-    }
-    break;
-
-#ifndef IPPROTO_ESP
-#define IPPROTO_ESP 50
-#endif
-  case IPPROTO_ESP:
-    esp_print(cp, len, (const u_char *)ip);
-    break;
-
-#ifndef IPPROTO_AH
-#define IPPROTO_AH  51
-#endif
-  case IPPROTO_AH:
-    ah_print(cp, len, (const u_char *)ip);
-    break;
-    
-  default:
-    (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
-                ipaddr_string(&ip->ip_dst));
-    (void)printf(" ip-proto-%d %d", proto, len);
-    break;
-  }
-}
-
 /*
  * print an IP datagram.
  */
 void
-ip_print(register const u_char *bp, register int length)
+ip_print(register const u_char *bp, register u_int length)
 {
        register const struct ip *ip;
-       register int hlen;
-       register int len;
-       register int off;
+       register u_int hlen, len, off;
        register const u_char *cp;
 
        ip = (const struct ip *)bp;
-#ifdef TCPDUMP_ALIGN
+#ifdef LBL_ALIGN
        /*
-        * The IP header is not word aligned, so copy into abuf.
+        * If the IP header is not aligned, copy into abuf.
         * This will never happen with BPF.  It does happen raw packet
         * dumps from -r.
         */
-       if ((long)ip & (sizeof(long)-1)) {
-               static u_char *abuf;
+       if ((long)ip & 3) {
+               static u_char *abuf = NULL;
+               static int didwarn = 0;
 
-               if (abuf == 0)
+               if (abuf == NULL) {
                        abuf = (u_char *)malloc(snaplen);
-               bcopy((char *)ip, (char *)abuf, min(length, snaplen));
+                       if (abuf == NULL)
+                               error("ip_print: malloc");
+               }
+               memcpy((char *)abuf, (char *)ip, min(length, snaplen));
                snapend += abuf - (u_char *)ip;
                packetp = abuf;
                ip = (struct ip *)abuf;
+               /* We really want libpcap to give us aligned packets */
+               if (!didwarn) {
+                       warning("compensating for unaligned libpcap packets");
+                       ++didwarn;
+               }
        }
 #endif
        if ((u_char *)(ip + 1) > snapend) {
@@ -329,7 +386,86 @@ ip_print(register const u_char *bp, register int length)
        off = ntohs(ip->ip_off);
        if ((off & 0x1fff) == 0) {
                cp = (const u_char *)ip + hlen;
-               print_ipproto(ip->ip_p, ip, cp, len);
+               switch (ip->ip_p) {
+
+               case IPPROTO_TCP:
+                       tcp_print(cp, len, (const u_char *)ip);
+                       break;
+
+               case IPPROTO_UDP:
+                       udp_print(cp, len, (const u_char *)ip);
+                       break;
+
+               case IPPROTO_ICMP:
+                       icmp_print(cp, (const u_char *)ip);
+                       break;
+
+#ifndef IPPROTO_IGRP
+#define IPPROTO_IGRP 9
+#endif
+               case IPPROTO_IGRP:
+                       igrp_print(cp, len, (const u_char *)ip);
+                       break;
+
+               case IPPROTO_ND:
+                       (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
+                               ipaddr_string(&ip->ip_dst));
+                       (void)printf(" nd %d", len);
+                       break;
+
+               case IPPROTO_EGP:
+                       egp_print(cp, len, (const u_char *)ip);
+                       break;
+
+#ifndef IPPROTO_OSPF
+#define IPPROTO_OSPF 89
+#endif
+               case IPPROTO_OSPF:
+                       ospf_print(cp, len, (const u_char *)ip);
+                       break;
+
+#ifndef IPPROTO_IGMP
+#define IPPROTO_IGMP 2
+#endif
+               case IPPROTO_IGMP:
+                       igmp_print(cp, len, (const u_char *)ip);
+                       break;
+
+               case 4:
+                       /* DVMRP multicast tunnel (ip-in-ip encapsulation) */
+                       if (vflag)
+                               (void)printf("%s > %s: ",
+                                            ipaddr_string(&ip->ip_src),
+                                            ipaddr_string(&ip->ip_dst));
+                       ip_print(cp, len);
+                       if (! vflag) {
+                               printf(" (ipip)");
+                               return;
+                       }
+                       break;
+
+#ifndef IPPROTO_GRE
+#define IPPROTO_GRE 47
+#endif
+               case IPPROTO_GRE:
+                       if (vflag)
+                               (void)printf("gre %s > %s: ",
+                                            ipaddr_string(&ip->ip_src),
+                                            ipaddr_string(&ip->ip_dst));
+                       /* do it */
+                       gre_print(cp, len);
+                       if (! vflag) {
+                               printf(" (gre encap)");
+                               return;
+                       }
+                       break;
+
+               default:
+                       (void)printf("%s > %s:", ipaddr_string(&ip->ip_src),
+                               ipaddr_string(&ip->ip_dst));
+                       (void)printf(" ip-proto-%d %d", ip->ip_p, len);
+                       break;
+               }
        }
        /*
         * for fragmented datagrams, print id:size@offset.  On all
@@ -368,11 +504,13 @@ ip_print(register const u_char *bp, register int length)
                        (void)printf("%sid %d", sep, (int)ntohs(ip->ip_id));
                        sep = ", ";
                }
-               sum = in_cksum(ip);
-               if (sum != 0) {
-                       (void)printf("%sbad cksum %x!", sep,
-                                    ntohs(ip->ip_sum));
-                       sep = ", ";
+               if ((u_char *)ip + hlen <= snapend) {
+                       sum = in_cksum(ip);
+                       if (sum != 0) {
+                               (void)printf("%sbad cksum %x!", sep,
+                                            ntohs(ip->ip_sum));
+                               sep = ", ";
+                       }
                }
                if ((hlen -= sizeof(struct ip)) > 0) {
                        (void)printf("%soptlen=%d", sep, hlen);
index 9a6a0d401a9ede1102175b4856e442d9947b9c87..b4a6f8fda48261ddda5e5223c575dbae7cce4df3 100644 (file)
@@ -45,6 +45,7 @@ static char rcsid[] =
 #endif
 
 #include <ctype.h>
+#include <pcap.h>
 #include <stdio.h>
 #include <string.h>
 
@@ -68,7 +69,7 @@ struct isakmp_header {
   u_char  exgtype;
   u_char  flags;
   u_char  msgid[4];
-  u_int32 length;
+  u_int32_t length;
 };
 
 #define FLAGS_ENCRYPTION 1
@@ -84,8 +85,6 @@ isakmp_print(register const u_char *cp, int length)
   register const u_char *ep;
   int mode, version, leapind;
   
-#define TCHECK(var, l) if ((u_char *)&(var) > ep - l) goto trunc
-  
   ih = (struct isakmp_header *)cp;
   /* Note funny sized packets */
   if (length < 20)
@@ -116,12 +115,12 @@ isakmp_print(register const u_char *cp, int length)
         ih->resp_cookie[0], ih->resp_cookie[1], 
         ih->resp_cookie[2], ih->resp_cookie[3]);
 
-  TCHECK(ih->msgid, sizeof(ih->msgid));
+  TCHECK(ih->msgid);
   printf(" msgid:%02x%02x%02x%02x",
         ih->msgid[0], ih->msgid[1],
         ih->msgid[2], ih->msgid[3]);
 
-  TCHECK(ih->length, sizeof(ih->length));
+  TCHECK(ih->length);
   printf(" length %d", ntohl(ih->length));
   
   if(ih->mjver > 1)
index 572429d04bd4ed7d2f142511d381d61156dba52e..5c417e7b73757c6c324f4148cd0e45330aa27c72 100644 (file)
@@ -42,7 +42,7 @@
 
 #ifndef lint
 static const char rcsid[] =
-    "@(#) $Header: /tcpdump/master/tcpdump/print-snmp.c,v 1.35 1999-10-17 21:37:15 mcr Exp $ (LBL)";
+    "@(#) $Header: /tcpdump/master/tcpdump/print-snmp.c,v 1.36 1999-10-17 22:18:02 mcr Exp $ (LBL)";
 #endif
 
 #include <sys/param.h>
@@ -94,7 +94,11 @@ char *Application[] = {
 #define GAUGE 2
        "TimeTicks",
 #define TIMETICKS 3
-       "Opaque"
+       "Opaque",
+#define OPAQUE 4
+       "C-5",
+       "Counter64"
+#define COUNTER64 6
 };
 
 /*
@@ -109,8 +113,28 @@ char *Context[] = {
 #define GETRESP 2
        "SetRequest",
 #define SETREQ 3
-       "Trap"
+       "Trap",
 #define TRAP 4
+       "GetBulk",
+#define GETBULKREQ 5
+       "Inform",
+#define INFORMREQ 6
+       "V2Trap",
+#define V2TRAP 7
+       "Report"
+#define REPORT 8
+};
+
+/*
+ * Context-specific ASN.1 types for the SNMP Exceptions and their tags
+ */
+char *Exceptions[] = {
+       "noSuchObject",
+#define NOSUCHOBJECT 0
+       "noSuchInstance",
+#define NOSUCHINSTANCE 1
+       "endOfMibView",
+#define ENDOFMIBVIEW 2
 };
 
 /*
@@ -130,10 +154,23 @@ char *ErrorStatus[] = {
        "noSuchName",
        "badValue",
        "readOnly",
-       "genErr"
+       "genErr",
+       "noAccess",
+       "wrongType",
+       "wrongLength",
+       "wrongEncoding",
+       "wrongValue",
+       "noCreation",
+       "inconsistentValue",
+       "resourceUnavailable",
+       "commitFailed",
+       "undoFailed",
+       "authorizationError",
+       "notWritable",
+       "inconsistentName"
 };
 #define DECODE_ErrorStatus(e) \
-       ( e >= 0 && e <= sizeof(ErrorStatus)/sizeof(ErrorStatus[0]) \
+       ( e >= 0 && e < sizeof(ErrorStatus)/sizeof(ErrorStatus[0]) \
        ? ErrorStatus[e] : (sprintf(errbuf, "err=%u", e), errbuf))
 
 /*
@@ -150,7 +187,7 @@ char *GenericTrap[] = {
 #define GT_ENTERPRISE 7
 };
 #define DECODE_GenericTrap(t) \
-       ( t >= 0 && t <= sizeof(GenericTrap)/sizeof(GenericTrap[0]) \
+       ( t >= 0 && t < sizeof(GenericTrap)/sizeof(GenericTrap[0]) \
        ? GenericTrap[t] : (sprintf(buf, "gt=%d", t), buf))
 
 /*
@@ -172,6 +209,8 @@ struct {
 #define        CONTEXT         2
        defineCLASS(Private),
 #define        PRIVATE         3
+       defineCLASS(Exceptions),
+#define EXCEPTIONS     4
 };
 
 /*
@@ -226,6 +265,10 @@ struct obj_abrev {
 #ifndef NO_ABREV_EXPERI
        /* .iso.org.dod.internet.experimental */
        { "X:", &_experimental_obj,     "\53\6\1\3" },
+#endif
+#ifndef NO_ABBREV_SNMPMODS
+       /* .iso.org.dod.internet.snmpV2.snmpModules */
+        { "S:", &_snmpModules_obj,      "\53\6\1\6\3" },
 #endif
        { 0,0,0 }
 };
@@ -260,6 +303,10 @@ struct be {
                int32_t integer;
                u_int32_t uns;
                const u_char *str;
+               struct {
+                       u_int32_t high;
+                       u_int32_t low;
+               } uns64;
        } data;
        u_short id;
        u_char form, class;             /* tag info */
@@ -275,13 +322,30 @@ struct be {
 #define BE_SEQ         7
 #define BE_INETADDR    8
 #define BE_PDU         9
+#define BE_UNS64       10
+#define BE_NOSUCHOBJECT        128
+#define BE_NOSUCHINST  129
+#define BE_ENDOFMIBVIEW        130
+};
+
+/*
+ * SNMP versions recognized by this module
+ */
+char *SnmpVersion[] = {
+       "SNMPv1",
+#define SNMP_VERSION_1 0
+       "SNMPv2c",
+#define SNMP_VERSION_2 1
+       "SNMPv2u",
+#define SNMP_VERSION_2U        2
+       "SNMPv3"
+#define SNMP_VERSION_3 3
 };
 
 /*
  * Defaults for SNMP PDU components
  */
 #define DEF_COMMUNITY "public"
-#define DEF_VERSION 0
 
 /*
  * constants for ASN.1 decoding
@@ -325,7 +389,7 @@ asn1_parse(register const u_char *p, u_int len, struct be *elem)
        elem->asnlen = 0;
        elem->type = BE_ANY;
        if (len < 1) {
-               ifNotTruncated puts("[nothing to parse], stdout");
+               ifNotTruncated fputs("[nothing to parse]", stdout);
                return -1;
        }
 
@@ -471,6 +535,20 @@ asn1_parse(register const u_char *p, u_int len, struct be *elem)
                                break;
                        }
 
+                       case COUNTER64: {
+                               register u_int32_t high, low;
+                               elem->type = BE_UNS64;
+                               high = 0, low = 0;
+                               for (i = elem->asnlen; i-- > 0; p++) {
+                                       high = (high << 8) | 
+                                           ((low & 0xFF000000) >> 24);
+                                       low = (low << 8) | *p;
+                               }
+                               elem->data.uns64.high = high;
+                               elem->data.uns64.low = low;
+                               break;
+                       }
+
                        default:
                                elem->type = BE_OCTET;
                                elem->data.raw = (caddr_t)p;
@@ -480,6 +558,25 @@ asn1_parse(register const u_char *p, u_int len, struct be *elem)
                        }
                        break;
 
+               case CONTEXT:
+                       switch (id) {
+                       case NOSUCHOBJECT:
+                               elem->type = BE_NOSUCHOBJECT;
+                               elem->data.raw = NULL;
+                               break;
+
+                       case NOSUCHINSTANCE:
+                               elem->type = BE_NOSUCHINST;
+                               elem->data.raw = NULL;
+                               break;
+
+                       case ENDOFMIBVIEW:
+                               elem->type = BE_ENDOFMIBVIEW;
+                               elem->data.raw = NULL;
+                               break;
+                       }
+                       break;
+
                default:
                        elem->type = BE_OCTET;
                        elem->data.raw = (caddr_t)p;
@@ -595,6 +692,39 @@ asn1_print(struct be *elem)
                printf("%d", elem->data.uns);
                break;
 
+       case BE_UNS64: {        /* idea borrowed from by Marshall Rose */
+               double d;
+               int j, carry;
+               char *cpf, *cpl, last[6], first[30];
+               if (elem->data.uns64.high == 0) {
+                       printf("%u", elem->data.uns64.low);
+                       break;
+               }
+               d = elem->data.uns64.high * 4294967296.0;       /* 2^32 */
+               if (elem->data.uns64.high <= 0x1fffff) { 
+                       d += elem->data.uns64.low;
+                       printf("%.f", d);
+                       break;
+               }
+               d += (elem->data.uns64.low & 0xfffff000);
+               sprintf(first, "%.f", d);
+               sprintf(last, "%5.5d", elem->data.uns64.low & 0xfff);
+               for (carry = 0, cpf = first+strlen(first)-1, cpl = last+4;
+                    cpl >= last;
+                    cpf--, cpl--) {
+                       j = carry + (*cpf - '0') + (*cpl - '0');
+                       if (j > 9) {
+                               j -= 10;
+                               carry = 1;
+                       } else {
+                               carry = 0;
+                       }
+                       *cpf = j + '0';
+               }
+               fputs(first, stdout);
+               break;
+       }
+
        case BE_STR: {
                register int printable = 1, first = 1;
                const u_char *p = elem->data.str;
@@ -630,6 +760,12 @@ asn1_print(struct be *elem)
                break;
        }
 
+       case BE_NOSUCHOBJECT:
+       case BE_NOSUCHINST:
+       case BE_ENDOFMIBVIEW:
+               printf("[%s]", Class[EXCEPTIONS].Id[elem->id]);
+               break;
+
        case BE_PDU:
                printf("%s(%u)",
                        Class[CONTEXT].Id[elem->id], elem->asnlen);
@@ -768,13 +904,15 @@ varbind_print(u_char pduid, const u_char *np, u_int length, int error)
                length -= count;
                np += count;
 
-               if (pduid != GETREQ && pduid != GETNEXTREQ && !error)
+               if (pduid != GETREQ && pduid != GETNEXTREQ
+                   && pduid != GETBULKREQ && !error)
                                fputs("=", stdout);
 
                /* objVal (ANY) */
                if ((count = asn1_parse(np, length, &elem)) < 0)
                        return;
-               if (pduid == GETREQ || pduid == GETNEXTREQ) {
+               if (pduid == GETREQ || pduid == GETNEXTREQ
+                   || pduid == GETBULKREQ) {
                        if (elem.type != BE_NULL) {
                                fputs("[objVal!=NULL]", stdout);
                                asn1_print(&elem);
@@ -791,7 +929,8 @@ varbind_print(u_char pduid, const u_char *np, u_int length, int error)
 }
 
 /*
- * Decode SNMP PDUs: GetRequest, GetNextRequest, GetResponse, and SetRequest
+ * Decode SNMP PDUs: GetRequest, GetNextRequest, GetResponse, SetRequest,
+ * GetBulk, Inform, V2Trap, and Report
  */
 static void
 snmppdu_print(u_char pduid, const u_char *np, u_int length)
@@ -820,11 +959,14 @@ snmppdu_print(u_char pduid, const u_char *np, u_int length)
                return;
        }
        error = 0;
-       if ((pduid == GETREQ || pduid == GETNEXTREQ)
+       if ((pduid == GETREQ || pduid == GETNEXTREQ || pduid == SETREQ
+           || pduid == INFORMREQ || pduid == V2TRAP || pduid == REPORT)
            && elem.data.integer != 0) {
                char errbuf[10];
                printf("[errorStatus(%s)!=0]",
                        DECODE_ErrorStatus(elem.data.integer));
+       } else if (pduid == GETBULKREQ) {
+               printf(" N=%d", elem.data.integer);
        } else if (elem.data.integer != 0) {
                char errbuf[10];
                printf(" %s", DECODE_ErrorStatus(elem.data.integer));
@@ -841,9 +983,12 @@ snmppdu_print(u_char pduid, const u_char *np, u_int length)
                asn1_print(&elem);
                return;
        }
-       if ((pduid == GETREQ || pduid == GETNEXTREQ)
+       if ((pduid == GETREQ || pduid == GETNEXTREQ || pduid == SETREQ
+           || pduid == INFORMREQ || pduid == V2TRAP || pduid == REPORT)
            && elem.data.integer != 0)
                printf("[errorIndex(%d)!=0]", elem.data.integer);
+       else if (pduid == GETBULKREQ)
+               printf(" M=%d", elem.data.integer);
        else if (elem.data.integer != 0) {
                if (!error)
                        printf("[errorIndex(%d) w/o errorStatus]",
@@ -867,7 +1012,7 @@ snmppdu_print(u_char pduid, const u_char *np, u_int length)
  * Decode SNMP Trap PDU
  */
 static void
-trap_print(const u_char *np, u_int length)
+trappdu_print(const u_char *np, u_int length)
 {
        struct be elem;
        int count = 0, generic;
@@ -951,53 +1096,119 @@ trap_print(const u_char *np, u_int length)
 }
 
 /*
- * Decode SNMP header and pass on to PDU printing routines
+ * Decode arbitrary SNMP PDUs.
  */
-void
-snmp_print(const u_char *np, u_int length)
+static void
+pdu_print(const u_char *np, u_int length, int version)
 {
-       struct be elem, pdu;
+       struct be pdu;
        int count = 0;
 
-       truncated = 0;
+       /* PDU (Context) */
+       if ((count = asn1_parse(np, length, &pdu)) < 0)
+               return;
+       if (pdu.type != BE_PDU) {
+               fputs("[no PDU]", stdout);
+               return;
+       }
+       if (count < length)
+               printf("[%d extra after PDU]", length - count);
+       asn1_print(&pdu);
+       /* descend into PDU */
+       length = pdu.asnlen;
+       np = (u_char *)pdu.data.raw;
 
-       /* truncated packet? */
-       if (np + length > snapend) {
-               truncated = 1;
-               length = snapend - np;
+       if (version == SNMP_VERSION_1 &&
+           (pdu.id == GETBULKREQ || pdu.id == INFORMREQ || 
+            pdu.id == V2TRAP || pdu.id == REPORT)) {
+               printf("[v2 PDU in v1 message]");
+               return;
        }
 
-       putchar(' ');
+       if (version == SNMP_VERSION_2 && pdu.id == TRAP) {
+               printf("[v1 PDU in v2 message]");
+               return;
+       }
 
-       /* initial Sequence */
+       switch (pdu.id) {
+       case TRAP:
+               trappdu_print(np, length);
+               break;
+       case GETREQ:
+       case GETNEXTREQ:
+       case GETRESP:
+       case SETREQ:
+       case GETBULKREQ:
+       case INFORMREQ:
+       case V2TRAP:
+       case REPORT:
+               snmppdu_print(pdu.id, np, length);
+               break;
+       }
+}
+
+/*
+ * Decode a scoped SNMP PDU.
+ */
+static void
+scopedpdu_print(const u_char *np, u_int length, int version)
+{
+       struct be elem;
+       int i, count = 0;
+
+       /* Sequence */
        if ((count = asn1_parse(np, length, &elem)) < 0)
                return;
        if (elem.type != BE_SEQ) {
-               fputs("[!init SEQ]", stdout);
+               fputs("[!scoped PDU]", stdout);
                asn1_print(&elem);
                return;
        }
-       if (count < length)
-               printf("[%d extra after iSEQ]", length - count);
-       /* descend */
        length = elem.asnlen;
        np = (u_char *)elem.data.raw;
-       /* Version (Integer) */
+
+       /* contextEngineID (OCTET STRING) */
        if ((count = asn1_parse(np, length, &elem)) < 0)
                return;
-       if (elem.type != BE_INT) {
-               fputs("[version!=INT]", stdout);
+       if (elem.type != BE_STR) {
+               fputs("[contextEngineID!=STR]", stdout);
                asn1_print(&elem);
                return;
        }
-       /* only handle version==0 */
-       if (elem.data.integer != DEF_VERSION) {
-               printf("[version(%d)!=0]", elem.data.integer);
+       length -= count;
+       np += count;
+
+       fputs("E= ", stdout);
+       for (i = 0; i < (int)elem.asnlen; i++) {
+            printf("0x%02X", elem.data.str[i]);
+        }
+       fputs(" ", stdout);
+
+       /* contextName (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[contextName!=STR]", stdout);
+               asn1_print(&elem);
                return;
        }
        length -= count;
        np += count;
 
+       printf("C=%.*s ", (int)elem.asnlen, elem.data.str);
+
+       pdu_print(np, length, version);
+}
+
+/*
+ * Decode SNMP Community Header (SNMPv1 and SNMPv2c)
+ */
+static void
+community_print(const u_char *np, u_int length, int version)
+{
+       struct be elem;
+       int count = 0;
+
        /* Community (String) */
        if ((count = asn1_parse(np, length, &elem)) < 0)
                return;
@@ -1014,30 +1225,295 @@ snmp_print(const u_char *np, u_int length)
        length -= count;
        np += count;
 
-       /* PDU (Context) */
-       if ((count = asn1_parse(np, length, &pdu)) < 0)
+       pdu_print(np, length, version);
+}
+
+/*
+ * Decode SNMPv3 User-based Security Message Header (SNMPv3)
+ */
+static void
+usm_print(const u_char *np, u_int length)
+{
+        struct be elem;
+       int count = 0;
+
+       /* Sequence */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
                return;
-       if (pdu.type != BE_PDU) {
-               fputs("[no PDU]", stdout);
+       if (elem.type != BE_SEQ) {
+               fputs("[!usm]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length = elem.asnlen;
+       np = (u_char *)elem.data.raw;
+
+       /* msgAuthoritativeEngineID (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgAuthoritativeEngineID!=STR]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+       np += count;
+
+       /* msgAuthoritativeEngineBoots (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[msgAuthoritativeEngineBoots!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       if (vflag) 
+               printf("B=%d ", elem.data.integer);
+       length -= count;
+       np += count;
+
+       /* msgAuthoritativeEngineTime (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[msgAuthoritativeEngineTime!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       if (vflag) 
+               printf("T=%d ", elem.data.integer);
+       length -= count;
+       np += count;
+
+       /* msgUserName (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgUserName!=STR]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+        np += count;
+
+       printf("U=%.*s ", (int)elem.asnlen, elem.data.str);
+
+       /* msgAuthenticationParameters (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgAuthenticationParameters!=STR]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+        np += count;
+
+       /* msgPrivacyParameters (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgPrivacyParameters!=STR]", stdout);
+               asn1_print(&elem);
                return;
        }
+       length -= count;
+        np += count;
+
        if (count < length)
-               printf("[%d extra after PDU]", length - count);
-       asn1_print(&pdu);
-       /* descend into PDU */
-       length = pdu.asnlen;
-       np = (u_char *)pdu.data.raw;
+               printf("[%d extra after usm SEQ]", length - count);
+}
 
-       switch (pdu.id) {
-       case TRAP:
-               trap_print(np, length);
+/*
+ * Decode SNMPv3 Message Header (SNMPv3)
+ */
+static void
+v3msg_print(const u_char *np, u_int length)
+{
+       struct be elem;
+       int count = 0;
+       u_char flags;
+       int model;
+       const u_char *xnp = np;
+       int xlength = length;
+
+       /* Sequence */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_SEQ) {
+               fputs("[!message]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length = elem.asnlen;
+       np = (u_char *)elem.data.raw;
+
+       /* msgID (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[msgID!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+       np += count;
+
+       /* msgMaxSize (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[msgMaxSize!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+       np += count;
+
+       /* msgFlags (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgFlags!=STR]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       if (elem.asnlen != 1) {
+               printf("[msgFlags size %d]", elem.asnlen);
+               return;
+       }
+       flags = elem.data.str[0];
+       if (flags != 0x00 && flags != 0x01 && flags != 0x03 
+           && flags != 0x04 && flags != 0x05 && flags != 0x07) {
+               printf("[msgFlags=0x%02X]", flags);
+               return;
+       }
+       length -= count;
+       np += count;
+
+       fputs("F=", stdout);
+       if (flags & 0x01) fputs("a", stdout);
+       if (flags & 0x02) fputs("p", stdout);
+       if (flags & 0x04) fputs("r", stdout);
+       fputs(" ", stdout);
+
+       /* msgSecurityModel (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[msgSecurityModel!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       model = elem.data.integer;
+       length -= count;
+       np += count;
+
+       if (count < length)
+               printf("[%d extra after message SEQ]", length - count);
+
+       if (model == 3) {
+           if (vflag) {
+               fputs("USM ", stdout);
+           }
+       } else {
+           printf("[security model %d]", model);
+            return;
+       }
+
+       np = xnp + (np - xnp);
+       length = xlength - (np - xnp);
+
+       /* msgSecurityParameters (OCTET STRING) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_STR) {
+               fputs("[msgSecurityParameters!=STR]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       length -= count;
+       np += count;
+
+       if (model == 3) {
+           usm_print(elem.data.str, elem.asnlen);
+       }
+
+       if (vflag) {
+           fputs("ScopedPDU ", stdout);
+       }
+
+       scopedpdu_print(np, length, 3);
+}
+
+/*
+ * Decode SNMP header and pass on to PDU printing routines
+ */
+void
+snmp_print(const u_char *np, u_int length)
+{
+       struct be elem;
+       int count = 0;
+       int version = 0;
+
+       truncated = 0;
+
+       /* truncated packet? */
+       if (np + length > snapend) {
+               truncated = 1;
+               length = snapend - np;
+       }
+
+       putchar(' ');
+
+       /* initial Sequence */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_SEQ) {
+               fputs("[!init SEQ]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+       if (count < length)
+               printf("[%d extra after iSEQ]", length - count);
+       /* descend */
+       length = elem.asnlen;
+       np = (u_char *)elem.data.raw;
+
+       /* Version (INTEGER) */
+       if ((count = asn1_parse(np, length, &elem)) < 0)
+               return;
+       if (elem.type != BE_INT) {
+               fputs("[version!=INT]", stdout);
+               asn1_print(&elem);
+               return;
+       }
+
+       switch (elem.data.integer) {
+       case SNMP_VERSION_1:
+       case SNMP_VERSION_2:
+       case SNMP_VERSION_3:
+               if (vflag)
+                       printf("%s ", SnmpVersion[elem.data.integer]);
                break;
-       case GETREQ:
-       case GETNEXTREQ:
-       case GETRESP:
-       case SETREQ:
-               snmppdu_print(pdu.id, np, length);
+       default:
+               printf("[version = %d]", elem.data.integer);
+               return;
+       }
+       version = elem.data.integer;
+       length -= count;
+       np += count;
+
+       switch (version) {
+       case SNMP_VERSION_1:
+        case SNMP_VERSION_2:
+               community_print(np, length, version);
+               break;
+       case SNMP_VERSION_3:
+               v3msg_print(np, length);
+               break;
+       default:
+               printf("[version = %d]", elem.data.integer);
                break;
        }
-       return;
 }