2 * Copyright (c) 2011 Mellanox Technologies. All rights reserved.
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
34 #include <linux/dcbnl.h>
35 #include <linux/math64.h>
39 static int mlx4_en_dcbnl_ieee_getets(struct net_device *dev,
42 struct mlx4_en_priv *priv = netdev_priv(dev);
43 struct ieee_ets *my_ets = &priv->ets;
45 /* No IEEE PFC settings available */
49 ets->ets_cap = IEEE_8021QAZ_MAX_TCS;
50 ets->cbs = my_ets->cbs;
51 memcpy(ets->tc_tx_bw, my_ets->tc_tx_bw, sizeof(ets->tc_tx_bw));
52 memcpy(ets->tc_tsa, my_ets->tc_tsa, sizeof(ets->tc_tsa));
53 memcpy(ets->prio_tc, my_ets->prio_tc, sizeof(ets->prio_tc));
58 static int mlx4_en_ets_validate(struct mlx4_en_priv *priv, struct ieee_ets *ets)
64 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
65 if (ets->prio_tc[i] > MLX4_EN_NUM_UP) {
66 en_err(priv, "Bad priority in UP <=> TC mapping. TC: %d, UP: %d\n",
71 switch (ets->tc_tsa[i]) {
72 case IEEE_8021QAZ_TSA_STRICT:
74 case IEEE_8021QAZ_TSA_ETS:
76 total_ets_bw += ets->tc_tx_bw[i];
79 en_err(priv, "TC[%d]: Not supported TSA: %d\n",
85 if (has_ets_tc && total_ets_bw != MLX4_EN_BW_MAX) {
86 en_err(priv, "Bad ETS BW sum: %d. Should be exactly 100%%\n",
94 static int mlx4_en_config_port_scheduler(struct mlx4_en_priv *priv,
95 struct ieee_ets *ets, u16 *ratelimit)
97 struct mlx4_en_dev *mdev = priv->mdev;
100 __u8 tc_tx_bw[IEEE_8021QAZ_MAX_TCS] = { 0 };
101 __u8 pg[IEEE_8021QAZ_MAX_TCS] = { 0 };
103 ets = ets ?: &priv->ets;
104 ratelimit = ratelimit ?: priv->maxrate;
106 /* higher TC means higher priority => lower pg */
107 for (i = IEEE_8021QAZ_MAX_TCS - 1; i >= 0; i--) {
108 switch (ets->tc_tsa[i]) {
109 case IEEE_8021QAZ_TSA_STRICT:
110 pg[i] = num_strict++;
111 tc_tx_bw[i] = MLX4_EN_BW_MAX;
113 case IEEE_8021QAZ_TSA_ETS:
114 pg[i] = MLX4_EN_TC_ETS;
115 tc_tx_bw[i] = ets->tc_tx_bw[i] ?: MLX4_EN_BW_MIN;
120 return mlx4_SET_PORT_SCHEDULER(mdev->dev, priv->port, tc_tx_bw, pg,
125 mlx4_en_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
127 struct mlx4_en_priv *priv = netdev_priv(dev);
128 struct mlx4_en_dev *mdev = priv->mdev;
131 err = mlx4_en_ets_validate(priv, ets);
135 err = mlx4_SET_PORT_PRIO2TC(mdev->dev, priv->port, ets->prio_tc);
139 err = mlx4_en_config_port_scheduler(priv, ets, NULL);
143 memcpy(&priv->ets, ets, sizeof(priv->ets));
148 static int mlx4_en_dcbnl_ieee_getpfc(struct net_device *dev,
149 struct ieee_pfc *pfc)
151 struct mlx4_en_priv *priv = netdev_priv(dev);
153 pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
154 pfc->pfc_en = priv->prof->tx_ppp;
159 static int mlx4_en_dcbnl_ieee_setpfc(struct net_device *dev,
160 struct ieee_pfc *pfc)
162 struct mlx4_en_priv *priv = netdev_priv(dev);
163 struct mlx4_en_dev *mdev = priv->mdev;
166 en_dbg(DRV, priv, "cap: 0x%x en: 0x%x mbc: 0x%x delay: %d\n",
172 priv->prof->rx_pause = priv->prof->tx_pause = !!pfc->pfc_en;
173 priv->prof->rx_ppp = priv->prof->tx_ppp = pfc->pfc_en;
175 err = mlx4_SET_PORT_general(mdev->dev, priv->port,
176 priv->rx_skb_size + ETH_FCS_LEN,
177 priv->prof->tx_pause,
179 priv->prof->rx_pause,
182 en_err(priv, "Failed setting pause params\n");
187 static u8 mlx4_en_dcbnl_getdcbx(struct net_device *dev)
189 return DCB_CAP_DCBX_VER_IEEE;
192 static u8 mlx4_en_dcbnl_setdcbx(struct net_device *dev, u8 mode)
194 if ((mode & DCB_CAP_DCBX_LLD_MANAGED) ||
195 (mode & DCB_CAP_DCBX_VER_CEE) ||
196 !(mode & DCB_CAP_DCBX_VER_IEEE) ||
197 !(mode & DCB_CAP_DCBX_HOST))
203 #define MLX4_RATELIMIT_UNITS_IN_KB 100000 /* rate-limit HW unit in Kbps */
204 static int mlx4_en_dcbnl_ieee_getmaxrate(struct net_device *dev,
205 struct ieee_maxrate *maxrate)
207 struct mlx4_en_priv *priv = netdev_priv(dev);
213 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
214 maxrate->tc_maxrate[i] =
215 priv->maxrate[i] * MLX4_RATELIMIT_UNITS_IN_KB;
220 static int mlx4_en_dcbnl_ieee_setmaxrate(struct net_device *dev,
221 struct ieee_maxrate *maxrate)
223 struct mlx4_en_priv *priv = netdev_priv(dev);
224 u16 tmp[IEEE_8021QAZ_MAX_TCS];
227 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
228 /* Convert from Kbps into HW units, rounding result up.
229 * Setting to 0, means unlimited BW.
231 tmp[i] = div_u64(maxrate->tc_maxrate[i] +
232 MLX4_RATELIMIT_UNITS_IN_KB - 1,
233 MLX4_RATELIMIT_UNITS_IN_KB);
236 err = mlx4_en_config_port_scheduler(priv, NULL, tmp);
240 memcpy(priv->maxrate, tmp, sizeof(priv->maxrate));
245 const struct dcbnl_rtnl_ops mlx4_en_dcbnl_ops = {
246 .ieee_getets = mlx4_en_dcbnl_ieee_getets,
247 .ieee_setets = mlx4_en_dcbnl_ieee_setets,
248 .ieee_getmaxrate = mlx4_en_dcbnl_ieee_getmaxrate,
249 .ieee_setmaxrate = mlx4_en_dcbnl_ieee_setmaxrate,
250 .ieee_getpfc = mlx4_en_dcbnl_ieee_getpfc,
251 .ieee_setpfc = mlx4_en_dcbnl_ieee_setpfc,
253 .getdcbx = mlx4_en_dcbnl_getdcbx,
254 .setdcbx = mlx4_en_dcbnl_setdcbx,