summaryrefslogtreecommitdiffstats
path: root/usr.sbin
diff options
context:
space:
mode:
authorhselasky <hselasky@FreeBSD.org>2012-04-24 06:26:14 +0000
committerhselasky <hselasky@FreeBSD.org>2012-04-24 06:26:14 +0000
commite0380acdc0579432c3510160f574b350556f06c2 (patch)
treec70cb6c4ccf18efdfbdb3c17ee92777d3aa215c0 /usr.sbin
parent6ad6e5ad458430028d7210712b32b42a6a5bd27f (diff)
downloadFreeBSD-src-e0380acdc0579432c3510160f574b350556f06c2.zip
FreeBSD-src-e0380acdc0579432c3510160f574b350556f06c2.tar.gz
Improve support for USB packet filtering also when reading dumps, and
allow filtered data to be dumped to a binary file. MFC after: 1 week
Diffstat (limited to 'usr.sbin')
-rw-r--r--usr.sbin/usbdump/usbdump.89
-rw-r--r--usr.sbin/usbdump/usbdump.c107
2 files changed, 89 insertions, 27 deletions
diff --git a/usr.sbin/usbdump/usbdump.8 b/usr.sbin/usbdump/usbdump.8
index d95f4b9..eec13b8 100644
--- a/usr.sbin/usbdump/usbdump.8
+++ b/usr.sbin/usbdump/usbdump.8
@@ -25,7 +25,7 @@
.\"
.\" $FreeBSD$
.\"
-.Dd February 16, 2012
+.Dd April 24, 2012
.Dt USBDUMP 8
.Os
.Sh NAME
@@ -39,6 +39,7 @@
.Op Fl v
.Op Fl w Ar file
.Op Fl f Ar filter
+.Op Fl b Ar file
.Sh DESCRIPTION
The
.Nm
@@ -46,12 +47,17 @@ utility provides a way to dump USB packets on host controllers.
.Pp
The following options are accepted:
.Bl -tag -width ".Fl f Ar file"
+.It Fl b Ar file
+Store data part of the USB trace in binary format to the given
+.Ar file .
+This option also works with the -r and -f options.
.It Fl i Ar ifname
Listen on USB bus interface
.Ar ifname .
.It Fl r Ar file
Read the raw packets from
.Ar file .
+This option also works with the -f option.
.It Fl s Ar snaplen
Snapshot
.Ar snaplen
@@ -62,6 +68,7 @@ When defined multiple times the verbosity level increases.
.It Fl w Ar file
Write the raw packets to
.Ar file .
+This option also works with the -s and -v options.
.It Fl f Ar filter
The filter argument consists of either one or two numbers separated by a dot.
The first indicates the device unit number which should be traced.
diff --git a/usr.sbin/usbdump/usbdump.c b/usr.sbin/usbdump/usbdump.c
index b929da9..c26d831 100644
--- a/usr.sbin/usbdump/usbdump.c
+++ b/usr.sbin/usbdump/usbdump.c
@@ -82,6 +82,8 @@ struct usbcap {
int wfd;
/* for -r option */
int rfd;
+ /* for -b option */
+ int bfd;
};
struct usbcap_filehdr {
@@ -112,6 +114,8 @@ static int uf_minor;
static const char *i_arg = "usbus0";
static const char *r_arg = NULL;
static const char *w_arg = NULL;
+static const char *b_arg = NULL;
+static struct usbcap uc;
static const char *errstr_table[USB_ERR_MAX] = {
[USB_ERR_NORMAL_COMPLETION] = "0",
[USB_ERR_PENDING_REQUESTS] = "PENDING_REQUESTS",
@@ -255,6 +259,22 @@ done:
pprog->bf_insns = dynamic_insn;
}
+static int
+match_filter(int unit, int endpoint)
+{
+ struct usb_filt *puf;
+
+ if (STAILQ_FIRST(&usb_filt_head) == NULL)
+ return (1);
+
+ STAILQ_FOREACH(puf, &usb_filt_head, entry) {
+ if ((puf->unit == -1 || puf->unit == unit) &&
+ (puf->endpoint == -1 || puf->endpoint == endpoint))
+ return (1);
+ }
+ return (0);
+}
+
static void
free_filter(struct bpf_program *pprog)
{
@@ -462,28 +482,33 @@ print_apacket(const struct header_32 *hdr, const uint8_t *ptr, int ptr_len)
up->up_packet_count = le32toh(up->up_packet_count);
up->up_endpoint = le32toh(up->up_endpoint);
+ if (!match_filter(up->up_address, up->up_endpoint))
+ return;
+
tv.tv_sec = hdr->ts_sec;
tv.tv_usec = hdr->ts_usec;
tm = localtime(&tv.tv_sec);
len = strftime(buf, sizeof(buf), "%H:%M:%S", tm);
- printf("%.*s.%06ld usbus%d.%d %s-%s-EP=%08x,SPD=%s,NFR=%d,SLEN=%d,IVAL=%d%s%s\n",
- (int)len, buf, tv.tv_usec,
- (int)up->up_busunit, (int)up->up_address,
- (up->up_type == USBPF_XFERTAP_SUBMIT) ? "SUBM" : "DONE",
- xfertype_table[up->up_xfertype],
- (unsigned int)up->up_endpoint,
- usb_speedstr(up->up_speed),
- (int)up->up_frames,
- (int)(up->up_totlen - USBPF_HDR_LEN -
- (USBPF_FRAME_HDR_LEN * up->up_frames)),
- (int)up->up_interval,
- (up->up_type == USBPF_XFERTAP_DONE) ? ",ERR=" : "",
- (up->up_type == USBPF_XFERTAP_DONE) ?
- usb_errstr(up->up_error) : "");
-
- if (verbose >= 1) {
+ if (verbose >= 0) {
+ printf("%.*s.%06ld usbus%d.%d %s-%s-EP=%08x,SPD=%s,NFR=%d,SLEN=%d,IVAL=%d%s%s\n",
+ (int)len, buf, tv.tv_usec,
+ (int)up->up_busunit, (int)up->up_address,
+ (up->up_type == USBPF_XFERTAP_SUBMIT) ? "SUBM" : "DONE",
+ xfertype_table[up->up_xfertype],
+ (unsigned int)up->up_endpoint,
+ usb_speedstr(up->up_speed),
+ (int)up->up_frames,
+ (int)(up->up_totlen - USBPF_HDR_LEN -
+ (USBPF_FRAME_HDR_LEN * up->up_frames)),
+ (int)up->up_interval,
+ (up->up_type == USBPF_XFERTAP_DONE) ? ",ERR=" : "",
+ (up->up_type == USBPF_XFERTAP_DONE) ?
+ usb_errstr(up->up_error) : "");
+ }
+
+ if (verbose >= 1 || b_arg != NULL) {
for (x = 0; x != up->up_frames; x++) {
const struct usbpf_framehdr *uf;
uint32_t framelen;
@@ -498,10 +523,12 @@ print_apacket(const struct header_32 *hdr, const uint8_t *ptr, int ptr_len)
framelen = le32toh(uf->length);
flags = le32toh(uf->flags);
- printf(" frame[%u] %s %d bytes\n",
- (unsigned int)x,
- (flags & USBPF_FRAMEFLAG_READ) ? "READ" : "WRITE",
- (int)framelen);
+ if (verbose >= 1) {
+ printf(" frame[%u] %s %d bytes\n",
+ (unsigned int)x,
+ (flags & USBPF_FRAMEFLAG_READ) ? "READ" : "WRITE",
+ (int)framelen);
+ }
if (flags & USBPF_FRAMEFLAG_DATA_FOLLOWS) {
@@ -515,7 +542,15 @@ print_apacket(const struct header_32 *hdr, const uint8_t *ptr, int ptr_len)
(int)framelen < 0 || (int)ptr_len < 0)
break;
- hexdump(ptr, framelen);
+ if (b_arg != NULL) {
+ struct usbcap *p = &uc;
+ int ret;
+ ret = write(p->bfd, ptr, framelen);
+ if (ret != (int)framelen)
+ err(EXIT_FAILURE, "Could not write binary data");
+ }
+ if (verbose >= 1)
+ hexdump(ptr, framelen);
ptr += tot_frame_len;
}
@@ -592,7 +627,7 @@ print_packets(uint8_t *data, const int datalen)
if (next <= ptr)
err(EXIT_FAILURE, "Invalid length");
- if (w_arg == NULL || r_arg != NULL) {
+ if (verbose >= 0 || r_arg != NULL || b_arg != NULL) {
print_apacket(&temp, ptr +
temp.hdrlen, temp.caplen);
}
@@ -738,6 +773,7 @@ usage(void)
fprintf(stderr, FMT, "-r <file>", "Read the raw packets from file");
fprintf(stderr, FMT, "-s <snaplen>", "Snapshot bytes from each packet");
fprintf(stderr, FMT, "-v", "Increase the verbose level");
+ fprintf(stderr, FMT, "-b <file>", "Save raw version of all recorded data to file");
fprintf(stderr, FMT, "-w <file>", "Write the raw packets to file");
#undef FMT
exit(EX_USAGE);
@@ -750,7 +786,7 @@ main(int argc, char *argv[])
struct bpf_program total_prog;
struct bpf_stat us;
struct bpf_version bv;
- struct usbcap uc, *p = &uc;
+ struct usbcap *p = &uc;
struct ifreq ifr;
long snapshot = 192;
uint32_t v;
@@ -761,9 +797,7 @@ main(int argc, char *argv[])
const char *optstring;
char *pp;
- memset(&uc, 0, sizeof(struct usbcap));
-
- optstring = "i:r:s:vw:f:";
+ optstring = "b:i:r:s:vw:f:";
while ((o = getopt(argc, argv, optstring)) != -1) {
switch (o) {
case 'i':
@@ -784,6 +818,9 @@ main(int argc, char *argv[])
if (snapshot == 0)
snapshot = -1;
break;
+ case 'b':
+ b_arg = optarg;
+ break;
case 'v':
verbose++;
break;
@@ -811,6 +848,22 @@ main(int argc, char *argv[])
}
}
+ if (b_arg != NULL) {
+ p->bfd = open(b_arg, O_CREAT | O_TRUNC |
+ O_WRONLY, S_IRUSR | S_IWUSR);
+ if (p->bfd < 0) {
+ err(EXIT_FAILURE, "Could not open "
+ "'%s' for write", b_arg);
+ }
+ }
+
+ /*
+ * Require more verbosity to print anything when -w or -b is
+ * specified on the command line:
+ */
+ if (w_arg != NULL || b_arg != NULL)
+ verbose--;
+
if (r_arg != NULL) {
read_file(p);
exit(EXIT_SUCCESS);
@@ -882,6 +935,8 @@ main(int argc, char *argv[])
close(p->rfd);
if (p->wfd > 0)
close(p->wfd);
+ if (p->bfd > 0)
+ close(p->bfd);
return (EXIT_SUCCESS);
}
OpenPOWER on IntegriCloud