LXR linux/drivers/net/ethernet/netronome/nfp/nfp_net

   1/*
   2 * Copyright (C) 2017 Netronome Systems, Inc.
   3 *
   4 * This software is dual licensed under the GNU General License Version 2,
   5 * June 1991 as shown in the file COPYING in the top-level directory of this
   6 * source tree or the BSD 2-Clause License provided below.  You have the
   7 * option to license this software under the complete terms of either license.
   8 *
   9 * The BSD 2-Clause License:
  10 *
  11 *     Redistribution and use in source and binary forms, with or
  12 *     without modification, are permitted provided that the following
  13 *     conditions are met:
  14 *
  15 *      1. Redistributions of source code must retain the above
  16 *         copyright notice, this list of conditions and the following
  17 *         disclaimer.
  18 *
  19 *      2. Redistributions in binary form must reproduce the above
  20 *         copyright notice, this list of conditions and the following
  21 *         disclaimer in the documentation and/or other materials
  22 *         provided with the distribution.
  23 *
  24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31 * SOFTWARE.
  32 */
  33
  34#include <linux/bitfield.h>
  35#include <linux/errno.h>
  36#include <linux/etherdevice.h>
  37#include <linux/if_link.h>
  38#include <linux/if_ether.h>
  39
  40#include "nfpcore/nfp_cpp.h"
  41#include "nfp_app.h"
  42#include "nfp_main.h"
  43#include "nfp_net_ctrl.h"
  44#include "nfp_net.h"
  45#include "nfp_net_sriov.h"
  46
  47static int
  48nfp_net_sriov_check(struct nfp_app *app, int vf, u16 cap, const char *msg)
  49{
  50        u16 cap_vf;
  51
  52        if (!app || !app->pf->vfcfg_tbl2)
  53                return -EOPNOTSUPP;
  54
  55        cap_vf = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_CAP);
  56        if ((cap_vf & cap) != cap) {
  57                nfp_warn(app->pf->cpp, "ndo_set_vf_%s not supported\n", msg);
  58                return -EOPNOTSUPP;
  59        }
  60
  61        if (vf < 0 || vf >= app->pf->num_vfs) {
  62                nfp_warn(app->pf->cpp, "invalid VF id %d\n", vf);
  63                return -EINVAL;
  64        }
  65
  66        return 0;
  67}
  68
  69static int
  70nfp_net_sriov_update(struct nfp_app *app, int vf, u16 update, const char *msg)
  71{
  72        struct nfp_net *nn;
  73        int ret;
  74
  75        /* Write update info to mailbox in VF config symbol */
  76        writeb(vf, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_VF_NUM);
  77        writew(update, app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_UPD);
  78
  79        nn = list_first_entry(&app->pf->vnics, struct nfp_net, vnic_list);
  80        /* Signal VF reconfiguration */
  81        ret = nfp_net_reconfig(nn, NFP_NET_CFG_UPDATE_VF);
  82        if (ret)
  83                return ret;
  84
  85        ret = readw(app->pf->vfcfg_tbl2 + NFP_NET_VF_CFG_MB_RET);
  86        if (ret)
  87                nfp_warn(app->pf->cpp,
  88                         "FW refused VF %s update with errno: %d\n", msg, ret);
  89        return -ret;
  90}
  91
  92int nfp_app_set_vf_mac(struct net_device *netdev, int vf, u8 *mac)
  93{
  94        struct nfp_app *app = nfp_app_from_netdev(netdev);
  95        unsigned int vf_offset;
  96        int err;
  97
  98        err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_MAC, "mac");
  99        if (err)
 100                return err;
 101
 102        if (is_multicast_ether_addr(mac)) {
 103                nfp_warn(app->pf->cpp,
 104                         "invalid Ethernet address %pM for VF id %d\n",
 105                         mac, vf);
 106                return -EINVAL;
 107        }
 108
 109        /* Write MAC to VF entry in VF config symbol */
 110        vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 111        writel(get_unaligned_be32(mac), app->pf->vfcfg_tbl2 + vf_offset);
 112        writew(get_unaligned_be16(mac + 4),
 113               app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_MAC_LO);
 114
 115        return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_MAC, "MAC");
 116}
 117
 118int nfp_app_set_vf_vlan(struct net_device *netdev, int vf, u16 vlan, u8 qos,
 119                        __be16 vlan_proto)
 120{
 121        struct nfp_app *app = nfp_app_from_netdev(netdev);
 122        unsigned int vf_offset;
 123        u16 vlan_tci;
 124        int err;
 125
 126        err = nfp_net_sriov_check(app, vf, NFP_NET_VF_CFG_MB_CAP_VLAN, "vlan");
 127        if (err)
 128                return err;
 129
 130        if (vlan_proto != htons(ETH_P_8021Q))
 131                return -EOPNOTSUPP;
 132
 133        if (vlan > 4095 || qos > 7) {
 134                nfp_warn(app->pf->cpp,
 135                         "invalid vlan id or qos for VF id %d\n", vf);
 136                return -EINVAL;
 137        }
 138
 139        /* Write VLAN tag to VF entry in VF config symbol */
 140        vlan_tci = FIELD_PREP(NFP_NET_VF_CFG_VLAN_VID, vlan) |
 141                FIELD_PREP(NFP_NET_VF_CFG_VLAN_QOS, qos);
 142        vf_offset = NFP_NET_VF_CFG_MB_SZ + vf * NFP_NET_VF_CFG_SZ;
 143        writew(vlan_tci, app->pf->vfcfg_tbl2 + vf_offset + NFP_NET_VF_CFG_VLAN);
 144
 145        return nfp_net_sriov_update(app, vf, NFP_NET_VF_CFG_MB_UPD_VLAN,
 146                                    "vlan");
 147}
 148
 149int nfp_app_set_vf_spoofchk(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_SPOOF,
 157                                  "spoofchk");
 158        if (err)
 159                return err;
 160
 161        /* Write spoof check 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_SPOOF;
 166        vf_ctrl |= FIELD_PREP(NFP_NET_VF_CFG_CTRL_SPOOF, 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_SPOOF,
 170                                    "spoofchk");
 171}
 172
 173int 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
 207int 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->linkstate = FIELD_GET(NFP_NET_VF_CFG_CTRL_LINK_STATE, flags);
 241
 242        return 0;
 243}
 244