net/sfc: support flow control settings
[dpdk.git] / drivers / net / sfc / sfc_ethdev.c
index 77f22f8..0fb5e32 100644 (file)
@@ -323,17 +323,247 @@ sfc_tx_queue_release(void *queue)
        sfc_adapter_unlock(sa);
 }
 
+static void
+sfc_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
+{
+       struct sfc_adapter *sa = dev->data->dev_private;
+       struct sfc_port *port = &sa->port;
+       uint64_t *mac_stats;
+
+       rte_spinlock_lock(&port->mac_stats_lock);
+
+       if (sfc_port_update_mac_stats(sa) != 0)
+               goto unlock;
+
+       mac_stats = port->mac_stats_buf;
+
+       if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask,
+                                  EFX_MAC_VADAPTER_RX_UNICAST_PACKETS)) {
+               stats->ipackets =
+                       mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_PACKETS] +
+                       mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_PACKETS] +
+                       mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_PACKETS];
+               stats->opackets =
+                       mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_PACKETS] +
+                       mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_PACKETS] +
+                       mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_PACKETS];
+               stats->ibytes =
+                       mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_BYTES] +
+                       mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_BYTES] +
+                       mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_BYTES];
+               stats->obytes =
+                       mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_BYTES] +
+                       mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_BYTES] +
+                       mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_BYTES];
+               stats->imissed = mac_stats[EFX_MAC_VADAPTER_RX_OVERFLOW];
+               stats->ierrors = mac_stats[EFX_MAC_VADAPTER_RX_BAD_PACKETS];
+               stats->oerrors = mac_stats[EFX_MAC_VADAPTER_TX_BAD_PACKETS];
+       } else {
+               stats->ipackets = mac_stats[EFX_MAC_RX_PKTS];
+               stats->opackets = mac_stats[EFX_MAC_TX_PKTS];
+               stats->ibytes = mac_stats[EFX_MAC_RX_OCTETS];
+               stats->obytes = mac_stats[EFX_MAC_TX_OCTETS];
+               /*
+                * Take into account stats which are whenever supported
+                * on EF10. If some stat is not supported by current
+                * firmware variant or HW revision, it is guaranteed
+                * to be zero in mac_stats.
+                */
+               stats->imissed =
+                       mac_stats[EFX_MAC_RX_NODESC_DROP_CNT] +
+                       mac_stats[EFX_MAC_PM_TRUNC_BB_OVERFLOW] +
+                       mac_stats[EFX_MAC_PM_DISCARD_BB_OVERFLOW] +
+                       mac_stats[EFX_MAC_PM_TRUNC_VFIFO_FULL] +
+                       mac_stats[EFX_MAC_PM_DISCARD_VFIFO_FULL] +
+                       mac_stats[EFX_MAC_PM_TRUNC_QBB] +
+                       mac_stats[EFX_MAC_PM_DISCARD_QBB] +
+                       mac_stats[EFX_MAC_PM_DISCARD_MAPPING] +
+                       mac_stats[EFX_MAC_RXDP_Q_DISABLED_PKTS] +
+                       mac_stats[EFX_MAC_RXDP_DI_DROPPED_PKTS];
+               stats->ierrors =
+                       mac_stats[EFX_MAC_RX_FCS_ERRORS] +
+                       mac_stats[EFX_MAC_RX_ALIGN_ERRORS] +
+                       mac_stats[EFX_MAC_RX_JABBER_PKTS];
+               /* no oerrors counters supported on EF10 */
+       }
+
+unlock:
+       rte_spinlock_unlock(&port->mac_stats_lock);
+}
+
+static int
+sfc_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
+              unsigned int xstats_count)
+{
+       struct sfc_adapter *sa = dev->data->dev_private;
+       struct sfc_port *port = &sa->port;
+       uint64_t *mac_stats;
+       int rc;
+       unsigned int i;
+       int nstats = 0;
+
+       rte_spinlock_lock(&port->mac_stats_lock);
+
+       rc = sfc_port_update_mac_stats(sa);
+       if (rc != 0) {
+               SFC_ASSERT(rc > 0);
+               nstats = -rc;
+               goto unlock;
+       }
+
+       mac_stats = port->mac_stats_buf;
+
+       for (i = 0; i < EFX_MAC_NSTATS; ++i) {
+               if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
+                       if (xstats != NULL && nstats < (int)xstats_count) {
+                               xstats[nstats].id = nstats;
+                               xstats[nstats].value = mac_stats[i];
+                       }
+                       nstats++;
+               }
+       }
+
+unlock:
+       rte_spinlock_unlock(&port->mac_stats_lock);
+
+       return nstats;
+}
+
+static int
+sfc_xstats_get_names(struct rte_eth_dev *dev,
+                    struct rte_eth_xstat_name *xstats_names,
+                    unsigned int xstats_count)
+{
+       struct sfc_adapter *sa = dev->data->dev_private;
+       struct sfc_port *port = &sa->port;
+       unsigned int i;
+       unsigned int nstats = 0;
+
+       for (i = 0; i < EFX_MAC_NSTATS; ++i) {
+               if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
+                       if (xstats_names != NULL && nstats < xstats_count)
+                               strncpy(xstats_names[nstats].name,
+                                       efx_mac_stat_name(sa->nic, i),
+                                       sizeof(xstats_names[0].name));
+                       nstats++;
+               }
+       }
+
+       return nstats;
+}
+
+static int
+sfc_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
+{
+       struct sfc_adapter *sa = dev->data->dev_private;
+       unsigned int wanted_fc, link_fc;
+
+       memset(fc_conf, 0, sizeof(*fc_conf));
+
+       sfc_adapter_lock(sa);
+
+       if (sa->state == SFC_ADAPTER_STARTED)
+               efx_mac_fcntl_get(sa->nic, &wanted_fc, &link_fc);
+       else
+               link_fc = sa->port.flow_ctrl;
+
+       switch (link_fc) {
+       case 0:
+               fc_conf->mode = RTE_FC_NONE;
+               break;
+       case EFX_FCNTL_RESPOND:
+               fc_conf->mode = RTE_FC_RX_PAUSE;
+               break;
+       case EFX_FCNTL_GENERATE:
+               fc_conf->mode = RTE_FC_TX_PAUSE;
+               break;
+       case (EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE):
+               fc_conf->mode = RTE_FC_FULL;
+               break;
+       default:
+               sfc_err(sa, "%s: unexpected flow control value %#x",
+                       __func__, link_fc);
+       }
+
+       fc_conf->autoneg = sa->port.flow_ctrl_autoneg;
+
+       sfc_adapter_unlock(sa);
+
+       return 0;
+}
+
+static int
+sfc_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
+{
+       struct sfc_adapter *sa = dev->data->dev_private;
+       struct sfc_port *port = &sa->port;
+       unsigned int fcntl;
+       int rc;
+
+       if (fc_conf->high_water != 0 || fc_conf->low_water != 0 ||
+           fc_conf->pause_time != 0 || fc_conf->send_xon != 0 ||
+           fc_conf->mac_ctrl_frame_fwd != 0) {
+               sfc_err(sa, "unsupported flow control settings specified");
+               rc = EINVAL;
+               goto fail_inval;
+       }
+
+       switch (fc_conf->mode) {
+       case RTE_FC_NONE:
+               fcntl = 0;
+               break;
+       case RTE_FC_RX_PAUSE:
+               fcntl = EFX_FCNTL_RESPOND;
+               break;
+       case RTE_FC_TX_PAUSE:
+               fcntl = EFX_FCNTL_GENERATE;
+               break;
+       case RTE_FC_FULL:
+               fcntl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
+               break;
+       default:
+               rc = EINVAL;
+               goto fail_inval;
+       }
+
+       sfc_adapter_lock(sa);
+
+       if (sa->state == SFC_ADAPTER_STARTED) {
+               rc = efx_mac_fcntl_set(sa->nic, fcntl, fc_conf->autoneg);
+               if (rc != 0)
+                       goto fail_mac_fcntl_set;
+       }
+
+       port->flow_ctrl = fcntl;
+       port->flow_ctrl_autoneg = fc_conf->autoneg;
+
+       sfc_adapter_unlock(sa);
+
+       return 0;
+
+fail_mac_fcntl_set:
+       sfc_adapter_unlock(sa);
+fail_inval:
+       SFC_ASSERT(rc > 0);
+       return -rc;
+}
+
 static const struct eth_dev_ops sfc_eth_dev_ops = {
        .dev_configure                  = sfc_dev_configure,
        .dev_start                      = sfc_dev_start,
        .dev_stop                       = sfc_dev_stop,
        .dev_close                      = sfc_dev_close,
        .link_update                    = sfc_dev_link_update,
+       .stats_get                      = sfc_stats_get,
+       .xstats_get                     = sfc_xstats_get,
+       .xstats_get_names               = sfc_xstats_get_names,
        .dev_infos_get                  = sfc_dev_infos_get,
        .rx_queue_setup                 = sfc_rx_queue_setup,
        .rx_queue_release               = sfc_rx_queue_release,
        .tx_queue_setup                 = sfc_tx_queue_setup,
        .tx_queue_release               = sfc_tx_queue_release,
+       .flow_ctrl_get                  = sfc_flow_ctrl_get,
+       .flow_ctrl_set                  = sfc_flow_ctrl_set,
 };
 
 static int