svn commit: r238279 - in head: sys/dev/usb usr.sbin/usbdump
Hiroki Sato
hrs at FreeBSD.org
Mon Jul 9 07:25:10 UTC 2012
Author: hrs
Date: Mon Jul 9 07:25:09 2012
New Revision: 238279
URL: http://svn.freebsd.org/changeset/base/238279
Log:
Make usbusN logging pseudo-interface used by usbdump(8) clonable. One is
now created/destroyed automatically by usbdump(8).
Note that "hw.usb.no_pf" loader tunable is now obsolete.
Reviewed by: hselasky
Modified:
head/sys/dev/usb/usb_pf.c
head/usr.sbin/usbdump/usbdump.c
Modified: head/sys/dev/usb/usb_pf.c
==============================================================================
--- head/sys/dev/usb/usb_pf.c Mon Jul 9 07:19:11 2012 (r238278)
+++ head/sys/dev/usb/usb_pf.c Mon Jul 9 07:25:09 2012 (r238279)
@@ -44,8 +44,10 @@ __FBSDID("$FreeBSD$");
#include <sys/sockio.h>
#include <net/if.h>
#include <net/if_types.h>
+#include <net/if_clone.h>
#include <net/bpf.h>
#include <sys/sysctl.h>
+#include <net/route.h>
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
@@ -58,35 +60,144 @@ __FBSDID("$FreeBSD$");
#include <dev/usb/usb_pf.h>
#include <dev/usb/usb_transfer.h>
-static int usb_no_pf;
+#define USBUSNAME "usbus"
-SYSCTL_INT(_hw_usb, OID_AUTO, no_pf, CTLFLAG_RW,
- &usb_no_pf, 0, "Set to disable USB packet filtering");
+static void usbpf_init(void);
+static void usbpf_uninit(void);
+static int usbpf_ioctl(struct ifnet *, u_long, caddr_t);
+static int usbpf_clone_match(struct if_clone *, const char *);
+static int usbpf_clone_create(struct if_clone *, char *, size_t, caddr_t);
+static int usbpf_clone_destroy(struct if_clone *, struct ifnet *);
+static struct usb_bus *usbpf_ifname2ubus(const char *);
+static uint32_t usbpf_aggregate_xferflags(struct usb_xfer_flags *);
+static uint32_t usbpf_aggregate_status(struct usb_xfer_flags_int *);
+static int usbpf_xfer_frame_is_read(struct usb_xfer *, uint32_t);
+static uint32_t usbpf_xfer_precompute_size(struct usb_xfer *, int);
+
+static struct if_clone usbpf_cloner = IFC_CLONE_INITIALIZER(
+ USBUSNAME, NULL, IF_MAXUNIT,
+ NULL, usbpf_clone_match, usbpf_clone_create, usbpf_clone_destroy);
-TUNABLE_INT("hw.usb.no_pf", &usb_no_pf);
+SYSINIT(usbpf_init, SI_SUB_PSEUDO, SI_ORDER_MIDDLE, usbpf_init, NULL);
+SYSUNINIT(usbpf_uninit, SI_SUB_PSEUDO, SI_ORDER_MIDDLE, usbpf_uninit, NULL);
-void
-usbpf_attach(struct usb_bus *ubus)
+static void
+usbpf_init(void)
{
- struct ifnet *ifp;
- if (usb_no_pf != 0) {
- ubus->ifp = NULL;
+ if_clone_attach(&usbpf_cloner);
+}
+
+static void
+usbpf_uninit(void)
+{
+ int devlcnt;
+ device_t *devlp;
+ devclass_t dc;
+ struct usb_bus *ubus;
+ int error;
+ int i;
+
+ if_clone_detach(&usbpf_cloner);
+
+ dc = devclass_find(USBUSNAME);
+ if (dc == NULL)
return;
+ error = devclass_get_devices(dc, &devlp, &devlcnt);
+ if (error)
+ return;
+ for (i = 0; i < devlcnt; i++) {
+ ubus = device_get_softc(devlp[i]);
+ if (ubus != NULL && ubus->ifp != NULL)
+ usbpf_clone_destroy(&usbpf_cloner, ubus->ifp);
}
+}
+
+static int
+usbpf_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
+{
+
+ /* No configuration allowed. */
+ return (EINVAL);
+}
+
+static struct usb_bus *
+usbpf_ifname2ubus(const char *ifname)
+{
+ device_t dev;
+ devclass_t dc;
+ int unit;
+ int error;
+
+ if (strncmp(ifname, USBUSNAME, sizeof(USBUSNAME)) <= 0)
+ return (NULL);
+ error = ifc_name2unit(ifname, &unit);
+ if (error || unit < 0)
+ return (NULL);
+ dc = devclass_find(USBUSNAME);
+ if (dc == NULL)
+ return (NULL);
+ dev = devclass_get_device(dc, unit);
+ if (dev == NULL)
+ return (NULL);
+
+ return (device_get_softc(dev));
+}
+
+static int
+usbpf_clone_match(struct if_clone *ifc, const char *name)
+{
+ struct usb_bus *ubus;
+
+ ubus = usbpf_ifname2ubus(name);
+ if (ubus == NULL)
+ return (0);
+ if (ubus->ifp != NULL)
+ return (0);
+
+ return (1);
+}
+
+static int
+usbpf_clone_create(struct if_clone *ifc, char *name, size_t len, caddr_t params)
+{
+ int error;
+ int unit;
+ struct ifnet *ifp;
+ struct usb_bus *ubus;
+ error = ifc_name2unit(name, &unit);
+ if (error || unit < 0)
+ return (error);
+
+ ubus = usbpf_ifname2ubus(name);
+ if (ubus == NULL)
+ return (1);
+ if (ubus->ifp != NULL)
+ return (1);
+
+ error = ifc_alloc_unit(ifc, &unit);
+ if (error) {
+ ifc_free_unit(ifc, unit);
+ device_printf(ubus->parent, "usbpf: Could not allocate "
+ "instance\n");
+ return (error);
+ }
ifp = ubus->ifp = if_alloc(IFT_USB);
if (ifp == NULL) {
+ ifc_free_unit(ifc, unit);
device_printf(ubus->parent, "usbpf: Could not allocate "
"instance\n");
- return;
+ return (ENOSPC);
}
-
- if_initname(ifp, "usbus", device_get_unit(ubus->bdev));
- ifp->if_flags = IFF_CANTCONFIG;
+ strlcpy(ifp->if_xname, name, sizeof(ifp->if_xname));
+ ifp->if_softc = ubus;
+ ifp->if_dname = ifc->ifc_name;
+ ifp->if_dunit = unit;
+ ifp->if_ioctl = usbpf_ioctl;
if_attach(ifp);
- if_up(ifp);
-
+ ifp->if_flags |= IFF_UP;
+ rt_ifmsg(ifp);
/*
* XXX According to the specification of DLT_USB, it indicates
* packets beginning with USB setup header. But not sure all
@@ -94,6 +205,31 @@ usbpf_attach(struct usb_bus *ubus)
*/
bpfattach(ifp, DLT_USB, USBPF_HDR_LEN);
+ return (0);
+}
+
+static int
+usbpf_clone_destroy(struct if_clone *ifc, struct ifnet *ifp)
+{
+ struct usb_bus *ubus;
+ int unit;
+
+ ubus = ifp->if_softc;
+ unit = ifp->if_dunit;
+
+ ubus->ifp = NULL;
+ bpfdetach(ifp);
+ if_detach(ifp);
+ if_free(ifp);
+ ifc_free_unit(ifc, unit);
+
+ return (0);
+}
+
+void
+usbpf_attach(struct usb_bus *ubus)
+{
+
if (bootverbose)
device_printf(ubus->parent, "usbpf: Attached\n");
}
@@ -101,15 +237,11 @@ usbpf_attach(struct usb_bus *ubus)
void
usbpf_detach(struct usb_bus *ubus)
{
- struct ifnet *ifp = ubus->ifp;
- if (ifp != NULL) {
- bpfdetach(ifp);
- if_down(ifp);
- if_detach(ifp);
- if_free(ifp);
- }
- ubus->ifp = NULL;
+ if (ubus->ifp != NULL)
+ usbpf_clone_destroy(&usbpf_cloner, ubus->ifp);
+ if (bootverbose)
+ device_printf(ubus->parent, "usbpf: Detached\n");
}
static uint32_t
@@ -259,8 +391,6 @@ usbpf_xfertap(struct usb_xfer *xfer, int
bus = xfer->xroot->bus;
/* sanity checks */
- if (usb_no_pf != 0)
- return;
if (bus->ifp == NULL)
return;
if (!bpf_peers_present(bus->ifp->if_bpf))
Modified: head/usr.sbin/usbdump/usbdump.c
==============================================================================
--- head/usr.sbin/usbdump/usbdump.c Mon Jul 9 07:19:11 2012 (r238278)
+++ head/usr.sbin/usbdump/usbdump.c Mon Jul 9 07:25:09 2012 (r238279)
@@ -795,6 +795,8 @@ main(int argc, char *argv[])
int o;
int filt_unit;
int filt_ep;
+ int s;
+ int ifindex;
const char *optstring;
char *pp;
@@ -887,9 +889,20 @@ main(int argc, char *argv[])
/* clear ifr structure */
memset(&ifr, 0, sizeof(ifr));
+ /* Try to create usbusN interface if it is not available. */
+ s = socket(AF_LOCAL, SOCK_DGRAM, 0);
+ if (s < 0)
+ errx(EXIT_FAILURE, "Could not open a socket");
+ ifindex = if_nametoindex(i_arg);
+ if (ifindex == 0) {
+ (void)strlcpy(ifr.ifr_name, i_arg, sizeof(ifr.ifr_name));
+ if (ioctl(s, SIOCIFCREATE2, &ifr) < 0)
+ errx(EXIT_FAILURE, "Invalid bus interface: %s", i_arg);
+ }
+
for ( ; v >= USBPF_HDR_LEN; v >>= 1) {
(void)ioctl(fd, BIOCSBLEN, (caddr_t)&v);
- (void)strncpy(ifr.ifr_name, i_arg, sizeof(ifr.ifr_name));
+ (void)strlcpy(ifr.ifr_name, i_arg, sizeof(ifr.ifr_name));
if (ioctl(fd, BIOCSETIF, (caddr_t)&ifr) >= 0)
break;
}
@@ -930,6 +943,17 @@ main(int argc, char *argv[])
printf("%d packets received by filter\n", us.bs_recv);
printf("%d packets dropped by kernel\n", us.bs_drop);
+ /*
+ * Destroy the usbusN interface only if it was created by
+ * usbdump(8). Ignore when it was already destroyed.
+ */
+ if (ifindex == 0 && if_nametoindex(i_arg) > 0) {
+ (void)strlcpy(ifr.ifr_name, i_arg, sizeof(ifr.ifr_name));
+ if (ioctl(s, SIOCIFDESTROY, &ifr) < 0)
+ warn("SIOCIFDESTROY ioctl failed");
+ }
+ close(s);
+
if (p->fd > 0)
close(p->fd);
if (p->rfd > 0)
More information about the svn-src-head
mailing list