git.oblomov.eu Git - linux-2.6/blob - drivers/net/ixgbe/ixgbe_dcb_nl.c

   1 /*******************************************************************************
   2
   3   Intel 10 Gigabit PCI Express Linux driver
   4   Copyright(c) 1999 - 2009 Intel Corporation.
   5
   6   This program is free software; you can redistribute it and/or modify it
   7   under the terms and conditions of the GNU General Public License,
   8   version 2, as published by the Free Software Foundation.
   9
  10   This program is distributed in the hope it will be useful, but WITHOUT
  11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13   more details.
  14
  15   You should have received a copy of the GNU General Public License along with
  16   this program; if not, write to the Free Software Foundation, Inc.,
  17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  18
  19   The full GNU General Public License is included in this distribution in
  20   the file called "COPYING".
  21
  22   Contact Information:
  23   Linux NICS <linux.nics@intel.com>
  24   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  25   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  26
  27 *******************************************************************************/
  28
  29 #include "ixgbe.h"
  30 #include <linux/dcbnl.h>
  31
  32 /* Callbacks for DCB netlink in the kernel */
  33 #define BIT_DCB_MODE    0x01
  34 #define BIT_PFC         0x02
  35 #define BIT_PG_RX       0x04
  36 #define BIT_PG_TX       0x08
  37 #define BIT_BCN         0x10
  38 #define BIT_LINKSPEED   0x80
  39
  40 int ixgbe_copy_dcb_cfg(struct ixgbe_dcb_config *src_dcb_cfg,
  41                        struct ixgbe_dcb_config *dst_dcb_cfg, int tc_max)
  42 {
  43         struct tc_configuration *src_tc_cfg = NULL;
  44         struct tc_configuration *dst_tc_cfg = NULL;
  45         int i;
  46
  47         if (!src_dcb_cfg || !dst_dcb_cfg)
  48                 return -EINVAL;
  49
  50         for (i = DCB_PG_ATTR_TC_0; i < tc_max + DCB_PG_ATTR_TC_0; i++) {
  51                 src_tc_cfg = &src_dcb_cfg->tc_config[i - DCB_PG_ATTR_TC_0];
  52                 dst_tc_cfg = &dst_dcb_cfg->tc_config[i - DCB_PG_ATTR_TC_0];
  53
  54                 dst_tc_cfg->path[DCB_TX_CONFIG].prio_type =
  55                                 src_tc_cfg->path[DCB_TX_CONFIG].prio_type;
  56
  57                 dst_tc_cfg->path[DCB_TX_CONFIG].bwg_id =
  58                                 src_tc_cfg->path[DCB_TX_CONFIG].bwg_id;
  59
  60                 dst_tc_cfg->path[DCB_TX_CONFIG].bwg_percent =
  61                                 src_tc_cfg->path[DCB_TX_CONFIG].bwg_percent;
  62
  63                 dst_tc_cfg->path[DCB_TX_CONFIG].up_to_tc_bitmap =
  64                                 src_tc_cfg->path[DCB_TX_CONFIG].up_to_tc_bitmap;
  65
  66                 dst_tc_cfg->path[DCB_RX_CONFIG].prio_type =
  67                                 src_tc_cfg->path[DCB_RX_CONFIG].prio_type;
  68
  69                 dst_tc_cfg->path[DCB_RX_CONFIG].bwg_id =
  70                                 src_tc_cfg->path[DCB_RX_CONFIG].bwg_id;
  71
  72                 dst_tc_cfg->path[DCB_RX_CONFIG].bwg_percent =
  73                                 src_tc_cfg->path[DCB_RX_CONFIG].bwg_percent;
  74
  75                 dst_tc_cfg->path[DCB_RX_CONFIG].up_to_tc_bitmap =
  76                                 src_tc_cfg->path[DCB_RX_CONFIG].up_to_tc_bitmap;
  77         }
  78
  79         for (i = DCB_PG_ATTR_BW_ID_0; i < DCB_PG_ATTR_BW_ID_MAX; i++) {
  80                 dst_dcb_cfg->bw_percentage[DCB_TX_CONFIG]
  81                         [i-DCB_PG_ATTR_BW_ID_0] = src_dcb_cfg->bw_percentage
  82                                 [DCB_TX_CONFIG][i-DCB_PG_ATTR_BW_ID_0];
  83                 dst_dcb_cfg->bw_percentage[DCB_RX_CONFIG]
  84                         [i-DCB_PG_ATTR_BW_ID_0] = src_dcb_cfg->bw_percentage
  85                                 [DCB_RX_CONFIG][i-DCB_PG_ATTR_BW_ID_0];
  86         }
  87
  88         for (i = DCB_PFC_UP_ATTR_0; i < DCB_PFC_UP_ATTR_MAX; i++) {
  89                 dst_dcb_cfg->tc_config[i - DCB_PFC_UP_ATTR_0].dcb_pfc =
  90                         src_dcb_cfg->tc_config[i - DCB_PFC_UP_ATTR_0].dcb_pfc;
  91         }
  92
  93         return 0;
  94 }
  95
  96 static u8 ixgbe_dcbnl_get_state(struct net_device *netdev)
  97 {
  98         struct ixgbe_adapter *adapter = netdev_priv(netdev);
  99
 100         DPRINTK(DRV, INFO, "Get DCB Admin Mode.\n");
 101
 102         return !!(adapter->flags & IXGBE_FLAG_DCB_ENABLED);
 103 }
 104
 105 static u8 ixgbe_dcbnl_set_state(struct net_device *netdev, u8 state)
 106 {
 107         u8 err = 0;
 108         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 109
 110         DPRINTK(DRV, INFO, "Set DCB Admin Mode.\n");
 111
 112         if (state > 0) {
 113                 /* Turn on DCB */
 114                 if (adapter->flags & IXGBE_FLAG_DCB_ENABLED)
 115                         goto out;
 116
 117                 if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
 118                         DPRINTK(DRV, ERR, "Enable failed, needs MSI-X\n");
 119                         err = 1;
 120                         goto out;
 121                 }
 122
 123                 if (netif_running(netdev))
 124                         netdev->netdev_ops->ndo_stop(netdev);
 125                 ixgbe_reset_interrupt_capability(adapter);
 126                 ixgbe_napi_del_all(adapter);
 127                 INIT_LIST_HEAD(&netdev->napi_list);
 128                 kfree(adapter->tx_ring);
 129                 kfree(adapter->rx_ring);
 130                 adapter->tx_ring = NULL;
 131                 adapter->rx_ring = NULL;
 132
 133                 adapter->flags &= ~IXGBE_FLAG_RSS_ENABLED;
 134                 adapter->flags |= IXGBE_FLAG_DCB_ENABLED;
 135                 ixgbe_init_interrupt_scheme(adapter);
 136                 if (netif_running(netdev))
 137                         netdev->netdev_ops->ndo_open(netdev);
 138         } else {
 139                 /* Turn off DCB */
 140                 if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
 141                         if (netif_running(netdev))
 142                                 netdev->netdev_ops->ndo_stop(netdev);
 143                         ixgbe_reset_interrupt_capability(adapter);
 144                         ixgbe_napi_del_all(adapter);
 145                         INIT_LIST_HEAD(&netdev->napi_list);
 146                         kfree(adapter->tx_ring);
 147                         kfree(adapter->rx_ring);
 148                         adapter->tx_ring = NULL;
 149                         adapter->rx_ring = NULL;
 150
 151                         adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
 152                         adapter->flags |= IXGBE_FLAG_RSS_ENABLED;
 153                         ixgbe_init_interrupt_scheme(adapter);
 154                         if (netif_running(netdev))
 155                                 netdev->netdev_ops->ndo_open(netdev);
 156                 }
 157         }
 158 out:
 159         return err;
 160 }
 161
 162 static void ixgbe_dcbnl_get_perm_hw_addr(struct net_device *netdev,
 163                                          u8 *perm_addr)
 164 {
 165         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 166         int i;
 167
 168         for (i = 0; i < netdev->addr_len; i++)
 169                 perm_addr[i] = adapter->hw.mac.perm_addr[i];
 170 }
 171
 172 static void ixgbe_dcbnl_set_pg_tc_cfg_tx(struct net_device *netdev, int tc,
 173                                          u8 prio, u8 bwg_id, u8 bw_pct,
 174                                          u8 up_map)
 175 {
 176         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 177
 178         if (prio != DCB_ATTR_VALUE_UNDEFINED)
 179                 adapter->temp_dcb_cfg.tc_config[tc].path[0].prio_type = prio;
 180         if (bwg_id != DCB_ATTR_VALUE_UNDEFINED)
 181                 adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_id = bwg_id;
 182         if (bw_pct != DCB_ATTR_VALUE_UNDEFINED)
 183                 adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_percent =
 184                         bw_pct;
 185         if (up_map != DCB_ATTR_VALUE_UNDEFINED)
 186                 adapter->temp_dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap =
 187                         up_map;
 188
 189         if ((adapter->temp_dcb_cfg.tc_config[tc].path[0].prio_type !=
 190              adapter->dcb_cfg.tc_config[tc].path[0].prio_type) ||
 191             (adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_id !=
 192              adapter->dcb_cfg.tc_config[tc].path[0].bwg_id) ||
 193             (adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_percent !=
 194              adapter->dcb_cfg.tc_config[tc].path[0].bwg_percent) ||
 195             (adapter->temp_dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap !=
 196              adapter->dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap))
 197                 adapter->dcb_set_bitmap |= BIT_PG_TX;
 198 }
 199
 200 static void ixgbe_dcbnl_set_pg_bwg_cfg_tx(struct net_device *netdev, int bwg_id,
 201                                           u8 bw_pct)
 202 {
 203         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 204
 205         adapter->temp_dcb_cfg.bw_percentage[0][bwg_id] = bw_pct;
 206
 207         if (adapter->temp_dcb_cfg.bw_percentage[0][bwg_id] !=
 208             adapter->dcb_cfg.bw_percentage[0][bwg_id])
 209                 adapter->dcb_set_bitmap |= BIT_PG_RX;
 210 }
 211
 212 static void ixgbe_dcbnl_set_pg_tc_cfg_rx(struct net_device *netdev, int tc,
 213                                          u8 prio, u8 bwg_id, u8 bw_pct,
 214                                          u8 up_map)
 215 {
 216         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 217
 218         if (prio != DCB_ATTR_VALUE_UNDEFINED)
 219                 adapter->temp_dcb_cfg.tc_config[tc].path[1].prio_type = prio;
 220         if (bwg_id != DCB_ATTR_VALUE_UNDEFINED)
 221                 adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_id = bwg_id;
 222         if (bw_pct != DCB_ATTR_VALUE_UNDEFINED)
 223                 adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_percent =
 224                         bw_pct;
 225         if (up_map != DCB_ATTR_VALUE_UNDEFINED)
 226                 adapter->temp_dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap =
 227                         up_map;
 228
 229         if ((adapter->temp_dcb_cfg.tc_config[tc].path[1].prio_type !=
 230              adapter->dcb_cfg.tc_config[tc].path[1].prio_type) ||
 231             (adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_id !=
 232              adapter->dcb_cfg.tc_config[tc].path[1].bwg_id) ||
 233             (adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_percent !=
 234              adapter->dcb_cfg.tc_config[tc].path[1].bwg_percent) ||
 235             (adapter->temp_dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap !=
 236              adapter->dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap))
 237                 adapter->dcb_set_bitmap |= BIT_PG_RX;
 238 }
 239
 240 static void ixgbe_dcbnl_set_pg_bwg_cfg_rx(struct net_device *netdev, int bwg_id,
 241                                           u8 bw_pct)
 242 {
 243         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 244
 245         adapter->temp_dcb_cfg.bw_percentage[1][bwg_id] = bw_pct;
 246
 247         if (adapter->temp_dcb_cfg.bw_percentage[1][bwg_id] !=
 248             adapter->dcb_cfg.bw_percentage[1][bwg_id])
 249                 adapter->dcb_set_bitmap |= BIT_PG_RX;
 250 }
 251
 252 static void ixgbe_dcbnl_get_pg_tc_cfg_tx(struct net_device *netdev, int tc,
 253                                          u8 *prio, u8 *bwg_id, u8 *bw_pct,
 254                                          u8 *up_map)
 255 {
 256         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 257
 258         *prio = adapter->dcb_cfg.tc_config[tc].path[0].prio_type;
 259         *bwg_id = adapter->dcb_cfg.tc_config[tc].path[0].bwg_id;
 260         *bw_pct = adapter->dcb_cfg.tc_config[tc].path[0].bwg_percent;
 261         *up_map = adapter->dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap;
 262 }
 263
 264 static void ixgbe_dcbnl_get_pg_bwg_cfg_tx(struct net_device *netdev, int bwg_id,
 265                                           u8 *bw_pct)
 266 {
 267         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 268
 269         *bw_pct = adapter->dcb_cfg.bw_percentage[0][bwg_id];
 270 }
 271
 272 static void ixgbe_dcbnl_get_pg_tc_cfg_rx(struct net_device *netdev, int tc,
 273                                          u8 *prio, u8 *bwg_id, u8 *bw_pct,
 274                                          u8 *up_map)
 275 {
 276         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 277
 278         *prio = adapter->dcb_cfg.tc_config[tc].path[1].prio_type;
 279         *bwg_id = adapter->dcb_cfg.tc_config[tc].path[1].bwg_id;
 280         *bw_pct = adapter->dcb_cfg.tc_config[tc].path[1].bwg_percent;
 281         *up_map = adapter->dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap;
 282 }
 283
 284 static void ixgbe_dcbnl_get_pg_bwg_cfg_rx(struct net_device *netdev, int bwg_id,
 285                                           u8 *bw_pct)
 286 {
 287         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 288
 289         *bw_pct = adapter->dcb_cfg.bw_percentage[1][bwg_id];
 290 }
 291
 292 static void ixgbe_dcbnl_set_pfc_cfg(struct net_device *netdev, int priority,
 293                                     u8 setting)
 294 {
 295         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 296
 297         adapter->temp_dcb_cfg.tc_config[priority].dcb_pfc = setting;
 298         if (adapter->temp_dcb_cfg.tc_config[priority].dcb_pfc !=
 299             adapter->dcb_cfg.tc_config[priority].dcb_pfc)
 300                 adapter->dcb_set_bitmap |= BIT_PFC;
 301 }
 302
 303 static void ixgbe_dcbnl_get_pfc_cfg(struct net_device *netdev, int priority,
 304                                     u8 *setting)
 305 {
 306         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 307
 308         *setting = adapter->dcb_cfg.tc_config[priority].dcb_pfc;
 309 }
 310
 311 static u8 ixgbe_dcbnl_set_all(struct net_device *netdev)
 312 {
 313         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 314         int ret;
 315
 316         adapter->dcb_set_bitmap &= ~BIT_BCN;    /* no set for BCN */
 317         if (!adapter->dcb_set_bitmap)
 318                 return 1;
 319
 320         while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
 321                 msleep(1);
 322
 323         if (netif_running(netdev))
 324                 ixgbe_down(adapter);
 325
 326         ret = ixgbe_copy_dcb_cfg(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
 327                                  adapter->ring_feature[RING_F_DCB].indices);
 328         if (ret) {
 329                 clear_bit(__IXGBE_RESETTING, &adapter->state);
 330                 return ret;
 331         }
 332
 333         if (netif_running(netdev))
 334                 ixgbe_up(adapter);
 335
 336         adapter->dcb_set_bitmap = 0x00;
 337         clear_bit(__IXGBE_RESETTING, &adapter->state);
 338         return ret;
 339 }
 340
 341 static u8 ixgbe_dcbnl_getcap(struct net_device *netdev, int capid, u8 *cap)
 342 {
 343         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 344         u8 rval = 0;
 345
 346         if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
 347                 switch (capid) {
 348                 case DCB_CAP_ATTR_PG:
 349                         *cap = true;
 350                         break;
 351                 case DCB_CAP_ATTR_PFC:
 352                         *cap = true;
 353                         break;
 354                 case DCB_CAP_ATTR_UP2TC:
 355                         *cap = false;
 356                         break;
 357                 case DCB_CAP_ATTR_PG_TCS:
 358                         *cap = 0x80;
 359                         break;
 360                 case DCB_CAP_ATTR_PFC_TCS:
 361                         *cap = 0x80;
 362                         break;
 363                 case DCB_CAP_ATTR_GSP:
 364                         *cap = true;
 365                         break;
 366                 case DCB_CAP_ATTR_BCN:
 367                         *cap = false;
 368                         break;
 369                 default:
 370                         rval = -EINVAL;
 371                         break;
 372                 }
 373         } else {
 374                 rval = -EINVAL;
 375         }
 376
 377         return rval;
 378 }
 379
 380 static u8 ixgbe_dcbnl_getnumtcs(struct net_device *netdev, int tcid, u8 *num)
 381 {
 382         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 383         u8 rval = 0;
 384
 385         if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
 386                 switch (tcid) {
 387                 case DCB_NUMTCS_ATTR_PG:
 388                         *num = MAX_TRAFFIC_CLASS;
 389                         break;
 390                 case DCB_NUMTCS_ATTR_PFC:
 391                         *num = MAX_TRAFFIC_CLASS;
 392                         break;
 393                 default:
 394                         rval = -EINVAL;
 395                         break;
 396                 }
 397         } else {
 398                 rval = -EINVAL;
 399         }
 400
 401         return rval;
 402 }
 403
 404 static u8 ixgbe_dcbnl_setnumtcs(struct net_device *netdev, int tcid, u8 num)
 405 {
 406         return -EINVAL;
 407 }
 408
 409 static u8 ixgbe_dcbnl_getpfcstate(struct net_device *netdev)
 410 {
 411         struct ixgbe_adapter *adapter = netdev_priv(netdev);
 412
 413         return !!(adapter->flags & IXGBE_FLAG_DCB_ENABLED);
 414 }
 415
 416 static void ixgbe_dcbnl_setpfcstate(struct net_device *netdev, u8 state)
 417 {
 418         return;
 419 }
 420
 421 struct dcbnl_rtnl_ops dcbnl_ops = {
 422         .getstate       = ixgbe_dcbnl_get_state,
 423         .setstate       = ixgbe_dcbnl_set_state,
 424         .getpermhwaddr  = ixgbe_dcbnl_get_perm_hw_addr,
 425         .setpgtccfgtx   = ixgbe_dcbnl_set_pg_tc_cfg_tx,
 426         .setpgbwgcfgtx  = ixgbe_dcbnl_set_pg_bwg_cfg_tx,
 427         .setpgtccfgrx   = ixgbe_dcbnl_set_pg_tc_cfg_rx,
 428         .setpgbwgcfgrx  = ixgbe_dcbnl_set_pg_bwg_cfg_rx,
 429         .getpgtccfgtx   = ixgbe_dcbnl_get_pg_tc_cfg_tx,
 430         .getpgbwgcfgtx  = ixgbe_dcbnl_get_pg_bwg_cfg_tx,
 431         .getpgtccfgrx   = ixgbe_dcbnl_get_pg_tc_cfg_rx,
 432         .getpgbwgcfgrx  = ixgbe_dcbnl_get_pg_bwg_cfg_rx,
 433         .setpfccfg      = ixgbe_dcbnl_set_pfc_cfg,
 434         .getpfccfg      = ixgbe_dcbnl_get_pfc_cfg,
 435         .setall         = ixgbe_dcbnl_set_all,
 436         .getcap         = ixgbe_dcbnl_getcap,
 437         .getnumtcs      = ixgbe_dcbnl_getnumtcs,
 438         .setnumtcs      = ixgbe_dcbnl_setnumtcs,
 439         .getpfcstate    = ixgbe_dcbnl_getpfcstate,
 440         .setpfcstate    = ixgbe_dcbnl_setpfcstate,
 441 };
 442