1*d56f51eaSDavid van Moolenbroek /* $NetBSD: capturetest.c,v 1.2 2014/11/19 19:33:31 christos Exp $ */
2*d56f51eaSDavid van Moolenbroek
3*d56f51eaSDavid van Moolenbroek /*
4*d56f51eaSDavid van Moolenbroek * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997, 2000
5*d56f51eaSDavid van Moolenbroek * The Regents of the University of California. All rights reserved.
6*d56f51eaSDavid van Moolenbroek *
7*d56f51eaSDavid van Moolenbroek * Redistribution and use in source and binary forms, with or without
8*d56f51eaSDavid van Moolenbroek * modification, are permitted provided that: (1) source code distributions
9*d56f51eaSDavid van Moolenbroek * retain the above copyright notice and this paragraph in its entirety, (2)
10*d56f51eaSDavid van Moolenbroek * distributions including binary code include the above copyright notice and
11*d56f51eaSDavid van Moolenbroek * this paragraph in its entirety in the documentation or other materials
12*d56f51eaSDavid van Moolenbroek * provided with the distribution, and (3) all advertising materials mentioning
13*d56f51eaSDavid van Moolenbroek * features or use of this software display the following acknowledgement:
14*d56f51eaSDavid van Moolenbroek * ``This product includes software developed by the University of California,
15*d56f51eaSDavid van Moolenbroek * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
16*d56f51eaSDavid van Moolenbroek * the University nor the names of its contributors may be used to endorse
17*d56f51eaSDavid van Moolenbroek * or promote products derived from this software without specific prior
18*d56f51eaSDavid van Moolenbroek * written permission.
19*d56f51eaSDavid van Moolenbroek * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
20*d56f51eaSDavid van Moolenbroek * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
21*d56f51eaSDavid van Moolenbroek * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
22*d56f51eaSDavid van Moolenbroek */
23*d56f51eaSDavid van Moolenbroek
24*d56f51eaSDavid van Moolenbroek #include <sys/cdefs.h>
25*d56f51eaSDavid van Moolenbroek __RCSID("$NetBSD: capturetest.c,v 1.2 2014/11/19 19:33:31 christos Exp $");
26*d56f51eaSDavid van Moolenbroek
27*d56f51eaSDavid van Moolenbroek #ifndef lint
28*d56f51eaSDavid van Moolenbroek static const char copyright[] =
29*d56f51eaSDavid van Moolenbroek "@(#) Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997, 2000\n\
30*d56f51eaSDavid van Moolenbroek The Regents of the University of California. All rights reserved.\n";
31*d56f51eaSDavid van Moolenbroek #endif
32*d56f51eaSDavid van Moolenbroek
33*d56f51eaSDavid van Moolenbroek #include <stdio.h>
34*d56f51eaSDavid van Moolenbroek #include <stdlib.h>
35*d56f51eaSDavid van Moolenbroek #include <string.h>
36*d56f51eaSDavid van Moolenbroek #include <stdarg.h>
37*d56f51eaSDavid van Moolenbroek #include <limits.h>
38*d56f51eaSDavid van Moolenbroek #include <unistd.h>
39*d56f51eaSDavid van Moolenbroek #include <errno.h>
40*d56f51eaSDavid van Moolenbroek #include <sys/types.h>
41*d56f51eaSDavid van Moolenbroek #include <sys/select.h>
42*d56f51eaSDavid van Moolenbroek #include <poll.h>
43*d56f51eaSDavid van Moolenbroek
44*d56f51eaSDavid van Moolenbroek #include <pcap.h>
45*d56f51eaSDavid van Moolenbroek
46*d56f51eaSDavid van Moolenbroek static char *program_name;
47*d56f51eaSDavid van Moolenbroek
48*d56f51eaSDavid van Moolenbroek /* Forwards */
49*d56f51eaSDavid van Moolenbroek static void countme(u_char *, const struct pcap_pkthdr *, const u_char *);
50*d56f51eaSDavid van Moolenbroek static void usage(void) __attribute__((noreturn));
51*d56f51eaSDavid van Moolenbroek static void error(const char *, ...);
52*d56f51eaSDavid van Moolenbroek static void warning(const char *, ...);
53*d56f51eaSDavid van Moolenbroek static char *copy_argv(char **);
54*d56f51eaSDavid van Moolenbroek
55*d56f51eaSDavid van Moolenbroek static pcap_t *pd;
56*d56f51eaSDavid van Moolenbroek
57*d56f51eaSDavid van Moolenbroek extern int optind;
58*d56f51eaSDavid van Moolenbroek extern int opterr;
59*d56f51eaSDavid van Moolenbroek extern char *optarg;
60*d56f51eaSDavid van Moolenbroek
61*d56f51eaSDavid van Moolenbroek int
main(int argc,char ** argv)62*d56f51eaSDavid van Moolenbroek main(int argc, char **argv)
63*d56f51eaSDavid van Moolenbroek {
64*d56f51eaSDavid van Moolenbroek register int op;
65*d56f51eaSDavid van Moolenbroek register char *cp, *cmdbuf, *device;
66*d56f51eaSDavid van Moolenbroek long longarg;
67*d56f51eaSDavid van Moolenbroek char *p;
68*d56f51eaSDavid van Moolenbroek int timeout = 1000;
69*d56f51eaSDavid van Moolenbroek int immediate = 0;
70*d56f51eaSDavid van Moolenbroek int nonblock = 0;
71*d56f51eaSDavid van Moolenbroek bpf_u_int32 localnet, netmask;
72*d56f51eaSDavid van Moolenbroek struct bpf_program fcode;
73*d56f51eaSDavid van Moolenbroek char ebuf[PCAP_ERRBUF_SIZE];
74*d56f51eaSDavid van Moolenbroek int status;
75*d56f51eaSDavid van Moolenbroek int packet_count;
76*d56f51eaSDavid van Moolenbroek
77*d56f51eaSDavid van Moolenbroek device = NULL;
78*d56f51eaSDavid van Moolenbroek if ((cp = strrchr(argv[0], '/')) != NULL)
79*d56f51eaSDavid van Moolenbroek program_name = cp + 1;
80*d56f51eaSDavid van Moolenbroek else
81*d56f51eaSDavid van Moolenbroek program_name = argv[0];
82*d56f51eaSDavid van Moolenbroek
83*d56f51eaSDavid van Moolenbroek opterr = 0;
84*d56f51eaSDavid van Moolenbroek while ((op = getopt(argc, argv, "i:mnt:")) != -1) {
85*d56f51eaSDavid van Moolenbroek switch (op) {
86*d56f51eaSDavid van Moolenbroek
87*d56f51eaSDavid van Moolenbroek case 'i':
88*d56f51eaSDavid van Moolenbroek device = optarg;
89*d56f51eaSDavid van Moolenbroek break;
90*d56f51eaSDavid van Moolenbroek
91*d56f51eaSDavid van Moolenbroek case 'm':
92*d56f51eaSDavid van Moolenbroek immediate = 1;
93*d56f51eaSDavid van Moolenbroek break;
94*d56f51eaSDavid van Moolenbroek
95*d56f51eaSDavid van Moolenbroek case 'n':
96*d56f51eaSDavid van Moolenbroek nonblock = 1;
97*d56f51eaSDavid van Moolenbroek break;
98*d56f51eaSDavid van Moolenbroek
99*d56f51eaSDavid van Moolenbroek case 't':
100*d56f51eaSDavid van Moolenbroek longarg = strtol(optarg, &p, 10);
101*d56f51eaSDavid van Moolenbroek if (p == optarg || *p != '\0') {
102*d56f51eaSDavid van Moolenbroek error("Timeout value \"%s\" is not a number",
103*d56f51eaSDavid van Moolenbroek optarg);
104*d56f51eaSDavid van Moolenbroek /* NOTREACHED */
105*d56f51eaSDavid van Moolenbroek }
106*d56f51eaSDavid van Moolenbroek if (longarg < 0) {
107*d56f51eaSDavid van Moolenbroek error("Timeout value %ld is negative", longarg);
108*d56f51eaSDavid van Moolenbroek /* NOTREACHED */
109*d56f51eaSDavid van Moolenbroek }
110*d56f51eaSDavid van Moolenbroek if (longarg > INT_MAX) {
111*d56f51eaSDavid van Moolenbroek error("Timeout value %ld is too large (> %d)",
112*d56f51eaSDavid van Moolenbroek longarg, INT_MAX);
113*d56f51eaSDavid van Moolenbroek /* NOTREACHED */
114*d56f51eaSDavid van Moolenbroek }
115*d56f51eaSDavid van Moolenbroek timeout = (int)longarg;
116*d56f51eaSDavid van Moolenbroek break;
117*d56f51eaSDavid van Moolenbroek
118*d56f51eaSDavid van Moolenbroek default:
119*d56f51eaSDavid van Moolenbroek usage();
120*d56f51eaSDavid van Moolenbroek /* NOTREACHED */
121*d56f51eaSDavid van Moolenbroek }
122*d56f51eaSDavid van Moolenbroek }
123*d56f51eaSDavid van Moolenbroek
124*d56f51eaSDavid van Moolenbroek if (device == NULL) {
125*d56f51eaSDavid van Moolenbroek device = pcap_lookupdev(ebuf);
126*d56f51eaSDavid van Moolenbroek if (device == NULL)
127*d56f51eaSDavid van Moolenbroek error("%s", ebuf);
128*d56f51eaSDavid van Moolenbroek }
129*d56f51eaSDavid van Moolenbroek *ebuf = '\0';
130*d56f51eaSDavid van Moolenbroek pd = pcap_create(device, ebuf);
131*d56f51eaSDavid van Moolenbroek if (pd == NULL)
132*d56f51eaSDavid van Moolenbroek error("%s", ebuf);
133*d56f51eaSDavid van Moolenbroek status = pcap_set_snaplen(pd, 65535);
134*d56f51eaSDavid van Moolenbroek if (status != 0)
135*d56f51eaSDavid van Moolenbroek error("%s: pcap_set_snaplen failed: %s",
136*d56f51eaSDavid van Moolenbroek device, pcap_statustostr(status));
137*d56f51eaSDavid van Moolenbroek if (immediate) {
138*d56f51eaSDavid van Moolenbroek status = pcap_set_immediate_mode(pd, 1);
139*d56f51eaSDavid van Moolenbroek if (status != 0)
140*d56f51eaSDavid van Moolenbroek error("%s: pcap_set_immediate_mode failed: %s",
141*d56f51eaSDavid van Moolenbroek device, pcap_statustostr(status));
142*d56f51eaSDavid van Moolenbroek }
143*d56f51eaSDavid van Moolenbroek status = pcap_set_timeout(pd, timeout);
144*d56f51eaSDavid van Moolenbroek if (status != 0)
145*d56f51eaSDavid van Moolenbroek error("%s: pcap_set_timeout failed: %s",
146*d56f51eaSDavid van Moolenbroek device, pcap_statustostr(status));
147*d56f51eaSDavid van Moolenbroek status = pcap_activate(pd);
148*d56f51eaSDavid van Moolenbroek if (status < 0) {
149*d56f51eaSDavid van Moolenbroek /*
150*d56f51eaSDavid van Moolenbroek * pcap_activate() failed.
151*d56f51eaSDavid van Moolenbroek */
152*d56f51eaSDavid van Moolenbroek error("%s: %s\n(%s)", device,
153*d56f51eaSDavid van Moolenbroek pcap_statustostr(status), pcap_geterr(pd));
154*d56f51eaSDavid van Moolenbroek } else if (status > 0) {
155*d56f51eaSDavid van Moolenbroek /*
156*d56f51eaSDavid van Moolenbroek * pcap_activate() succeeded, but it's warning us
157*d56f51eaSDavid van Moolenbroek * of a problem it had.
158*d56f51eaSDavid van Moolenbroek */
159*d56f51eaSDavid van Moolenbroek warning("%s: %s\n(%s)", device,
160*d56f51eaSDavid van Moolenbroek pcap_statustostr(status), pcap_geterr(pd));
161*d56f51eaSDavid van Moolenbroek }
162*d56f51eaSDavid van Moolenbroek if (pcap_lookupnet(device, &localnet, &netmask, ebuf) < 0) {
163*d56f51eaSDavid van Moolenbroek localnet = 0;
164*d56f51eaSDavid van Moolenbroek netmask = 0;
165*d56f51eaSDavid van Moolenbroek warning("%s", ebuf);
166*d56f51eaSDavid van Moolenbroek }
167*d56f51eaSDavid van Moolenbroek cmdbuf = copy_argv(&argv[optind]);
168*d56f51eaSDavid van Moolenbroek
169*d56f51eaSDavid van Moolenbroek if (pcap_compile(pd, &fcode, cmdbuf, 1, netmask) < 0)
170*d56f51eaSDavid van Moolenbroek error("%s", pcap_geterr(pd));
171*d56f51eaSDavid van Moolenbroek
172*d56f51eaSDavid van Moolenbroek if (pcap_setfilter(pd, &fcode) < 0)
173*d56f51eaSDavid van Moolenbroek error("%s", pcap_geterr(pd));
174*d56f51eaSDavid van Moolenbroek if (pcap_setnonblock(pd, nonblock, ebuf) == -1)
175*d56f51eaSDavid van Moolenbroek error("pcap_setnonblock failed: %s", ebuf);
176*d56f51eaSDavid van Moolenbroek printf("Listening on %s\n", device);
177*d56f51eaSDavid van Moolenbroek for (;;) {
178*d56f51eaSDavid van Moolenbroek packet_count = 0;
179*d56f51eaSDavid van Moolenbroek status = pcap_dispatch(pd, -1, countme,
180*d56f51eaSDavid van Moolenbroek (u_char *)&packet_count);
181*d56f51eaSDavid van Moolenbroek if (status < 0)
182*d56f51eaSDavid van Moolenbroek break;
183*d56f51eaSDavid van Moolenbroek if (status != 0) {
184*d56f51eaSDavid van Moolenbroek printf("%d packets seen, %d packets counted after pcap_dispatch returns\n",
185*d56f51eaSDavid van Moolenbroek status, packet_count);
186*d56f51eaSDavid van Moolenbroek }
187*d56f51eaSDavid van Moolenbroek }
188*d56f51eaSDavid van Moolenbroek if (status == -2) {
189*d56f51eaSDavid van Moolenbroek /*
190*d56f51eaSDavid van Moolenbroek * We got interrupted, so perhaps we didn't
191*d56f51eaSDavid van Moolenbroek * manage to finish a line we were printing.
192*d56f51eaSDavid van Moolenbroek * Print an extra newline, just in case.
193*d56f51eaSDavid van Moolenbroek */
194*d56f51eaSDavid van Moolenbroek putchar('\n');
195*d56f51eaSDavid van Moolenbroek }
196*d56f51eaSDavid van Moolenbroek (void)fflush(stdout);
197*d56f51eaSDavid van Moolenbroek if (status == -1) {
198*d56f51eaSDavid van Moolenbroek /*
199*d56f51eaSDavid van Moolenbroek * Error. Report it.
200*d56f51eaSDavid van Moolenbroek */
201*d56f51eaSDavid van Moolenbroek (void)fprintf(stderr, "%s: pcap_loop: %s\n",
202*d56f51eaSDavid van Moolenbroek program_name, pcap_geterr(pd));
203*d56f51eaSDavid van Moolenbroek }
204*d56f51eaSDavid van Moolenbroek pcap_close(pd);
205*d56f51eaSDavid van Moolenbroek exit(status == -1 ? 1 : 0);
206*d56f51eaSDavid van Moolenbroek }
207*d56f51eaSDavid van Moolenbroek
208*d56f51eaSDavid van Moolenbroek static void
countme(u_char * user,const struct pcap_pkthdr * h,const u_char * sp)209*d56f51eaSDavid van Moolenbroek countme(u_char *user, const struct pcap_pkthdr *h, const u_char *sp)
210*d56f51eaSDavid van Moolenbroek {
211*d56f51eaSDavid van Moolenbroek int *counterp = (int *)user;
212*d56f51eaSDavid van Moolenbroek
213*d56f51eaSDavid van Moolenbroek (*counterp)++;
214*d56f51eaSDavid van Moolenbroek }
215*d56f51eaSDavid van Moolenbroek
216*d56f51eaSDavid van Moolenbroek static void
usage(void)217*d56f51eaSDavid van Moolenbroek usage(void)
218*d56f51eaSDavid van Moolenbroek {
219*d56f51eaSDavid van Moolenbroek (void)fprintf(stderr, "Usage: %s [ -mn ] [ -i interface ] [ -t timeout] [expression]\n",
220*d56f51eaSDavid van Moolenbroek program_name);
221*d56f51eaSDavid van Moolenbroek exit(1);
222*d56f51eaSDavid van Moolenbroek }
223*d56f51eaSDavid van Moolenbroek
224*d56f51eaSDavid van Moolenbroek /* VARARGS */
225*d56f51eaSDavid van Moolenbroek static void
error(const char * fmt,...)226*d56f51eaSDavid van Moolenbroek error(const char *fmt, ...)
227*d56f51eaSDavid van Moolenbroek {
228*d56f51eaSDavid van Moolenbroek va_list ap;
229*d56f51eaSDavid van Moolenbroek
230*d56f51eaSDavid van Moolenbroek (void)fprintf(stderr, "%s: ", program_name);
231*d56f51eaSDavid van Moolenbroek va_start(ap, fmt);
232*d56f51eaSDavid van Moolenbroek (void)vfprintf(stderr, fmt, ap);
233*d56f51eaSDavid van Moolenbroek va_end(ap);
234*d56f51eaSDavid van Moolenbroek if (*fmt) {
235*d56f51eaSDavid van Moolenbroek fmt += strlen(fmt);
236*d56f51eaSDavid van Moolenbroek if (fmt[-1] != '\n')
237*d56f51eaSDavid van Moolenbroek (void)fputc('\n', stderr);
238*d56f51eaSDavid van Moolenbroek }
239*d56f51eaSDavid van Moolenbroek exit(1);
240*d56f51eaSDavid van Moolenbroek /* NOTREACHED */
241*d56f51eaSDavid van Moolenbroek }
242*d56f51eaSDavid van Moolenbroek
243*d56f51eaSDavid van Moolenbroek /* VARARGS */
244*d56f51eaSDavid van Moolenbroek static void
warning(const char * fmt,...)245*d56f51eaSDavid van Moolenbroek warning(const char *fmt, ...)
246*d56f51eaSDavid van Moolenbroek {
247*d56f51eaSDavid van Moolenbroek va_list ap;
248*d56f51eaSDavid van Moolenbroek
249*d56f51eaSDavid van Moolenbroek (void)fprintf(stderr, "%s: WARNING: ", program_name);
250*d56f51eaSDavid van Moolenbroek va_start(ap, fmt);
251*d56f51eaSDavid van Moolenbroek (void)vfprintf(stderr, fmt, ap);
252*d56f51eaSDavid van Moolenbroek va_end(ap);
253*d56f51eaSDavid van Moolenbroek if (*fmt) {
254*d56f51eaSDavid van Moolenbroek fmt += strlen(fmt);
255*d56f51eaSDavid van Moolenbroek if (fmt[-1] != '\n')
256*d56f51eaSDavid van Moolenbroek (void)fputc('\n', stderr);
257*d56f51eaSDavid van Moolenbroek }
258*d56f51eaSDavid van Moolenbroek }
259*d56f51eaSDavid van Moolenbroek
260*d56f51eaSDavid van Moolenbroek /*
261*d56f51eaSDavid van Moolenbroek * Copy arg vector into a new buffer, concatenating arguments with spaces.
262*d56f51eaSDavid van Moolenbroek */
263*d56f51eaSDavid van Moolenbroek static char *
copy_argv(register char ** argv)264*d56f51eaSDavid van Moolenbroek copy_argv(register char **argv)
265*d56f51eaSDavid van Moolenbroek {
266*d56f51eaSDavid van Moolenbroek register char **p;
267*d56f51eaSDavid van Moolenbroek register u_int len = 0;
268*d56f51eaSDavid van Moolenbroek char *buf;
269*d56f51eaSDavid van Moolenbroek char *src, *dst;
270*d56f51eaSDavid van Moolenbroek
271*d56f51eaSDavid van Moolenbroek p = argv;
272*d56f51eaSDavid van Moolenbroek if (*p == 0)
273*d56f51eaSDavid van Moolenbroek return 0;
274*d56f51eaSDavid van Moolenbroek
275*d56f51eaSDavid van Moolenbroek while (*p)
276*d56f51eaSDavid van Moolenbroek len += strlen(*p++) + 1;
277*d56f51eaSDavid van Moolenbroek
278*d56f51eaSDavid van Moolenbroek buf = (char *)malloc(len);
279*d56f51eaSDavid van Moolenbroek if (buf == NULL)
280*d56f51eaSDavid van Moolenbroek error("copy_argv: malloc");
281*d56f51eaSDavid van Moolenbroek
282*d56f51eaSDavid van Moolenbroek p = argv;
283*d56f51eaSDavid van Moolenbroek dst = buf;
284*d56f51eaSDavid van Moolenbroek while ((src = *p++) != NULL) {
285*d56f51eaSDavid van Moolenbroek while ((*dst++ = *src++) != '\0')
286*d56f51eaSDavid van Moolenbroek ;
287*d56f51eaSDavid van Moolenbroek dst[-1] = ' ';
288*d56f51eaSDavid van Moolenbroek }
289*d56f51eaSDavid van Moolenbroek dst[-1] = '\0';
290*d56f51eaSDavid van Moolenbroek
291*d56f51eaSDavid van Moolenbroek return buf;
292*d56f51eaSDavid van Moolenbroek }
293