usbmon

commit 57a1b3850e65f37c2282177f6201439eefcb49a2
Author: Brian Swetland <swetland@frotz.net>
Date:   Wed, 26 Oct 2011 02:06:03 -0700

initial commit

Diffstat:
A
Makefile
 | 
6
++++++
A
usbmon.c
 | 
126
+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
A
usbmon.h
 | 
44
++++++++++++++++++++++++++++++++++++++++++++

3 files changed, 176 insertions(+), 0 deletions(-)
diff --git a/Makefile b/Makefile
@@ -0,0 +1,6 @@
+CFLAGS := -O2 -g -Wall
+
+usbmon: usbmon.o
+
+clean:
+	rm -f usbmon *.o
diff --git a/usbmon.c b/usbmon.c
@@ -0,0 +1,126 @@
+/* usbmon.c
+ *
+ * Copyright 2011 Brian Swetland <swetland@frotz.net>
+ * 
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <string.h>
+#include <errno.h>
+
+#include <sys/ioctl.h>
+#include <linux/ioctl.h>
+
+typedef unsigned long long u64;
+typedef signed long long s64;
+typedef int s32;
+typedef unsigned short u16;
+
+#include "usbmon.h"
+
+static char _xfer[4] = "SICB";
+
+int main(int argc, char **argv) 
+{
+	unsigned char data[4096];
+	struct usbmon_packet hdr;
+	struct usbmon_get arg;
+	unsigned char filter_dev[128];
+	int fd, r, n;
+
+	memset(filter_dev, 0, sizeof(filter_dev));
+
+	fd = open("/dev/usbmon0", O_RDONLY);
+	if (fd < 0) 
+		return -1;
+
+	argc--;
+	argv++;
+	while (argc--) {
+		if (argv[0][0] == '-') {
+			switch(argv[0][1]) {
+			case 'x':
+				r = atoi(argv[0] + 2);
+				if ((r < 0) || (r > 127))
+					continue;
+				filter_dev[r] = 1;
+				break;
+			}
+		}
+		argv++;
+	}
+
+	arg.hdr = &hdr;
+	arg.data = data;
+	for (;;) {
+		arg.alloc = sizeof(data);
+		r = ioctl(fd, MON_IOCX_GET, &arg);
+		if (r < 0)
+			break;
+		if (filter_dev[hdr.devnum])
+			continue;
+		printf("%d.%03d.%03d %c %c%c %04x",
+			hdr.busnum, hdr.devnum, hdr.epnum & 0x7F,
+			hdr.type,
+			_xfer[hdr.xfer], (hdr.epnum & 0x80) ? 'i' : 'o',
+#if 0
+			hdr.flag_setup ? hdr.flag_setup : ' ',
+			hdr.flag_data ? hdr.flag_data : ' ',
+#endif
+			hdr.length);
+		if (hdr.type == 'S') {
+			if (hdr.xfer == 2) {
+				printf(" %02x %02x %02x%02x %02x%02x %02x%02x\n",
+					hdr.s.setup[0], hdr.s.setup[1],
+					hdr.s.setup[3], hdr.s.setup[2],
+					hdr.s.setup[5], hdr.s.setup[4],
+					hdr.s.setup[7], hdr.s.setup[6]);
+			} else {
+				goto dumpdata;
+			}
+	
+		} else {
+			switch (hdr.status) {
+			case 0:
+				printf(" OK\n");
+				break;
+			case -EPIPE:
+				printf(" STALLED\n");
+				break;
+			case -ENODEV:
+				printf(" DISCONNECTED\n");
+				break;
+			case -ETIMEDOUT:
+				printf(" TIMEDOUT\n");
+				break;
+			default:
+				printf(" %s\n", strerror(-hdr.status));
+			}
+		}
+		if (!hdr.len_cap) 
+			continue;
+		printf("                   ");
+dumpdata:
+		if (hdr.len_cap > sizeof(data))
+			hdr.len_cap = sizeof(data);
+		for (n = 0; n < hdr.len_cap; n++) 
+			printf((n & 3) ? "%02x" : " %02x",data[n]);
+		printf("\n");
+	}
+	return 0;	
+}
+
diff --git a/usbmon.h b/usbmon.h
@@ -0,0 +1,44 @@
+/* Based on Documentation/usbmon.txt in the Linux Kernel */
+
+#ifndef _USBMON_H_
+#define _USBMON_H_
+
+struct usbmon_packet {
+	u64 id;			/* URB ID */
+	unsigned char type;	/* 'S'ubmit 'C'allback 'E'rror */
+	unsigned char xfer;	/* ISO=0 INT=1 CTRL=2 BULK=3 */
+	unsigned char epnum;
+	unsigned char devnum;
+	u16 busnum;
+	char flag_setup;
+	char flag_data;
+	s64 ts_sec;
+	s32 ts_usec;
+	int status;
+	unsigned int length;
+	unsigned int len_cap;
+	union {
+		unsigned char setup[8];
+		struct iso_rec {
+			int error_count;
+			int numdesc;
+		} iso;
+	} s;
+	int interval;
+	int start_frame;
+	unsigned int xfer_flags;
+	unsigned int ndesc;
+};
+
+struct usbmon_get {
+	struct usbmon_packet *hdr;
+	void *data;
+	size_t alloc;
+};
+
+#define MON_IOC_MAGIC	0x92
+
+#define MON_IOCX_GET	_IOW(MON_IOC_MAGIC, 6, struct usbmon_get)
+#define MON_IOCX_GETX	_IOW(MON_IOC_MAGIC, 10, struct usbmon_get)
+
+#endif