151 lines · c
1// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)2/* Copyright 2020 NXP */3 4#include "dpaa2-eth.h"5 6static int dpaa2_eth_dcbnl_ieee_getpfc(struct net_device *net_dev,7 struct ieee_pfc *pfc)8{9 struct dpaa2_eth_priv *priv = netdev_priv(net_dev);10 11 if (!(priv->link_state.options & DPNI_LINK_OPT_PFC_PAUSE))12 return 0;13 14 memcpy(pfc, &priv->pfc, sizeof(priv->pfc));15 pfc->pfc_cap = dpaa2_eth_tc_count(priv);16 17 return 0;18}19 20static inline bool dpaa2_eth_is_prio_enabled(u8 pfc_en, u8 tc)21{22 return !!(pfc_en & (1 << tc));23}24 25static int dpaa2_eth_set_pfc_cn(struct dpaa2_eth_priv *priv, u8 pfc_en)26{27 struct dpni_congestion_notification_cfg cfg = {0};28 int i, err;29 30 cfg.notification_mode = DPNI_CONG_OPT_FLOW_CONTROL;31 cfg.units = DPNI_CONGESTION_UNIT_FRAMES;32 cfg.message_iova = 0ULL;33 cfg.message_ctx = 0ULL;34 35 for (i = 0; i < dpaa2_eth_tc_count(priv); i++) {36 if (dpaa2_eth_is_prio_enabled(pfc_en, i)) {37 cfg.threshold_entry = DPAA2_ETH_CN_THRESH_ENTRY(priv);38 cfg.threshold_exit = DPAA2_ETH_CN_THRESH_EXIT(priv);39 } else {40 /* For priorities not set in the pfc_en mask, we leave41 * the congestion thresholds at zero, which effectively42 * disables generation of PFC frames for them43 */44 cfg.threshold_entry = 0;45 cfg.threshold_exit = 0;46 }47 48 err = dpni_set_congestion_notification(priv->mc_io, 0,49 priv->mc_token,50 DPNI_QUEUE_RX, i, &cfg);51 if (err) {52 netdev_err(priv->net_dev,53 "dpni_set_congestion_notification failed\n");54 return err;55 }56 }57 58 return 0;59}60 61static int dpaa2_eth_dcbnl_ieee_setpfc(struct net_device *net_dev,62 struct ieee_pfc *pfc)63{64 struct dpaa2_eth_priv *priv = netdev_priv(net_dev);65 struct dpni_link_cfg link_cfg = {0};66 bool tx_pause;67 int err;68 69 if (pfc->mbc || pfc->delay)70 return -EOPNOTSUPP;71 72 /* If same PFC enabled mask, nothing to do */73 if (priv->pfc.pfc_en == pfc->pfc_en)74 return 0;75 76 /* We allow PFC configuration even if it won't have any effect until77 * general pause frames are enabled78 */79 tx_pause = dpaa2_eth_tx_pause_enabled(priv->link_state.options);80 if (!dpaa2_eth_rx_pause_enabled(priv->link_state.options) || !tx_pause)81 netdev_warn(net_dev, "Pause support must be enabled in order for PFC to work!\n");82 83 link_cfg.rate = priv->link_state.rate;84 link_cfg.options = priv->link_state.options;85 if (pfc->pfc_en)86 link_cfg.options |= DPNI_LINK_OPT_PFC_PAUSE;87 else88 link_cfg.options &= ~DPNI_LINK_OPT_PFC_PAUSE;89 err = dpni_set_link_cfg(priv->mc_io, 0, priv->mc_token, &link_cfg);90 if (err) {91 netdev_err(net_dev, "dpni_set_link_cfg failed\n");92 return err;93 }94 95 /* Configure congestion notifications for the enabled priorities */96 err = dpaa2_eth_set_pfc_cn(priv, pfc->pfc_en);97 if (err)98 return err;99 100 memcpy(&priv->pfc, pfc, sizeof(priv->pfc));101 priv->pfc_enabled = !!pfc->pfc_en;102 103 dpaa2_eth_set_rx_taildrop(priv, tx_pause, priv->pfc_enabled);104 105 return 0;106}107 108static u8 dpaa2_eth_dcbnl_getdcbx(struct net_device *net_dev)109{110 struct dpaa2_eth_priv *priv = netdev_priv(net_dev);111 112 return priv->dcbx_mode;113}114 115static u8 dpaa2_eth_dcbnl_setdcbx(struct net_device *net_dev, u8 mode)116{117 struct dpaa2_eth_priv *priv = netdev_priv(net_dev);118 119 return (mode != (priv->dcbx_mode)) ? 1 : 0;120}121 122static u8 dpaa2_eth_dcbnl_getcap(struct net_device *net_dev, int capid, u8 *cap)123{124 struct dpaa2_eth_priv *priv = netdev_priv(net_dev);125 126 switch (capid) {127 case DCB_CAP_ATTR_PFC:128 *cap = true;129 break;130 case DCB_CAP_ATTR_PFC_TCS:131 *cap = 1 << (dpaa2_eth_tc_count(priv) - 1);132 break;133 case DCB_CAP_ATTR_DCBX:134 *cap = priv->dcbx_mode;135 break;136 default:137 *cap = false;138 break;139 }140 141 return 0;142}143 144const struct dcbnl_rtnl_ops dpaa2_eth_dcbnl_ops = {145 .ieee_getpfc = dpaa2_eth_dcbnl_ieee_getpfc,146 .ieee_setpfc = dpaa2_eth_dcbnl_ieee_setpfc,147 .getdcbx = dpaa2_eth_dcbnl_getdcbx,148 .setdcbx = dpaa2_eth_dcbnl_setdcbx,149 .getcap = dpaa2_eth_dcbnl_getcap,150};151