fm10k: Correctly set the number of Tx queues
[cascardo/linux.git] / drivers / net / ethernet / intel / fm10k / fm10k_netdev.c
index 5dbb4d7..bf44a8f 100644 (file)
@@ -243,6 +243,9 @@ void fm10k_clean_all_tx_rings(struct fm10k_intfc *interface)
 
        for (i = 0; i < interface->num_tx_queues; i++)
                fm10k_clean_tx_ring(interface->tx_ring[i]);
+
+       /* remove any stale timestamp buffers and free them */
+       skb_queue_purge(&interface->ts_tx_skb_queue);
 }
 
 /**
@@ -368,7 +371,21 @@ static void fm10k_request_glort_range(struct fm10k_intfc *interface)
        if (hw->mac.dglort_map == FM10K_DGLORTMAP_NONE)
                return;
 
-       interface->glort_count = mask + 1;
+       /* we support 3 possible GLORT configurations.
+        * 1: VFs consume all but the last 1
+        * 2: VFs and PF split glorts with possible gap between
+        * 3: VFs allocated first 64, all others belong to PF
+        */
+       if (mask <= hw->iov.total_vfs) {
+               interface->glort_count = 1;
+               interface->glort += mask;
+       } else if (mask < 64) {
+               interface->glort_count = (mask + 1) / 2;
+               interface->glort += interface->glort_count;
+       } else {
+               interface->glort_count = mask - 63;
+               interface->glort += 64;
+       }
 }
 
 /**
@@ -529,6 +546,10 @@ int fm10k_open(struct net_device *netdev)
        fm10k_request_glort_range(interface);
 
        /* Notify the stack of the actual queue counts */
+       err = netif_set_real_num_tx_queues(netdev,
+                                          interface->num_tx_queues);
+       if (err)
+               goto err_set_queues;
 
        err = netif_set_real_num_rx_queues(netdev,
                                           interface->num_rx_queues);
@@ -584,7 +605,7 @@ int fm10k_close(struct net_device *netdev)
 static netdev_tx_t fm10k_xmit_frame(struct sk_buff *skb, struct net_device *dev)
 {
        struct fm10k_intfc *interface = netdev_priv(dev);
-       unsigned int r_idx = 0;
+       unsigned int r_idx = skb->queue_mapping;
        int err;
 
        if ((skb->protocol ==  htons(ETH_P_8021Q)) &&
@@ -637,6 +658,10 @@ static netdev_tx_t fm10k_xmit_frame(struct sk_buff *skb, struct net_device *dev)
                __skb_put(skb, pad_len);
        }
 
+       /* prepare packet for hardware time stamping */
+       if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP))
+               fm10k_ts_tx_enqueue(interface, skb);
+
        if (r_idx >= interface->num_tx_queues)
                r_idx %= interface->num_tx_queues;
 
@@ -976,6 +1001,21 @@ void fm10k_restore_rx_state(struct fm10k_intfc *interface)
        int xcast_mode;
        u16 vid, glort;
 
+       /* restore our address if perm_addr is set */
+       if (hw->mac.type == fm10k_mac_vf) {
+               if (is_valid_ether_addr(hw->mac.perm_addr)) {
+                       ether_addr_copy(hw->mac.addr, hw->mac.perm_addr);
+                       ether_addr_copy(netdev->perm_addr, hw->mac.perm_addr);
+                       ether_addr_copy(netdev->dev_addr, hw->mac.perm_addr);
+                       netdev->addr_assign_type &= ~NET_ADDR_RANDOM;
+               }
+
+               if (hw->mac.vlan_override)
+                       netdev->features &= ~NETIF_F_HW_VLAN_CTAG_RX;
+               else
+                       netdev->features |= NETIF_F_HW_VLAN_CTAG_RX;
+       }
+
        /* record glort for this interface */
        glort = interface->glort;
 
@@ -1148,6 +1188,167 @@ int fm10k_setup_tc(struct net_device *dev, u8 tc)
        return 0;
 }
 
