Quelle  nfp_net_sriov.c   Sprache: C

// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
/* Copyright (C) 2017-2019 Netronome Systems, Inc. */

#include <linux/bitfield.h>
#include <linux/errno.h>
#include <linux/etherdevice.h>
#include <linux/if_link.h>
#include <linux/if_ether.h>

#include "nfpcore/nfp_cpp.h"
#include "nfp_app.h"
#include "nfp_main.h"
#include "nfp_net_ctrl.h"
#include "nfp_net.h"
#include "nfp_net_sriov.h"

static int
nfp_net_sriov_check(struct nfp_app *app, int vf, u16 cap, const char *msg, bool warn)
{
 u16 cap_vf;

 if (!app || !app->pf->vfcfg_tbl2)
  return -EOPNOTSUPP;

 cap_vf = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_CAP);
 if ((cap_vf & cap) != cap) {
  if (warn)
   nfp_warn(app->pf->cpp, "ndo_set_vf_%s not supported\n", msg);
  return -EOPNOTSUPP;
 }

 if (vf < 0 || vf >= app->pf->num_vfs) {
  if (warn)
   nfp_warn(app->pf->cpp, "invalid VF id %d\n", vf);
  return -EINVAL;
 }

 return 0;
}

static int
nfp_net_sriov_update(struct nfp_app *app, int vf, u16 update, const char *msg)
{
 struct nfp_net *nn;
 int ret;

 /* Write update info to mailbox in VF config symbol */
 writeb(vf, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_VF_NUM);
 writew(update, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_UPD);

 nn = list_first_entry(&app->pf->vnics, struct nfp_net, vnic_list);
 /* Signal VF reconfiguration */
 ret = nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_VF);
 if (ret)
  return ret;

 ret = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_RET);
 if (ret)
  nfp_warn(app->pf->cpp,
    "FW refused VF %s update with errno: %d\n", msg, ret);
 return -ret;
}

int nfp_app_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 unsigned int vf_offset;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_MAC, "mac", true);
 if (err)
  return err;

 if (is_multicast_ether_addr(mac)) {
  nfp_warn(app->pf->cpp,
    "invalid Ethernet address %pM for VF id %d\n",
    mac, vf);
  return -EINVAL;
 }

 /* Write MAC to VF entry in VF config symbol */
 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 writel(get_unaligned_be32(mac), app->pf->vfcfg_tbl2 + vf_offset);
 writew(get_unaligned_be16(mac + 4),
        app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_MAC_LO);

 err = nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_MAC, "MAC");
 if (!err)
  nfp_info(app->pf->cpp,
    "MAC %pM set on VF %d, reload the VF driver to make this change effective.\n",
    mac, vf);

 return err;
}

int nfp_app_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos,
   __be16 vlan_proto)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 u16 update = NFP_NET_VF_CFG_MB_UPD_VLAN;
 bool is_proto_sup = true;
 unsigned int vf_offset;
 u32 vlan_tag;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_VLAN, "vlan", true);
 if (err)
  return err;

 if (!eth_type_vlan(vlan_proto))
  return -EOPNOTSUPP;

 if (vlan > 4095 || qos > 7) {
  nfp_warn(app->pf->cpp,
    "invalid vlan id or qos for VF id %d\n", vf);
  return -EINVAL;
 }

 /* Check if fw supports or not */
 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_VLAN_PROTO, "vlan_proto", true);
 if (err)
  is_proto_sup = false;

 if (vlan_proto != htons(ETH_P_8021Q)) {
  if (!is_proto_sup)
   return -EOPNOTSUPP;
  update |= NFP_NET_VF_CFG_MB_UPD_VLAN_PROTO;
 }

 /* Write VLAN tag to VF entry in VF config symbol */
 vlan_tag = FIELD_PREP(NFP_NET_VF_CFG_VLAN_VID, vlan) |
  FIELD_PREP(NFP_NET_VF_CFG_VLAN_QOS, qos);

 /* vlan_tag of 0 means that the configuration should be cleared and in
 * such circumstances setting the TPID has no meaning when
 * configuring firmware.
 */
 if (vlan_tag && is_proto_sup)
  vlan_tag |= FIELD_PREP(NFP_NET_VF_CFG_VLAN_PROT, ntohs(vlan_proto));

 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 writel(vlan_tag, app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_VLAN);

 return nfp_net_sriov_update(app, vf, update, "vlan");
}

