1de8650a8SEran Ben Elisha /* SPDX-License-Identifier: GPL-2.0 */ 2de8650a8SEran Ben Elisha /* Copyright (c) 2019 Mellanox Technologies. */ 3de8650a8SEran Ben Elisha 44edc17fdSAya Levin #include "health.h" 5de8650a8SEran Ben Elisha 6de8650a8SEran Ben Elisha static int mlx5e_wait_for_sq_flush(struct mlx5e_txqsq *sq) 7de8650a8SEran Ben Elisha { 8de8650a8SEran Ben Elisha unsigned long exp_time = jiffies + msecs_to_jiffies(2000); 9de8650a8SEran Ben Elisha 10de8650a8SEran Ben Elisha while (time_before(jiffies, exp_time)) { 11de8650a8SEran Ben Elisha if (sq->cc == sq->pc) 12de8650a8SEran Ben Elisha return 0; 13de8650a8SEran Ben Elisha 14de8650a8SEran Ben Elisha msleep(20); 15de8650a8SEran Ben Elisha } 16de8650a8SEran Ben Elisha 17de8650a8SEran Ben Elisha netdev_err(sq->channel->netdev, 18de8650a8SEran Ben Elisha "Wait for SQ 0x%x flush timeout (sq cc = 0x%x, sq pc = 0x%x)\n", 19de8650a8SEran Ben Elisha sq->sqn, sq->cc, sq->pc); 20de8650a8SEran Ben Elisha 21de8650a8SEran Ben Elisha return -ETIMEDOUT; 22de8650a8SEran Ben Elisha } 23de8650a8SEran Ben Elisha 24de8650a8SEran Ben Elisha static void mlx5e_reset_txqsq_cc_pc(struct mlx5e_txqsq *sq) 25de8650a8SEran Ben Elisha { 26de8650a8SEran Ben Elisha WARN_ONCE(sq->cc != sq->pc, 27de8650a8SEran Ben Elisha "SQ 0x%x: cc (0x%x) != pc (0x%x)\n", 28de8650a8SEran Ben Elisha sq->sqn, sq->cc, sq->pc); 29de8650a8SEran Ben Elisha sq->cc = 0; 30de8650a8SEran Ben Elisha sq->dma_fifo_cc = 0; 31de8650a8SEran Ben Elisha sq->pc = 0; 32de8650a8SEran Ben Elisha } 33de8650a8SEran Ben Elisha 34c50de4afSAya Levin static int mlx5e_tx_reporter_err_cqe_recover(void *ctx) 35de8650a8SEran Ben Elisha { 36c50de4afSAya Levin struct mlx5_core_dev *mdev; 37c50de4afSAya Levin struct net_device *dev; 38c50de4afSAya Levin struct mlx5e_txqsq *sq; 39de8650a8SEran Ben Elisha u8 state; 40de8650a8SEran Ben Elisha int err; 41de8650a8SEran Ben Elisha 42c50de4afSAya Levin sq = ctx; 43c50de4afSAya Levin mdev = sq->channel->mdev; 44c50de4afSAya Levin dev = sq->channel->netdev; 45c50de4afSAya Levin 46c50de4afSAya Levin if (!test_bit(MLX5E_SQ_STATE_RECOVERING, &sq->state)) 47c50de4afSAya Levin return 0; 48c50de4afSAya Levin 49de8650a8SEran Ben Elisha err = mlx5_core_query_sq_state(mdev, sq->sqn, &state); 50de8650a8SEran Ben Elisha if (err) { 51de8650a8SEran Ben Elisha netdev_err(dev, "Failed to query SQ 0x%x state. err = %d\n", 52de8650a8SEran Ben Elisha sq->sqn, err); 53276d197eSAya Levin goto out; 54de8650a8SEran Ben Elisha } 55de8650a8SEran Ben Elisha 56d9a2fcf5SAya Levin if (state != MLX5_SQC_STATE_ERR) 57276d197eSAya Levin goto out; 58de8650a8SEran Ben Elisha 59de8650a8SEran Ben Elisha mlx5e_tx_disable_queue(sq->txq); 60de8650a8SEran Ben Elisha 61de8650a8SEran Ben Elisha err = mlx5e_wait_for_sq_flush(sq); 62de8650a8SEran Ben Elisha if (err) 63276d197eSAya Levin goto out; 64de8650a8SEran Ben Elisha 65de8650a8SEran Ben Elisha /* At this point, no new packets will arrive from the stack as TXQ is 66de8650a8SEran Ben Elisha * marked with QUEUE_STATE_DRV_XOFF. In addition, NAPI cleared all 67de8650a8SEran Ben Elisha * pending WQEs. SQ can safely reset the SQ. 68de8650a8SEran Ben Elisha */ 69de8650a8SEran Ben Elisha 70c50de4afSAya Levin err = mlx5e_health_sq_to_ready(sq->channel, sq->sqn); 71de8650a8SEran Ben Elisha if (err) 72276d197eSAya Levin goto out; 73de8650a8SEran Ben Elisha 74de8650a8SEran Ben Elisha mlx5e_reset_txqsq_cc_pc(sq); 75de8650a8SEran Ben Elisha sq->stats->recover++; 76276d197eSAya Levin clear_bit(MLX5E_SQ_STATE_RECOVERING, &sq->state); 77de8650a8SEran Ben Elisha mlx5e_activate_txqsq(sq); 78de8650a8SEran Ben Elisha 79de8650a8SEran Ben Elisha return 0; 80276d197eSAya Levin out: 81276d197eSAya Levin clear_bit(MLX5E_SQ_STATE_RECOVERING, &sq->state); 82276d197eSAya Levin return err; 83de8650a8SEran Ben Elisha } 84de8650a8SEran Ben Elisha 8506293ae4SAya Levin void mlx5e_reporter_tx_err_cqe(struct mlx5e_txqsq *sq) 86de8650a8SEran Ben Elisha { 87c50de4afSAya Levin struct mlx5e_priv *priv = sq->channel->priv; 88c50de4afSAya Levin char err_str[MLX5E_REPORTER_PER_Q_MAX_LEN]; 89c50de4afSAya Levin struct mlx5e_err_ctx err_ctx = {0}; 90de8650a8SEran Ben Elisha 91c50de4afSAya Levin err_ctx.ctx = sq; 92de8650a8SEran Ben Elisha err_ctx.recover = mlx5e_tx_reporter_err_cqe_recover; 93de8650a8SEran Ben Elisha sprintf(err_str, "ERR CQE on SQ: 0x%x", sq->sqn); 94de8650a8SEran Ben Elisha 95c50de4afSAya Levin mlx5e_health_report(priv, priv->tx_reporter, err_str, &err_ctx); 96de8650a8SEran Ben Elisha } 97de8650a8SEran Ben Elisha 98c50de4afSAya Levin static int mlx5e_tx_reporter_timeout_recover(void *ctx) 997d91126bSEran Ben Elisha { 100c50de4afSAya Levin struct mlx5_eq_comp *eq; 101c50de4afSAya Levin struct mlx5e_txqsq *sq; 102c50de4afSAya Levin int err; 1037d91126bSEran Ben Elisha 104c50de4afSAya Levin sq = ctx; 105c50de4afSAya Levin eq = sq->cq.mcq.eq; 106c50de4afSAya Levin err = mlx5e_health_channel_eq_recover(eq, sq->channel); 107c50de4afSAya Levin if (err) 1087d91126bSEran Ben Elisha clear_bit(MLX5E_SQ_STATE_ENABLED, &sq->state); 1097d91126bSEran Ben Elisha 110c50de4afSAya Levin return err; 1117d91126bSEran Ben Elisha } 1127d91126bSEran Ben Elisha 11306293ae4SAya Levin int mlx5e_reporter_tx_timeout(struct mlx5e_txqsq *sq) 1147d91126bSEran Ben Elisha { 115c50de4afSAya Levin struct mlx5e_priv *priv = sq->channel->priv; 116c50de4afSAya Levin char err_str[MLX5E_REPORTER_PER_Q_MAX_LEN]; 117c50de4afSAya Levin struct mlx5e_err_ctx err_ctx; 1187d91126bSEran Ben Elisha 119c50de4afSAya Levin err_ctx.ctx = sq; 1207d91126bSEran Ben Elisha err_ctx.recover = mlx5e_tx_reporter_timeout_recover; 1217d91126bSEran Ben Elisha sprintf(err_str, 1227d91126bSEran Ben Elisha "TX timeout on queue: %d, SQ: 0x%x, CQ: 0x%x, SQ Cons: 0x%x SQ Prod: 0x%x, usecs since last trans: %u\n", 1237d91126bSEran Ben Elisha sq->channel->ix, sq->sqn, sq->cq.mcq.cqn, sq->cc, sq->pc, 1247d91126bSEran Ben Elisha jiffies_to_usecs(jiffies - sq->txq->trans_start)); 1257d91126bSEran Ben Elisha 126c50de4afSAya Levin return mlx5e_health_report(priv, priv->tx_reporter, err_str, &err_ctx); 1277d91126bSEran Ben Elisha } 1287d91126bSEran Ben Elisha 129de8650a8SEran Ben Elisha /* state lock cannot be grabbed within this function. 130de8650a8SEran Ben Elisha * It can cause a dead lock or a read-after-free. 131de8650a8SEran Ben Elisha */ 132c50de4afSAya Levin static int mlx5e_tx_reporter_recover_from_ctx(struct mlx5e_err_ctx *err_ctx) 133de8650a8SEran Ben Elisha { 134c50de4afSAya Levin return err_ctx->recover(err_ctx->ctx); 135de8650a8SEran Ben Elisha } 136de8650a8SEran Ben Elisha 137de8650a8SEran Ben Elisha static int mlx5e_tx_reporter_recover(struct devlink_health_reporter *reporter, 138de8650a8SEran Ben Elisha void *context) 139de8650a8SEran Ben Elisha { 140de8650a8SEran Ben Elisha struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); 141c50de4afSAya Levin struct mlx5e_err_ctx *err_ctx = context; 142de8650a8SEran Ben Elisha 143de8650a8SEran Ben Elisha return err_ctx ? mlx5e_tx_reporter_recover_from_ctx(err_ctx) : 144c50de4afSAya Levin mlx5e_health_recover_channels(priv); 145de8650a8SEran Ben Elisha } 146de8650a8SEran Ben Elisha 147de8650a8SEran Ben Elisha static int 148de8650a8SEran Ben Elisha mlx5e_tx_reporter_build_diagnose_output(struct devlink_fmsg *fmsg, 149dd921fd2SAya Levin struct mlx5e_txqsq *sq) 150de8650a8SEran Ben Elisha { 151dd921fd2SAya Levin struct mlx5e_priv *priv = sq->channel->priv; 152dd921fd2SAya Levin bool stopped = netif_xmit_stopped(sq->txq); 153dd921fd2SAya Levin u8 state; 154de8650a8SEran Ben Elisha int err; 155de8650a8SEran Ben Elisha 156dd921fd2SAya Levin err = mlx5_core_query_sq_state(priv->mdev, sq->sqn, &state); 157dd921fd2SAya Levin if (err) 158dd921fd2SAya Levin return err; 159dd921fd2SAya Levin 160de8650a8SEran Ben Elisha err = devlink_fmsg_obj_nest_start(fmsg); 161de8650a8SEran Ben Elisha if (err) 162de8650a8SEran Ben Elisha return err; 163de8650a8SEran Ben Elisha 164dd921fd2SAya Levin err = devlink_fmsg_u32_pair_put(fmsg, "sqn", sq->sqn); 165de8650a8SEran Ben Elisha if (err) 166de8650a8SEran Ben Elisha return err; 167de8650a8SEran Ben Elisha 168de8650a8SEran Ben Elisha err = devlink_fmsg_u8_pair_put(fmsg, "HW state", state); 169de8650a8SEran Ben Elisha if (err) 170de8650a8SEran Ben Elisha return err; 171de8650a8SEran Ben Elisha 172de8650a8SEran Ben Elisha err = devlink_fmsg_bool_pair_put(fmsg, "stopped", stopped); 173de8650a8SEran Ben Elisha if (err) 174de8650a8SEran Ben Elisha return err; 175de8650a8SEran Ben Elisha 176de8650a8SEran Ben Elisha err = devlink_fmsg_obj_nest_end(fmsg); 177de8650a8SEran Ben Elisha if (err) 178de8650a8SEran Ben Elisha return err; 179de8650a8SEran Ben Elisha 180de8650a8SEran Ben Elisha return 0; 181de8650a8SEran Ben Elisha } 182de8650a8SEran Ben Elisha 183de8650a8SEran Ben Elisha static int mlx5e_tx_reporter_diagnose(struct devlink_health_reporter *reporter, 184de8650a8SEran Ben Elisha struct devlink_fmsg *fmsg) 185de8650a8SEran Ben Elisha { 186de8650a8SEran Ben Elisha struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); 187de8650a8SEran Ben Elisha int i, err = 0; 188de8650a8SEran Ben Elisha 189de8650a8SEran Ben Elisha mutex_lock(&priv->state_lock); 190de8650a8SEran Ben Elisha 191de8650a8SEran Ben Elisha if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) 192de8650a8SEran Ben Elisha goto unlock; 193de8650a8SEran Ben Elisha 194de8650a8SEran Ben Elisha err = devlink_fmsg_arr_pair_nest_start(fmsg, "SQs"); 195de8650a8SEran Ben Elisha if (err) 196de8650a8SEran Ben Elisha goto unlock; 197de8650a8SEran Ben Elisha 198de8650a8SEran Ben Elisha for (i = 0; i < priv->channels.num * priv->channels.params.num_tc; 199de8650a8SEran Ben Elisha i++) { 200de8650a8SEran Ben Elisha struct mlx5e_txqsq *sq = priv->txq2sq[i]; 201de8650a8SEran Ben Elisha 202dd921fd2SAya Levin err = mlx5e_tx_reporter_build_diagnose_output(fmsg, sq); 203de8650a8SEran Ben Elisha if (err) 20499d31cbdSAya Levin goto unlock; 205de8650a8SEran Ben Elisha } 206de8650a8SEran Ben Elisha err = devlink_fmsg_arr_pair_nest_end(fmsg); 207de8650a8SEran Ben Elisha if (err) 208de8650a8SEran Ben Elisha goto unlock; 209de8650a8SEran Ben Elisha 210de8650a8SEran Ben Elisha unlock: 211de8650a8SEran Ben Elisha mutex_unlock(&priv->state_lock); 212de8650a8SEran Ben Elisha return err; 213de8650a8SEran Ben Elisha } 214de8650a8SEran Ben Elisha 215de8650a8SEran Ben Elisha static const struct devlink_health_reporter_ops mlx5_tx_reporter_ops = { 216de8650a8SEran Ben Elisha .name = "tx", 217de8650a8SEran Ben Elisha .recover = mlx5e_tx_reporter_recover, 218de8650a8SEran Ben Elisha .diagnose = mlx5e_tx_reporter_diagnose, 219de8650a8SEran Ben Elisha }; 220de8650a8SEran Ben Elisha 221de8650a8SEran Ben Elisha #define MLX5_REPORTER_TX_GRACEFUL_PERIOD 500 222de8650a8SEran Ben Elisha 22306293ae4SAya Levin int mlx5e_reporter_tx_create(struct mlx5e_priv *priv) 224de8650a8SEran Ben Elisha { 225baf6dfdbSAya Levin struct devlink_health_reporter *reporter; 226de8650a8SEran Ben Elisha struct mlx5_core_dev *mdev = priv->mdev; 227c50de4afSAya Levin struct devlink *devlink; 228de8650a8SEran Ben Elisha 229c50de4afSAya Levin devlink = priv_to_devlink(mdev); 230baf6dfdbSAya Levin reporter = 231de8650a8SEran Ben Elisha devlink_health_reporter_create(devlink, &mlx5_tx_reporter_ops, 232de8650a8SEran Ben Elisha MLX5_REPORTER_TX_GRACEFUL_PERIOD, 233de8650a8SEran Ben Elisha true, priv); 234baf6dfdbSAya Levin if (IS_ERR(reporter)) { 235de8650a8SEran Ben Elisha netdev_warn(priv->netdev, 236de8650a8SEran Ben Elisha "Failed to create tx reporter, err = %ld\n", 237baf6dfdbSAya Levin PTR_ERR(reporter)); 238baf6dfdbSAya Levin return PTR_ERR(reporter); 2397f7cc235SAya Levin } 240baf6dfdbSAya Levin priv->tx_reporter = reporter; 2417f7cc235SAya Levin return 0; 242de8650a8SEran Ben Elisha } 243de8650a8SEran Ben Elisha 24406293ae4SAya Levin void mlx5e_reporter_tx_destroy(struct mlx5e_priv *priv) 245de8650a8SEran Ben Elisha { 246baf6dfdbSAya Levin if (!priv->tx_reporter) 247de8650a8SEran Ben Elisha return; 248de8650a8SEran Ben Elisha 249de8650a8SEran Ben Elisha devlink_health_reporter_destroy(priv->tx_reporter); 250de8650a8SEran Ben Elisha } 251