From: Giuseppe Lettieri Date: Sat, 30 Jun 2012 12:10:38 +0000 (+0200) Subject: Merge remote-tracking branch 'origin/ovs-dev' into bsd-port X-Git-Url: http://git.onelab.eu/?a=commitdiff_plain;h=refs%2Fheads%2Fbsd-port;hp=908ff19af7ab2b6e0a865bcf566aaa47e32889ff;p=sliver-openvswitch.git Merge remote-tracking branch 'origin/ovs-dev' into bsd-port Conflicts: acinclude.m4 lib/automake.mk --- diff --git a/acinclude.m4 b/acinclude.m4 index 43f044a95..51e784b60 100644 --- a/acinclude.m4 +++ b/acinclude.m4 @@ -287,7 +287,7 @@ AC_DEFUN([OVS_CHECK_IF_PACKET], [Define to 1 if net/if_packet.h is available.]) fi]) -dnl Checks for net/if_dl.h +dnl Checks for net/if_dl.h. AC_DEFUN([OVS_CHECK_IF_DL], [AC_CHECK_HEADER([net/if_dl.h], [HAVE_IF_DL=yes], diff --git a/configure.ac b/configure.ac index c89c60a1b..5bcf27b60 100644 --- a/configure.ac +++ b/configure.ac @@ -41,6 +41,7 @@ AC_SYS_LARGEFILE AC_SEARCH_LIBS([pow], [m]) AC_SEARCH_LIBS([clock_gettime], [rt]) AC_SEARCH_LIBS([timer_create], [rt]) +AC_SEARCH_LIBS([pcap_open_live], [pcap]) OVS_CHECK_COVERAGE OVS_CHECK_NDEBUG diff --git a/lib/automake.mk b/lib/automake.mk index feac1d453..be8602bc6 100644 --- a/lib/automake.mk +++ b/lib/automake.mk @@ -240,6 +240,9 @@ endif if HAVE_IF_DL lib_libopenvswitch_a_SOURCES += \ + lib/netdev-bsd.c \ + lib/rtbsd.c \ + lib/rtbsd.h lib/route-table-bsd.c endif diff --git a/lib/netdev-bsd.c b/lib/netdev-bsd.c new file mode 100644 index 000000000..db844be54 --- /dev/null +++ b/lib/netdev-bsd.c @@ -0,0 +1,1484 @@ +/* + * Copyright (c) 2011 Gaetano Catalli. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED ``AS IS'' WITHOUT ANY WARRANTIES OF ANY KIND. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "rtbsd.h" +#include "coverage.h" +#include "dynamic-string.h" +#include "fatal-signal.h" +#include "netdev-provider.h" +#include "ofpbuf.h" +#include "openflow/openflow.h" +#include "packets.h" +#include "poll-loop.h" +#include "socket-util.h" +#include "shash.h" +#include "svec.h" +#include "vlog.h" + +VLOG_DEFINE_THIS_MODULE(netdev_bsd); + + +/* + * This file implements objects to access interfaces. + * Externally, interfaces are represented by two structures: + * + struct netdev_dev, representing a network device, + * containing e.g. name and a refcount; + * We can have private variables by embedding the + * struct netdev_dev into our own structure + * (e.g. netdev_dev_bsd) + * + * + struct netdev, representing an instance of an open netdev_dev. + * The structure contains a pointer to the 'struct netdev' + * representing the device. Again, private information + * such as file descriptor etc. are stored in our + * own struct netdev_bsd which includes a struct netdev. + * + * Both 'struct netdev' and 'struct netdev_dev' are referenced + * in containers which hold pointers to the data structures. + * We can reach our own struct netdev_XXX_bsd by putting a + * struct netdev_XXX within our own struct, and using CONTAINER_OF + * to access the parent structure. + */ +struct netdev_bsd { + struct netdev netdev; + + int netdev_fd; /* Selectable file descriptor for the network device. + This descriptor will be used for polling operations */ + + pcap_t *pcap_handle; /* Packet capture descriptor for a system network + device */ +}; + +struct netdev_dev_bsd { + struct netdev_dev netdev_dev; + unsigned int cache_valid; + unsigned int change_seq; + + int ifindex; + uint8_t etheraddr[ETH_ADDR_LEN]; + struct in_addr in4; + struct in6_addr in6; + int mtu; + int carrier; + + bool tap_opened; + int tap_fd; /* TAP character device, if any */ +}; + + +enum { + VALID_IFINDEX = 1 << 0, + VALID_ETHERADDR = 1 << 1, + VALID_IN4 = 1 << 2, + VALID_IN6 = 1 << 3, + VALID_MTU = 1 << 4, + VALID_CARRIER = 1 << 5 +}; + +/* An AF_INET socket (used for ioctl operations). */ +static int af_inet_sock = -1; + +#define PCAP_SNAPLEN 1024 + + +/* + * Notifier used to invalidate device informations in case of status change. + * + * It will be registered with a 'rtbsd_notifier_register()' when the first + * device will be created with the call of either 'netdev_bsd_tap_create()' or + * 'netdev_bsd_system_create()'. + * + * The callback associated with this notifier ('netdev_bsd_cache_cb()') will + * invalidate cached information about the device. + */ +static struct rtbsd_notifier netdev_bsd_cache_notifier; +static int cache_notifier_refcount; + +static struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(5, 20); + +static int netdev_bsd_do_ioctl(const struct netdev *, struct ifreq *, + unsigned long cmd, const char *cmd_name); +static void destroy_tap(int fd, const char *name); +static int get_flags(const struct netdev *, int *flagsp); +static int set_flags(struct netdev *, int flags); +static int do_set_addr(struct netdev *netdev, + int ioctl_nr, const char *ioctl_name, + struct in_addr addr); +static int get_etheraddr(const char *netdev_name, uint8_t ea[ETH_ADDR_LEN]); +static int set_etheraddr(const char *netdev_name, int hwaddr_family, + int hwaddr_len, const uint8_t[ETH_ADDR_LEN]); +static int get_ifindex(const struct netdev *, int *ifindexp); + +static int netdev_bsd_init(void); + +static bool +is_netdev_bsd_class(const struct netdev_class *netdev_class) +{ + return netdev_class->init == netdev_bsd_init; +} + +static struct netdev_bsd * +netdev_bsd_cast(const struct netdev *netdev) +{ + assert(is_netdev_bsd_class(netdev_dev_get_class(netdev_get_dev(netdev)))); + return CONTAINER_OF(netdev, struct netdev_bsd, netdev); +} + +static struct netdev_dev_bsd * +netdev_dev_bsd_cast(const struct netdev_dev *netdev_dev) +{ + assert(is_netdev_bsd_class(netdev_dev_get_class(netdev_dev))); + return CONTAINER_OF(netdev_dev, struct netdev_dev_bsd, netdev_dev); +} + +/* Initialize the AF_INET socket used for ioctl operations */ +static int +netdev_bsd_init(void) +{ + static int status = -1; + + if (status >= 0) { /* already initialized */ + return status; + } + + af_inet_sock = socket(AF_INET, SOCK_DGRAM, 0); + status = af_inet_sock >= 0 ? 0 : errno; + + if (status) { + VLOG_ERR("failed to create inet socket: %s", strerror(status)); + } + + return status; +} + +/* + * Perform periodic work needed by netdev. In BSD netdevs it checks for any + * interface status changes, and eventually calls all the user callbacks. + */ +static void +netdev_bsd_run(void) +{ + rtbsd_notifier_run(); +} + +/* + * Arranges for poll_block() to wake up if the "run" member function needs to + * be called. + */ +static void +netdev_bsd_wait(void) +{ + rtbsd_notifier_wait(); +} + +static void +netdev_dev_bsd_changed(struct netdev_dev_bsd *dev) +{ + dev->change_seq++; + if (!dev->change_seq) { + dev->change_seq++; + } +} + +/* Invalidate cache in case of interface status change. */ +static void +netdev_bsd_cache_cb(const struct rtbsd_change *change, + void *aux OVS_UNUSED) +{ + struct netdev_dev_bsd *dev; + + if (change) { + struct netdev_dev *base_dev = netdev_dev_from_name(change->if_name); + + if (base_dev) { + const struct netdev_class *netdev_class = + netdev_dev_get_class(base_dev); + + if (is_netdev_bsd_class(netdev_class)) { + dev = netdev_dev_bsd_cast(base_dev); + dev->cache_valid = 0; + netdev_dev_bsd_changed(dev); + } + } + } else { + /* + * XXX the API is lacking, we should be able to iterate on the list of + * netdevs without having to store the info in a temp shash. + */ + struct shash device_shash; + struct shash_node *node; + + shash_init(&device_shash); + netdev_dev_get_devices(&netdev_bsd_class, &device_shash); + SHASH_FOR_EACH (node, &device_shash) { + dev = node->data; + dev->cache_valid = 0; + netdev_dev_bsd_changed(dev); + } + shash_destroy(&device_shash); + } +} + +static int +cache_notifier_ref(void) +{ + int ret = 0; + + if (!cache_notifier_refcount) { + ret = rtbsd_notifier_register(&netdev_bsd_cache_notifier, + netdev_bsd_cache_cb, NULL); + if (ret) { + return ret; + } + } + cache_notifier_refcount++; + return 0; +} + +static int +cache_notifier_unref(void) +{ + cache_notifier_refcount--; + if (cache_notifier_refcount == 0) { + rtbsd_notifier_unregister(&netdev_bsd_cache_notifier); + } + return 0; +} + +/* Allocate a netdev_dev_bsd structure */ +static int +netdev_bsd_create_system(const struct netdev_class *class, const char *name, + struct netdev_dev **netdev_devp) +{ + struct netdev_dev_bsd *netdev_dev; + int error; + + error = cache_notifier_ref(); + if (error) { + return error; + } + + netdev_dev = xzalloc(sizeof *netdev_dev); + netdev_dev->change_seq = 1; + netdev_dev_init(&netdev_dev->netdev_dev, name, class); + *netdev_devp = &netdev_dev->netdev_dev; + + return 0; +} + +/* + * Allocate a netdev_dev_bsd structure with 'tap' class. + */ +static int +netdev_bsd_create_tap(const struct netdev_class *class, const char *name, + struct netdev_dev **netdev_devp) +{ + struct netdev_dev_bsd *netdev_dev = NULL; + int error = 0; + struct ifreq ifr; + + error = cache_notifier_ref(); + if (error) { + goto error; + } + + /* allocate the device structure and set the internal flag */ + netdev_dev = xzalloc(sizeof *netdev_dev); + + memset(&ifr, 0, sizeof(ifr)); + + /* Create a tap device by opening /dev/tap. The TAPGIFNAME ioctl is used + * to retrieve the name of the tap device. */ + netdev_dev->tap_fd = open("/dev/tap", O_RDWR); + netdev_dev->change_seq = 1; + if (netdev_dev->tap_fd < 0) { + error = errno; + VLOG_WARN("opening \"/dev/tap\" failed: %s", strerror(error)); + goto error_undef_notifier; + } + + /* Retrieve tap name (e.g. tap0) */ + if (ioctl(netdev_dev->tap_fd, TAPGIFNAME, &ifr) == -1) { + /* XXX Need to destroy the device? */ + error = errno; + goto error_undef_notifier; + } + + /* Change the name of the tap device */ + ifr.ifr_data = (void *)name; + if (ioctl(af_inet_sock, SIOCSIFNAME, &ifr) == -1) { + error = errno; + destroy_tap(netdev_dev->tap_fd, ifr.ifr_name); + goto error_undef_notifier; + } + + /* set non-blocking. */ + error = set_nonblocking(netdev_dev->tap_fd); + if (error) { + destroy_tap(netdev_dev->tap_fd, name); + goto error_undef_notifier; + } + + /* Turn device UP */ + ifr.ifr_flags = (uint16_t)IFF_UP; + ifr.ifr_flagshigh = 0; + strncpy(ifr.ifr_name, name, sizeof ifr.ifr_name); + if (ioctl(af_inet_sock, SIOCSIFFLAGS, &ifr) == -1) { + error = errno; + destroy_tap(netdev_dev->tap_fd, name); + goto error_undef_notifier; + } + + /* initialize the device structure and + * link the structure to its netdev */ + netdev_dev_init(&netdev_dev->netdev_dev, name, class); + *netdev_devp = &netdev_dev->netdev_dev; + + return 0; + +error_undef_notifier: + cache_notifier_unref(); +error: + free(netdev_dev); + return error; +} + +static void +netdev_bsd_destroy(struct netdev_dev *netdev_dev_) +{ + struct netdev_dev_bsd *netdev_dev = netdev_dev_bsd_cast(netdev_dev_); + + cache_notifier_unref(); + + if (netdev_dev->tap_fd >= 0 && + !strcmp(netdev_dev_get_type(netdev_dev_), "tap")) { + destroy_tap(netdev_dev->tap_fd, netdev_dev_get_name(netdev_dev_)); + } + free(netdev_dev); +} + + +static int +netdev_bsd_open_system(struct netdev_dev *netdev_dev_, struct netdev **netdevp) +{ + struct netdev_dev_bsd *netdev_dev = netdev_dev_bsd_cast(netdev_dev_); + struct netdev_bsd *netdev; + int error; + enum netdev_flags flags; + + /* Allocate network device. */ + netdev = xcalloc(1, sizeof *netdev); + netdev->netdev_fd = -1; + netdev_init(&netdev->netdev, netdev_dev_); + + /* Verify that the netdev really exists by attempting to read its flags */ + error = netdev_get_flags(&netdev->netdev, &flags); + if (error == ENXIO) { + goto error; + } + + /* The first user that opens a tap port(from dpif_create_and_open()) will + * receive the file descriptor associated with the tap device. Instead, the + * following users will open the tap device as a normal 'system' device. */ + if (!strcmp(netdev_dev_get_type(netdev_dev_), "tap") && + !netdev_dev->tap_opened) { + netdev_dev->tap_opened = true; + netdev->netdev_fd = netdev_dev->tap_fd; + } + + *netdevp = &netdev->netdev; + return 0; + +error: + netdev_uninit(&netdev->netdev, true); + return error; +} + + + +/* Close a 'netdev'. */ +static void +netdev_bsd_close(struct netdev *netdev_) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + + if (netdev->netdev_fd >= 0 && strcmp(netdev_get_type(netdev_), "tap")) { + pcap_close(netdev->pcap_handle); + } + + free(netdev); +} + +static int +netdev_bsd_listen(struct netdev *netdev_) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + char errbuf[PCAP_ERRBUF_SIZE]; + int error; + int fd; + int one = 1; + + if (netdev->netdev_fd >= 0) { + return 0; + } + + /* open the pcap device. The device is opened in non-promiscuous mode + * because the interface flags are manually set by the caller. */ + netdev->pcap_handle = pcap_open_live(netdev_get_name(netdev_), PCAP_SNAPLEN, + 0, 1000, errbuf); + if (netdev->pcap_handle == NULL) { + error = errno; + goto error; + } + + netdev_dev_bsd_changed(netdev_dev_bsd_cast(netdev_get_dev(netdev_))); + + /* initialize netdev->netdev_fd */ + fd = pcap_get_selectable_fd(netdev->pcap_handle); + if (fd == -1) { + error = errno; + goto error; + } + + /* Set non-blocking mode. Also the BIOCIMMEDIATE ioctl must be called + * on the file descriptor returned by pcap_get_selectable_fd to achieve + * a real non-blocking behaviour.*/ + error = pcap_setnonblock(netdev->pcap_handle, 1, errbuf); + if (error == -1) { + error = errno; + goto error; + } + + /* This call assure that reads return immediately upon packet reception. + * Otherwise, a read will block until either the kernel buffer becomes + * full or a timeout occurs. */ + if(ioctl(fd, BIOCIMMEDIATE, &one) < 0 ) { + VLOG_ERR("ioctl(BIOCIMMEDIATE) on %s device failed: %s", + netdev_get_name(netdev_), strerror(errno)); + error = errno; + goto error; + } + + /* Capture only incoming packets */ + error = pcap_setdirection(netdev->pcap_handle, PCAP_D_IN); + if (error == -1) { + error = errno; + goto error; + } + + netdev->netdev_fd = fd; + return 0; + +error: + if (fd >= 0) { + close(netdev->netdev_fd); + } + return error; +} + + +/* The recv callback of the netdev class returns the number of bytes of the + * received packet. + * + * This can be done by the pcap_next() function. Unfortunately pcap_next() does + * not make difference between a missing packet on the capture interface and + * an error during the file capture. We can use the pcap_dispatch() function + * instead, which is able to distinguish between errors and null packet. + * + * To make pcap_dispatch() returns the number of bytes read from the interface + * we need to define the following callback and argument. + */ +struct pcap_arg { + void *data; + int size; + int retval; +}; + +/* + * This callback will be executed on every captured packet. + * + * If the packet captured by pcap_dispatch() does not fit the pcap buffer, + * pcap returns a truncated packet and we follow this behavior. + * + * The argument args->retval is the packet size in bytes. + */ +static void +proc_pkt(u_char *args_, const struct pcap_pkthdr *hdr, const u_char *packet) +{ + struct pcap_arg *args = (struct pcap_arg *)args_; + + if (args->size < hdr->len) { + printf("%s Warning: Packet truncated'n", __func__); + args->retval = args->size; + } else { + args->retval = hdr->len; + } + + /* copy the packet to our buffer */ + memcpy(args->data, packet, args->retval); +} + +/* + * This function attempts to receive a packet from the specified network + * device. It is assumed that the network device is a system device or a tap + * device opened as a system one. In this case the read operation is performed + * on the 'netdev' pcap descriptor. + */ +static int +netdev_bsd_recv_system(struct netdev_bsd *netdev, void *data, size_t size) +{ + struct pcap_arg arg; + int ret; + + if (netdev->netdev_fd < 0) { + /* Device was opened with NETDEV_ETH_TYPE_NONE. */ + return -EAGAIN; + } + + /* prepare the pcap argument to store the packet */ + arg.size = size; + arg.data = data; + + for (;;) { + ret = pcap_dispatch(netdev->pcap_handle, 1, proc_pkt, (u_char *)&arg); + + if (ret > 0) { + return arg.retval; /* arg.retval < 0 is handled in the caller */ + } + if (ret == -1) { + if (errno == EINTR) { + continue; + } + } + + return -EAGAIN; + } +} + +/* + * This function attempts to receive a packet from the specified network + * device. It is assumed that the network device is a tap device and the + * 'netdev_fd' member of the 'netdev' structure is initialized with the tap + * file descriptor. + */ +static int +netdev_bsd_recv_tap(struct netdev_bsd *netdev, void *data, size_t size) +{ + if (netdev->netdev_fd < 0) { + /* Device was opened with NETDEV_ETH_TYPE_NONE. */ + return -EAGAIN; + } + + for (;;) { + ssize_t retval = read(netdev->netdev_fd, data, size); + if (retval >= 0) { + return retval; + } else if (errno != EINTR) { + if (errno != EAGAIN) { + VLOG_WARN_RL(&rl, "error receiving Ethernet packet on %s: %s", + strerror(errno), netdev->netdev.netdev_dev->name); + } + return -errno; + } + } +} + + +/* + * According with the nature of the device a different function must be called. + * If the device is the bridge local port the 'netdev_bsd_recv_tap' function + * must be called, otherwise the 'netdev_bsd_recv_system' function is called. + * + * type!="tap" ---> system device. + * type=="tap" && netdev_fd == tap_fd ---> internal tap device + * type=="tap" && netdev_fd != tap_fd ---> internal tap device + * opened as a system + * device. + */ +static int +netdev_bsd_recv(struct netdev *netdev_, void* data, size_t size) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + struct netdev_dev_bsd * netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + if (!strcmp(netdev_get_type(netdev_), "tap") && + netdev->netdev_fd == netdev_dev->tap_fd) { + return netdev_bsd_recv_tap(netdev, data, size); + } else { + return netdev_bsd_recv_system(netdev, data, size); + } +} + + +/* + * Registers with the poll loop to wake up from the next call to poll_block() + * when a packet is ready to be received with netdev_recv() on 'netdev'. + */ +static void +netdev_bsd_recv_wait(struct netdev *netdev_) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + + if (netdev->netdev_fd >= 0) { + poll_fd_wait(netdev->netdev_fd, POLLIN); + } +} + +/* Discards all packets waiting to be received from 'netdev'. */ +static int +netdev_bsd_drain(struct netdev *netdev_) +{ + struct ifreq ifr; + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + + strcpy(ifr.ifr_name, netdev_get_name(netdev_)); + if (ioctl(netdev->netdev_fd, BIOCFLUSH, &ifr) == -1) { + VLOG_DBG_RL(&rl, "%s: ioctl(BIOCFLUSH) failed: %s", + netdev_get_name(netdev_), strerror(errno)); + return errno; + } + return 0; +} + +/* + * Send a packet on the specified network device. The device could be either a + * system or a tap device. + */ +static int +netdev_bsd_send(struct netdev *netdev_, const void *data, size_t size) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + struct netdev_dev_bsd * netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + /* XXX should support sending even if 'ethertype' was NETDEV_ETH_TYPE_NONE. + */ + if (netdev->netdev_fd < 0) { + return EPIPE; + } + + for (;;) { + ssize_t retval; + if (!strcmp(netdev_get_type(netdev_), "tap") && + netdev_dev->tap_fd == netdev->netdev_fd) { + retval = write(netdev->netdev_fd, data, size); + } else { + retval = pcap_inject(netdev->pcap_handle, data, size); + } + if (retval < 0) { + if (errno == EINTR) { + continue; + } else if (errno != EAGAIN) { + VLOG_WARN_RL(&rl, "error sending Ethernet packet on %s: %s", + netdev_get_name(netdev_), strerror(errno)); + } + return errno; + } else if (retval != size) { + VLOG_WARN_RL(&rl, "sent partial Ethernet packet (%zd bytes of " + "%zu) on %s", retval, size, + netdev_get_name(netdev_)); + return EMSGSIZE; + } else { + return 0; + } + } +} + +/* + * Registers with the poll loop to wake up from the next call to poll_block() + * when the packet transmission queue has sufficient room to transmit a packet + * with netdev_send(). + */ +static void +netdev_bsd_send_wait(struct netdev *netdev_) +{ + struct netdev_bsd *netdev = netdev_bsd_cast(netdev_); + + if (netdev->netdev_fd < 0) { /* Nothing to do. */ + return; + } + + if (strcmp(netdev_get_type(netdev_), "tap")) { + poll_fd_wait(netdev->netdev_fd, POLLOUT); + } else { + /* TAP device always accepts packets. */ + poll_immediate_wake(); + } +} + +/* + * Attempts to set 'netdev''s MAC address to 'mac'. Returns 0 if successful, + * otherwise a positive errno value. + */ +static int +netdev_bsd_set_etheraddr(struct netdev *netdev_, + const uint8_t mac[ETH_ADDR_LEN]) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + int error; + + if (!(netdev_dev->cache_valid & VALID_ETHERADDR) + || !eth_addr_equals(netdev_dev->etheraddr, mac)) { + error = set_etheraddr(netdev_get_name(netdev_), AF_LINK, ETH_ADDR_LEN, + mac); + if (!error) { + netdev_dev->cache_valid |= VALID_ETHERADDR; + memcpy(netdev_dev->etheraddr, mac, ETH_ADDR_LEN); + netdev_dev_bsd_changed(netdev_dev); + } + } else { + error = 0; + } + return error; +} + +/* + * Returns a pointer to 'netdev''s MAC address. The caller must not modify or + * free the returned buffer. + */ +static int +netdev_bsd_get_etheraddr(const struct netdev *netdev_, + uint8_t mac[ETH_ADDR_LEN]) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + if (!(netdev_dev->cache_valid & VALID_ETHERADDR)) { + int error = get_etheraddr(netdev_get_name(netdev_), + netdev_dev->etheraddr); + if (error) { + return error; + } + netdev_dev->cache_valid |= VALID_ETHERADDR; + } + memcpy(mac, netdev_dev->etheraddr, ETH_ADDR_LEN); + + return 0; +} + +/* + * Returns the maximum size of transmitted (and received) packets on 'netdev', + * in bytes, not including the hardware header; thus, this is typically 1500 + * bytes for Ethernet devices. + */ +static int +netdev_bsd_get_mtu(const struct netdev *netdev_, int *mtup) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + if (!(netdev_dev->cache_valid & VALID_MTU)) { + struct ifreq ifr; + int error; + + error = netdev_bsd_do_ioctl(netdev_, &ifr, SIOCGIFMTU, "SIOCGIFMTU"); + if (error) { + return error; + } + netdev_dev->mtu = ifr.ifr_mtu; + netdev_dev->cache_valid |= VALID_MTU; + } + + *mtup = netdev_dev->mtu; + return 0; +} + +static int +netdev_bsd_get_ifindex(const struct netdev *netdev) +{ + int ifindex, error; + + error = get_ifindex(netdev, &ifindex); + return error ? -error : ifindex; +} + +static int +netdev_bsd_get_carrier(const struct netdev *netdev_, bool *carrier) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + if (!(netdev_dev->cache_valid & VALID_CARRIER)) { + struct ifmediareq ifmr; + + memset(&ifmr, 0, sizeof(ifmr)); + strncpy(ifmr.ifm_name, netdev_get_name(netdev_), sizeof ifmr.ifm_name); + + if (ioctl(af_inet_sock, SIOCGIFMEDIA, &ifmr) == -1) { + VLOG_DBG_RL(&rl, "%s: ioctl(SIOCGIFMEDIA) failed: %s", + netdev_get_name(netdev_), strerror(errno)); + return errno; + } + + netdev_dev->carrier = (ifmr.ifm_status & IFM_ACTIVE) == IFM_ACTIVE; + netdev_dev->cache_valid |= VALID_CARRIER; + + /* If the interface doesn't report whether the media is active, + * just assume it is active. */ + if ((ifmr.ifm_status & IFM_AVALID) == 0) { + netdev_dev->carrier = true; + } + } + *carrier = netdev_dev->carrier; + + return 0; +} + +/* Retrieves current device stats for 'netdev'. */ +static int +netdev_bsd_get_stats(const struct netdev *netdev_, struct netdev_stats *stats) +{ + int if_count, i; + int mib[6]; + size_t len; + struct ifmibdata ifmd; + + //COVERAGE_INC(netdev_get_stats); + + mib[0] = CTL_NET; + mib[1] = PF_LINK; + mib[2] = NETLINK_GENERIC; + mib[3] = IFMIB_SYSTEM; + mib[4] = IFMIB_IFCOUNT; + + len = sizeof(if_count); + + if (sysctl(mib, 5, &if_count, &len, (void *)0, 0) == -1) { + VLOG_DBG_RL(&rl, "%s: sysctl failed: %s", + netdev_get_name(netdev_), strerror(errno)); + return errno; + } + + mib[5] = IFDATA_GENERAL; + mib[3] = IFMIB_IFDATA; + len = sizeof(ifmd); + for (i = 1; i <= if_count; i++) { + mib[4] = i; //row + if (sysctl(mib, 6, &ifmd, &len, (void *)0, 0) == -1) { + VLOG_DBG_RL(&rl, "%s: sysctl failed: %s", + netdev_get_name(netdev_), strerror(errno)); + return errno; + } else if (!strcmp(ifmd.ifmd_name, netdev_get_name(netdev_))) { + stats->rx_packets = ifmd.ifmd_data.ifi_ipackets; + stats->tx_packets = ifmd.ifmd_data.ifi_opackets; + stats->rx_bytes = ifmd.ifmd_data.ifi_ibytes; + stats->tx_bytes = ifmd.ifmd_data.ifi_obytes; + stats->rx_errors = ifmd.ifmd_data.ifi_ierrors; + stats->tx_errors = ifmd.ifmd_data.ifi_oerrors; + stats->rx_dropped = ifmd.ifmd_data.ifi_iqdrops; + stats->tx_dropped = 0; + stats->multicast = ifmd.ifmd_data.ifi_imcasts; + stats->collisions = ifmd.ifmd_data.ifi_collisions; + + stats->rx_length_errors = 0; + stats->rx_over_errors = 0; + stats->rx_crc_errors = 0; + stats->rx_frame_errors = 0; + stats->rx_fifo_errors = 0; + stats->rx_missed_errors = 0; + + stats->tx_aborted_errors = 0; + stats->tx_carrier_errors = 0; + stats->tx_fifo_errors = 0; + stats->tx_heartbeat_errors = 0; + stats->tx_window_errors = 0; + break; + } + } + + return 0; +} + +static uint32_t +netdev_bsd_parse_media(int media) +{ + uint32_t supported = 0; + bool half_duplex = media & IFM_HDX ? true : false; + + switch (IFM_SUBTYPE(media)) { + case IFM_10_2: + case IFM_10_5: + case IFM_10_STP: + case IFM_10_T: + supported |= half_duplex ? NETDEV_F_10MB_HD : NETDEV_F_10MB_FD; + supported |= NETDEV_F_COPPER; + break; + + case IFM_10_FL: + supported |= half_duplex ? NETDEV_F_10MB_HD : NETDEV_F_10MB_FD; + supported |= NETDEV_F_FIBER; + break; + + case IFM_100_T2: + case IFM_100_T4: + case IFM_100_TX: + case IFM_100_VG: + supported |= half_duplex ? NETDEV_F_100MB_HD : NETDEV_F_100MB_FD; + supported |= NETDEV_F_COPPER; + break; + + case IFM_100_FX: + supported |= half_duplex ? NETDEV_F_100MB_HD : NETDEV_F_100MB_FD; + supported |= NETDEV_F_FIBER; + break; + + case IFM_1000_CX: + case IFM_1000_T: + supported |= half_duplex ? NETDEV_F_1GB_HD : NETDEV_F_1GB_FD; + supported |= NETDEV_F_COPPER; + break; + + case IFM_1000_LX: + case IFM_1000_SX: + supported |= half_duplex ? NETDEV_F_1GB_HD : NETDEV_F_1GB_FD; + supported |= NETDEV_F_FIBER; + break; + + case IFM_10G_CX4: + supported |= NETDEV_F_10GB_FD; + supported |= NETDEV_F_COPPER; + break; + + case IFM_10G_LR: + case IFM_10G_SR: + supported |= NETDEV_F_10GB_FD; + supported |= NETDEV_F_FIBER; + break; + + default: + return 0; + } + + if (IFM_SUBTYPE(media) == IFM_AUTO) { + supported |= NETDEV_F_AUTONEG; + } + /* + if (media & IFM_ETH_FMASK) { + supported |= NETDEV_F_PAUSE; + } + */ + + return supported; +} + +/* + * Stores the features supported by 'netdev' into each of '*current', + * '*advertised', '*supported', and '*peer' that are non-null. Each value is a + * bitmap of "enum ofp_port_features" bits, in host byte order. Returns 0 if + * successful, otherwise a positive errno value. On failure, all of the + * passed-in values are set to 0. + */ +static int +netdev_bsd_get_features(const struct netdev *netdev, + enum netdev_features *current, uint32_t *advertised, + enum netdev_features *supported, uint32_t *peer) +{ + struct ifmediareq ifmr; + int *media_list; + int i; + int error; + + + /* XXX Look into SIOCGIFCAP instead of SIOCGIFMEDIA */ + + memset(&ifmr, 0, sizeof(ifmr)); + strncpy(ifmr.ifm_name, netdev_get_name(netdev), sizeof ifmr.ifm_name); + + /* We make two SIOCGIFMEDIA ioctl calls. The first to determine the + * number of supported modes, and a second with a buffer to retrieve + * them. */ + if (ioctl(af_inet_sock, SIOCGIFMEDIA, &ifmr) == -1) { + VLOG_DBG_RL(&rl, "%s: ioctl(SIOCGIFMEDIA) failed: %s", + netdev_get_name(netdev), strerror(errno)); + return errno; + } + + media_list = xcalloc(ifmr.ifm_count, sizeof(int)); + ifmr.ifm_ulist = media_list; + + if (!IFM_TYPE(ifmr.ifm_current) & IFM_ETHER) { + VLOG_DBG_RL(&rl, "%s: doesn't appear to be ethernet", + netdev_get_name(netdev)); + error = EINVAL; + goto cleanup; + } + + if (ioctl(af_inet_sock, SIOCGIFMEDIA, &ifmr) == -1) { + VLOG_DBG_RL(&rl, "%s: ioctl(SIOCGIFMEDIA) failed: %s", + netdev_get_name(netdev), strerror(errno)); + error = errno; + goto cleanup; + } + + /* Current settings. */ + *current = netdev_bsd_parse_media(ifmr.ifm_active); + + /* Advertised features. */ + *advertised = netdev_bsd_parse_media(ifmr.ifm_current); + + /* Supported features. */ + *supported = 0; + for (i = 0; i < ifmr.ifm_count; i++) { + *supported |= netdev_bsd_parse_media(ifmr.ifm_ulist[i]); + } + + /* Peer advertisements. */ + *peer = 0; /* XXX */ + + error = 0; +cleanup: + free(media_list); + return error; +} + +/* + * If 'netdev' has an assigned IPv4 address, sets '*in4' to that address (if + * 'in4' is non-null) and returns true. Otherwise, returns false. + */ +static int +netdev_bsd_get_in4(const struct netdev *netdev_, struct in_addr *in4, + struct in_addr *netmask) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + + if (!(netdev_dev->cache_valid & VALID_IN4)) { + const struct sockaddr_in *sin; + struct ifreq ifr; + int error; + + ifr.ifr_addr.sa_family = AF_INET; + error = netdev_bsd_do_ioctl(netdev_, &ifr, + SIOCGIFADDR, "SIOCGIFADDR"); + if (error) { + return error; + } + + sin = (struct sockaddr_in *) &ifr.ifr_addr; + netdev_dev->in4 = sin->sin_addr; + netdev_dev->cache_valid |= VALID_IN4; + error = netdev_bsd_do_ioctl(netdev_, &ifr, + SIOCGIFNETMASK, "SIOCGIFNETMASK"); + if (error) { + return error; + } + *netmask = ((struct sockaddr_in*)&ifr.ifr_addr)->sin_addr; + } + *in4 = netdev_dev->in4; + + return in4->s_addr == INADDR_ANY ? EADDRNOTAVAIL : 0; +} + +/* + * Assigns 'addr' as 'netdev''s IPv4 address and 'mask' as its netmask. If + * 'addr' is INADDR_ANY, 'netdev''s IPv4 address is cleared. Returns a + * positive errno value. + */ +static int +netdev_bsd_set_in4(struct netdev *netdev_, struct in_addr addr, + struct in_addr mask) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + int error; + + error = do_set_addr(netdev_, SIOCSIFADDR, "SIOCSIFADDR", addr); + if (!error) { + netdev_dev->cache_valid |= VALID_IN4; + netdev_dev->in4 = addr; + if (addr.s_addr != INADDR_ANY) { + error = do_set_addr(netdev_, SIOCSIFNETMASK, + "SIOCSIFNETMASK", mask); + } + netdev_dev_bsd_changed(netdev_dev); + } + return error; +} + +static int +netdev_bsd_get_in6(const struct netdev *netdev_, struct in6_addr *in6) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + if (!(netdev_dev->cache_valid & VALID_IN6)) { + struct ifaddrs *ifa, *head; + struct sockaddr_in6 *sin6; + const char *netdev_name = netdev_get_name(netdev_); + + if (getifaddrs(&head) != 0) { + VLOG_ERR("getifaddrs on %s device failed: %s", netdev_name, + strerror(errno)); + return errno; + } + + for (ifa = head; ifa; ifa = ifa->ifa_next) { + if (ifa->ifa_addr->sa_family == AF_INET6 && + !strcmp(ifa->ifa_name, netdev_name)) { + sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; + if (sin6) { + memcpy(&netdev_dev->in6, &sin6->sin6_addr, sin6->sin6_len); + netdev_dev->cache_valid |= VALID_IN6; + *in6 = netdev_dev->in6; + freeifaddrs(head); + return 0; + } + } + } + return EADDRNOTAVAIL; + } + *in6 = netdev_dev->in6; + return 0; +} + +static void +make_in4_sockaddr(struct sockaddr *sa, struct in_addr addr) +{ + struct sockaddr_in sin; + memset(&sin, 0, sizeof sin); + sin.sin_family = AF_INET; + sin.sin_addr = addr; + sin.sin_port = 0; + + memset(sa, 0, sizeof *sa); + memcpy(sa, &sin, sizeof sin); +} + +static int +do_set_addr(struct netdev *netdev, + int ioctl_nr, const char *ioctl_name, struct in_addr addr) +{ + struct ifreq ifr; + make_in4_sockaddr(&ifr.ifr_addr, addr); + return netdev_bsd_do_ioctl(netdev, &ifr, ioctl_nr, ioctl_name); +} + +static int +nd_to_iff_flags(enum netdev_flags nd) +{ + int iff = 0; + if (nd & NETDEV_UP) { + iff |= IFF_UP; + } + if (nd & NETDEV_PROMISC) { + iff |= IFF_PROMISC; + iff |= IFF_PPROMISC; + } + return iff; +} + +static int +iff_to_nd_flags(int iff) +{ + enum netdev_flags nd = 0; + if (iff & IFF_UP) { + nd |= NETDEV_UP; + } + if (iff & IFF_PROMISC) { + nd |= NETDEV_PROMISC; + } + return nd; +} + +static int +netdev_bsd_update_flags(struct netdev *netdev, enum netdev_flags off, + enum netdev_flags on, enum netdev_flags *old_flagsp) +{ + int old_flags, new_flags; + int error; + + error = get_flags(netdev, &old_flags); + if (!error) { + *old_flagsp = iff_to_nd_flags(old_flags); + new_flags = (old_flags & ~nd_to_iff_flags(off)) | nd_to_iff_flags(on); + if (new_flags != old_flags) { + error = set_flags(netdev, new_flags); + netdev_dev_bsd_changed(netdev_dev_bsd_cast(netdev_get_dev(netdev))); + } + } + return error; +} + +static unsigned int +netdev_bsd_change_seq(const struct netdev *netdev) +{ + return netdev_dev_bsd_cast(netdev_get_dev(netdev))->change_seq; +} + + +const struct netdev_class netdev_bsd_class = { + "system", + + netdev_bsd_init, + netdev_bsd_run, + netdev_bsd_wait, + netdev_bsd_create_system, + netdev_bsd_destroy, + NULL, /* get_config */ + NULL, /* set_config */ + netdev_bsd_open_system, + netdev_bsd_close, + + netdev_bsd_listen, + + netdev_bsd_recv, + netdev_bsd_recv_wait, + netdev_bsd_drain, + + netdev_bsd_send, + netdev_bsd_send_wait, + + netdev_bsd_set_etheraddr, + netdev_bsd_get_etheraddr, + netdev_bsd_get_mtu, + NULL, /* set_mtu */ + netdev_bsd_get_ifindex, + netdev_bsd_get_carrier, + NULL, /* get_carrier_resets */ + NULL, /* set_miimon_interval */ + netdev_bsd_get_stats, + NULL, /* set_stats */ + + netdev_bsd_get_features, + NULL, /* set_advertisement */ + NULL, /* set_policing */ + NULL, /* get_qos_type */ + NULL, /* get_qos_capabilities */ + NULL, /* get_qos */ + NULL, /* set_qos */ + NULL, /* get_queue */ + NULL, /* set_queue */ + NULL, /* delete_queue */ + NULL, /* get_queue_stats */ + NULL, /* dump_queue */ + NULL, /* dump_queue_stats */ + + netdev_bsd_get_in4, + netdev_bsd_set_in4, + netdev_bsd_get_in6, + NULL, /* add_router */ + NULL, /* get_next_hop */ + NULL, /* get_drv_info */ + NULL, /* arp_lookup */ + + netdev_bsd_update_flags, + + netdev_bsd_change_seq +}; + +const struct netdev_class netdev_tap_class = { + "tap", + + netdev_bsd_init, + netdev_bsd_run, + netdev_bsd_wait, + netdev_bsd_create_tap, + netdev_bsd_destroy, + NULL, /* get_config */ + NULL, /* set_config */ + netdev_bsd_open_system, + netdev_bsd_close, + + netdev_bsd_listen, + + netdev_bsd_recv, + netdev_bsd_recv_wait, + netdev_bsd_drain, + + netdev_bsd_send, + netdev_bsd_send_wait, + + netdev_bsd_set_etheraddr, + netdev_bsd_get_etheraddr, + netdev_bsd_get_mtu, + NULL, /* set_mtu */ + netdev_bsd_get_ifindex, + netdev_bsd_get_carrier, + NULL, /* get_carrier_resets */ + NULL, /* set_miimon_interval */ + netdev_bsd_get_stats, + NULL, /* set_stats */ + + netdev_bsd_get_features, + NULL, /* set_advertisement */ + NULL, /* set_policing */ + NULL, /* get_qos_type */ + NULL, /* get_qos_capabilities */ + NULL, /* get_qos */ + NULL, /* set_qos */ + NULL, /* get_queue */ + NULL, /* set_queue */ + NULL, /* delete_queue */ + NULL, /* get_queue_stats */ + NULL, /* dump_queue */ + NULL, /* dump_queue_stats */ + + netdev_bsd_get_in4, + netdev_bsd_set_in4, + netdev_bsd_get_in6, + NULL, /* add_router */ + NULL, /* get_next_hop */ + NULL, /* get_drv_info */ + NULL, /* arp_lookup */ + + netdev_bsd_update_flags, + + netdev_bsd_change_seq +}; + + +static void +destroy_tap(int fd, const char *name) +{ + struct ifreq ifr; + + close(fd); + strcpy(ifr.ifr_name, name); + /* XXX What to do if this call fails? */ + ioctl(af_inet_sock, SIOCIFDESTROY, &ifr); +} + +static int +get_flags(const struct netdev *netdev, int *flags) +{ + struct ifreq ifr; + int error; + + error = netdev_bsd_do_ioctl(netdev, &ifr, SIOCGIFFLAGS, "SIOCGIFFLAGS"); + + *flags = 0xFFFF0000 & (ifr.ifr_flagshigh << 16); + *flags |= 0x0000FFFF & ifr.ifr_flags; + + return error; +} + +static int +set_flags(struct netdev *netdev, int flags) +{ + struct ifreq ifr; + + ifr.ifr_flags = 0x0000FFFF & flags; + ifr.ifr_flagshigh = (0xFFFF0000 & flags) >> 16; + + return netdev_bsd_do_ioctl(netdev, &ifr, SIOCSIFFLAGS, "SIOCSIFFLAGS"); +} + +static int +get_ifindex(const struct netdev *netdev_, int *ifindexp) +{ + struct netdev_dev_bsd *netdev_dev = + netdev_dev_bsd_cast(netdev_get_dev(netdev_)); + *ifindexp = 0; + if (!(netdev_dev->cache_valid & VALID_IFINDEX)) { + int ifindex = if_nametoindex(netdev_get_name(netdev_)); + if (ifindex <= 0) { + return errno; + } + netdev_dev->cache_valid |= VALID_IFINDEX; + netdev_dev->ifindex = ifindex; + } + *ifindexp = netdev_dev->ifindex; + return 0; +} + +static int +get_etheraddr(const char *netdev_name, uint8_t ea[ETH_ADDR_LEN]) +{ + struct ifaddrs *head; + struct ifaddrs *ifa; + struct sockaddr_dl *sdl; + + if (getifaddrs(&head) != 0) { + VLOG_ERR("getifaddrs on %s device failed: %s", netdev_name, + strerror(errno)); + return errno; + } + + for (ifa = head; ifa; ifa = ifa->ifa_next) { + if (ifa->ifa_addr->sa_family == AF_LINK) { + if (!strcmp(ifa->ifa_name, netdev_name)) { + sdl = (struct sockaddr_dl *)ifa->ifa_addr; + if (sdl) { + memcpy(ea, LLADDR(sdl), sdl->sdl_alen); + freeifaddrs(head); + return 0; + } + } + } + } + + VLOG_ERR("could not find ethernet address for %s device", netdev_name); + freeifaddrs(head); + return ENODEV; +} + +static int +set_etheraddr(const char *netdev_name, int hwaddr_family, + int hwaddr_len, const uint8_t mac[ETH_ADDR_LEN]) +{ + struct ifreq ifr; + + memset(&ifr, 0, sizeof ifr); + strncpy(ifr.ifr_name, netdev_name, sizeof ifr.ifr_name); + ifr.ifr_addr.sa_family = hwaddr_family; + ifr.ifr_addr.sa_len = hwaddr_len; + memcpy(ifr.ifr_addr.sa_data, mac, hwaddr_len); + //COVERAGE_INC(netdev_set_hwaddr); + if (ioctl(af_inet_sock, SIOCSIFLLADDR, &ifr) < 0) { + VLOG_ERR("ioctl(SIOCSIFLLADDR) on %s device failed: %s", + netdev_name, strerror(errno)); + return errno; + } + return 0; +} + +static int +netdev_bsd_do_ioctl(const struct netdev *netdev, struct ifreq *ifr, + unsigned long cmd, const char *cmd_name) +{ + strncpy(ifr->ifr_name, netdev_get_name(netdev), sizeof ifr->ifr_name); + if (ioctl(af_inet_sock, cmd, ifr) == -1) { + VLOG_DBG_RL(&rl, "%s: ioctl(%s) failed: %s", + netdev_get_name(netdev), cmd_name, strerror(errno)); + return errno; + } + return 0; +} diff --git a/lib/netdev-provider.h b/lib/netdev-provider.h index 5fb1bbf23..94f60af72 100644 --- a/lib/netdev-provider.h +++ b/lib/netdev-provider.h @@ -596,6 +596,9 @@ const struct netdev_class *netdev_lookup_provider(const char *type); extern const struct netdev_class netdev_linux_class; extern const struct netdev_class netdev_internal_class; extern const struct netdev_class netdev_tap_class; +#ifdef __FreeBSD__ +extern const struct netdev_class netdev_bsd_class; +#endif #ifdef __cplusplus } diff --git a/lib/netdev.c b/lib/netdev.c index 1b76785ae..ac98cb52b 100644 --- a/lib/netdev.c +++ b/lib/netdev.c @@ -80,6 +80,10 @@ netdev_initialize(void) netdev_register_provider(&netdev_internal_class); netdev_register_provider(&netdev_tap_class); netdev_vport_register(); +#endif +#ifdef __FreeBSD__ + netdev_register_provider(&netdev_tap_class); + netdev_register_provider(&netdev_bsd_class); #endif } } diff --git a/lib/rtbsd.c b/lib/rtbsd.c new file mode 100644 index 000000000..e115ad9e8 --- /dev/null +++ b/lib/rtbsd.c @@ -0,0 +1,166 @@ +/* + * Copyright (c) 2011 Gaetano Catalli. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED ``AS IS'' WITHOUT ANY WARRANTIES OF ANY KIND. + */ + +#include + +#include +#include +#include +#include +#include +#include + +#include "coverage.h" +#include "socket-util.h" +#include "poll-loop.h" +#include "vlog.h" +#include "rtbsd.h" + +VLOG_DEFINE_THIS_MODULE(rtbsd); + +/* PF_ROUTE socket. */ +static int notify_sock = -1; + +/* All registered notifiers. */ +static struct list all_notifiers = LIST_INITIALIZER(&all_notifiers); + +static void rtbsd_report_change(const struct if_msghdr *); +static void rtbsd_report_notify_error(void); + +/* Registers 'cb' to be called with auxiliary data 'aux' with network device + * change notifications. The notifier is stored in 'notifier', which the + * caller must not modify or free. + * + * Returns 0 if successful, otherwise a positive errno value. */ +int +rtbsd_notifier_register(struct rtbsd_notifier *notifier, + rtbsd_notify_func *cb, void *aux) +{ + if (notify_sock < 0) { + int error; + notify_sock = socket(PF_ROUTE, SOCK_RAW, 0); + if (notify_sock < 0) { + VLOG_WARN("could not create PF_ROUTE socket: %s", + strerror(errno)); + return errno; + } + error = set_nonblocking(notify_sock); + if (error) { + VLOG_WARN("error set_nonblocking PF_ROUTE socket: %s", + strerror(error)); + return error; + } + } else { + /* Catch up on notification work so that the new notifier won't + * receive any stale notifications. XXX*/ + rtbsd_notifier_run(); + } + + list_push_back(&all_notifiers, ¬ifier->node); + notifier->cb = cb; + notifier->aux = aux; + return 0; +} + +/* Cancels notification on 'notifier', which must have previously been + * registered with rtbsd_notifier_register(). */ +void +rtbsd_notifier_unregister(struct rtbsd_notifier *notifier) +{ + list_remove(¬ifier->node); + if (list_is_empty(&all_notifiers)) { + close(notify_sock); + notify_sock = -1; + } +} + +/* Calls all of the registered notifiers, passing along any as-yet-unreported + * netdev change events. */ +void +rtbsd_notifier_run(void) +{ + static struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(1, 5); + struct if_msghdr msg; + if (notify_sock < 0) { + return; + } + + for (;;) { + int retval; + + msg.ifm_type = RTM_IFINFO; + msg.ifm_version = RTM_VERSION; //XXX check if necessary + + /* read from PF_ROUTE socket */ + retval = read(notify_sock, (char *)&msg, sizeof(msg)); + if (retval >= 0) { + /* received packet from PF_ROUTE socket + * XXX check for bad packets */ + if (msg.ifm_type == RTM_IFINFO) { + rtbsd_report_change(&msg); + } + } else if (errno == EAGAIN) { + return; + } else { + if (errno == ENOBUFS) { + VLOG_WARN_RL(&rl, "PF_ROUTE receive buffer overflowed"); + } else { + VLOG_WARN_RL(&rl, "error reading PF_ROUTE socket: %s", + strerror(errno)); + } + rtbsd_report_notify_error(); + } + } +} + +/* Causes poll_block() to wake up when network device change notifications are + * ready. */ +void +rtbsd_notifier_wait(void) +{ + if (notify_sock >= 0) { + poll_fd_wait(notify_sock, POLLIN); + } +} + +static void +rtbsd_report_change(const struct if_msghdr *msg) +{ + struct rtbsd_notifier *notifier; + struct rtbsd_change change; + + /*COVERAGE_INC(rtbsd_changed);*/ /* XXX update coverage-counters.c */ + + change.msg_type = msg->ifm_type; //XXX + change.if_index = msg->ifm_index; + if_indextoname(msg->ifm_index, change.if_name); + change.master_ifindex = 0; //XXX + + LIST_FOR_EACH (notifier, node, &all_notifiers) { + notifier->cb(&change, notifier->aux); + } +} + +/* If an error occurs the notifiers' callbacks are called with NULL changes */ +static void +rtbsd_report_notify_error(void) +{ + struct rtbsd_notifier *notifier; + + LIST_FOR_EACH (notifier, node, &all_notifiers) { + notifier->cb(NULL, notifier->aux); + } +} diff --git a/lib/rtbsd.h b/lib/rtbsd.h new file mode 100644 index 000000000..2c30909b5 --- /dev/null +++ b/lib/rtbsd.h @@ -0,0 +1,58 @@ +/* + * Copyright (c) 2011 Gaetano Catalli. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED ``AS IS'' WITHOUT ANY WARRANTIES OF ANY KIND. + */ + +#ifndef RTBSD_H +#define RTBSD_H 1 + +#include "list.h" + +/* + * A digested version of a message received from a PF_ROUTE socket which + * indicates that a network device has been created or destroyed or changed. + */ +struct rtbsd_change { + /* Copied from struct if_msghdr. */ + int msg_type; /* e.g. XXX. */ + + /* Copied from struct if_msghdr. */ + int if_index; /* Index of network device. */ + + char if_name[IF_NAMESIZE]; /* Name of network device. */ + int master_ifindex; /* Ifindex of datapath master (0 if none). */ +}; + +/* + * Function called to report that a netdev has changed. 'change' describes the + * specific change. It may be null if the buffer of change information + * overflowed, in which case the function must assume that every device may + * have changed. 'aux' is as specified in the call to + * rtbsd_notifier_register(). + */ +typedef void rtbsd_notify_func(const struct rtbsd_change *, void *aux); + +struct rtbsd_notifier { + struct list node; + rtbsd_notify_func *cb; + void *aux; +}; + +int rtbsd_notifier_register(struct rtbsd_notifier *, + rtbsd_notify_func *, void *aux); +void rtbsd_notifier_unregister(struct rtbsd_notifier *); +void rtbsd_notifier_run(void); +void rtbsd_notifier_wait(void); + +#endif /* rtbsd.h */