int nfp_app_set_vf_rate(struct net_device *netdev, int vf,
   int min_tx_rate, int max_tx_rate)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 u32 vf_offset, ratevalue;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_RATE, "rate", true);
 if (err)
  return err;

 if (max_tx_rate >= NFP_NET_VF_RATE_MAX ||
     min_tx_rate >= NFP_NET_VF_RATE_MAX) {
  nfp_warn(app->cpp, "tx-rate exceeds %d.\n",
    NFP_NET_VF_RATE_MAX);
  return -EINVAL;
 }

 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 ratevalue = FIELD_PREP(NFP_NET_VF_CFG_MAX_RATE,
          max_tx_rate ? max_tx_rate :
          NFP_NET_VF_RATE_MAX) |
      FIELD_PREP(NFP_NET_VF_CFG_MIN_RATE, min_tx_rate);

 writel(ratevalue,
        app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_RATE);

 return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_RATE,
        "rate");
}

int nfp_app_set_vf_spoofchk(struct net_device *netdev, int vf, bool enable)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 unsigned int vf_offset;
 u8 vf_ctrl;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_SPOOF,
      "spoofchk", true);
 if (err)
  return err;

 /* Write spoof check control bit to VF entry in VF config symbol */
 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
  NFP_NET_VF_CFG_CTRL;
 vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_SPOOF;
 vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_SPOOF, enable);
 writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);

 return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_SPOOF,
        "spoofchk");
}

int nfp_app_set_vf_trust(struct net_device *netdev, int vf, bool enable)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 unsigned int vf_offset;
 u8 vf_ctrl;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_TRUST,
      "trust", true);
 if (err)
  return err;

 /* Write trust control bit to VF entry in VF config symbol */
 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
  NFP_NET_VF_CFG_CTRL;
 vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_TRUST;
 vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_TRUST, enable);
 writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);

 return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_TRUST,
        "trust");
}

int nfp_app_set_vf_link_state(struct net_device *netdev, int vf,
         int link_state)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 unsigned int vf_offset;
 u8 vf_ctrl;
 int err;

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_LINK_STATE,
      "link_state", true);
 if (err)
  return err;

 switch (link_state) {
 case IFLA_VF_LINK_STATE_AUTO:
 case IFLA_VF_LINK_STATE_ENABLE:
 case IFLA_VF_LINK_STATE_DISABLE:
  break;
 default:
  return -EINVAL;
 }

 /* Write link state to VF entry in VF config symbol */
 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
  NFP_NET_VF_CFG_CTRL;
 vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_LINK_STATE;
 vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_LINK_STATE, link_state);
 writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);

 return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_LINK_STATE,
        "link state");
}

int nfp_app_get_vf_config(struct net_device *netdev, int vf,
     struct ifla_vf_info *ivi)
{
 struct nfp_app *app = nfp_app_from_netdev(netdev);
 u32 vf_offset, mac_hi, rate;
 u32 vlan_tag;
 u16 mac_lo;
 u8 flags;
 int err;

 err = nfp_net_sriov_check(app, vf, 0, "", true);
 if (err)
  return err;

 vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;

 mac_hi = readl(app->pf->vfcfg_tbl2 + vf_offset);
 mac_lo = readw(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_MAC_LO);

 flags = readb(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_CTRL);
 vlan_tag = readl(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_VLAN);

 memset(ivi, 0, sizeof(*ivi));
 ivi->vf = vf;

 put_unaligned_be32(mac_hi, &ivi->mac[0]);
 put_unaligned_be16(mac_lo, &ivi->mac[4]);

 ivi->vlan = FIELD_GET(NFP_NET_VF_CFG_VLAN_VID, vlan_tag);
 ivi->qos = FIELD_GET(NFP_NET_VF_CFG_VLAN_QOS, vlan_tag);
 if (!nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_VLAN_PROTO, "vlan_proto", false))
  ivi->vlan_proto = htons(FIELD_GET(NFP_NET_VF_CFG_VLAN_PROT, vlan_tag));
 ivi->spoofchk = FIELD_GET(NFP_NET_VF_CFG_CTRL_SPOOF, flags);
 ivi->trusted = FIELD_GET(NFP_NET_VF_CFG_CTRL_TRUST, flags);
 ivi->linkstate = FIELD_GET(NFP_NET_VF_CFG_CTRL_LINK_STATE, flags);

 err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_RATE, "rate", false);
 if (!err) {
  rate = readl(app->pf->vfcfg_tbl2 + vf_offset +
        NFP_NET_VF_CFG_RATE);

  ivi->max_tx_rate = FIELD_GET(NFP_NET_VF_CFG_MAX_RATE, rate);
  ivi->min_tx_rate = FIELD_GET(NFP_NET_VF_CFG_MIN_RATE, rate);

  if (ivi->max_tx_rate == NFP_NET_VF_RATE_MAX)
   ivi->max_tx_rate = 0;
  if (ivi->min_tx_rate == NFP_NET_VF_RATE_MAX)
   ivi->min_tx_rate = 0;
 }

 return 0;
}