net/tap: add speed capabilities
[dpdk.git] / drivers / net / tap / rte_eth_tap.c
index fcf4a1d..c531feb 100644 (file)
@@ -114,6 +114,7 @@ struct pmd_internals {
        struct ether_addr eth_addr;     /* Mac address of the device port */
 
        int if_index;                   /* IF_INDEX for the port */
+       int ioctl_sock;                 /* socket for ioctl calls */
 
        struct rx_queue rxq[RTE_PMD_TAP_MAX_QUEUES];    /* List of RX queues */
        struct tx_queue txq[RTE_PMD_TAP_MAX_QUEUES];    /* List of TX queues */
@@ -126,6 +127,10 @@ tap_trigger_cb(int sig __rte_unused)
        tap_trigger = (tap_trigger + 1) | 0x80000000;
 }
 
+static int
+tap_ioctl(struct pmd_internals *pmd, unsigned long request,
+         struct ifreq *ifr, int set);
+
 /* Tun/Tap allocation routine
  *
  * name is the number of the interface to use, unless NULL to take the host
@@ -228,13 +233,12 @@ tun_alloc(struct pmd_internals *pmd, uint16_t qid)
        }
 
        if (qid == 0) {
-               if (ioctl(fd, SIOCGIFHWADDR, &ifr) == -1) {
-                       RTE_LOG(ERR, PMD, "ioctl failed (SIOCGIFHWADDR) (%s)\n",
-                               ifr.ifr_name);
-                       goto error;
-               }
+               struct ifreq ifr;
 
-               rte_memcpy(&pmd->eth_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
+               if (tap_ioctl(pmd, SIOCGIFHWADDR, &ifr, 0) < 0)
+                       goto error;
+               rte_memcpy(&pmd->eth_addr, ifr.ifr_hwaddr.sa_data,
+                          ETHER_ADDR_LEN);
        }
 
        return fd;
@@ -328,63 +332,59 @@ pmd_tx_burst(void *queue, struct rte_mbuf **bufs, uint16_t nb_pkts)
 }
 
 static int
-tap_link_set_flags(struct pmd_internals *pmd, short flags, int add)
+tap_ioctl(struct pmd_internals *pmd, unsigned long request,
+         struct ifreq *ifr, int set)
 {
-       struct ifreq ifr;
-       int err, s;
-
-       /*
-        * An AF_INET/DGRAM socket is needed for
-        * SIOCGIFFLAGS/SIOCSIFFLAGS, using fd won't work.
-        */
-       s = socket(AF_INET, SOCK_DGRAM, 0);
-       if (s < 0) {
-               RTE_LOG(ERR, PMD,
-                       "Unable to get a socket to set flags: %s\n",
-                       strerror(errno));
-               return -1;
-       }
-       memset(&ifr, 0, sizeof(ifr));
-       snprintf(ifr.ifr_name, IFNAMSIZ, "%s", pmd->name);
-       err = ioctl(s, SIOCGIFFLAGS, &ifr);
-       if (err < 0) {
-               RTE_LOG(WARNING, PMD, "Unable to get %s device flags: %s\n",
-                       pmd->name, strerror(errno));
-               close(s);
-               return -1;
-       }
-       if (add)
-               ifr.ifr_flags |= flags;
-       else
-               ifr.ifr_flags &= ~flags;
-       err = ioctl(s, SIOCSIFFLAGS, &ifr);
-       if (err < 0) {
-               RTE_LOG(WARNING, PMD, "Unable to %s flags 0x%x: %s\n",
-                       add ? "set" : "unset", flags, strerror(errno));
-               close(s);
-               return -1;
-       }
-       close(s);
+       short req_flags = ifr->ifr_flags;
 
