| // 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; |
| } |