// SPDX-License-Identifier: GPL-2.0 // Copyright (c) 2019 Mellanox Technologies. #include "health.h" #include "params.h" #include "txrx.h" #include "devlink.h" #include "ptp.h" #include "lib/tout.h" /* Keep this string array consistent with the MLX5E_RQ_STATE_* enums in en.h */ static const char * const rq_sw_state_type_name[] = { [MLX5E_RQ_STATE_ENABLED] = "enabled", [MLX5E_RQ_STATE_RECOVERING] = "recovering", [MLX5E_RQ_STATE_DIM] = "dim", [MLX5E_RQ_STATE_NO_CSUM_COMPLETE] = "no_csum_complete", [MLX5E_RQ_STATE_CSUM_FULL] = "csum_full", [MLX5E_RQ_STATE_MINI_CQE_HW_STRIDX] = "mini_cqe_hw_stridx", [MLX5E_RQ_STATE_SHAMPO] = "shampo", [MLX5E_RQ_STATE_MINI_CQE_ENHANCED] = "mini_cqe_enhanced", [MLX5E_RQ_STATE_XSK] = "xsk", }; static int mlx5e_query_rq_state(struct mlx5_core_dev *dev, u32 rqn, u8 *state) { int outlen = MLX5_ST_SZ_BYTES(query_rq_out); void *out; void *rqc; int err; out = kvzalloc(outlen, GFP_KERNEL); if (!out) return -ENOMEM; err = mlx5_core_query_rq(dev, rqn, out); if (err) goto out; rqc = MLX5_ADDR_OF(query_rq_out, out, rq_context); *state = MLX5_GET(rqc, rqc, state); out: kvfree(out); return err; } static int mlx5e_wait_for_icosq_flush(struct mlx5e_icosq *icosq) { struct mlx5_core_dev *dev = icosq->channel->mdev; unsigned long exp_time; exp_time = jiffies + msecs_to_jiffies(mlx5_tout_ms(dev, FLUSH_ON_ERROR)); while (time_before(jiffies, exp_time)) { if (icosq->cc == icosq->pc) return 0; msleep(20); } netdev_err(icosq->channel->netdev, "Wait for ICOSQ 0x%x flush timeout (cc = 0x%x, pc = 0x%x)\n", icosq->sqn, icosq->cc, icosq->pc); return -ETIMEDOUT; } static void mlx5e_reset_icosq_cc_pc(struct mlx5e_icosq *icosq) { WARN_ONCE(icosq->cc != icosq->pc, "ICOSQ 0x%x: cc (0x%x) != pc (0x%x)\n", icosq->sqn, icosq->cc, icosq->pc); icosq->cc = 0; icosq->pc = 0; } static int mlx5e_rx_reporter_err_icosq_cqe_recover(void *ctx) { struct mlx5e_rq *xskrq = NULL; struct mlx5_core_dev *mdev; struct mlx5e_icosq *icosq; struct net_device *dev; struct mlx5e_rq *rq; u8 state; int err; icosq = ctx; mutex_lock(&icosq->channel->icosq_recovery_lock); /* mlx5e_close_rq cancels this work before RQ and ICOSQ are killed. */ rq = &icosq->channel->rq; if (test_bit(MLX5E_RQ_STATE_ENABLED, &icosq->channel->xskrq.state)) xskrq = &icosq->channel->xskrq; mdev = icosq->channel->mdev; dev = icosq->channel->netdev; err = mlx5_core_query_sq_state(mdev, icosq->sqn, &state); if (err) { netdev_err(dev, "Failed to query ICOSQ 0x%x state. err = %d\n", icosq->sqn, err); goto out; } if (state != MLX5_SQC_STATE_ERR) goto out; mlx5e_deactivate_rq(rq); if (xskrq) mlx5e_deactivate_rq(xskrq); err = mlx5e_wait_for_icosq_flush(icosq); if (err) goto out; mlx5e_deactivate_icosq(icosq); /* At this point, both the rq and the icosq are disabled */ err = mlx5e_health_sq_to_ready(mdev, dev, icosq->sqn); if (err) goto out; mlx5e_reset_icosq_cc_pc(icosq); mlx5e_free_rx_missing_descs(rq); if (xskrq) mlx5e_free_rx_missing_descs(xskrq); clear_bit(MLX5E_SQ_STATE_RECOVERING, &icosq->state); mlx5e_activate_icosq(icosq); mlx5e_activate_rq(rq); rq->stats->recover++; if (xskrq) { mlx5e_activate_rq(xskrq); xskrq->stats->recover++; } mlx5e_trigger_napi_icosq(icosq->channel); mutex_unlock(&icosq->channel->icosq_recovery_lock); return 0; out: clear_bit(MLX5E_SQ_STATE_RECOVERING, &icosq->state); mutex_unlock(&icosq->channel->icosq_recovery_lock); return err; } static int mlx5e_rx_reporter_err_rq_cqe_recover(void *ctx) { struct mlx5e_rq *rq = ctx; int err; mlx5e_deactivate_rq(rq); err = mlx5e_flush_rq(rq, MLX5_RQC_STATE_ERR); clear_bit(MLX5E_RQ_STATE_RECOVERING, &rq->state); if (err) return err; mlx5e_activate_rq(rq); rq->stats->recover++; if (rq->channel) mlx5e_trigger_napi_icosq(rq->channel); else mlx5e_trigger_napi_sched(rq->cq.napi); return 0; } static int mlx5e_rx_reporter_timeout_recover(void *ctx) { struct mlx5_eq_comp *eq; struct mlx5e_rq *rq; int err; rq = ctx; eq = rq->cq.mcq.eq; err = mlx5e_health_channel_eq_recover(rq->netdev, eq, rq->cq.ch_stats); if (err && rq->icosq) clear_bit(MLX5E_SQ_STATE_ENABLED, &rq->icosq->state); return err; } static int mlx5e_rx_reporter_recover_from_ctx(struct mlx5e_err_ctx *err_ctx) { return err_ctx->recover(err_ctx->ctx); } static int mlx5e_rx_reporter_recover(struct devlink_health_reporter *reporter, void *context, struct netlink_ext_ack *extack) { struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); struct mlx5e_err_ctx *err_ctx = context; return err_ctx ? mlx5e_rx_reporter_recover_from_ctx(err_ctx) : mlx5e_health_recover_channels(priv); } static void mlx5e_reporter_icosq_diagnose(struct mlx5e_icosq *icosq, u8 hw_state, struct devlink_fmsg *fmsg) { mlx5e_health_fmsg_named_obj_nest_start(fmsg, "ICOSQ"); devlink_fmsg_u32_pair_put(fmsg, "sqn", icosq->sqn); devlink_fmsg_u8_pair_put(fmsg, "HW state", hw_state); devlink_fmsg_u32_pair_put(fmsg, "cc", icosq->cc); devlink_fmsg_u32_pair_put(fmsg, "pc", icosq->pc); devlink_fmsg_u32_pair_put(fmsg, "WQE size", mlx5_wq_cyc_get_size(&icosq->wq)); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "CQ"); devlink_fmsg_u32_pair_put(fmsg, "cqn", icosq->cq.mcq.cqn); devlink_fmsg_u32_pair_put(fmsg, "cc", icosq->cq.wq.cc); devlink_fmsg_u32_pair_put(fmsg, "size", mlx5_cqwq_get_size(&icosq->cq.wq)); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); } static void mlx5e_health_rq_put_sw_state(struct devlink_fmsg *fmsg, struct mlx5e_rq *rq) { int i; BUILD_BUG_ON_MSG(ARRAY_SIZE(rq_sw_state_type_name) != MLX5E_NUM_RQ_STATES, "rq_sw_state_type_name string array must be consistent with MLX5E_RQ_STATE_* enum in en.h"); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "SW State"); for (i = 0; i < ARRAY_SIZE(rq_sw_state_type_name); ++i) devlink_fmsg_u32_pair_put(fmsg, rq_sw_state_type_name[i], test_bit(i, &rq->state)); mlx5e_health_fmsg_named_obj_nest_end(fmsg); } static int mlx5e_rx_reporter_build_diagnose_output_rq_common(struct mlx5e_rq *rq, struct devlink_fmsg *fmsg) { u16 wqe_counter; int wqes_sz; u8 hw_state; u16 wq_head; int err; err = mlx5e_query_rq_state(rq->mdev, rq->rqn, &hw_state); if (err) return err; wqes_sz = mlx5e_rqwq_get_cur_sz(rq); wq_head = mlx5e_rqwq_get_head(rq); wqe_counter = mlx5e_rqwq_get_wqe_counter(rq); devlink_fmsg_u32_pair_put(fmsg, "rqn", rq->rqn); devlink_fmsg_u8_pair_put(fmsg, "HW state", hw_state); devlink_fmsg_u32_pair_put(fmsg, "WQE counter", wqe_counter); devlink_fmsg_u32_pair_put(fmsg, "posted WQEs", wqes_sz); devlink_fmsg_u32_pair_put(fmsg, "cc", wq_head); mlx5e_health_rq_put_sw_state(fmsg, rq); mlx5e_health_cq_diag_fmsg(&rq->cq, fmsg); mlx5e_health_eq_diag_fmsg(rq->cq.mcq.eq, fmsg); if (rq->icosq) { struct mlx5e_icosq *icosq = rq->icosq; u8 icosq_hw_state; int err; err = mlx5_core_query_sq_state(rq->mdev, icosq->sqn, &icosq_hw_state); if (err) return err; mlx5e_reporter_icosq_diagnose(icosq, icosq_hw_state, fmsg); } return 0; } static void mlx5e_rx_reporter_build_diagnose_output(struct mlx5e_rq *rq, struct devlink_fmsg *fmsg) { devlink_fmsg_obj_nest_start(fmsg); devlink_fmsg_u32_pair_put(fmsg, "channel ix", rq->ix); mlx5e_rx_reporter_build_diagnose_output_rq_common(rq, fmsg); devlink_fmsg_obj_nest_end(fmsg); } static void mlx5e_rx_reporter_diagnose_generic_rq(struct mlx5e_rq *rq, struct devlink_fmsg *fmsg) { struct mlx5e_priv *priv = rq->priv; struct mlx5e_params *params; u32 rq_stride, rq_sz; bool real_time; params = &priv->channels.params; rq_sz = mlx5e_rqwq_get_size(rq); real_time = mlx5_is_real_time_rq(rq->mdev); rq_stride = BIT(mlx5e_mpwqe_get_log_stride_size(rq->mdev, params, NULL)); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "RQ"); devlink_fmsg_u8_pair_put(fmsg, "type", params->rq_wq_type); devlink_fmsg_u64_pair_put(fmsg, "stride size", rq_stride); devlink_fmsg_u32_pair_put(fmsg, "size", rq_sz); devlink_fmsg_string_pair_put(fmsg, "ts_format", real_time ? "RT" : "FRC"); mlx5e_health_cq_common_diag_fmsg(&rq->cq, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); } static void mlx5e_rx_reporter_diagnose_common_ptp_config(struct mlx5e_priv *priv, struct mlx5e_ptp *ptp_ch, struct devlink_fmsg *fmsg) { mlx5e_health_fmsg_named_obj_nest_start(fmsg, "PTP"); devlink_fmsg_u32_pair_put(fmsg, "filter_type", priv->tstamp.rx_filter); mlx5e_rx_reporter_diagnose_generic_rq(&ptp_ch->rq, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); } static void mlx5e_rx_reporter_diagnose_common_config(struct devlink_health_reporter *reporter, struct devlink_fmsg *fmsg) { struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); struct mlx5e_rq *generic_rq = &priv->channels.c[0]->rq; struct mlx5e_ptp *ptp_ch = priv->channels.ptp; mlx5e_health_fmsg_named_obj_nest_start(fmsg, "Common config"); mlx5e_rx_reporter_diagnose_generic_rq(generic_rq, fmsg); if (ptp_ch && test_bit(MLX5E_PTP_STATE_RX, ptp_ch->state)) mlx5e_rx_reporter_diagnose_common_ptp_config(priv, ptp_ch, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); } static void mlx5e_rx_reporter_build_diagnose_output_ptp_rq(struct mlx5e_rq *rq, struct devlink_fmsg *fmsg) { devlink_fmsg_obj_nest_start(fmsg); devlink_fmsg_string_pair_put(fmsg, "channel", "ptp"); mlx5e_rx_reporter_build_diagnose_output_rq_common(rq, fmsg); devlink_fmsg_obj_nest_end(fmsg); } static int mlx5e_rx_reporter_diagnose(struct devlink_health_reporter *reporter, struct devlink_fmsg *fmsg, struct netlink_ext_ack *extack) { struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); struct mlx5e_ptp *ptp_ch = priv->channels.ptp; int i; mutex_lock(&priv->state_lock); if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) goto unlock; mlx5e_rx_reporter_diagnose_common_config(reporter, fmsg); devlink_fmsg_arr_pair_nest_start(fmsg, "RQs"); for (i = 0; i < priv->channels.num; i++) { struct mlx5e_channel *c = priv->channels.c[i]; struct mlx5e_rq *rq; rq = test_bit(MLX5E_CHANNEL_STATE_XSK, c->state) ? &c->xskrq : &c->rq; mlx5e_rx_reporter_build_diagnose_output(rq, fmsg); } if (ptp_ch && test_bit(MLX5E_PTP_STATE_RX, ptp_ch->state)) mlx5e_rx_reporter_build_diagnose_output_ptp_rq(&ptp_ch->rq, fmsg); devlink_fmsg_arr_pair_nest_end(fmsg); unlock: mutex_unlock(&priv->state_lock); return 0; } static int mlx5e_rx_reporter_dump_icosq(struct mlx5e_priv *priv, struct devlink_fmsg *fmsg, void *ctx) { struct mlx5e_txqsq *icosq = ctx; struct mlx5_rsc_key key = {}; if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) return 0; mlx5e_health_fmsg_named_obj_nest_start(fmsg, "SX Slice"); key.size = PAGE_SIZE; key.rsc = MLX5_SGMT_TYPE_SX_SLICE_ALL; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "ICOSQ"); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "QPC"); key.rsc = MLX5_SGMT_TYPE_FULL_QPC; key.index1 = icosq->sqn; key.num_of_obj1 = 1; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "send_buff"); key.rsc = MLX5_SGMT_TYPE_SND_BUFF; key.num_of_obj2 = MLX5_RSC_DUMP_ALL; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); return 0; } static int mlx5e_rx_reporter_dump_rq(struct mlx5e_priv *priv, struct devlink_fmsg *fmsg, void *ctx) { struct mlx5_rsc_key key = {}; struct mlx5e_rq *rq = ctx; if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) return 0; mlx5e_health_fmsg_named_obj_nest_start(fmsg, "RX Slice"); key.size = PAGE_SIZE; key.rsc = MLX5_SGMT_TYPE_RX_SLICE_ALL; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "RQ"); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "QPC"); key.rsc = MLX5_SGMT_TYPE_FULL_QPC; key.index1 = rq->rqn; key.num_of_obj1 = 1; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_start(fmsg, "receive_buff"); key.rsc = MLX5_SGMT_TYPE_RCV_BUFF; key.num_of_obj2 = MLX5_RSC_DUMP_ALL; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); return 0; } static int mlx5e_rx_reporter_dump_all_rqs(struct mlx5e_priv *priv, struct devlink_fmsg *fmsg) { struct mlx5e_ptp *ptp_ch = priv->channels.ptp; struct mlx5_rsc_key key = {}; if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) return 0; mlx5e_health_fmsg_named_obj_nest_start(fmsg, "RX Slice"); key.size = PAGE_SIZE; key.rsc = MLX5_SGMT_TYPE_RX_SLICE_ALL; mlx5e_health_rsc_fmsg_dump(priv, &key, fmsg); mlx5e_health_fmsg_named_obj_nest_end(fmsg); devlink_fmsg_arr_pair_nest_start(fmsg, "RQs"); for (int i = 0; i < priv->channels.num; i++) { struct mlx5e_rq *rq = &priv->channels.c[i]->rq; mlx5e_health_queue_dump(priv, fmsg, rq->rqn, "RQ"); } if (ptp_ch && test_bit(MLX5E_PTP_STATE_RX, ptp_ch->state)) mlx5e_health_queue_dump(priv, fmsg, ptp_ch->rq.rqn, "PTP RQ"); devlink_fmsg_arr_pair_nest_end(fmsg); return 0; } static int mlx5e_rx_reporter_dump_from_ctx(struct mlx5e_priv *priv, struct mlx5e_err_ctx *err_ctx, struct devlink_fmsg *fmsg) { return err_ctx->dump(priv, fmsg, err_ctx->ctx); } static int mlx5e_rx_reporter_dump(struct devlink_health_reporter *reporter, struct devlink_fmsg *fmsg, void *context, struct netlink_ext_ack *extack) { struct mlx5e_priv *priv = devlink_health_reporter_priv(reporter); struct mlx5e_err_ctx *err_ctx = context; return err_ctx ? mlx5e_rx_reporter_dump_from_ctx(priv, err_ctx, fmsg) : mlx5e_rx_reporter_dump_all_rqs(priv, fmsg); } void mlx5e_reporter_rx_timeout(struct mlx5e_rq *rq) { char err_str[MLX5E_REPORTER_PER_Q_MAX_LEN]; struct mlx5e_icosq *icosq = rq->icosq; struct mlx5e_priv *priv = rq->priv; struct mlx5e_err_ctx err_ctx = {}; char icosq_str[32] = {}; err_ctx.ctx = rq; err_ctx.recover = mlx5e_rx_reporter_timeout_recover; err_ctx.dump = mlx5e_rx_reporter_dump_rq; if (icosq) snprintf(icosq_str, sizeof(icosq_str), "ICOSQ: 0x%x, ", icosq->sqn); snprintf(err_str, sizeof(err_str), "RX timeout on channel: %d, %s RQ: 0x%x, CQ: 0x%x", rq->ix, icosq_str, rq->rqn, rq->cq.mcq.cqn); mlx5e_health_report(priv, priv->rx_reporter, err_str, &err_ctx); } void mlx5e_reporter_rq_cqe_err(struct mlx5e_rq *rq) { char err_str[MLX5E_REPORTER_PER_Q_MAX_LEN]; struct mlx5e_priv *priv = rq->priv; struct mlx5e_err_ctx err_ctx = {}; err_ctx.ctx = rq; err_ctx.recover = mlx5e_rx_reporter_err_rq_cqe_recover; err_ctx.dump = mlx5e_rx_reporter_dump_rq; snprintf(err_str, sizeof(err_str), "ERR CQE on RQ: 0x%x", rq->rqn); mlx5e_health_report(priv, priv->rx_reporter, err_str, &err_ctx); } void mlx5e_reporter_icosq_cqe_err(struct mlx5e_icosq *icosq) { struct mlx5e_priv *priv = icosq->channel->priv; char err_str[MLX5E_REPORTER_PER_Q_MAX_LEN]; struct mlx5e_err_ctx err_ctx = {}; err_ctx.ctx = icosq; err_ctx.recover = mlx5e_rx_reporter_err_icosq_cqe_recover; err_ctx.dump = mlx5e_rx_reporter_dump_icosq; snprintf(err_str, sizeof(err_str), "ERR CQE on ICOSQ: 0x%x", icosq->sqn); mlx5e_health_report(priv, priv->rx_reporter, err_str, &err_ctx); } void mlx5e_reporter_icosq_suspend_recovery(struct mlx5e_channel *c) { mutex_lock(&c->icosq_recovery_lock); } void mlx5e_reporter_icosq_resume_recovery(struct mlx5e_channel *c) { mutex_unlock(&c->icosq_recovery_lock); } static const struct devlink_health_reporter_ops mlx5_rx_reporter_ops = { .name = "rx", .recover = mlx5e_rx_reporter_recover, .diagnose = mlx5e_rx_reporter_diagnose, .dump = mlx5e_rx_reporter_dump, }; #define MLX5E_REPORTER_RX_GRACEFUL_PERIOD 500 void mlx5e_reporter_rx_create(struct mlx5e_priv *priv) { struct devlink_health_reporter *reporter; reporter = devlink_port_health_reporter_create(priv->netdev->devlink_port, &mlx5_rx_reporter_ops, MLX5E_REPORTER_RX_GRACEFUL_PERIOD, priv); if (IS_ERR(reporter)) { netdev_warn(priv->netdev, "Failed to create rx reporter, err = %ld\n", PTR_ERR(reporter)); return; } priv->rx_reporter = reporter; } void mlx5e_reporter_rx_destroy(struct mlx5e_priv *priv) { if (!priv->rx_reporter) return; devlink_health_reporter_destroy(priv->rx_reporter); priv->rx_reporter = NULL; }