+       snprintf(ifr->ifr_name, IFNAMSIZ, "%s", pmd->name);
+       switch (request) {
+       case SIOCSIFFLAGS:
+               /* fetch current flags to leave other flags untouched */
+               if (ioctl(pmd->ioctl_sock, SIOCGIFFLAGS, ifr) < 0)
+                       goto error;
+               if (set)
+                       ifr->ifr_flags |= req_flags;
+               else
+                       ifr->ifr_flags &= ~req_flags;
+               break;
+       case SIOCGIFHWADDR:
+       case SIOCSIFHWADDR:
+       case SIOCSIFMTU:
+               break;
+       default:
+               RTE_LOG(WARNING, PMD, "%s: ioctl() called with wrong arg\n",
+                       pmd->name);
+               return -EINVAL;
+       }
+       if (ioctl(pmd->ioctl_sock, request, ifr) < 0)
+               goto error;
        return 0;
+
+error:
+       RTE_LOG(ERR, PMD, "%s: ioctl(%lu) failed with error: %s\n",
+               ifr->ifr_name, request, strerror(errno));
+       return -errno;
 }
 
 static int
 tap_link_set_down(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_UP };
 
        dev->data->dev_link.link_status = ETH_LINK_DOWN;
-       return tap_link_set_flags(pmd, IFF_UP, 0);
+       return tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 0);
 }
 
 static int
 tap_link_set_up(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_UP };
 
        dev->data->dev_link.link_status = ETH_LINK_UP;
-       return tap_link_set_flags(pmd, IFF_UP, 1);
+       return tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 1);
 }
 
 static int
@@ -407,6 +407,40 @@ tap_dev_configure(struct rte_eth_dev *dev __rte_unused)
        return 0;
 }
 
+static uint32_t
+tap_dev_speed_capa(void)
+{
+       uint32_t speed = pmd_link.link_speed;
+       uint32_t capa = 0;
+
+       if (speed >= ETH_SPEED_NUM_10M)
+               capa |= ETH_LINK_SPEED_10M;
+       if (speed >= ETH_SPEED_NUM_100M)
+               capa |= ETH_LINK_SPEED_100M;
+       if (speed >= ETH_SPEED_NUM_1G)
+               capa |= ETH_LINK_SPEED_1G;
+       if (speed >= ETH_SPEED_NUM_5G)
+               capa |= ETH_LINK_SPEED_2_5G;
+       if (speed >= ETH_SPEED_NUM_5G)
+               capa |= ETH_LINK_SPEED_5G;
+       if (speed >= ETH_SPEED_NUM_10G)
+               capa |= ETH_LINK_SPEED_10G;
+       if (speed >= ETH_SPEED_NUM_20G)
+               capa |= ETH_LINK_SPEED_20G;
+       if (speed >= ETH_SPEED_NUM_25G)
+               capa |= ETH_LINK_SPEED_25G;
+       if (speed >= ETH_SPEED_NUM_40G)
+               capa |= ETH_LINK_SPEED_40G;
+       if (speed >= ETH_SPEED_NUM_50G)
+               capa |= ETH_LINK_SPEED_50G;
+       if (speed >= ETH_SPEED_NUM_56G)
+               capa |= ETH_LINK_SPEED_56G;
+       if (speed >= ETH_SPEED_NUM_100G)
+               capa |= ETH_LINK_SPEED_100G;
+
+       return capa;
+}
+
 static void
 tap_dev_info(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
 {
@@ -419,6 +453,7 @@ tap_dev_info(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
        dev_info->max_tx_queues = internals->nb_queues;
        dev_info->min_rx_bufsize = 0;
        dev_info->pci_dev = NULL;
+       dev_info->speed_capa = tap_dev_speed_capa();
 }
 
 static void
@@ -518,36 +553,60 @@ static void
 tap_promisc_enable(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_PROMISC };
 
        dev->data->promiscuous = 1;
-       tap_link_set_flags(pmd, IFF_PROMISC, 1);
+       tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 1);
 }
 
 static void
 tap_promisc_disable(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_PROMISC };
 
        dev->data->promiscuous = 0;
-       tap_link_set_flags(pmd, IFF_PROMISC, 0);
+       tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 0);
 }
 
 static void
 tap_allmulti_enable(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_ALLMULTI };
 
        dev->data->all_multicast = 1;
