New upstream version 18.11-rc1
[deb_dpdk.git] / drivers / net / pcap / rte_eth_pcap.c
index e8810a1..7bbe72e 100644 (file)
@@ -7,6 +7,14 @@
 #include <time.h>
 
 #include <net/if.h>
+#include <sys/socket.h>
+#include <sys/ioctl.h>
+#include <unistd.h>
+
+#if defined(RTE_EXEC_ENV_BSDAPP)
+#include <sys/sysctl.h>
+#include <net/if_dl.h>
+#endif
 
 #include <pcap.h>
 
@@ -17,6 +25,7 @@
 #include <rte_malloc.h>
 #include <rte_mbuf.h>
 #include <rte_bus_vdev.h>
+#include <rte_string_fns.h>
 
 #define RTE_ETH_PCAP_SNAPSHOT_LEN 65535
 #define RTE_ETH_PCAP_SNAPLEN ETHER_MAX_JUMBO_FRAME_LEN
@@ -29,6 +38,7 @@
 #define ETH_PCAP_RX_IFACE_IN_ARG "rx_iface_in"
 #define ETH_PCAP_TX_IFACE_ARG "tx_iface"
 #define ETH_PCAP_IFACE_ARG    "iface"
+#define ETH_PCAP_PHY_MAC_ARG  "phy_mac"
 
 #define ETH_PCAP_ARG_MAXLEN    64
 
@@ -39,6 +49,7 @@ static unsigned char tx_pcap_data[RTE_ETH_PCAP_SNAPLEN];
 static struct timeval start_time;
 static uint64_t start_cycles;
 static uint64_t hz;