+static int fm10k_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
+{
+       switch (cmd) {
+       case SIOCGHWTSTAMP:
+               return fm10k_get_ts_config(netdev, ifr);
+       case SIOCSHWTSTAMP:
+               return fm10k_set_ts_config(netdev, ifr);
+       default:
+               return -EOPNOTSUPP;
+       }
+}
+
+static void fm10k_assign_l2_accel(struct fm10k_intfc *interface,
+                                 struct fm10k_l2_accel *l2_accel)
+{
+       struct fm10k_ring *ring;
+       int i;
+
+       for (i = 0; i < interface->num_rx_queues; i++) {
+               ring = interface->rx_ring[i];
+               rcu_assign_pointer(ring->l2_accel, l2_accel);
+       }
+
+       interface->l2_accel = l2_accel;
+}
+
+static void *fm10k_dfwd_add_station(struct net_device *dev,
+                                   struct net_device *sdev)
+{
+       struct fm10k_intfc *interface = netdev_priv(dev);
+       struct fm10k_l2_accel *l2_accel = interface->l2_accel;
+       struct fm10k_l2_accel *old_l2_accel = NULL;
+       struct fm10k_dglort_cfg dglort = { 0 };
+       struct fm10k_hw *hw = &interface->hw;
+       int size = 0, i;
+       u16 glort;
+
+       /* allocate l2 accel structure if it is not available */
+       if (!l2_accel) {
+               /* verify there is enough free GLORTs to support l2_accel */
+               if (interface->glort_count < 7)
+                       return ERR_PTR(-EBUSY);
+
+               size = offsetof(struct fm10k_l2_accel, macvlan[7]);
+               l2_accel = kzalloc(size, GFP_KERNEL);
+               if (!l2_accel)
+                       return ERR_PTR(-ENOMEM);
+
+               l2_accel->size = 7;
+               l2_accel->dglort = interface->glort;
+
+               /* update pointers */
+               fm10k_assign_l2_accel(interface, l2_accel);
+       /* do not expand if we are at our limit */
+       } else if ((l2_accel->count == FM10K_MAX_STATIONS) ||
+                  (l2_accel->count == (interface->glort_count - 1))) {
+               return ERR_PTR(-EBUSY);
+       /* expand if we have hit the size limit */
+       } else if (l2_accel->count == l2_accel->size) {
+               old_l2_accel = l2_accel;
+               size = offsetof(struct fm10k_l2_accel,
+                               macvlan[(l2_accel->size * 2) + 1]);
+               l2_accel = kzalloc(size, GFP_KERNEL);
+               if (!l2_accel)
+                       return ERR_PTR(-ENOMEM);
+
+               memcpy(l2_accel, old_l2_accel,
+                      offsetof(struct fm10k_l2_accel,
+                               macvlan[old_l2_accel->size]));
+
+               l2_accel->size = (old_l2_accel->size * 2) + 1;
+
+               /* update pointers */
+               fm10k_assign_l2_accel(interface, l2_accel);
+               kfree_rcu(old_l2_accel, rcu);
+       }
+
+       /* add macvlan to accel table, and record GLORT for position */
+       for (i = 0; i < l2_accel->size; i++) {
+               if (!l2_accel->macvlan[i])
+                       break;
+       }
+
+       /* record station */
+       l2_accel->macvlan[i] = sdev;
+       l2_accel->count++;
+
+       /* configure default DGLORT mapping for RSS/DCB */
+       dglort.idx = fm10k_dglort_pf_rss;
+       dglort.inner_rss = 1;
+       dglort.rss_l = fls(interface->ring_feature[RING_F_RSS].mask);
+       dglort.pc_l = fls(interface->ring_feature[RING_F_QOS].mask);
+       dglort.glort = interface->glort;
+       dglort.shared_l = fls(l2_accel->size);
+       hw->mac.ops.configure_dglort_map(hw, &dglort);
+
+       /* Add rules for this specific dglort to the switch */
+       fm10k_mbx_lock(interface);
+
+       glort = l2_accel->dglort + 1 + i;
+       hw->mac.ops.update_xcast_mode(hw, glort, FM10K_XCAST_MODE_MULTI);
+       hw->mac.ops.update_uc_addr(hw, glort, sdev->dev_addr, 0, true, 0);
+
+       fm10k_mbx_unlock(interface);
+
+       return sdev;
+}
+
+static void fm10k_dfwd_del_station(struct net_device *dev, void *priv)
+{
+       struct fm10k_intfc *interface = netdev_priv(dev);
+       struct fm10k_l2_accel *l2_accel = ACCESS_ONCE(interface->l2_accel);
+       struct fm10k_dglort_cfg dglort = { 0 };
+       struct fm10k_hw *hw = &interface->hw;
+       struct net_device *sdev = priv;
+       int i;
+       u16 glort;
+
+       if (!l2_accel)
+               return;
+
+       /* search table for matching interface */
+       for (i = 0; i < l2_accel->size; i++) {
+               if (l2_accel->macvlan[i] == sdev)
+                       break;
+       }
+
+       /* exit if macvlan not found */
+       if (i == l2_accel->size)
+               return;
+
+       /* Remove any rules specific to this dglort */
+       fm10k_mbx_lock(interface);
+
+       glort = l2_accel->dglort + 1 + i;
+       hw->mac.ops.update_xcast_mode(hw, glort, FM10K_XCAST_MODE_NONE);
+       hw->mac.ops.update_uc_addr(hw, glort, sdev->dev_addr, 0, false, 0);
+
+       fm10k_mbx_unlock(interface);
+
+       /* record removal */
+       l2_accel->macvlan[i] = NULL;
+       l2_accel->count--;
+
+       /* configure default DGLORT mapping for RSS/DCB */
+       dglort.idx = fm10k_dglort_pf_rss;
+       dglort.inner_rss = 1;
+       dglort.rss_l = fls(interface->ring_feature[RING_F_RSS].mask);
+       dglort.pc_l = fls(interface->ring_feature[RING_F_QOS].mask);
+       dglort.glort = interface->glort;
+       if (l2_accel)
+               dglort.shared_l = fls(l2_accel->size);
+       hw->mac.ops.configure_dglort_map(hw, &dglort);
+
+       /* If table is empty remove it */
+       if (l2_accel->count == 0) {
+               fm10k_assign_l2_accel(interface, NULL);
+               kfree_rcu(l2_accel, rcu);
+       }
+}
+
 static const struct net_device_ops fm10k_netdev_ops = {
        .ndo_open               = fm10k_open,
        .ndo_stop               = fm10k_close,
@@ -1161,8 +1362,15 @@ static const struct net_device_ops fm10k_netdev_ops = {
        .ndo_set_rx_mode        = fm10k_set_rx_mode,
        .ndo_get_stats64        = fm10k_get_stats64,
        .ndo_setup_tc           = fm10k_setup_tc,
+       .ndo_set_vf_mac         = fm10k_ndo_set_vf_mac,
+       .ndo_set_vf_vlan        = fm10k_ndo_set_vf_vlan,
+       .ndo_set_vf_rate        = fm10k_ndo_set_vf_bw,
+       .ndo_get_vf_config      = fm10k_ndo_get_vf_config,
        .ndo_add_vxlan_port     = fm10k_add_vxlan_port,
        .ndo_del_vxlan_port     = fm10k_del_vxlan_port,
+       .ndo_do_ioctl           = fm10k_ioctl,
+       .ndo_dfwd_add_station   = fm10k_dfwd_add_station,
+       .ndo_dfwd_del_station   = fm10k_dfwd_del_station,
 };
 
 #define DEFAULT_DEBUG_LEVEL_SHIFT 3
@@ -1198,6 +1406,9 @@ struct net_device *fm10k_alloc_netdev(void)
        /* all features defined to this point should be changeable */
        dev->hw_features |= dev->features;
 
+       /* allow user to enable L2 forwarding acceleration */
+       dev->hw_features |= NETIF_F_HW_L2FW_DOFFLOAD;
+
        /* configure VLAN features */
        dev->vlan_features |= dev->features;