dpaa2-eth-dcb.c (3874B)
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 leave 41 * the congestion thresholds at zero, which effectively 42 * disables generation of PFC frames for them 43 */ 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 until 77 * general pause frames are enabled 78 */ 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 else 88 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};