-       tap_link_set_flags(pmd, IFF_ALLMULTI, 1);
+       tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 1);
 }
 
 static void
 tap_allmulti_disable(struct rte_eth_dev *dev)
 {
        struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_flags = IFF_ALLMULTI };
 
        dev->data->all_multicast = 0;
-       tap_link_set_flags(pmd, IFF_ALLMULTI, 0);
+       tap_ioctl(pmd, SIOCSIFFLAGS, &ifr, 0);
+}
+
+
+static void
+tap_mac_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr)
+{
+       struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr;
+
+       if (is_zero_ether_addr(mac_addr)) {
+               RTE_LOG(ERR, PMD, "%s: can't set an empty MAC address\n",
+                       dev->data->name);
+               return;
+       }
+
+       ifr.ifr_hwaddr.sa_family = AF_LOCAL;
+       rte_memcpy(ifr.ifr_hwaddr.sa_data, mac_addr, ETHER_ADDR_LEN);
+       if (tap_ioctl(pmd, SIOCSIFHWADDR, &ifr, 1) < 0)
+               return;
+       rte_memcpy(&pmd->eth_addr, mac_addr, ETHER_ADDR_LEN);
 }
 
 static int
@@ -572,6 +631,15 @@ tap_setup_queue(struct rte_eth_dev *dev,
                                        pmd->name, qid);
                                return -1;
                        }
+                       if (qid == 0) {
+                               struct ifreq ifr;
+
+                               ifr.ifr_mtu = dev->data->mtu;
+                               if (tap_ioctl(pmd, SIOCSIFMTU, &ifr, 1) < 0) {
+                                       close(fd);
+                                       return -1;
+                               }
+                       }
                }
        }
 
@@ -668,6 +736,20 @@ tap_tx_queue_setup(struct rte_eth_dev *dev,
        return 0;
 }
 
+static int
+tap_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
+{
+       struct pmd_internals *pmd = dev->data->dev_private;
+       struct ifreq ifr = { .ifr_mtu = mtu };
+       int err = 0;
+
+       err = tap_ioctl(pmd, SIOCSIFMTU, &ifr, 1);
+       if (!err)
+               dev->data->mtu = mtu;
+
+       return err;
+}
+
 static const struct eth_dev_ops ops = {
        .dev_start              = tap_dev_start,
        .dev_stop               = tap_dev_stop,
@@ -685,6 +767,8 @@ static const struct eth_dev_ops ops = {
        .promiscuous_disable    = tap_promisc_disable,
        .allmulticast_enable    = tap_allmulti_enable,
        .allmulticast_disable   = tap_allmulti_disable,
+       .mac_addr_set           = tap_mac_set,
+       .mtu_set                = tap_mtu_set,
        .stats_get              = tap_stats_get,
        .stats_reset            = tap_stats_reset,
 };
@@ -724,9 +808,18 @@ eth_dev_tap_create(const char *name, char *tap_name)
 
        pmd->nb_queues = RTE_PMD_TAP_MAX_QUEUES;
 
+       pmd->ioctl_sock = socket(AF_INET, SOCK_DGRAM, 0);
+       if (pmd->ioctl_sock == -1) {
+               RTE_LOG(ERR, PMD,
+                       "TAP Unable to get a socket for management: %s\n",
+                       strerror(errno));
+               goto error_exit;
+       }
+
        /* Setup some default values */
        data->dev_private = pmd;
        data->port_id = dev->data->port_id;
+       data->mtu = dev->data->mtu;
        data->dev_flags = RTE_ETH_DEV_DETACHABLE;
        data->kdrv = RTE_KDRV_NONE;
        data->drv_name = pmd_tap_drv.driver.name;
@@ -866,6 +959,7 @@ rte_pmd_tap_remove(const char *name)
                if (internals->rxq[i].fd != -1)
                        close(internals->rxq[i].fd);
 
+       close(internals->ioctl_sock);
        rte_free(eth_dev->data->dev_private);
        rte_free(eth_dev->data);