1024 lines
24 KiB
C
1024 lines
24 KiB
C
|
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
|
||
|
/* Copyright (C) 2017-2018 Netronome Systems, Inc. */
|
||
|
|
||
|
#include <linux/etherdevice.h>
|
||
|
#include <linux/lockdep.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/skbuff.h>
|
||
|
#include <linux/vmalloc.h>
|
||
|
#include <net/devlink.h>
|
||
|
#include <net/dst_metadata.h>
|
||
|
|
||
|
#include "main.h"
|
||
|
#include "../nfpcore/nfp_cpp.h"
|
||
|
#include "../nfpcore/nfp_nffw.h"
|
||
|
#include "../nfpcore/nfp_nsp.h"
|
||
|
#include "../nfp_app.h"
|
||
|
#include "../nfp_main.h"
|
||
|
#include "../nfp_net.h"
|
||
|
#include "../nfp_net_repr.h"
|
||
|
#include "../nfp_port.h"
|
||
|
#include "./cmsg.h"
|
||
|
|
||
|
#define NFP_FLOWER_ALLOWED_VER 0x0001000000010000UL
|
||
|
|
||
|
#define NFP_MIN_INT_PORT_ID 1
|
||
|
#define NFP_MAX_INT_PORT_ID 256
|
||
|
|
||
|
static const char *nfp_flower_extra_cap(struct nfp_app *app, struct nfp_net *nn)
|
||
|
{
|
||
|
return "FLOWER";
|
||
|
}
|
||
|
|
||
|
static enum devlink_eswitch_mode eswitch_mode_get(struct nfp_app *app)
|
||
|
{
|
||
|
return DEVLINK_ESWITCH_MODE_SWITCHDEV;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_lookup_internal_port_id(struct nfp_flower_priv *priv,
|
||
|
struct net_device *netdev)
|
||
|
{
|
||
|
struct net_device *entry;
|
||
|
int i, id = 0;
|
||
|
|
||
|
rcu_read_lock();
|
||
|
idr_for_each_entry(&priv->internal_ports.port_ids, entry, i)
|
||
|
if (entry == netdev) {
|
||
|
id = i;
|
||
|
break;
|
||
|
}
|
||
|
rcu_read_unlock();
|
||
|
|
||
|
return id;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_get_internal_port_id(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
int id;
|
||
|
|
||
|
id = nfp_flower_lookup_internal_port_id(priv, netdev);
|
||
|
if (id > 0)
|
||
|
return id;
|
||
|
|
||
|
idr_preload(GFP_ATOMIC);
|
||
|
spin_lock_bh(&priv->internal_ports.lock);
|
||
|
id = idr_alloc(&priv->internal_ports.port_ids, netdev,
|
||
|
NFP_MIN_INT_PORT_ID, NFP_MAX_INT_PORT_ID, GFP_ATOMIC);
|
||
|
spin_unlock_bh(&priv->internal_ports.lock);
|
||
|
idr_preload_end();
|
||
|
|
||
|
return id;
|
||
|
}
|
||
|
|
||
|
u32 nfp_flower_get_port_id_from_netdev(struct nfp_app *app,
|
||
|
struct net_device *netdev)
|
||
|
{
|
||
|
int ext_port;
|
||
|
|
||
|
if (nfp_netdev_is_nfp_repr(netdev)) {
|
||
|
return nfp_repr_get_port_id(netdev);
|
||
|
} else if (nfp_flower_internal_port_can_offload(app, netdev)) {
|
||
|
ext_port = nfp_flower_get_internal_port_id(app, netdev);
|
||
|
if (ext_port < 0)
|
||
|
return 0;
|
||
|
|
||
|
return nfp_flower_internal_port_get_port_id(ext_port);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct net_device *
|
||
|
nfp_flower_get_netdev_from_internal_port_id(struct nfp_app *app, int port_id)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
struct net_device *netdev;
|
||
|
|
||
|
rcu_read_lock();
|
||
|
netdev = idr_find(&priv->internal_ports.port_ids, port_id);
|
||
|
rcu_read_unlock();
|
||
|
|
||
|
return netdev;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
nfp_flower_free_internal_port_id(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
int id;
|
||
|
|
||
|
id = nfp_flower_lookup_internal_port_id(priv, netdev);
|
||
|
if (!id)
|
||
|
return;
|
||
|
|
||
|
spin_lock_bh(&priv->internal_ports.lock);
|
||
|
idr_remove(&priv->internal_ports.port_ids, id);
|
||
|
spin_unlock_bh(&priv->internal_ports.lock);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_internal_port_event_handler(struct nfp_app *app,
|
||
|
struct net_device *netdev,
|
||
|
unsigned long event)
|
||
|
{
|
||
|
if (event == NETDEV_UNREGISTER &&
|
||
|
nfp_flower_internal_port_can_offload(app, netdev))
|
||
|
nfp_flower_free_internal_port_id(app, netdev);
|
||
|
|
||
|
return NOTIFY_OK;
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_internal_port_init(struct nfp_flower_priv *priv)
|
||
|
{
|
||
|
spin_lock_init(&priv->internal_ports.lock);
|
||
|
idr_init(&priv->internal_ports.port_ids);
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_internal_port_cleanup(struct nfp_flower_priv *priv)
|
||
|
{
|
||
|
idr_destroy(&priv->internal_ports.port_ids);
|
||
|
}
|
||
|
|
||
|
static struct nfp_flower_non_repr_priv *
|
||
|
nfp_flower_non_repr_priv_lookup(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
struct nfp_flower_non_repr_priv *entry;
|
||
|
|
||
|
ASSERT_RTNL();
|
||
|
|
||
|
list_for_each_entry(entry, &priv->non_repr_priv, list)
|
||
|
if (entry->netdev == netdev)
|
||
|
return entry;
|
||
|
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
void
|
||
|
__nfp_flower_non_repr_priv_get(struct nfp_flower_non_repr_priv *non_repr_priv)
|
||
|
{
|
||
|
non_repr_priv->ref_count++;
|
||
|
}
|
||
|
|
||
|
struct nfp_flower_non_repr_priv *
|
||
|
nfp_flower_non_repr_priv_get(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
struct nfp_flower_non_repr_priv *entry;
|
||
|
|
||
|
entry = nfp_flower_non_repr_priv_lookup(app, netdev);
|
||
|
if (entry)
|
||
|
goto inc_ref;
|
||
|
|
||
|
entry = kzalloc(sizeof(*entry), GFP_KERNEL);
|
||
|
if (!entry)
|
||
|
return NULL;
|
||
|
|
||
|
entry->netdev = netdev;
|
||
|
list_add(&entry->list, &priv->non_repr_priv);
|
||
|
|
||
|
inc_ref:
|
||
|
__nfp_flower_non_repr_priv_get(entry);
|
||
|
return entry;
|
||
|
}
|
||
|
|
||
|
void
|
||
|
__nfp_flower_non_repr_priv_put(struct nfp_flower_non_repr_priv *non_repr_priv)
|
||
|
{
|
||
|
if (--non_repr_priv->ref_count)
|
||
|
return;
|
||
|
|
||
|
list_del(&non_repr_priv->list);
|
||
|
kfree(non_repr_priv);
|
||
|
}
|
||
|
|
||
|
void
|
||
|
nfp_flower_non_repr_priv_put(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_flower_non_repr_priv *entry;
|
||
|
|
||
|
entry = nfp_flower_non_repr_priv_lookup(app, netdev);
|
||
|
if (!entry)
|
||
|
return;
|
||
|
|
||
|
__nfp_flower_non_repr_priv_put(entry);
|
||
|
}
|
||
|
|
||
|
static enum nfp_repr_type
|
||
|
nfp_flower_repr_get_type_and_port(struct nfp_app *app, u32 port_id, u8 *port)
|
||
|
{
|
||
|
switch (FIELD_GET(NFP_FLOWER_CMSG_PORT_TYPE, port_id)) {
|
||
|
case NFP_FLOWER_CMSG_PORT_TYPE_PHYS_PORT:
|
||
|
*port = FIELD_GET(NFP_FLOWER_CMSG_PORT_PHYS_PORT_NUM,
|
||
|
port_id);
|
||
|
return NFP_REPR_TYPE_PHYS_PORT;
|
||
|
|
||
|
case NFP_FLOWER_CMSG_PORT_TYPE_PCIE_PORT:
|
||
|
*port = FIELD_GET(NFP_FLOWER_CMSG_PORT_VNIC, port_id);
|
||
|
if (FIELD_GET(NFP_FLOWER_CMSG_PORT_VNIC_TYPE, port_id) ==
|
||
|
NFP_FLOWER_CMSG_PORT_VNIC_TYPE_PF)
|
||
|
return NFP_REPR_TYPE_PF;
|
||
|
else
|
||
|
return NFP_REPR_TYPE_VF;
|
||
|
}
|
||
|
|
||
|
return __NFP_REPR_TYPE_MAX;
|
||
|
}
|
||
|
|
||
|
static struct net_device *
|
||
|
nfp_flower_dev_get(struct nfp_app *app, u32 port_id, bool *redir_egress)
|
||
|
{
|
||
|
enum nfp_repr_type repr_type;
|
||
|
struct nfp_reprs *reprs;
|
||
|
u8 port = 0;
|
||
|
|
||
|
/* Check if the port is internal. */
|
||
|
if (FIELD_GET(NFP_FLOWER_CMSG_PORT_TYPE, port_id) ==
|
||
|
NFP_FLOWER_CMSG_PORT_TYPE_OTHER_PORT) {
|
||
|
if (redir_egress)
|
||
|
*redir_egress = true;
|
||
|
port = FIELD_GET(NFP_FLOWER_CMSG_PORT_PHYS_PORT_NUM, port_id);
|
||
|
return nfp_flower_get_netdev_from_internal_port_id(app, port);
|
||
|
}
|
||
|
|
||
|
repr_type = nfp_flower_repr_get_type_and_port(app, port_id, &port);
|
||
|
if (repr_type > NFP_REPR_TYPE_MAX)
|
||
|
return NULL;
|
||
|
|
||
|
reprs = rcu_dereference(app->reprs[repr_type]);
|
||
|
if (!reprs)
|
||
|
return NULL;
|
||
|
|
||
|
if (port >= reprs->num_reprs)
|
||
|
return NULL;
|
||
|
|
||
|
return rcu_dereference(reprs->reprs[port]);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_reprs_reify(struct nfp_app *app, enum nfp_repr_type type,
|
||
|
bool exists)
|
||
|
{
|
||
|
struct nfp_reprs *reprs;
|
||
|
int i, err, count = 0;
|
||
|
|
||
|
reprs = rcu_dereference_protected(app->reprs[type],
|
||
|
nfp_app_is_locked(app));
|
||
|
if (!reprs)
|
||
|
return 0;
|
||
|
|
||
|
for (i = 0; i < reprs->num_reprs; i++) {
|
||
|
struct net_device *netdev;
|
||
|
|
||
|
netdev = nfp_repr_get_locked(app, reprs, i);
|
||
|
if (netdev) {
|
||
|
struct nfp_repr *repr = netdev_priv(netdev);
|
||
|
|
||
|
err = nfp_flower_cmsg_portreify(repr, exists);
|
||
|
if (err)
|
||
|
return err;
|
||
|
count++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return count;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_wait_repr_reify(struct nfp_app *app, atomic_t *replies, int tot_repl)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
|
||
|
if (!tot_repl)
|
||
|
return 0;
|
||
|
|
||
|
assert_nfp_app_locked(app);
|
||
|
if (!wait_event_timeout(priv->reify_wait_queue,
|
||
|
atomic_read(replies) >= tot_repl,
|
||
|
NFP_FL_REPLY_TIMEOUT)) {
|
||
|
nfp_warn(app->cpp, "Not all reprs responded to reify\n");
|
||
|
return -EIO;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_repr_netdev_open(struct nfp_app *app, struct nfp_repr *repr)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
err = nfp_flower_cmsg_portmod(repr, true, repr->netdev->mtu, false);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
netif_tx_wake_all_queues(repr->netdev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_repr_netdev_stop(struct nfp_app *app, struct nfp_repr *repr)
|
||
|
{
|
||
|
netif_tx_disable(repr->netdev);
|
||
|
|
||
|
return nfp_flower_cmsg_portmod(repr, false, repr->netdev->mtu, false);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
nfp_flower_repr_netdev_clean(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_repr *repr = netdev_priv(netdev);
|
||
|
|
||
|
kfree(repr->app_priv);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
nfp_flower_repr_netdev_preclean(struct nfp_app *app, struct net_device *netdev)
|
||
|
{
|
||
|
struct nfp_repr *repr = netdev_priv(netdev);
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
atomic_t *replies = &priv->reify_replies;
|
||
|
int err;
|
||
|
|
||
|
atomic_set(replies, 0);
|
||
|
err = nfp_flower_cmsg_portreify(repr, false);
|
||
|
if (err) {
|
||
|
nfp_warn(app->cpp, "Failed to notify firmware about repr destruction\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
nfp_flower_wait_repr_reify(app, replies, 1);
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_sriov_disable(struct nfp_app *app)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
|
||
|
if (!priv->nn)
|
||
|
return;
|
||
|
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_VF);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_spawn_vnic_reprs(struct nfp_app *app,
|
||
|
enum nfp_flower_cmsg_port_vnic_type vnic_type,
|
||
|
enum nfp_repr_type repr_type, unsigned int cnt)
|
||
|
{
|
||
|
u8 nfp_pcie = nfp_cppcore_pcie_unit(app->pf->cpp);
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
atomic_t *replies = &priv->reify_replies;
|
||
|
struct nfp_flower_repr_priv *repr_priv;
|
||
|
enum nfp_port_type port_type;
|
||
|
struct nfp_repr *nfp_repr;
|
||
|
struct nfp_reprs *reprs;
|
||
|
int i, err, reify_cnt;
|
||
|
const u8 queue = 0;
|
||
|
|
||
|
port_type = repr_type == NFP_REPR_TYPE_PF ? NFP_PORT_PF_PORT :
|
||
|
NFP_PORT_VF_PORT;
|
||
|
|
||
|
reprs = nfp_reprs_alloc(cnt);
|
||
|
if (!reprs)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
for (i = 0; i < cnt; i++) {
|
||
|
struct net_device *repr;
|
||
|
struct nfp_port *port;
|
||
|
u32 port_id;
|
||
|
|
||
|
repr = nfp_repr_alloc(app);
|
||
|
if (!repr) {
|
||
|
err = -ENOMEM;
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
repr_priv = kzalloc(sizeof(*repr_priv), GFP_KERNEL);
|
||
|
if (!repr_priv) {
|
||
|
err = -ENOMEM;
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
nfp_repr = netdev_priv(repr);
|
||
|
nfp_repr->app_priv = repr_priv;
|
||
|
repr_priv->nfp_repr = nfp_repr;
|
||
|
|
||
|
/* For now we only support 1 PF */
|
||
|
WARN_ON(repr_type == NFP_REPR_TYPE_PF && i);
|
||
|
|
||
|
port = nfp_port_alloc(app, port_type, repr);
|
||
|
if (IS_ERR(port)) {
|
||
|
err = PTR_ERR(port);
|
||
|
kfree(repr_priv);
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
if (repr_type == NFP_REPR_TYPE_PF) {
|
||
|
port->pf_id = i;
|
||
|
port->vnic = priv->nn->dp.ctrl_bar;
|
||
|
} else {
|
||
|
port->pf_id = 0;
|
||
|
port->vf_id = i;
|
||
|
port->vnic =
|
||
|
app->pf->vf_cfg_mem + i * NFP_NET_CFG_BAR_SZ;
|
||
|
}
|
||
|
|
||
|
eth_hw_addr_random(repr);
|
||
|
|
||
|
port_id = nfp_flower_cmsg_pcie_port(nfp_pcie, vnic_type,
|
||
|
i, queue);
|
||
|
err = nfp_repr_init(app, repr,
|
||
|
port_id, port, priv->nn->dp.netdev);
|
||
|
if (err) {
|
||
|
kfree(repr_priv);
|
||
|
nfp_port_free(port);
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
RCU_INIT_POINTER(reprs->reprs[i], repr);
|
||
|
nfp_info(app->cpp, "%s%d Representor(%s) created\n",
|
||
|
repr_type == NFP_REPR_TYPE_PF ? "PF" : "VF", i,
|
||
|
repr->name);
|
||
|
}
|
||
|
|
||
|
nfp_app_reprs_set(app, repr_type, reprs);
|
||
|
|
||
|
atomic_set(replies, 0);
|
||
|
reify_cnt = nfp_flower_reprs_reify(app, repr_type, true);
|
||
|
if (reify_cnt < 0) {
|
||
|
err = reify_cnt;
|
||
|
nfp_warn(app->cpp, "Failed to notify firmware about repr creation\n");
|
||
|
goto err_reprs_remove;
|
||
|
}
|
||
|
|
||
|
err = nfp_flower_wait_repr_reify(app, replies, reify_cnt);
|
||
|
if (err)
|
||
|
goto err_reprs_remove;
|
||
|
|
||
|
return 0;
|
||
|
err_reprs_remove:
|
||
|
reprs = nfp_app_reprs_set(app, repr_type, NULL);
|
||
|
err_reprs_clean:
|
||
|
nfp_reprs_clean_and_free(app, reprs);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_sriov_enable(struct nfp_app *app, int num_vfs)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
|
||
|
if (!priv->nn)
|
||
|
return 0;
|
||
|
|
||
|
return nfp_flower_spawn_vnic_reprs(app,
|
||
|
NFP_FLOWER_CMSG_PORT_VNIC_TYPE_VF,
|
||
|
NFP_REPR_TYPE_VF, num_vfs);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_spawn_phy_reprs(struct nfp_app *app, struct nfp_flower_priv *priv)
|
||
|
{
|
||
|
struct nfp_eth_table *eth_tbl = app->pf->eth_tbl;
|
||
|
atomic_t *replies = &priv->reify_replies;
|
||
|
struct nfp_flower_repr_priv *repr_priv;
|
||
|
struct nfp_repr *nfp_repr;
|
||
|
struct sk_buff *ctrl_skb;
|
||
|
struct nfp_reprs *reprs;
|
||
|
int err, reify_cnt;
|
||
|
unsigned int i;
|
||
|
|
||
|
ctrl_skb = nfp_flower_cmsg_mac_repr_start(app, eth_tbl->count);
|
||
|
if (!ctrl_skb)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
reprs = nfp_reprs_alloc(eth_tbl->max_index + 1);
|
||
|
if (!reprs) {
|
||
|
err = -ENOMEM;
|
||
|
goto err_free_ctrl_skb;
|
||
|
}
|
||
|
|
||
|
for (i = 0; i < eth_tbl->count; i++) {
|
||
|
unsigned int phys_port = eth_tbl->ports[i].index;
|
||
|
struct net_device *repr;
|
||
|
struct nfp_port *port;
|
||
|
u32 cmsg_port_id;
|
||
|
|
||
|
repr = nfp_repr_alloc(app);
|
||
|
if (!repr) {
|
||
|
err = -ENOMEM;
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
repr_priv = kzalloc(sizeof(*repr_priv), GFP_KERNEL);
|
||
|
if (!repr_priv) {
|
||
|
err = -ENOMEM;
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
nfp_repr = netdev_priv(repr);
|
||
|
nfp_repr->app_priv = repr_priv;
|
||
|
repr_priv->nfp_repr = nfp_repr;
|
||
|
|
||
|
port = nfp_port_alloc(app, NFP_PORT_PHYS_PORT, repr);
|
||
|
if (IS_ERR(port)) {
|
||
|
err = PTR_ERR(port);
|
||
|
kfree(repr_priv);
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
err = nfp_port_init_phy_port(app->pf, app, port, i);
|
||
|
if (err) {
|
||
|
kfree(repr_priv);
|
||
|
nfp_port_free(port);
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
SET_NETDEV_DEV(repr, &priv->nn->pdev->dev);
|
||
|
nfp_net_get_mac_addr(app->pf, repr, port);
|
||
|
|
||
|
cmsg_port_id = nfp_flower_cmsg_phys_port(phys_port);
|
||
|
err = nfp_repr_init(app, repr,
|
||
|
cmsg_port_id, port, priv->nn->dp.netdev);
|
||
|
if (err) {
|
||
|
kfree(repr_priv);
|
||
|
nfp_port_free(port);
|
||
|
nfp_repr_free(repr);
|
||
|
goto err_reprs_clean;
|
||
|
}
|
||
|
|
||
|
nfp_flower_cmsg_mac_repr_add(ctrl_skb, i,
|
||
|
eth_tbl->ports[i].nbi,
|
||
|
eth_tbl->ports[i].base,
|
||
|
phys_port);
|
||
|
|
||
|
RCU_INIT_POINTER(reprs->reprs[phys_port], repr);
|
||
|
nfp_info(app->cpp, "Phys Port %d Representor(%s) created\n",
|
||
|
phys_port, repr->name);
|
||
|
}
|
||
|
|
||
|
nfp_app_reprs_set(app, NFP_REPR_TYPE_PHYS_PORT, reprs);
|
||
|
|
||
|
/* The REIFY/MAC_REPR control messages should be sent after the MAC
|
||
|
* representors are registered using nfp_app_reprs_set(). This is
|
||
|
* because the firmware may respond with control messages for the
|
||
|
* MAC representors, f.e. to provide the driver with information
|
||
|
* about their state, and without registration the driver will drop
|
||
|
* any such messages.
|
||
|
*/
|
||
|
atomic_set(replies, 0);
|
||
|
reify_cnt = nfp_flower_reprs_reify(app, NFP_REPR_TYPE_PHYS_PORT, true);
|
||
|
if (reify_cnt < 0) {
|
||
|
err = reify_cnt;
|
||
|
nfp_warn(app->cpp, "Failed to notify firmware about repr creation\n");
|
||
|
goto err_reprs_remove;
|
||
|
}
|
||
|
|
||
|
err = nfp_flower_wait_repr_reify(app, replies, reify_cnt);
|
||
|
if (err)
|
||
|
goto err_reprs_remove;
|
||
|
|
||
|
nfp_ctrl_tx(app->ctrl, ctrl_skb);
|
||
|
|
||
|
return 0;
|
||
|
err_reprs_remove:
|
||
|
reprs = nfp_app_reprs_set(app, NFP_REPR_TYPE_PHYS_PORT, NULL);
|
||
|
err_reprs_clean:
|
||
|
nfp_reprs_clean_and_free(app, reprs);
|
||
|
err_free_ctrl_skb:
|
||
|
kfree_skb(ctrl_skb);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_vnic_alloc(struct nfp_app *app, struct nfp_net *nn,
|
||
|
unsigned int id)
|
||
|
{
|
||
|
if (id > 0) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC doesn't support more than one data vNIC\n");
|
||
|
goto err_invalid_port;
|
||
|
}
|
||
|
|
||
|
eth_hw_addr_random(nn->dp.netdev);
|
||
|
netif_keep_dst(nn->dp.netdev);
|
||
|
nn->vnic_no_name = true;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_invalid_port:
|
||
|
nn->port = nfp_port_alloc(app, NFP_PORT_INVALID, nn->dp.netdev);
|
||
|
return PTR_ERR_OR_ZERO(nn->port);
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_vnic_clean(struct nfp_app *app, struct nfp_net *nn)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
|
||
|
if (app->pf->num_vfs)
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_VF);
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_PF);
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_PHYS_PORT);
|
||
|
|
||
|
priv->nn = NULL;
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_vnic_init(struct nfp_app *app, struct nfp_net *nn)
|
||
|
{
|
||
|
struct nfp_flower_priv *priv = app->priv;
|
||
|
int err;
|
||
|
|
||
|
priv->nn = nn;
|
||
|
|
||
|
err = nfp_flower_spawn_phy_reprs(app, app->priv);
|
||
|
if (err)
|
||
|
goto err_clear_nn;
|
||
|
|
||
|
err = nfp_flower_spawn_vnic_reprs(app,
|
||
|
NFP_FLOWER_CMSG_PORT_VNIC_TYPE_PF,
|
||
|
NFP_REPR_TYPE_PF, 1);
|
||
|
if (err)
|
||
|
goto err_destroy_reprs_phy;
|
||
|
|
||
|
if (app->pf->num_vfs) {
|
||
|
err = nfp_flower_spawn_vnic_reprs(app,
|
||
|
NFP_FLOWER_CMSG_PORT_VNIC_TYPE_VF,
|
||
|
NFP_REPR_TYPE_VF,
|
||
|
app->pf->num_vfs);
|
||
|
if (err)
|
||
|
goto err_destroy_reprs_pf;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_destroy_reprs_pf:
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_PF);
|
||
|
err_destroy_reprs_phy:
|
||
|
nfp_reprs_clean_and_free_by_type(app, NFP_REPR_TYPE_PHYS_PORT);
|
||
|
err_clear_nn:
|
||
|
priv->nn = NULL;
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_wait_host_bit(struct nfp_app *app)
|
||
|
{
|
||
|
unsigned long err_at;
|
||
|
u64 feat;
|
||
|
int err;
|
||
|
|
||
|
/* Wait for HOST_ACK flag bit to propagate */
|
||
|
err_at = jiffies + msecs_to_jiffies(100);
|
||
|
do {
|
||
|
feat = nfp_rtsym_read_le(app->pf->rtbl,
|
||
|
"_abi_flower_combined_features_global",
|
||
|
&err);
|
||
|
if (time_is_before_eq_jiffies(err_at)) {
|
||
|
nfp_warn(app->cpp,
|
||
|
"HOST_ACK bit not propagated in FW.\n");
|
||
|
break;
|
||
|
}
|
||
|
usleep_range(1000, 2000);
|
||
|
} while (!err && !(feat & NFP_FL_FEATS_HOST_ACK));
|
||
|
|
||
|
if (err)
|
||
|
nfp_warn(app->cpp,
|
||
|
"Could not read global features entry from FW\n");
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_sync_feature_bits(struct nfp_app *app)
|
||
|
{
|
||
|
struct nfp_flower_priv *app_priv = app->priv;
|
||
|
int err;
|
||
|
|
||
|
/* Tell the firmware of the host supported features. */
|
||
|
err = nfp_rtsym_write_le(app->pf->rtbl, "_abi_flower_host_mask",
|
||
|
app_priv->flower_ext_feats |
|
||
|
NFP_FL_FEATS_HOST_ACK);
|
||
|
if (!err)
|
||
|
nfp_flower_wait_host_bit(app);
|
||
|
else if (err != -ENOENT)
|
||
|
return err;
|
||
|
|
||
|
/* Tell the firmware that the driver supports lag. */
|
||
|
err = nfp_rtsym_write_le(app->pf->rtbl,
|
||
|
"_abi_flower_balance_sync_enable", 1);
|
||
|
if (!err) {
|
||
|
app_priv->flower_en_feats |= NFP_FL_ENABLE_LAG;
|
||
|
nfp_flower_lag_init(&app_priv->nfp_lag);
|
||
|
} else if (err == -ENOENT) {
|
||
|
nfp_warn(app->cpp, "LAG not supported by FW.\n");
|
||
|
} else {
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
if (app_priv->flower_ext_feats & NFP_FL_FEATS_FLOW_MOD) {
|
||
|
/* Tell the firmware that the driver supports flow merging. */
|
||
|
err = nfp_rtsym_write_le(app->pf->rtbl,
|
||
|
"_abi_flower_merge_hint_enable", 1);
|
||
|
if (!err) {
|
||
|
app_priv->flower_en_feats |= NFP_FL_ENABLE_FLOW_MERGE;
|
||
|
nfp_flower_internal_port_init(app_priv);
|
||
|
} else if (err == -ENOENT) {
|
||
|
nfp_warn(app->cpp,
|
||
|
"Flow merge not supported by FW.\n");
|
||
|
} else {
|
||
|
return err;
|
||
|
}
|
||
|
} else {
|
||
|
nfp_warn(app->cpp, "Flow mod/merge not supported by FW.\n");
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_init(struct nfp_app *app)
|
||
|
{
|
||
|
u64 version, features, ctx_count, num_mems;
|
||
|
const struct nfp_pf *pf = app->pf;
|
||
|
struct nfp_flower_priv *app_priv;
|
||
|
int err;
|
||
|
|
||
|
if (!pf->eth_tbl) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC requires eth table\n");
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
if (!pf->mac_stats_bar) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC requires mac_stats BAR\n");
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
if (!pf->vf_cfg_bar) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC requires vf_cfg BAR\n");
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
version = nfp_rtsym_read_le(app->pf->rtbl, "hw_flower_version", &err);
|
||
|
if (err) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC requires hw_flower_version memory symbol\n");
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
num_mems = nfp_rtsym_read_le(app->pf->rtbl, "CONFIG_FC_HOST_CTX_SPLIT",
|
||
|
&err);
|
||
|
if (err) {
|
||
|
nfp_warn(app->cpp,
|
||
|
"FlowerNIC: unsupported host context memory: %d\n",
|
||
|
err);
|
||
|
err = 0;
|
||
|
num_mems = 1;
|
||
|
}
|
||
|
|
||
|
if (!FIELD_FIT(NFP_FL_STAT_ID_MU_NUM, num_mems) || !num_mems) {
|
||
|
nfp_warn(app->cpp,
|
||
|
"FlowerNIC: invalid host context memory: %llu\n",
|
||
|
num_mems);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
ctx_count = nfp_rtsym_read_le(app->pf->rtbl, "CONFIG_FC_HOST_CTX_COUNT",
|
||
|
&err);
|
||
|
if (err) {
|
||
|
nfp_warn(app->cpp,
|
||
|
"FlowerNIC: unsupported host context count: %d\n",
|
||
|
err);
|
||
|
err = 0;
|
||
|
ctx_count = BIT(17);
|
||
|
}
|
||
|
|
||
|
/* We need to ensure hardware has enough flower capabilities. */
|
||
|
if (version != NFP_FLOWER_ALLOWED_VER) {
|
||
|
nfp_warn(app->cpp, "FlowerNIC: unsupported firmware version\n");
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
app_priv = vzalloc(sizeof(struct nfp_flower_priv));
|
||
|
if (!app_priv)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
app_priv->total_mem_units = num_mems;
|
||
|
app_priv->active_mem_unit = 0;
|
||
|
app_priv->stats_ring_size = roundup_pow_of_two(ctx_count);
|
||
|
app->priv = app_priv;
|
||
|
app_priv->app = app;
|
||
|
skb_queue_head_init(&app_priv->cmsg_skbs_high);
|
||
|
skb_queue_head_init(&app_priv->cmsg_skbs_low);
|
||
|
INIT_WORK(&app_priv->cmsg_work, nfp_flower_cmsg_process_rx);
|
||
|
init_waitqueue_head(&app_priv->reify_wait_queue);
|
||
|
|
||
|
init_waitqueue_head(&app_priv->mtu_conf.wait_q);
|
||
|
spin_lock_init(&app_priv->mtu_conf.lock);
|
||
|
|
||
|
err = nfp_flower_metadata_init(app, ctx_count, num_mems);
|
||
|
if (err)
|
||
|
goto err_free_app_priv;
|
||
|
|
||
|
/* Extract the extra features supported by the firmware. */
|
||
|
features = nfp_rtsym_read_le(app->pf->rtbl,
|
||
|
"_abi_flower_extra_features", &err);
|
||
|
if (err)
|
||
|
app_priv->flower_ext_feats = 0;
|
||
|
else
|
||
|
app_priv->flower_ext_feats = features & NFP_FL_FEATS_HOST;
|
||
|
|
||
|
err = nfp_flower_sync_feature_bits(app);
|
||
|
if (err)
|
||
|
goto err_cleanup;
|
||
|
|
||
|
if (app_priv->flower_ext_feats & NFP_FL_FEATS_VF_RLIM)
|
||
|
nfp_flower_qos_init(app);
|
||
|
|
||
|
INIT_LIST_HEAD(&app_priv->indr_block_cb_priv);
|
||
|
INIT_LIST_HEAD(&app_priv->non_repr_priv);
|
||
|
app_priv->pre_tun_rule_cnt = 0;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_cleanup:
|
||
|
if (app_priv->flower_en_feats & NFP_FL_ENABLE_LAG)
|
||
|
nfp_flower_lag_cleanup(&app_priv->nfp_lag);
|
||
|
nfp_flower_metadata_cleanup(app);
|
||
|
err_free_app_priv:
|
||
|
vfree(app->priv);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_clean(struct nfp_app *app)
|
||
|
{
|
||
|
struct nfp_flower_priv *app_priv = app->priv;
|
||
|
|
||
|
skb_queue_purge(&app_priv->cmsg_skbs_high);
|
||
|
skb_queue_purge(&app_priv->cmsg_skbs_low);
|
||
|
flush_work(&app_priv->cmsg_work);
|
||
|
|
||
|
if (app_priv->flower_ext_feats & NFP_FL_FEATS_VF_RLIM)
|
||
|
nfp_flower_qos_cleanup(app);
|
||
|
|
||
|
if (app_priv->flower_en_feats & NFP_FL_ENABLE_LAG)
|
||
|
nfp_flower_lag_cleanup(&app_priv->nfp_lag);
|
||
|
|
||
|
if (app_priv->flower_en_feats & NFP_FL_ENABLE_FLOW_MERGE)
|
||
|
nfp_flower_internal_port_cleanup(app_priv);
|
||
|
|
||
|
nfp_flower_metadata_cleanup(app);
|
||
|
vfree(app->priv);
|
||
|
app->priv = NULL;
|
||
|
}
|
||
|
|
||
|
static bool nfp_flower_check_ack(struct nfp_flower_priv *app_priv)
|
||
|
{
|
||
|
bool ret;
|
||
|
|
||
|
spin_lock_bh(&app_priv->mtu_conf.lock);
|
||
|
ret = app_priv->mtu_conf.ack;
|
||
|
spin_unlock_bh(&app_priv->mtu_conf.lock);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_repr_change_mtu(struct nfp_app *app, struct net_device *netdev,
|
||
|
int new_mtu)
|
||
|
{
|
||
|
struct nfp_flower_priv *app_priv = app->priv;
|
||
|
struct nfp_repr *repr = netdev_priv(netdev);
|
||
|
int err;
|
||
|
|
||
|
/* Only need to config FW for physical port MTU change. */
|
||
|
if (repr->port->type != NFP_PORT_PHYS_PORT)
|
||
|
return 0;
|
||
|
|
||
|
if (!(app_priv->flower_ext_feats & NFP_FL_NBI_MTU_SETTING)) {
|
||
|
nfp_err(app->cpp, "Physical port MTU setting not supported\n");
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
spin_lock_bh(&app_priv->mtu_conf.lock);
|
||
|
app_priv->mtu_conf.ack = false;
|
||
|
app_priv->mtu_conf.requested_val = new_mtu;
|
||
|
app_priv->mtu_conf.portnum = repr->dst->u.port_info.port_id;
|
||
|
spin_unlock_bh(&app_priv->mtu_conf.lock);
|
||
|
|
||
|
err = nfp_flower_cmsg_portmod(repr, netif_carrier_ok(netdev), new_mtu,
|
||
|
true);
|
||
|
if (err) {
|
||
|
spin_lock_bh(&app_priv->mtu_conf.lock);
|
||
|
app_priv->mtu_conf.requested_val = 0;
|
||
|
spin_unlock_bh(&app_priv->mtu_conf.lock);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/* Wait for fw to ack the change. */
|
||
|
if (!wait_event_timeout(app_priv->mtu_conf.wait_q,
|
||
|
nfp_flower_check_ack(app_priv),
|
||
|
NFP_FL_REPLY_TIMEOUT)) {
|
||
|
spin_lock_bh(&app_priv->mtu_conf.lock);
|
||
|
app_priv->mtu_conf.requested_val = 0;
|
||
|
spin_unlock_bh(&app_priv->mtu_conf.lock);
|
||
|
nfp_warn(app->cpp, "MTU change not verified with fw\n");
|
||
|
return -EIO;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int nfp_flower_start(struct nfp_app *app)
|
||
|
{
|
||
|
struct nfp_flower_priv *app_priv = app->priv;
|
||
|
int err;
|
||
|
|
||
|
if (app_priv->flower_en_feats & NFP_FL_ENABLE_LAG) {
|
||
|
err = nfp_flower_lag_reset(&app_priv->nfp_lag);
|
||
|
if (err)
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
err = flow_indr_dev_register(nfp_flower_indr_setup_tc_cb, app);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
err = nfp_tunnel_config_start(app);
|
||
|
if (err)
|
||
|
goto err_tunnel_config;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_tunnel_config:
|
||
|
flow_indr_dev_unregister(nfp_flower_indr_setup_tc_cb, app,
|
||
|
nfp_flower_setup_indr_tc_release);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void nfp_flower_stop(struct nfp_app *app)
|
||
|
{
|
||
|
nfp_tunnel_config_stop(app);
|
||
|
|
||
|
flow_indr_dev_unregister(nfp_flower_indr_setup_tc_cb, app,
|
||
|
nfp_flower_setup_indr_tc_release);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
nfp_flower_netdev_event(struct nfp_app *app, struct net_device *netdev,
|
||
|
unsigned long event, void *ptr)
|
||
|
{
|
||
|
struct nfp_flower_priv *app_priv = app->priv;
|
||
|
int ret;
|
||
|
|
||
|
if (app_priv->flower_en_feats & NFP_FL_ENABLE_LAG) {
|
||
|
ret = nfp_flower_lag_netdev_event(app_priv, netdev, event, ptr);
|
||
|
if (ret & NOTIFY_STOP_MASK)
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
ret = nfp_flower_internal_port_event_handler(app, netdev, event);
|
||
|
if (ret & NOTIFY_STOP_MASK)
|
||
|
return ret;
|
||
|
|
||
|
return nfp_tunnel_mac_event_handler(app, netdev, event, ptr);
|
||
|
}
|
||
|
|
||
|
const struct nfp_app_type app_flower = {
|
||
|
.id = NFP_APP_FLOWER_NIC,
|
||
|
.name = "flower",
|
||
|
|
||
|
.ctrl_cap_mask = ~0U,
|
||
|
.ctrl_has_meta = true,
|
||
|
|
||
|
.extra_cap = nfp_flower_extra_cap,
|
||
|
|
||
|
.init = nfp_flower_init,
|
||
|
.clean = nfp_flower_clean,
|
||
|
|
||
|
.repr_change_mtu = nfp_flower_repr_change_mtu,
|
||
|
|
||
|
.vnic_alloc = nfp_flower_vnic_alloc,
|
||
|
.vnic_init = nfp_flower_vnic_init,
|
||
|
.vnic_clean = nfp_flower_vnic_clean,
|
||
|
|
||
|
.repr_preclean = nfp_flower_repr_netdev_preclean,
|
||
|
.repr_clean = nfp_flower_repr_netdev_clean,
|
||
|
|
||
|
.repr_open = nfp_flower_repr_netdev_open,
|
||
|
.repr_stop = nfp_flower_repr_netdev_stop,
|
||
|
|
||
|
.start = nfp_flower_start,
|
||
|
.stop = nfp_flower_stop,
|
||
|
|
||
|
.netdev_event = nfp_flower_netdev_event,
|
||
|
|
||
|
.ctrl_msg_rx = nfp_flower_cmsg_rx,
|
||
|
|
||
|
.sriov_enable = nfp_flower_sriov_enable,
|
||
|
.sriov_disable = nfp_flower_sriov_disable,
|
||
|
|
||
|
.eswitch_mode_get = eswitch_mode_get,
|
||
|
.dev_get = nfp_flower_dev_get,
|
||
|
|
||
|
.setup_tc = nfp_flower_setup_tc,
|
||
|
};
|