213 lines
5.9 KiB
C
213 lines
5.9 KiB
C
// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
|
|
/* Copyright (c) 2019 Mellanox Technologies. */
|
|
|
|
#include "setup.h"
|
|
#include "en/params.h"
|
|
#include "en/txrx.h"
|
|
#include "en/health.h"
|
|
#include <net/xdp_sock_drv.h>
|
|
|
|
static int mlx5e_legacy_rq_validate_xsk(struct mlx5_core_dev *mdev,
|
|
struct mlx5e_params *params,
|
|
struct mlx5e_xsk_param *xsk)
|
|
{
|
|
if (!mlx5e_rx_is_linear_skb(mdev, params, xsk)) {
|
|
mlx5_core_err(mdev, "Legacy RQ linear mode for XSK can't be activated with current params\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* The limitation of 2048 can be altered, but shouldn't go beyond the minimal
|
|
* stride size of striding RQ.
|
|
*/
|
|
#define MLX5E_MIN_XSK_CHUNK_SIZE max(2048, XDP_UMEM_MIN_CHUNK_SIZE)
|
|
|
|
bool mlx5e_validate_xsk_param(struct mlx5e_params *params,
|
|
struct mlx5e_xsk_param *xsk,
|
|
struct mlx5_core_dev *mdev)
|
|
{
|
|
/* AF_XDP doesn't support frames larger than PAGE_SIZE. */
|
|
if (xsk->chunk_size > PAGE_SIZE || xsk->chunk_size < MLX5E_MIN_XSK_CHUNK_SIZE) {
|
|
mlx5_core_err(mdev, "XSK chunk size %u out of bounds [%u, %lu]\n", xsk->chunk_size,
|
|
MLX5E_MIN_XSK_CHUNK_SIZE, PAGE_SIZE);
|
|
return false;
|
|
}
|
|
|
|
/* frag_sz is different for regular and XSK RQs, so ensure that linear
|
|
* SKB mode is possible.
|
|
*/
|
|
switch (params->rq_wq_type) {
|
|
case MLX5_WQ_TYPE_LINKED_LIST_STRIDING_RQ:
|
|
return !mlx5e_mpwrq_validate_xsk(mdev, params, xsk);
|
|
default: /* MLX5_WQ_TYPE_CYCLIC */
|
|
return !mlx5e_legacy_rq_validate_xsk(mdev, params, xsk);
|
|
}
|
|
}
|
|
|
|
static void mlx5e_build_xsk_cparam(struct mlx5_core_dev *mdev,
|
|
struct mlx5e_params *params,
|
|
struct mlx5e_xsk_param *xsk,
|
|
u16 q_counter,
|
|
struct mlx5e_channel_param *cparam)
|
|
{
|
|
mlx5e_build_rq_param(mdev, params, xsk, q_counter, &cparam->rq);
|
|
mlx5e_build_xdpsq_param(mdev, params, xsk, &cparam->xdp_sq);
|
|
}
|
|
|
|
static int mlx5e_init_xsk_rq(struct mlx5e_channel *c,
|
|
struct mlx5e_params *params,
|
|
struct xsk_buff_pool *pool,
|
|
struct mlx5e_xsk_param *xsk,
|
|
struct mlx5e_rq *rq)
|
|
{
|
|
struct mlx5_core_dev *mdev = c->mdev;
|
|
int rq_xdp_ix;
|
|
int err;
|
|
|
|
rq->wq_type = params->rq_wq_type;
|
|
rq->pdev = c->pdev;
|
|
rq->netdev = c->netdev;
|
|
rq->priv = c->priv;
|
|
rq->tstamp = c->tstamp;
|
|
rq->clock = &mdev->clock;
|
|
rq->icosq = &c->icosq;
|
|
rq->ix = c->ix;
|
|
rq->channel = c;
|
|
rq->mdev = mdev;
|
|
rq->hw_mtu = MLX5E_SW2HW_MTU(params, params->sw_mtu);
|
|
rq->xdpsq = &c->rq_xdpsq;
|
|
rq->xsk_pool = pool;
|
|
rq->stats = &c->priv->channel_stats[c->ix]->xskrq;
|
|
rq->ptp_cyc2time = mlx5_rq_ts_translator(mdev);
|
|
rq_xdp_ix = c->ix;
|
|
err = mlx5e_rq_set_handlers(rq, params, xsk);
|
|
if (err)
|
|
return err;
|
|
|
|
return xdp_rxq_info_reg(&rq->xdp_rxq, rq->netdev, rq_xdp_ix, c->napi.napi_id);
|
|
}
|
|
|
|
static int mlx5e_open_xsk_rq(struct mlx5e_channel *c, struct mlx5e_params *params,
|
|
struct mlx5e_rq_param *rq_params, struct xsk_buff_pool *pool,
|
|
struct mlx5e_xsk_param *xsk)
|
|
{
|
|
struct mlx5e_rq *xskrq = &c->xskrq;
|
|
int err;
|
|
|
|
err = mlx5e_init_xsk_rq(c, params, pool, xsk, xskrq);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mlx5e_open_rq(params, rq_params, xsk, cpu_to_node(c->cpu), xskrq);
|
|
if (err)
|
|
return err;
|
|
|
|
__set_bit(MLX5E_RQ_STATE_XSK, &xskrq->state);
|
|
return 0;
|
|
}
|
|
|
|
int mlx5e_open_xsk(struct mlx5e_priv *priv, struct mlx5e_params *params,
|
|
struct mlx5e_xsk_param *xsk, struct xsk_buff_pool *pool,
|
|
struct mlx5e_channel *c)
|
|
{
|
|
struct mlx5e_channel_param *cparam;
|
|
struct mlx5e_create_cq_param ccp;
|
|
int err;
|
|
|
|
mlx5e_build_create_cq_param(&ccp, c);
|
|
|
|
if (!mlx5e_validate_xsk_param(params, xsk, priv->mdev))
|
|
return -EINVAL;
|
|
|
|
cparam = kvzalloc(sizeof(*cparam), GFP_KERNEL);
|
|
if (!cparam)
|
|
return -ENOMEM;
|
|
|
|
mlx5e_build_xsk_cparam(priv->mdev, params, xsk, priv->q_counter, cparam);
|
|
|
|
err = mlx5e_open_cq(c->priv, params->rx_cq_moderation, &cparam->rq.cqp, &ccp,
|
|
&c->xskrq.cq);
|
|
if (unlikely(err))
|
|
goto err_free_cparam;
|
|
|
|
err = mlx5e_open_xsk_rq(c, params, &cparam->rq, pool, xsk);
|
|
if (unlikely(err))
|
|
goto err_close_rx_cq;
|
|
|
|
err = mlx5e_open_cq(c->priv, params->tx_cq_moderation, &cparam->xdp_sq.cqp, &ccp,
|
|
&c->xsksq.cq);
|
|
if (unlikely(err))
|
|
goto err_close_rq;
|
|
|
|
/* Create a separate SQ, so that when the buff pool is disabled, we could
|
|
* close this SQ safely and stop receiving CQEs. In other case, e.g., if
|
|
* the XDPSQ was used instead, we might run into trouble when the buff pool
|
|
* is disabled and then re-enabled, but the SQ continues receiving CQEs
|
|
* from the old buff pool.
|
|
*/
|
|
err = mlx5e_open_xdpsq(c, params, &cparam->xdp_sq, pool, &c->xsksq, true);
|
|
if (unlikely(err))
|
|
goto err_close_tx_cq;
|
|
|
|
kvfree(cparam);
|
|
|
|
set_bit(MLX5E_CHANNEL_STATE_XSK, c->state);
|
|
|
|
return 0;
|
|
|
|
err_close_tx_cq:
|
|
mlx5e_close_cq(&c->xsksq.cq);
|
|
|
|
err_close_rq:
|
|
mlx5e_close_rq(&c->xskrq);
|
|
|
|
err_close_rx_cq:
|
|
mlx5e_close_cq(&c->xskrq.cq);
|
|
|
|
err_free_cparam:
|
|
kvfree(cparam);
|
|
|
|
return err;
|
|
}
|
|
|
|
void mlx5e_close_xsk(struct mlx5e_channel *c)
|
|
{
|
|
clear_bit(MLX5E_CHANNEL_STATE_XSK, c->state);
|
|
synchronize_net(); /* Sync with NAPI. */
|
|
|
|
mlx5e_close_rq(&c->xskrq);
|
|
mlx5e_close_cq(&c->xskrq.cq);
|
|
mlx5e_close_xdpsq(&c->xsksq);
|
|
mlx5e_close_cq(&c->xsksq.cq);
|
|
|
|
memset(&c->xskrq, 0, sizeof(c->xskrq));
|
|
memset(&c->xsksq, 0, sizeof(c->xsksq));
|
|
}
|
|
|
|
void mlx5e_activate_xsk(struct mlx5e_channel *c)
|
|
{
|
|
/* ICOSQ recovery deactivates RQs. Suspend the recovery to avoid
|
|
* activating XSKRQ in the middle of recovery.
|
|
*/
|
|
mlx5e_reporter_icosq_suspend_recovery(c);
|
|
set_bit(MLX5E_RQ_STATE_ENABLED, &c->xskrq.state);
|
|
mlx5e_reporter_icosq_resume_recovery(c);
|
|
|
|
/* TX queue is created active. */
|
|
}
|
|
|
|
void mlx5e_deactivate_xsk(struct mlx5e_channel *c)
|
|
{
|
|
/* ICOSQ recovery may reactivate XSKRQ if clear_bit is called in the
|
|
* middle of recovery. Suspend the recovery to avoid it.
|
|
*/
|
|
mlx5e_reporter_icosq_suspend_recovery(c);
|
|
clear_bit(MLX5E_RQ_STATE_ENABLED, &c->xskrq.state);
|
|
mlx5e_reporter_icosq_resume_recovery(c);
|
|
synchronize_net(); /* Sync with NAPI to prevent mlx5e_post_rx_wqes. */
|
|
|
|
/* TX queue is disabled on close. */
|
|
}
|