570 lines
14 KiB
C
570 lines
14 KiB
C
/* $NetBSD: print-udp.c,v 1.11 1999/07/02 11:31:37 itojun Exp $ */
|
|
|
|
/*
|
|
* 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
|
|
* 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.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
#ifndef lint
|
|
#if 0
|
|
static const char rcsid[] =
|
|
"@(#) Header: print-udp.c,v 1.60 97/07/27 21:58:48 leres Exp (LBL)";
|
|
#else
|
|
__RCSID("$NetBSD: print-udp.c,v 1.11 1999/07/02 11:31:37 itojun Exp $");
|
|
#endif
|
|
#endif
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/time.h>
|
|
#include <sys/socket.h>
|
|
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_systm.h>
|
|
#include <netinet/ip.h>
|
|
#include <netinet/ip_var.h>
|
|
#include <netinet/udp.h>
|
|
#include <netinet/udp_var.h>
|
|
|
|
#ifdef NOERROR
|
|
#undef NOERROR /* Solaris sucks */
|
|
#endif
|
|
#ifdef T_UNSPEC
|
|
#undef T_UNSPEC /* SINIX does too */
|
|
#endif
|
|
#include <arpa/nameser.h>
|
|
#ifdef SEGSIZE
|
|
#undef SEGSIZE
|
|
#endif
|
|
#include <arpa/tftp.h>
|
|
|
|
#include <rpc/rpc.h>
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#ifdef INET6
|
|
#include <netinet/ip6.h>
|
|
#endif
|
|
|
|
#include "interface.h"
|
|
#include "addrtoname.h"
|
|
#include "appletalk.h"
|
|
|
|
#include "nfs.h"
|
|
#include "bootp.h"
|
|
|
|
struct rtcphdr {
|
|
u_short rh_flags; /* T:2 P:1 CNT:5 PT:8 */
|
|
u_short rh_len; /* length of message (in words) */
|
|
u_int rh_ssrc; /* synchronization src id */
|
|
};
|
|
|
|
typedef struct {
|
|
u_int upper; /* more significant 32 bits */
|
|
u_int lower; /* less significant 32 bits */
|
|
} ntp64;
|
|
|
|
/*
|
|
* Sender report.
|
|
*/
|
|
struct rtcp_sr {
|
|
ntp64 sr_ntp; /* 64-bit ntp timestamp */
|
|
u_int sr_ts; /* reference media timestamp */
|
|
u_int sr_np; /* no. packets sent */
|
|
u_int sr_nb; /* no. bytes sent */
|
|
};
|
|
|
|
/*
|
|
* Receiver report.
|
|
* Time stamps are middle 32-bits of ntp timestamp.
|
|
*/
|
|
struct rtcp_rr {
|
|
u_int rr_srcid; /* sender being reported */
|
|
u_int rr_nl; /* no. packets lost */
|
|
u_int rr_ls; /* extended last seq number received */
|
|
u_int rr_dv; /* jitter (delay variance) */
|
|
u_int rr_lsr; /* orig. ts from last rr from this src */
|
|
u_int rr_dlsr; /* time from recpt of last rr to xmit time */
|
|
};
|
|
|
|
/*XXX*/
|
|
#define RTCP_PT_SR 200
|
|
#define RTCP_PT_RR 201
|
|
#define RTCP_PT_SDES 202
|
|
#define RTCP_SDES_CNAME 1
|
|
#define RTCP_SDES_NAME 2
|
|
#define RTCP_SDES_EMAIL 3
|
|
#define RTCP_SDES_PHONE 4
|
|
#define RTCP_SDES_LOC 5
|
|
#define RTCP_SDES_TOOL 6
|
|
#define RTCP_SDES_NOTE 7
|
|
#define RTCP_SDES_PRIV 8
|
|
#define RTCP_PT_BYE 203
|
|
#define RTCP_PT_APP 204
|
|
|
|
static void
|
|
vat_print(const void *hdr, u_int len, register const struct udphdr *up)
|
|
{
|
|
/* vat/vt audio */
|
|
u_int ts = *(u_short *)hdr;
|
|
if ((ts & 0xf060) != 0) {
|
|
/* probably vt */
|
|
(void)printf(" udp/vt %u %d / %d",
|
|
(u_int32_t)(ntohs(up->uh_ulen) - sizeof(*up)),
|
|
ts & 0x3ff, ts >> 10);
|
|
} else {
|
|
/* probably vat */
|
|
u_int i0 = ntohl(((u_int *)hdr)[0]);
|
|
u_int i1 = ntohl(((u_int *)hdr)[1]);
|
|
printf(" udp/vat %u c%d %u%s",
|
|
(u_int32_t)(ntohs(up->uh_ulen) - sizeof(*up) - 8),
|
|
i0 & 0xffff,
|
|
i1, i0 & 0x800000? "*" : "");
|
|
/* audio format */
|
|
if (i0 & 0x1f0000)
|
|
printf(" f%d", (i0 >> 16) & 0x1f);
|
|
if (i0 & 0x3f000000)
|
|
printf(" s%d", (i0 >> 24) & 0x3f);
|
|
}
|
|
}
|
|
|
|
static void
|
|
rtp_print(const void *hdr, u_int len, register const struct udphdr *up)
|
|
{
|
|
/* rtp v1 or v2 */
|
|
u_int *ip = (u_int *)hdr;
|
|
u_int hasopt, hasext, contype, hasmarker;
|
|
u_int i0 = ntohl(((u_int *)hdr)[0]);
|
|
u_int i1 = ntohl(((u_int *)hdr)[1]);
|
|
u_int dlen = ntohs(up->uh_ulen) - sizeof(*up) - 8;
|
|
const char * ptype;
|
|
|
|
ip += 2;
|
|
len >>= 2;
|
|
len -= 2;
|
|
hasopt = 0;
|
|
hasext = 0;
|
|
if ((i0 >> 30) == 1) {
|
|
/* rtp v1 */
|
|
hasopt = i0 & 0x800000;
|
|
contype = (i0 >> 16) & 0x3f;
|
|
hasmarker = i0 & 0x400000;
|
|
ptype = "rtpv1";
|
|
} else {
|
|
/* rtp v2 */
|
|
hasext = i0 & 0x10000000;
|
|
contype = (i0 >> 16) & 0x7f;
|
|
hasmarker = i0 & 0x800000;
|
|
dlen -= 4;
|
|
ptype = "rtp";
|
|
ip += 1;
|
|
len -= 1;
|
|
}
|
|
printf(" udp/%s %d c%d %s%s %d %u",
|
|
ptype,
|
|
dlen,
|
|
contype,
|
|
(hasopt || hasext)? "+" : "",
|
|
hasmarker? "*" : "",
|
|
i0 & 0xffff,
|
|
i1);
|
|
if (vflag) {
|
|
printf(" %u", i1);
|
|
if (hasopt) {
|
|
u_int i2, optlen;
|
|
do {
|
|
i2 = ip[0];
|
|
optlen = (i2 >> 16) & 0xff;
|
|
if (optlen == 0 || optlen > len) {
|
|
printf(" !opt");
|
|
return;
|
|
}
|
|
ip += optlen;
|
|
len -= optlen;
|
|
} while ((int)i2 >= 0);
|
|
}
|
|
if (hasext) {
|
|
u_int i2, extlen;
|
|
i2 = ip[0];
|
|
extlen = (i2 & 0xffff) + 1;
|
|
if (extlen > len) {
|
|
printf(" !ext");
|
|
return;
|
|
}
|
|
ip += extlen;
|
|
}
|
|
if (contype == 0x1f) /*XXX H.261 */
|
|
printf(" 0x%04x", ip[0] >> 16);
|
|
}
|
|
}
|
|
|
|
static const u_char *
|
|
rtcp_print(const u_char *hdr, const u_char *ep)
|
|
{
|
|
/* rtp v2 control (rtcp) */
|
|
struct rtcp_rr *rr = 0;
|
|
struct rtcp_sr *sr;
|
|
struct rtcphdr *rh = (struct rtcphdr *)hdr;
|
|
u_int len;
|
|
u_short flags;
|
|
int cnt;
|
|
double ts, dts;
|
|
if ((u_char *)(rh + 1) > ep) {
|
|
printf(" [|rtcp]");
|
|
return (ep);
|
|
}
|
|
len = (ntohs(rh->rh_len) + 1) * 4;
|
|
flags = ntohs(rh->rh_flags);
|
|
cnt = (flags >> 8) & 0x1f;
|
|
switch (flags & 0xff) {
|
|
case RTCP_PT_SR:
|
|
sr = (struct rtcp_sr *)(rh + 1);
|
|
printf(" sr");
|
|
if (len != cnt * sizeof(*rr) + sizeof(*sr) + sizeof(*rh))
|
|
printf(" [%d]", len);
|
|
if (vflag)
|
|
printf(" %u", (u_int32_t)ntohl(rh->rh_ssrc));
|
|
if ((u_char *)(sr + 1) > ep) {
|
|
printf(" [|rtcp]");
|
|
return (ep);
|
|
}
|
|
ts = (double)((u_int32_t)ntohl(sr->sr_ntp.upper)) +
|
|
((double)((u_int32_t)ntohl(sr->sr_ntp.lower)) /
|
|
4294967296.0);
|
|
printf(" @%.2f %u %up %ub", ts, (u_int32_t)ntohl(sr->sr_ts),
|
|
(u_int32_t)ntohl(sr->sr_np), (u_int32_t)ntohl(sr->sr_nb));
|
|
rr = (struct rtcp_rr *)(sr + 1);
|
|
break;
|
|
case RTCP_PT_RR:
|
|
printf(" rr");
|
|
if (len != cnt * sizeof(*rr) + sizeof(*rh))
|
|
printf(" [%d]", len);
|
|
rr = (struct rtcp_rr *)(rh + 1);
|
|
if (vflag)
|
|
printf(" %u", (u_int32_t)ntohl(rh->rh_ssrc));
|
|
break;
|
|
case RTCP_PT_SDES:
|
|
printf(" sdes %d", len);
|
|
if (vflag)
|
|
printf(" %u", (u_int32_t)ntohl(rh->rh_ssrc));
|
|
cnt = 0;
|
|
break;
|
|
case RTCP_PT_BYE:
|
|
printf(" bye %d", len);
|
|
if (vflag)
|
|
printf(" %u", (u_int32_t)ntohl(rh->rh_ssrc));
|
|
cnt = 0;
|
|
break;
|
|
default:
|
|
printf(" type-0x%x %d", flags & 0xff, len);
|
|
cnt = 0;
|
|
break;
|
|
}
|
|
if (cnt > 1)
|
|
printf(" c%d", cnt);
|
|
while (--cnt >= 0) {
|
|
if ((u_char *)(rr + 1) > ep) {
|
|
printf(" [|rtcp]");
|
|
return (ep);
|
|
}
|
|
if (vflag)
|
|
printf(" %u", (u_int32_t)ntohl(rr->rr_srcid));
|
|
ts = (double)((u_int32_t)ntohl(rr->rr_lsr)) / 65536.;
|
|
dts = (double)((u_int32_t)ntohl(rr->rr_dlsr)) / 65536.;
|
|
printf(" %ul %us %uj @%.2f+%.2f",
|
|
(u_int32_t)ntohl(rr->rr_nl) & 0x00ffffff,
|
|
(u_int32_t)ntohl(rr->rr_ls),
|
|
(u_int32_t)ntohl(rr->rr_dv), ts, dts);
|
|
}
|
|
return (hdr + len);
|
|
}
|
|
|
|
static int udp_cksum(register const struct ip *ip,
|
|
register const struct udphdr *up,
|
|
register int len)
|
|
{
|
|
int i, tlen;
|
|
union phu {
|
|
struct phdr {
|
|
u_int32_t src;
|
|
u_int32_t dst;
|
|
u_char mbz;
|
|
u_char proto;
|
|
u_int16_t len;
|
|
} ph;
|
|
u_int16_t pa[6];
|
|
} phu;
|
|
register const u_int16_t *sp;
|
|
u_int32_t sum;
|
|
tlen = ntohs(ip->ip_len) - ((const char *)up-(const char*)ip);
|
|
|
|
/* pseudo-header.. */
|
|
phu.ph.len = htons(tlen);
|
|
phu.ph.mbz = 0;
|
|
phu.ph.proto = ip->ip_p;
|
|
memcpy(&phu.ph.src, &ip->ip_src.s_addr, sizeof(u_int32_t));
|
|
memcpy(&phu.ph.dst, &ip->ip_dst.s_addr, sizeof(u_int32_t));
|
|
|
|
sp = &phu.pa[0];
|
|
sum = sp[0]+sp[1]+sp[2]+sp[3]+sp[4]+sp[5];
|
|
|
|
sp = (const u_int16_t *)up;
|
|
|
|
for (i=0; i<(tlen&~1); i+= 2)
|
|
sum += *sp++;
|
|
|
|
if (tlen & 1) {
|
|
sum += htons( (*(const char *)sp) << 8);
|
|
}
|
|
|
|
while (sum > 0xffff)
|
|
sum = (sum & 0xffff) + (sum >> 16);
|
|
sum = ~sum & 0xffff;
|
|
|
|
return (sum);
|
|
}
|
|
|
|
|
|
|
|
/* XXX probably should use getservbyname() and cache answers */
|
|
#define TFTP_PORT 69 /*XXX*/
|
|
#define KERBEROS_PORT 88 /*XXX*/
|
|
#define SUNRPC_PORT 111 /*XXX*/
|
|
#define SNMP_PORT 161 /*XXX*/
|
|
#define NTP_PORT 123 /*XXX*/
|
|
#define SNMPTRAP_PORT 162 /*XXX*/
|
|
#define ISAKMP_PORT 500 /*XXX*/
|
|
#define RIP_PORT 520 /*XXX*/
|
|
#define KERBEROS_SEC_PORT 750 /*XXX*/
|
|
|
|
#ifdef INET6
|
|
#define RIPNG_PORT 521 /*XXX*/
|
|
#endif
|
|
|
|
void
|
|
udp_print(register const u_char *bp, u_int length, register const u_char *bp2)
|
|
{
|
|
register const struct udphdr *up;
|
|
register const struct ip *ip;
|
|
register const u_char *cp;
|
|
register const u_char *ep = bp + length;
|
|
u_int16_t sport, dport, ulen;
|
|
#ifdef INET6
|
|
register const struct ip6_hdr *ip6;
|
|
#endif
|
|
|
|
if (ep > snapend)
|
|
ep = snapend;
|
|
up = (struct udphdr *)bp;
|
|
ip = (struct ip *)bp2;
|
|
#ifdef INET6
|
|
if (ip->ip_v == 6)
|
|
ip6 = (struct ip6_hdr *)bp2;
|
|
else
|
|
ip6 = NULL;
|
|
#endif /*INET6*/
|
|
cp = (u_char *)(up + 1);
|
|
if (cp > snapend) {
|
|
printf("[|udp]");
|
|
return;
|
|
}
|
|
if (length < sizeof(struct udphdr)) {
|
|
(void)printf(" truncated-udp %d", length);
|
|
return;
|
|
}
|
|
length -= sizeof(struct udphdr);
|
|
|
|
sport = ntohs(up->uh_sport);
|
|
dport = ntohs(up->uh_dport);
|
|
ulen = ntohs(up->uh_ulen);
|
|
if (packettype) {
|
|
register struct rpc_msg *rp;
|
|
enum msg_type direction;
|
|
|
|
switch (packettype) {
|
|
|
|
case PT_VAT:
|
|
(void)printf("%s.%s > %s.%s:",
|
|
ipaddr_string(&ip->ip_src),
|
|
udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst),
|
|
udpport_string(dport));
|
|
vat_print((void *)(up + 1), length, up);
|
|
break;
|
|
|
|
case PT_WB:
|
|
(void)printf("%s.%s > %s.%s:",
|
|
ipaddr_string(&ip->ip_src),
|
|
udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst),
|
|
udpport_string(dport));
|
|
wb_print((void *)(up + 1), length);
|
|
break;
|
|
|
|
case PT_RPC:
|
|
rp = (struct rpc_msg *)(up + 1);
|
|
direction = (enum msg_type)ntohl(rp->rm_direction);
|
|
if (direction == CALL)
|
|
sunrpcrequest_print((u_char *)rp, length,
|
|
(u_char *)ip);
|
|
else
|
|
nfsreply_print((u_char *)rp, length,
|
|
(u_char *)ip); /*XXX*/
|
|
break;
|
|
|
|
case PT_RTP:
|
|
(void)printf("%s.%s > %s.%s:",
|
|
ipaddr_string(&ip->ip_src),
|
|
udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst),
|
|
udpport_string(dport));
|
|
rtp_print((void *)(up + 1), length, up);
|
|
break;
|
|
|
|
case PT_RTCP:
|
|
(void)printf("%s.%s > %s.%s:",
|
|
ipaddr_string(&ip->ip_src),
|
|
udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst),
|
|
udpport_string(dport));
|
|
while (cp < ep)
|
|
cp = rtcp_print(cp, ep);
|
|
break;
|
|
}
|
|
return;
|
|
}
|
|
|
|
if (!qflag) {
|
|
register struct rpc_msg *rp;
|
|
enum msg_type direction;
|
|
|
|
rp = (struct rpc_msg *)(up + 1);
|
|
if (TTEST(rp->rm_direction)) {
|
|
direction = (enum msg_type)ntohl(rp->rm_direction);
|
|
if (dport == NFS_PORT && direction == CALL) {
|
|
nfsreq_print((u_char *)rp, length,
|
|
(u_char *)ip);
|
|
return;
|
|
}
|
|
if (sport == NFS_PORT && direction == REPLY) {
|
|
nfsreply_print((u_char *)rp, length,
|
|
(u_char *)ip);
|
|
return;
|
|
}
|
|
#ifdef notdef
|
|
if (dport == SUNRPC_PORT && direction == CALL) {
|
|
sunrpcrequest_print((u_char *)rp, length, (u_char *)ip);
|
|
return;
|
|
}
|
|
#endif
|
|
}
|
|
if (TTEST(((struct LAP *)cp)->type) &&
|
|
((struct LAP *)cp)->type == lapDDP &&
|
|
(atalk_port(sport) || atalk_port(dport))) {
|
|
if (vflag)
|
|
fputs("kip ", stdout);
|
|
llap_print(cp, length);
|
|
return;
|
|
}
|
|
}
|
|
#if 0
|
|
(void)printf("%s.%s > %s.%s:",
|
|
ipaddr_string(&ip->ip_src), udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst), udpport_string(dport));
|
|
#else
|
|
#ifdef INET6
|
|
if (ip6) {
|
|
if (bp == (u_char *)(ip6 + 1)) {
|
|
(void)printf("%s.%s > %s.%s: ",
|
|
ip6addr_string(&ip6->ip6_src),
|
|
udpport_string(sport),
|
|
ip6addr_string(&ip6->ip6_dst),
|
|
udpport_string(dport));
|
|
} else {
|
|
(void)printf("%s > %s: ",
|
|
udpport_string(sport), udpport_string(dport));
|
|
}
|
|
} else
|
|
#endif /*INET6*/
|
|
{
|
|
if (bp == (u_char *)(ip + 1)) {
|
|
(void)printf("%s.%s > %s.%s: ",
|
|
ipaddr_string(&ip->ip_src),
|
|
udpport_string(sport),
|
|
ipaddr_string(&ip->ip_dst),
|
|
udpport_string(dport));
|
|
} else {
|
|
(void)printf("%s > %s: ",
|
|
udpport_string(sport), udpport_string(dport));
|
|
}
|
|
}
|
|
#endif
|
|
|
|
if (ip && vflag) {
|
|
int sum = up->uh_sum;
|
|
if (sum == 0) {
|
|
(void)printf(" [no cksum]");
|
|
} else if (TTEST2(cp[0], length)) {
|
|
sum = udp_cksum(ip, up, length);
|
|
if (sum != 0)
|
|
(void)printf(" [bad udp cksum %x!]", sum);
|
|
else
|
|
(void)printf(" [udp sum ok]");
|
|
}
|
|
}
|
|
|
|
if (!qflag) {
|
|
#define ISPORT(p) (dport == (p) || sport == (p))
|
|
if (ISPORT(NAMESERVER_PORT))
|
|
ns_print((const u_char *)(up + 1), length);
|
|
else if (ISPORT(TFTP_PORT))
|
|
tftp_print((const u_char *)(up + 1), length);
|
|
else if (ISPORT(IPPORT_BOOTPC) || ISPORT(IPPORT_BOOTPS))
|
|
bootp_print((const u_char *)(up + 1), length,
|
|
sport, dport);
|
|
else if (ISPORT(RIP_PORT))
|
|
rip_print((const u_char *)(up + 1), length);
|
|
else if (ISPORT(ISAKMP_PORT))
|
|
isakmp_print((const u_char *)(up + 1), length, bp2);
|
|
else if (ISPORT(SNMP_PORT) || ISPORT(SNMPTRAP_PORT))
|
|
snmp_print((const u_char *)(up + 1), length);
|
|
else if (ISPORT(NTP_PORT))
|
|
ntp_print((const u_char *)(up + 1), length);
|
|
else if (ISPORT(KERBEROS_PORT) || ISPORT(KERBEROS_SEC_PORT))
|
|
krb_print((const void *)(up + 1), length);
|
|
else if (dport == 3456)
|
|
vat_print((const void *)(up + 1), length, up);
|
|
#ifdef INET6
|
|
else if (ISPORT(RIPNG_PORT))
|
|
ripng_print((const u_char *)(up + 1), length);
|
|
#endif /*INET6*/
|
|
/*
|
|
* Kludge in test for whiteboard packets.
|
|
*/
|
|
else if (dport == 4567)
|
|
wb_print((const void *)(up + 1), length);
|
|
else
|
|
(void)printf(" udp %u",
|
|
(u_int32_t)(ulen - sizeof(*up)));
|
|
#undef ISPORT
|
|
} else
|
|
(void)printf(" udp %u", (u_int32_t)(ulen - sizeof(*up)));
|
|
}
|