1 files changed, 309 insertions, 0 deletions
diff --git a/src/cmd/ip/snoopy/ip6.c b/src/cmd/ip/snoopy/ip6.c
new file mode 100755
index 00000000..7fdc9679
--- /dev/null
+++ b/src/cmd/ip/snoopy/ip6.c
@@ -0,0 +1,309 @@
+#include <u.h>
+#include <libc.h>
+#include <ip.h>
+#include "dat.h"
+#include "protos.h"
+
+typedef struct Hdr	Hdr;
+struct Hdr
+{
+	uchar	vcf[4];			/* Version and header length */
+	uchar	length[2];		/* packet length */
+	uchar	proto;			/* Protocol */
+	uchar	ttl;			/* Time to live */
+	uchar	src[IPaddrlen];		/* IP source */
+	uchar	dst[IPaddrlen];		/* IP destination */
+};
+
+enum
+{
+	IP6HDR		= 40,		/* sizeof(Iphdr) */
+	IP_VER		= 0x60,		/* Using IP version 4 */
+	HBH_HDR		= 0,
+	ROUT_HDR	= 43,
+	FRAG_HDR	= 44,
+	FRAG_HSZ	= 8, 		/* in bytes */
+	DEST_HDR	= 60,
+};
+
+static Mux p_mux[] =
+{
+	{ "igmp", 2, },
+	{ "ggp", 3, },
+	{ "ip", 4, },
+	{ "st", 5, },
+	{ "tcp", 6, },
+	{ "ucl", 7, },
+	{ "egp", 8, },
+	{ "igp", 9, },
+	{ "bbn-rcc-mon", 10, },
+	{ "nvp-ii", 11, },
+	{ "pup", 12, },
+	{ "argus", 13, },
+	{ "emcon", 14, },
+	{ "xnet", 15, },
+	{ "chaos", 16, },
+	{ "udp", 17, },
+	{ "mux", 18, },
+	{ "dcn-meas", 19, },
+	{ "hmp", 20, },
+	{ "prm", 21, },
+	{ "xns-idp", 22, },
+	{ "trunk-1", 23, },
+	{ "trunk-2", 24, },
+	{ "leaf-1", 25, },
+	{ "leaf-2", 26, },
+	{ "rdp", 27, },
+	{ "irtp", 28, },
+	{ "iso-tp4", 29, },
+	{ "netblt", 30, },
+	{ "mfe-nsp", 31, },
+	{ "merit-inp", 32, },
+	{ "sep", 33, },
+	{ "3pc", 34, },
+	{ "idpr", 35, },
+	{ "xtp", 36, },
+	{ "ddp", 37, },
+	{ "idpr-cmtp", 38, },
+	{ "tp++", 39, },
+	{ "il", 40, },
+	{ "sip", 41, },
+	{ "sdrp", 42, },
+	{ "idrp", 45, },
+	{ "rsvp", 46, },
+	{ "gre", 47, },
+	{ "mhrp", 48, },
+	{ "bna", 49, },
+	{ "sipp-esp", 50, },
+	{ "sipp-ah", 51, },
+	{ "i-nlsp", 52, },
+	{ "swipe", 53, },
+	{ "nhrp", 54, },
+	{ "icmp6", 58, },
+	{ "any", 61, },
+	{ "cftp", 62, },
+	{ "any", 63, },
+	{ "sat-expak", 64, },
+	{ "kryptolan", 65, },
+	{ "rvd", 66, },
+	{ "ippc", 67, },
+	{ "any", 68, },
+	{ "sat-mon", 69, },
+	{ "visa", 70, },
+	{ "ipcv", 71, },
+	{ "cpnx", 72, },
+	{ "cphb", 73, },
+	{ "wsn", 74, },
+	{ "pvp", 75, },
+	{ "br-sat-mon", 76, },
+	{ "sun-nd", 77, },
+	{ "wb-mon", 78, },
+	{ "wb-expak", 79, },
+	{ "iso-ip", 80, },
+	{ "vmtp", 81, },
+	{ "secure-vmtp", 82, },
+	{ "vines", 83, },
+	{ "ttp", 84, },
+	{ "nsfnet-igp", 85, },
+	{ "dgp", 86, },
+	{ "tcf", 87, },
+	{ "igrp", 88, },
+	{ "ospf", 89, },
+	{ "sprite-rpc", 90, },
+	{ "larp", 91, },
+	{ "mtp", 92, },
+	{ "ax.25", 93, },
+	{ "ipip", 94, },
+	{ "micp", 95, },
+	{ "scc-sp", 96, },
+	{ "etherip", 97, },
+	{ "encap", 98, },
+	{ "any", 99, },
+	{ "gmtp", 100, },
+	{ "rudp", 254, },
+	{ 0 }
+};
+
+enum
+{
+	Os,	// source
+	Od,	// destination
+	Osd,	// source or destination
+	Ot,	// type
+};
+
+static Field p_fields[] = 
+{
+	{"s",	Fv6ip,	Os,	"source address",	} ,
+	{"d",	Fv6ip,	Od,	"destination address",	} ,
+	{"a",	Fv6ip,	Osd,	"source|destination address",} ,
+	{"t",	Fnum,	Ot,	"sub protocol number",	} ,
+	{0}
+};
+
+static void
+p_compile(Filter *f)
+{
+	Mux *m;
+
+	if(f->op == '='){
+		compile_cmp(ip6.name, f, p_fields);
+		return;
+	}
+	for(m = p_mux; m->name != nil; m++)
+		if(strcmp(f->s, m->name) == 0){
+			f->pr = m->pr;
+			f->ulv = m->val;
+			f->subop = Ot;
+			return;
+		}
+	sysfatal("unknown ip6 field or protocol: %s", f->s);
+}
+
+static int
+v6hdrlen(Hdr *h)
+{
+	int plen, len = IP6HDR;
+	int pktlen = IP6HDR + NetS(h->length);
+	uchar nexthdr = h->proto;
+	uchar *pkt = (uchar*) h;
+	
+	pkt += len;
+	plen = len;
+
+	while ( (nexthdr == HBH_HDR) || (nexthdr == ROUT_HDR) ||
+		(nexthdr == FRAG_HDR) || (nexthdr == DEST_HDR) ) {
+
+		if (nexthdr == FRAG_HDR)
+			len = FRAG_HSZ;
+		else 
+			len = ( ((int) *(pkt+1)) + 1) * 8;
+
+		if (plen + len > pktlen)
+			return -1;
+
+		pkt += len;
+		nexthdr = *pkt;
+		plen += len;
+	}
+	return plen;
+}
+
+static int
+p_filter(Filter *f, Msg *m)
+{
+	Hdr *h;
+	int hlen;
+
+	if(m->pe - m->ps < IP6HDR)
+		return 0;
+
+	h = (Hdr*)m->ps;
+
+	if ((hlen = v6hdrlen(h)) < 0)
+		return 0;
+	else
+		m->ps += hlen;
+	switch(f->subop){
+	case Os:
+		return !memcmp(h->src, f->a, IPaddrlen);
+	case Od:
+		return !memcmp(h->dst, f->a, IPaddrlen);
+	case Osd:
+		return !memcmp(h->src, f->a, IPaddrlen) || !memcmp(h->dst, f->a, IPaddrlen);
+	case Ot:
+		return h->proto == f->ulv;
+	}
+	return 0;
+}
+
+static int
+v6hdr_seprint(Msg *m)
+{
+	int len = IP6HDR;
+	uchar *pkt = m->ps;
+	Hdr *h = (Hdr *) pkt;
+	int pktlen = IP6HDR + NetS(h->length);
+	uchar nexthdr = h->proto;
+	int plen;
+	
+	pkt += len;
+	plen = len;
+
+	while ( (nexthdr == HBH_HDR) || (nexthdr == ROUT_HDR) ||
+		(nexthdr == FRAG_HDR) || (nexthdr == DEST_HDR) ) {
+
+		switch (nexthdr) {
+		case FRAG_HDR:
+			m->p = seprint(m->p, m->e, "\n	  xthdr=frag id=%d offset=%d pr=%d more=%d res1=%d res2=%d",
+					NetL(pkt+4),
+					NetS(pkt+2) & ~7,
+					(int) (*pkt),
+					(int) (*(pkt+3) & 0x1),
+					(int) *(pkt+1),
+					(int) (*(pkt+3) & 0x6)
+				);
+			len = FRAG_HSZ;
+			break;
+
+		case HBH_HDR:
+		case ROUT_HDR:
+		case DEST_HDR:
+			len = ( ((int) *(pkt+1)) + 1) * 8;
+			break;
+		}
+
+		if (plen + len > pktlen) {
+			m->p = seprint(m->p, m->e, "bad pkt");
+			m->pr = &dump;
+			return -1;
+		}
+		plen += len;
+		pkt += len;
+		nexthdr = *pkt;
+	}
+
+	m->ps = pkt;
+	return 1;
+
+}
+
+static int
+p_seprint(Msg *m)
+{
+	Hdr *h;
+	int len;
+
+	if(m->pe - m->ps < IP6HDR)
+		return -1;
+	h = (Hdr*)m->ps;
+
+	demux(p_mux, h->proto, h->proto, m, &dump);
+
+	/* truncate the message if there's extra */
+	len = NetS(h->length) + IP6HDR;
+	if(len < m->pe - m->ps)
+		m->pe = m->ps + len;
+
+	m->p = seprint(m->p, m->e, "s=%I d=%I ttl=%3d pr=%d ln=%d",
+			h->src, h->dst,
+			h->ttl,
+			h->proto,
+			NetS(h->length)
+			);
+
+	v6hdr_seprint(m);
+
+	return 0;
+}
+
+Proto ip6 =
+{
+	"ip6",
+	p_compile,
+	p_filter,
+	p_seprint,
+	p_mux,
+	p_fields,
+	defaultframer,
+};