+static uint8_t iface_idx;
 
 struct queue_stat {
        volatile unsigned long pkts;
@@ -66,8 +77,10 @@ struct pcap_tx_queue {
 struct pmd_internals {
        struct pcap_rx_queue rx_queue[RTE_PMD_PCAP_MAX_QUEUES];
        struct pcap_tx_queue tx_queue[RTE_PMD_PCAP_MAX_QUEUES];
+       struct ether_addr eth_addr;
        int if_index;
        int single_iface;
+       int phy_mac;
 };
 
 struct pmd_devargs {
@@ -78,6 +91,7 @@ struct pmd_devargs {
                const char *name;
                const char *type;
        } queue[RTE_PMD_PCAP_MAX_QUEUES];
+       int phy_mac;
 };
 
 static const char *valid_arguments[] = {
@@ -87,13 +101,10 @@ static const char *valid_arguments[] = {
        ETH_PCAP_RX_IFACE_IN_ARG,
        ETH_PCAP_TX_IFACE_ARG,
        ETH_PCAP_IFACE_ARG,
+       ETH_PCAP_PHY_MAC_ARG,
        NULL
 };
 
-static struct ether_addr eth_addr = {
-       .addr_bytes = { 0, 0, 0, 0x1, 0x2, 0x3 }
-};
-
 static struct rte_eth_link pmd_link = {
                .link_speed = ETH_SPEED_NUM_10G,
                .link_duplex = ETH_LINK_FULL_DUPLEX,
@@ -553,7 +564,6 @@ eth_dev_info(struct rte_eth_dev *dev,
        dev_info->max_rx_queues = dev->data->nb_rx_queues;
        dev_info->max_tx_queues = dev->data->nb_tx_queues;
        dev_info->min_rx_bufsize = 0;
-       dev_info->rx_offload_capa = DEV_RX_OFFLOAD_CRC_STRIP;
 }
 
 static int
@@ -862,6 +872,20 @@ open_tx_iface(const char *key, const char *value, void *extra_args)
        return open_iface(key, value, extra_args);
 }
 
+static int
+select_phy_mac(const char *key __rte_unused, const char *value,
+               void *extra_args)
+{
+       if (extra_args) {
+               const int phy_mac = atoi(value);
+               int *enable_phy_mac = extra_args;
+
+               if (phy_mac)
+                       *enable_phy_mac = 1;
+       }
+       return 0;
+}
+
 static struct rte_vdev_driver pmd_pcap_drv;
 
 static int
@@ -889,11 +913,20 @@ pmd_init_internals(struct rte_vdev_device *vdev,
         * - and point eth_dev structure to new eth_dev_data structure
         */
        *internals = (*eth_dev)->data->dev_private;
+       /*
+        * Interface MAC = 02:70:63:61:70:<iface_idx>
+        * derived from: 'locally administered':'p':'c':'a':'p':'iface_idx'
+        * where the middle 4 characters are converted to hex.
+        */
+       (*internals)->eth_addr = (struct ether_addr) {
+               .addr_bytes = { 0x02, 0x70, 0x63, 0x61, 0x70, iface_idx++ }
+       };
+       (*internals)->phy_mac = 0;
        data = (*eth_dev)->data;
        data->nb_rx_queues = (uint16_t)nb_rx_queues;
        data->nb_tx_queues = (uint16_t)nb_tx_queues;
        data->dev_link = pmd_link;
-       data->mac_addrs = &eth_addr;
+       data->mac_addrs = &(*internals)->eth_addr;
 
        /*
         * NOTE: we'll replace the data element, of originally allocated
@@ -904,15 +937,96 @@ pmd_init_internals(struct rte_vdev_device *vdev,
        return 0;
 }
 
+static int
+eth_pcap_update_mac(const char *if_name, struct rte_eth_dev *eth_dev,
+               const unsigned int numa_node)
+{
+#if defined(RTE_EXEC_ENV_LINUXAPP)
+       void *mac_addrs;
+       struct ifreq ifr;
+       int if_fd = socket(AF_INET, SOCK_DGRAM, 0);
+
+       if (if_fd == -1)
+               return -1;
+
+       rte_strscpy(ifr.ifr_name, if_name, sizeof(ifr.ifr_name));
+       if (ioctl(if_fd, SIOCGIFHWADDR, &ifr)) {
+               close(if_fd);
+               return -1;
+       }
+
+       mac_addrs = rte_zmalloc_socket(NULL, ETHER_ADDR_LEN, 0, numa_node);
+       if (!mac_addrs) {
+               close(if_fd);
+               return -1;
+       }
+
+       PMD_LOG(INFO, "Setting phy MAC for %s", if_name);
+       eth_dev->data->mac_addrs = mac_addrs;
+       rte_memcpy(eth_dev->data->mac_addrs[0].addr_bytes,
+                       ifr.ifr_hwaddr.sa_data, ETHER_ADDR_LEN);
+
+       close(if_fd);
+
+       return 0;
+
+#elif defined(RTE_EXEC_ENV_BSDAPP)
+       void *mac_addrs;
+       struct if_msghdr *ifm;
+       struct sockaddr_dl *sdl;
+       int mib[6];
+       size_t len = 0;
+       char *buf;
+
+       mib[0] = CTL_NET;
+       mib[1] = AF_ROUTE;
+       mib[2] = 0;
+       mib[3] = AF_LINK;
+       mib[4] = NET_RT_IFLIST;
+       mib[5] = if_nametoindex(if_name);
+
+       if (sysctl(mib, 6, NULL, &len, NULL, 0) < 0)
+               return -1;
+
+       if (len == 0)
+               return -1;
+
+       buf = rte_malloc(NULL, len, 0);
+       if (!buf)
+               return -1;
+
+       if (sysctl(mib, 6, buf, &len, NULL, 0) < 0) {
+               rte_free(buf);
+               return -1;
+       }
+       ifm = (struct if_msghdr *)buf;
+       sdl = (struct sockaddr_dl *)(ifm + 1);
+
+       mac_addrs = rte_zmalloc_socket(NULL, ETHER_ADDR_LEN, 0, numa_node);
+       if (!mac_addrs) {
+               rte_free(buf);
+               return -1;
+       }
+
+       PMD_LOG(INFO, "Setting phy MAC for %s", if_name);
+       eth_dev->data->mac_addrs = mac_addrs;
+       rte_memcpy(eth_dev->data->mac_addrs[0].addr_bytes,
+                       LLADDR(sdl), ETHER_ADDR_LEN);
+
+       rte_free(buf);
+
+       return 0;
+#else
+       return -1;
+#endif
+}
+
 static int
 eth_from_pcaps_common(struct rte_vdev_device *vdev,
                struct pmd_devargs *rx_queues, const unsigned int nb_rx_queues,
                struct pmd_devargs *tx_queues, const unsigned int nb_tx_queues,
-               struct rte_kvargs *kvlist, struct pmd_internals **internals,
-               struct rte_eth_dev **eth_dev)
+               struct pmd_internals **internals, struct rte_eth_dev **eth_dev)
 {
-       struct rte_kvargs_pair *pair = NULL;
-       unsigned int k_idx;
        unsigned int i;
 
        /* do some parameter checking */
@@ -944,17 +1058,6 @@ eth_from_pcaps_common(struct rte_vdev_device *vdev,
                snprintf(tx->type, sizeof(tx->type), "%s", queue->type);
        }
 
-       for (k_idx = 0; k_idx < kvlist->count; k_idx++) {
-               pair = &kvlist->pairs[k_idx];
-               if (strstr(pair->key, ETH_PCAP_IFACE_ARG) != NULL)
-                       break;
-       }
-
-       if (pair == NULL)
-               (*internals)->if_index = 0;
-       else
-               (*internals)->if_index = if_nametoindex(pair->value);
-
        return 0;
 }
 
@@ -962,15 +1065,14 @@ static int
 eth_from_pcaps(struct rte_vdev_device *vdev,
                struct pmd_devargs *rx_queues, const unsigned int nb_rx_queues,
                struct pmd_devargs *tx_queues, const unsigned int nb_tx_queues,
-               struct rte_kvargs *kvlist, int single_iface,
-               unsigned int using_dumpers)
+               int single_iface, unsigned int using_dumpers)
 {
        struct pmd_internals *internals = NULL;
        struct rte_eth_dev *eth_dev = NULL;
        int ret;
 
        ret = eth_from_pcaps_common(vdev, rx_queues, nb_rx_queues,
-               tx_queues, nb_tx_queues, kvlist, &internals, &eth_dev);
+               tx_queues, nb_tx_queues, &internals, &eth_dev);
 
        if (ret < 0)
                return ret;
@@ -978,6 +1080,18 @@ eth_from_pcaps(struct rte_vdev_device *vdev,
        /* store weather we are using a single interface for rx/tx or not */
        internals->single_iface = single_iface;
 
+       if (single_iface) {
+               internals->if_index = if_nametoindex(rx_queues->queue[0].name);
+
+               /* phy_mac arg is applied only only if "iface" devarg is provided */
+               if (rx_queues->phy_mac) {
+                       int ret = eth_pcap_update_mac(rx_queues->queue[0].name,
+                                       eth_dev, vdev->device.numa_node);
+                       if (ret == 0)
+                               internals->phy_mac = 1;
+               }
+       }
+
        eth_dev->rx_pkt_burst = eth_pcap_rx;
 
        if (using_dumpers)
@@ -1008,8 +1122,7 @@ pmd_pcap_probe(struct rte_vdev_device *dev)
        start_cycles = rte_get_timer_cycles();
        hz = rte_get_timer_hz();
 
-       if (rte_eal_process_type() == RTE_PROC_SECONDARY &&
-           strlen(rte_vdev_device_args(dev)) == 0) {
+       if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
                eth_dev = rte_eth_dev_attach_secondary(name);
                if (!eth_dev) {
                        PMD_LOG(ERR, "Failed to probe %s", name);
@@ -1034,12 +1147,18 @@ pmd_pcap_probe(struct rte_vdev_device *dev)
 
                ret = rte_kvargs_process(kvlist, ETH_PCAP_IFACE_ARG,
                                &open_rx_tx_iface, &pcaps);
-
                if (ret < 0)
                        goto free_kvlist;
 
                dumpers.queue[0] = pcaps.queue[0];
 
+               ret = rte_kvargs_process(kvlist, ETH_PCAP_PHY_MAC_ARG,
+                               &select_phy_mac, &pcaps.phy_mac);
+               if (ret < 0)
+                       goto free_kvlist;
+
+               dumpers.phy_mac = pcaps.phy_mac;
+
                single_iface = 1;
                pcaps.num_of_queue = 1;
                dumpers.num_of_queue = 1;
@@ -1084,7 +1203,7 @@ pmd_pcap_probe(struct rte_vdev_device *dev)
 
 create_eth:
        ret = eth_from_pcaps(dev, &pcaps, pcaps.num_of_queue, &dumpers,
-               dumpers.num_of_queue, kvlist, single_iface, is_tx_pcap);
+               dumpers.num_of_queue, single_iface, is_tx_pcap);
 
 free_kvlist:
        rte_kvargs_free(kvlist);
@@ -1095,6 +1214,7 @@ free_kvlist:
 static int
 pmd_pcap_remove(struct rte_vdev_device *dev)
 {
+       struct pmd_internals *internals = NULL;
        struct rte_eth_dev *eth_dev = NULL;
 
        PMD_LOG(INFO, "Closing pcap ethdev on numa socket %d",
@@ -1108,7 +1228,12 @@ pmd_pcap_remove(struct rte_vdev_device *dev)
        if (eth_dev == NULL)
                return -1;
 
-       rte_free(eth_dev->data->dev_private);
+       if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
+               internals = eth_dev->data->dev_private;
+               if (internals != NULL && internals->phy_mac == 0)
+                       /* not dynamically allocated, must not be freed */
+                       eth_dev->data->mac_addrs = NULL;
+       }
 
        rte_eth_dev_release_port(eth_dev);
 
@@ -1128,7 +1253,8 @@ RTE_PMD_REGISTER_PARAM_STRING(net_pcap,
        ETH_PCAP_RX_IFACE_ARG "=<ifc> "
        ETH_PCAP_RX_IFACE_IN_ARG "=<ifc> "
        ETH_PCAP_TX_IFACE_ARG "=<ifc> "
-       ETH_PCAP_IFACE_ARG "=<ifc>");
+       ETH_PCAP_IFACE_ARG "=<ifc> "
+       ETH_PCAP_PHY_MAC_ARG "=<int>");
 
 RTE_INIT(eth_pcap_init_log)
 {