drivers/net/ethernet/mellanox/mlx4/en_dcb_nl.c

   1 /*
   2  * Copyright (c) 2011 Mellanox Technologies. All rights reserved.
   3  *
   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:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  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.
  22  *
  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
  30  * SOFTWARE.
  31  *
  32  */
  33
  34 #include <linux/dcbnl.h>
  35 #include <linux/math64.h>
  36
  37 #include "mlx4_en.h"
  38
  39 static int mlx4_en_dcbnl_ieee_getets(struct net_device *dev,
  40                                    struct ieee_ets *ets)
  41 {
  42         struct mlx4_en_priv *priv = netdev_priv(dev);
  43         struct ieee_ets *my_ets = &priv->ets;
  44
  45         /* No IEEE PFC settings available */
  46         if (!my_ets)
  47                 return -EINVAL;
  48
  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));
  54
  55         return 0;
  56 }
  57
  58 static int mlx4_en_ets_validate(struct mlx4_en_priv *priv, struct ieee_ets *ets)
  59 {
  60         int i;
  61         int total_ets_bw = 0;
  62         int has_ets_tc = 0;
  63
  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",
  67                                         i, ets->prio_tc[i]);
  68                         return -EINVAL;
  69                 }
  70
  71                 switch (ets->tc_tsa[i]) {
  72                 case IEEE_8021QAZ_TSA_STRICT:
  73                         break;
  74                 case IEEE_8021QAZ_TSA_ETS:
  75                         has_ets_tc = 1;
  76                         total_ets_bw += ets->tc_tx_bw[i];
  77                         break;
  78                 default:
  79                         en_err(priv, "TC[%d]: Not supported TSA: %d\n",
  80                                         i, ets->tc_tsa[i]);
  81                         return -ENOTSUPP;
  82                 }
  83         }
  84
  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",
  87                                 total_ets_bw);
  88                 return -EINVAL;
  89         }
  90
  91         return 0;
  92 }
  93
  94 static int mlx4_en_config_port_scheduler(struct mlx4_en_priv *priv,
  95                 struct ieee_ets *ets, u16 *ratelimit)
  96 {
  97         struct mlx4_en_dev *mdev = priv->mdev;
  98         int num_strict = 0;
  99         int i;
 100         __u8 tc_tx_bw[IEEE_8021QAZ_MAX_TCS] = { 0 };
 101         __u8 pg[IEEE_8021QAZ_MAX_TCS] = { 0 };
 102
 103         ets = ets ?: &priv->ets;
 104         ratelimit = ratelimit ?: priv->maxrate;
 105
 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;
 112                         break;
 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;
 116                         break;
 117                 }
 118         }
 119
 120         return mlx4_SET_PORT_SCHEDULER(mdev->dev, priv->port, tc_tx_bw, pg,
 121                         ratelimit);
 122 }
 123
 124 static int
 125 mlx4_en_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
 126 {
 127         struct mlx4_en_priv *priv = netdev_priv(dev);
 128         struct mlx4_en_dev *mdev = priv->mdev;
 129         int err;
 130
 131         err = mlx4_en_ets_validate(priv, ets);
 132         if (err)
 133                 return err;
 134
 135         err = mlx4_SET_PORT_PRIO2TC(mdev->dev, priv->port, ets->prio_tc);
 136         if (err)
 137                 return err;
 138
 139         err = mlx4_en_config_port_scheduler(priv, ets, NULL);
 140         if (err)
 141                 return err;
 142
 143         memcpy(&priv->ets, ets, sizeof(priv->ets));
 144
 145         return 0;
 146 }
 147
 148 static int mlx4_en_dcbnl_ieee_getpfc(struct net_device *dev,
 149                 struct ieee_pfc *pfc)
 150 {
 151         struct mlx4_en_priv *priv = netdev_priv(dev);
 152
 153         pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
 154         pfc->pfc_en = priv->prof->tx_ppp;
 155
 156         return 0;
 157 }
 158
 159 static int mlx4_en_dcbnl_ieee_setpfc(struct net_device *dev,
 160                 struct ieee_pfc *pfc)
 161 {
 162         struct mlx4_en_priv *priv = netdev_priv(dev);
 163         struct mlx4_en_port_profile *prof = priv->prof;
 164         struct mlx4_en_dev *mdev = priv->mdev;
 165         int err;
 166
 167         en_dbg(DRV, priv, "cap: 0x%x en: 0x%x mbc: 0x%x delay: %d\n",
 168                         pfc->pfc_cap,
 169                         pfc->pfc_en,
 170                         pfc->mbc,
 171                         pfc->delay);
 172
 173         prof->rx_pause = !pfc->pfc_en;
 174         prof->tx_pause = !pfc->pfc_en;
 175         prof->rx_ppp = pfc->pfc_en;
 176         prof->tx_ppp = pfc->pfc_en;
 177
 178         err = mlx4_SET_PORT_general(mdev->dev, priv->port,
 179                                     priv->rx_skb_size + ETH_FCS_LEN,
 180                                     prof->tx_pause,
 181                                     prof->tx_ppp,
 182                                     prof->rx_pause,
 183                                     prof->rx_ppp);
 184         if (err)
 185                 en_err(priv, "Failed setting pause params\n");
 186
 187         return err;
 188 }
 189
 190 static u8 mlx4_en_dcbnl_getdcbx(struct net_device *dev)
 191 {
 192         return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE;
 193 }
 194
 195 static u8 mlx4_en_dcbnl_setdcbx(struct net_device *dev, u8 mode)
 196 {
 197         if ((mode & DCB_CAP_DCBX_LLD_MANAGED) ||
 198             (mode & DCB_CAP_DCBX_VER_CEE) ||
 199             !(mode & DCB_CAP_DCBX_VER_IEEE) ||
 200             !(mode & DCB_CAP_DCBX_HOST))
 201                 return 1;
 202
 203         return 0;
 204 }
 205
 206 #define MLX4_RATELIMIT_UNITS_IN_KB 100000 /* rate-limit HW unit in Kbps */
 207 static int mlx4_en_dcbnl_ieee_getmaxrate(struct net_device *dev,
 208                                    struct ieee_maxrate *maxrate)
 209 {
 210         struct mlx4_en_priv *priv = netdev_priv(dev);
 211         int i;
 212
 213         for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
 214                 maxrate->tc_maxrate[i] =
 215                         priv->maxrate[i] * MLX4_RATELIMIT_UNITS_IN_KB;
 216
 217         return 0;
 218 }
 219
 220 static int mlx4_en_dcbnl_ieee_setmaxrate(struct net_device *dev,
 221                 struct ieee_maxrate *maxrate)
 222 {
 223         struct mlx4_en_priv *priv = netdev_priv(dev);
 224         u16 tmp[IEEE_8021QAZ_MAX_TCS];
 225         int i, err;
 226
 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.
 230                  */
 231                 tmp[i] = div_u64(maxrate->tc_maxrate[i] +
 232                                  MLX4_RATELIMIT_UNITS_IN_KB - 1,
 233                                  MLX4_RATELIMIT_UNITS_IN_KB);
 234         }
 235
 236         err = mlx4_en_config_port_scheduler(priv, NULL, tmp);
 237         if (err)
 238                 return err;
 239
 240         memcpy(priv->maxrate, tmp, sizeof(priv->maxrate));
 241
 242         return 0;
 243 }
 244
 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,
 252
 253         .getdcbx        = mlx4_en_dcbnl_getdcbx,
 254         .setdcbx        = mlx4_en_dcbnl_setdcbx,
 255 };
 256
 257 const struct dcbnl_rtnl_ops mlx4_en_dcbnl_pfc_ops = {
 258         .ieee_getpfc    = mlx4_en_dcbnl_ieee_getpfc,
 259         .ieee_setpfc    = mlx4_en_dcbnl_ieee_setpfc,
 260
 261         .getdcbx        = mlx4_en_dcbnl_getdcbx,
 262         .setdcbx        = mlx4_en_dcbnl_setdcbx,
 263 };