drivers/net/ethernet/netronome/nfp/nfp_net_sriov.c

   1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
   2 /* Copyright (C) 2017-2019 Netronome Systems, Inc. */
   3
   4 #include <linux/bitfield.h>
   5 #include <linux/errno.h>
   6 #include <linux/etherdevice.h>
   7 #include <linux/if_link.h>
   8 #include <linux/if_ether.h>
   9
  10 #include "nfpcore/nfp_cpp.h"
  11 #include "nfp_app.h"
  12 #include "nfp_main.h"
  13 #include "nfp_net_ctrl.h"
  14 #include "nfp_net.h"
  15 #include "nfp_net_sriov.h"
  16
  17 static int
  18 nfp_net_sriov_check(struct nfp_app *app, int vf, u16 cap, const char *msg)
  19 {
  20         u16 cap_vf;
  21
  22         if (!app || !app->pf->vfcfg_tbl2)
  23                 return -EOPNOTSUPP;
  24
  25         cap_vf = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_CAP);
  26         if ((cap_vf & cap) != cap) {
  27                 nfp_warn(app->pf->cpp, "ndo_set_vf_%s not supported\n", msg);
  28                 return -EOPNOTSUPP;
  29         }
  30
  31         if (vf < 0 || vf >= app->pf->num_vfs) {
  32                 nfp_warn(app->pf->cpp, "invalid VF id %d\n", vf);
  33                 return -EINVAL;
  34         }
  35
  36         return 0;
  37 }
  38
  39 static int
  40 nfp_net_sriov_update(struct nfp_app *app, int vf, u16 update, const char *msg)
  41 {
  42         struct nfp_net *nn;
  43         int ret;
  44
  45         /* Write update info to mailbox in VF config symbol */
  46         writeb(vf, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_VF_NUM);
  47         writew(update, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_UPD);
  48
  49         nn = list_first_entry(&app->pf->vnics, struct nfp_net, vnic_list);
  50         /* Signal VF reconfiguration */
  51         ret = nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_VF);
  52         if (ret)
  53                 return ret;
  54
  55         ret = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_RET);
  56         if (ret)
  57                 nfp_warn(app->pf->cpp,
  58                          "FW refused VF %s update with errno: %d\n", msg, ret);
  59         return -ret;
  60 }
  61
  62 int nfp_app_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
  63 {
  64         struct nfp_app *app = nfp_app_from_netdev(netdev);
  65         unsigned int vf_offset;
  66         int err;
  67
  68         err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_MAC, "mac");
  69         if (err)
  70                 return err;
  71
  72         if (is_multicast_ether_addr(mac)) {
  73                 nfp_warn(app->pf->cpp,
  74                          "invalid Ethernet address %pM for VF id %d\n",
  75                          mac, vf);
  76                 return -EINVAL;
  77         }
  78
  79         /* Write MAC to VF entry in VF config symbol */
  80         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
  81         writel(get_unaligned_be32(mac), app->pf->vfcfg_tbl2 + vf_offset);
  82         writew(get_unaligned_be16(mac + 4),
  83                app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_MAC_LO);
  84
  85         err = nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_MAC, "MAC");
  86         if (!err)
  87                 nfp_info(app->pf->cpp,
  88                          "MAC %pM set on VF %d, reload the VF driver to make this change effective.\n",
  89                          mac, vf);
  90
  91         return err;
  92 }
  93
  94 int nfp_app_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos,
  95                         __be16 vlan_proto)
  96 {
  97         struct nfp_app *app = nfp_app_from_netdev(netdev);
  98         unsigned int vf_offset;
  99         u16 vlan_tci;
 100         int err;
 101
 102         err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_VLAN, "vlan");
 103         if (err)
 104                 return err;
 105
 106         if (vlan_proto != htons(ETH_P_8021Q))
 107                 return -EOPNOTSUPP;
 108
 109         if (vlan > 4095 || qos > 7) {
 110                 nfp_warn(app->pf->cpp,
 111                          "invalid vlan id or qos for VF id %d\n", vf);
 112                 return -EINVAL;
 113         }
 114
 115         /* Write VLAN tag to VF entry in VF config symbol */
 116         vlan_tci = FIELD_PREP(NFP_NET_VF_CFG_VLAN_VID, vlan) |
 117                 FIELD_PREP(NFP_NET_VF_CFG_VLAN_QOS, qos);
 118         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 119         writew(vlan_tci, app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_VLAN);
 120
 121         return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_VLAN,
 122                                     "vlan");
 123 }
 124
 125 int nfp_app_set_vf_spoofchk(struct net_device *netdev, int vf, bool enable)
 126 {
 127         struct nfp_app *app = nfp_app_from_netdev(netdev);
 128         unsigned int vf_offset;
 129         u8 vf_ctrl;
 130         int err;
 131
 132         err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_SPOOF,
 133                                   "spoofchk");
 134         if (err)
 135                 return err;
 136
 137         /* Write spoof check control bit to VF entry in VF config symbol */
 138         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
 139                 NFP_NET_VF_CFG_CTRL;
 140         vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 141         vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_SPOOF;
 142         vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_SPOOF, enable);
 143         writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);
 144
 145         return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_SPOOF,
 146                                     "spoofchk");
 147 }
 148
 149 int nfp_app_set_vf_trust(struct net_device *netdev, int vf, bool enable)
 150 {
 151         struct nfp_app *app = nfp_app_from_netdev(netdev);
 152         unsigned int vf_offset;
 153         u8 vf_ctrl;
 154         int err;
 155
 156         err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_TRUST,
 157                                   "trust");
 158         if (err)
 159                 return err;
 160
 161         /* Write trust control bit to VF entry in VF config symbol */
 162         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
 163                 NFP_NET_VF_CFG_CTRL;
 164         vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 165         vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_TRUST;
 166         vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_TRUST, enable);
 167         writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);
 168
 169         return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_TRUST,
 170                                     "trust");
 171 }
 172
 173 int nfp_app_set_vf_link_state(struct net_device *netdev, int vf,
 174                               int link_state)
 175 {
 176         struct nfp_app *app = nfp_app_from_netdev(netdev);
 177         unsigned int vf_offset;
 178         u8 vf_ctrl;
 179         int err;
 180
 181         err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_LINK_STATE,
 182                                   "link_state");
 183         if (err)
 184                 return err;
 185
 186         switch (link_state) {
 187         case IFLA_VF_LINK_STATE_AUTO:
 188         case IFLA_VF_LINK_STATE_ENABLE:
 189         case IFLA_VF_LINK_STATE_DISABLE:
 190                 break;
 191         default:
 192                 return -EINVAL;
 193         }
 194
 195         /* Write link state to VF entry in VF config symbol */
 196         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ +
 197                 NFP_NET_VF_CFG_CTRL;
 198         vf_ctrl = readb(app->pf->vfcfg_tbl2 + vf_offset);
 199         vf_ctrl &= ~NFP_NET_VF_CFG_CTRL_LINK_STATE;
 200         vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_LINK_STATE, link_state);
 201         writeb(vf_ctrl, app->pf->vfcfg_tbl2 + vf_offset);
 202
 203         return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_LINK_STATE,
 204                                     "link state");
 205 }
 206
 207 int nfp_app_get_vf_config(struct net_device *netdev, int vf,
 208                           struct ifla_vf_info *ivi)
 209 {
 210         struct nfp_app *app = nfp_app_from_netdev(netdev);
 211         unsigned int vf_offset;
 212         u16 vlan_tci;
 213         u32 mac_hi;
 214         u16 mac_lo;
 215         u8 flags;
 216         int err;
 217
 218         err = nfp_net_sriov_check(app, vf, 0, "");
 219         if (err)
 220                 return err;
 221
 222         vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 223
 224         mac_hi = readl(app->pf->vfcfg_tbl2 + vf_offset);
 225         mac_lo = readw(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_MAC_LO);
 226
 227         flags = readb(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_CTRL);
 228         vlan_tci = readw(app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_VLAN);
 229
 230         memset(ivi, 0, sizeof(*ivi));
 231         ivi->vf = vf;
 232
 233         put_unaligned_be32(mac_hi, &ivi->mac[0]);
 234         put_unaligned_be16(mac_lo, &ivi->mac[4]);
 235
 236         ivi->vlan = FIELD_GET(NFP_NET_VF_CFG_VLAN_VID, vlan_tci);
 237         ivi->qos = FIELD_GET(NFP_NET_VF_CFG_VLAN_QOS, vlan_tci);
 238
 239         ivi->spoofchk = FIELD_GET(NFP_NET_VF_CFG_CTRL_SPOOF, flags);
 240         ivi->trusted = FIELD_GET(NFP_NET_VF_CFG_CTRL_TRUST, flags);
 241         ivi->linkstate = FIELD_GET(NFP_NET_VF_CFG_CTRL_LINK_STATE, flags);
 242
 243         return 0;
 244 }