sys/ofed/drivers/net/mlx4/en_netdev.c

   1 /*
   2  * Copyright (c) 2007 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 "mlx4_en.h"
  35
  36 #include <linux/mlx4/driver.h>
  37 #include <linux/mlx4/device.h>
  38 #include <linux/mlx4/cmd.h>
  39 #include <linux/mlx4/cq.h>
  40
  41 #include <linux/delay.h>
  42 #include <net/ethernet.h>
  43 #include <net/if_vlan_var.h>
  44 #include <sys/sockio.h>
  45
  46 static void mlx4_en_init_locked(struct mlx4_en_priv *priv);
  47 static void mlx4_en_sysctl_stat(struct mlx4_en_priv *priv);
  48
  49 static void mlx4_en_vlan_rx_add_vid(void *arg, struct net_device *dev, u16 vid)
  50 {
  51         struct mlx4_en_priv *priv = netdev_priv(dev);
  52         int idx;
  53         u8 field;
  54
  55         if (arg != priv)
  56                 return;
  57
  58         if ((vid == 0) || (vid > 4095))    /* Invalid */
  59                 return;
  60         en_dbg(HW, priv, "adding VLAN:%d\n", vid);
  61         idx = vid >> 5;
  62         field = 1 << (vid & 0x1f);
  63         spin_lock(&priv->vlan_lock);
  64         priv->vlgrp_modified = true;
  65         if (priv->vlan_unregister[idx] & field)
  66                 priv->vlan_unregister[idx] &= ~field;
  67         else
  68                 priv->vlan_register[idx] |= field;
  69         priv->vlans[idx] |= field;
  70         spin_unlock(&priv->vlan_lock);
  71 }
  72
  73 static void mlx4_en_vlan_rx_kill_vid(void *arg, struct net_device *dev, u16 vid)
  74 {
  75         struct mlx4_en_priv *priv = netdev_priv(dev);
  76         int idx;
  77         u8 field;
  78
  79         if (arg != priv)
  80                 return;
  81
  82         if ((vid == 0) || (vid > 4095))    /* Invalid */
  83                 return;
  84         en_dbg(HW, priv, "Killing VID:%d\n", vid);
  85         idx = vid >> 5;
  86         field = 1 << (vid & 0x1f);
  87         spin_lock(&priv->vlan_lock);
  88         priv->vlgrp_modified = true;
  89         if (priv->vlan_register[idx] & field)
  90                 priv->vlan_register[idx] &= ~field;
  91         else
  92                 priv->vlan_unregister[idx] |= field;
  93         priv->vlans[idx] &= ~field;
  94         spin_unlock(&priv->vlan_lock);
  95 }
  96
  97 u64 mlx4_en_mac_to_u64(u8 *addr)
  98 {
  99         u64 mac = 0;
 100         int i;
 101
 102         for (i = 0; i < ETHER_ADDR_LEN; i++) {
 103                 mac <<= 8;
 104                 mac |= addr[i];
 105         }
 106         return mac;
 107 }
 108
 109 static int mlx4_en_cache_mclist(struct net_device *dev, u64 **mcaddrp)
 110 {
 111         struct ifmultiaddr *ifma;
 112         u64 *mcaddr;
 113         int cnt;
 114         int i;
 115
 116         *mcaddrp = NULL;
 117 restart:
 118         cnt = 0;
 119         if_maddr_rlock(dev);
 120         TAILQ_FOREACH(ifma, &dev->if_multiaddrs, ifma_link) {
 121                 if (ifma->ifma_addr->sa_family != AF_LINK)
 122                         continue;
 123                 if (((struct sockaddr_dl *)ifma->ifma_addr)->sdl_alen !=
 124                     ETHER_ADDR_LEN)
 125                         continue;
 126                 cnt++;
 127         }
 128         if_maddr_runlock(dev);
 129         if (cnt == 0)
 130                 return (0);
 131         mcaddr = kmalloc(sizeof(u64) * cnt, GFP_KERNEL);
 132         if (mcaddr == NULL)
 133                 return (0);
 134         i = 0;
 135         if_maddr_rlock(dev);
 136         TAILQ_FOREACH(ifma, &dev->if_multiaddrs, ifma_link) {
 137                 if (ifma->ifma_addr->sa_family != AF_LINK)
 138                         continue;
 139                 if (((struct sockaddr_dl *)ifma->ifma_addr)->sdl_alen !=
 140                     ETHER_ADDR_LEN)
 141                         continue;
 142                 /* Make sure the list didn't grow. */
 143                 if (i == cnt) {
 144                         if_maddr_runlock(dev);
 145                         kfree(mcaddr);
 146                         goto restart;
 147                 }
 148                 mcaddr[i++] = mlx4_en_mac_to_u64(
 149                     LLADDR((struct sockaddr_dl *)ifma->ifma_addr));
 150         }
 151         if_maddr_runlock(dev);
 152         *mcaddrp = mcaddr;
 153         return (i);
 154 }
 155
 156
 157 static void mlx4_en_set_multicast(struct net_device *dev)
 158 {
 159         struct mlx4_en_priv *priv = netdev_priv(dev);
 160
 161         if (!priv->port_up)
 162                 return;
 163
 164         queue_work(priv->mdev->workqueue, &priv->mcast_task);
 165 }
 166
 167 static void mlx4_en_do_set_multicast(struct work_struct *work)
 168 {
 169         struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
 170                                                  mcast_task);
 171         struct net_device *dev = priv->dev;
 172         struct mlx4_en_dev *mdev = priv->mdev;
 173         int err;
 174
 175         mutex_lock(&mdev->state_lock);
 176         if (!mdev->device_up) {
 177                 en_dbg(HW, priv, "Card is not up, "
 178                                  "ignoring multicast change.\n");
 179                 goto out;
 180         }
 181         if (!priv->port_up) {
 182                 en_dbg(HW, priv, "Port is down, "
 183                                  "ignoring  multicast change.\n");
 184                 goto out;
 185         }
 186
 187         /*
 188          * Promsicuous mode: disable all filters
 189          */
 190
 191         if (dev->if_flags & IFF_PROMISC) {
 192                 if (!(priv->flags & MLX4_EN_FLAG_PROMISC)) {
 193                         priv->flags |= MLX4_EN_FLAG_PROMISC;
 194
 195                         /* Enable promiscouos mode */
 196                         err = mlx4_SET_PORT_qpn_calc(mdev->dev, priv->port,
 197                                                      priv->base_qpn, 1);
 198                         if (err)
 199                                 en_err(priv, "Failed enabling "
 200                                              "promiscous mode\n");
 201
 202                         /* Disable port multicast filter (unconditionally) */
 203                         err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
 204                                                   0, MLX4_MCAST_DISABLE);
 205                         if (err)
 206                                 en_err(priv, "Failed disabling "
 207                                              "multicast filter\n");
 208
 209                         /* Disable port VLAN filter */
 210                         err = mlx4_SET_VLAN_FLTR(mdev->dev, priv->port, NULL);
 211                         if (err)
 212                                 en_err(priv, "Failed disabling VLAN filter\n");
 213                 }
 214                 goto out;
 215         }
 216
 217         /*
 218          * Not in promiscous mode
 219          */
 220
 221         if (priv->flags & MLX4_EN_FLAG_PROMISC) {
 222                 priv->flags &= ~MLX4_EN_FLAG_PROMISC;
 223
 224                 /* Disable promiscouos mode */
 225                 err = mlx4_SET_PORT_qpn_calc(mdev->dev, priv->port,
 226                                              priv->base_qpn, 0);
 227                 if (err)
 228                         en_err(priv, "Failed disabling promiscous mode\n");
 229
 230                 /* Enable port VLAN filter */
 231                 err = mlx4_SET_VLAN_FLTR(mdev->dev, priv->port, priv->vlans);
 232                 if (err)
 233                         en_err(priv, "Failed enabling VLAN filter\n");
 234         }
 235
 236         /* Enable/disable the multicast filter according to IFF_ALLMULTI */
 237         if (dev->if_flags & IFF_ALLMULTI) {
 238                 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
 239                                           0, MLX4_MCAST_DISABLE);
 240                 if (err)
 241                         en_err(priv, "Failed disabling multicast filter\n");
 242         } else {
 243                 u64 *mcaddr;
 244                 int mccount;
 245                 int i;
 246
 247                 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
 248                                           0, MLX4_MCAST_DISABLE);
 249                 if (err)
 250                         en_err(priv, "Failed disabling multicast filter\n");
 251
 252                 /* Flush mcast filter and init it with broadcast address */
 253                 mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, ETH_BCAST,
 254                                     1, MLX4_MCAST_CONFIG);
 255
 256                 /* Update multicast list - we cache all addresses so they won't
 257                  * change while HW is updated holding the command semaphor */
 258                 mccount = mlx4_en_cache_mclist(dev, &mcaddr);
 259                 for (i = 0; i < mccount; i++)
 260                         mlx4_SET_MCAST_FLTR(mdev->dev, priv->port,
 261                                             mcaddr[i], 0, MLX4_MCAST_CONFIG);
 262                 err = mlx4_SET_MCAST_FLTR(mdev->dev, priv->port, 0,
 263                                           0, MLX4_MCAST_ENABLE);
 264                 if (err)
 265                         en_err(priv, "Failed enabling multicast filter\n");
 266
 267                 kfree(mcaddr);
 268         }
 269 out:
 270         mutex_unlock(&mdev->state_lock);
 271 }
 272
 273 #ifdef CONFIG_NET_POLL_CONTROLLER
 274 static void mlx4_en_netpoll(struct net_device *dev)
 275 {
 276         struct mlx4_en_priv *priv = netdev_priv(dev);
 277         struct mlx4_en_cq *cq;
 278         unsigned long flags;
 279         int i;
 280
 281         for (i = 0; i < priv->rx_ring_num; i++) {
 282                 cq = &priv->rx_cq[i];
 283                 spin_lock_irqsave(&cq->lock, flags);
 284                 napi_synchronize(&cq->napi);
 285                 mlx4_en_process_rx_cq(dev, cq, 0);
 286                 spin_unlock_irqrestore(&cq->lock, flags);
 287         }
 288 }
 289 #endif
 290
 291 static void mlx4_en_watchdog_timeout(void *arg)
 292 {
 293         struct mlx4_en_priv *priv = arg;
 294         struct mlx4_en_dev *mdev = priv->mdev;
 295
 296         en_dbg(DRV, priv, "Scheduling watchdog\n");
 297         queue_work(mdev->workqueue, &priv->watchdog_task);
 298         if (priv->port_up)
 299                 callout_reset(&priv->watchdog_timer, MLX4_EN_WATCHDOG_TIMEOUT,
 300                     mlx4_en_watchdog_timeout, priv);
 301 }
 302
 303
 304 /* XXX This clears user settings in too many cases. */
 305 static void mlx4_en_set_default_moderation(struct mlx4_en_priv *priv)
 306 {
 307         struct mlx4_en_cq *cq;
 308         int i;
 309
 310         /* If we haven't received a specific coalescing setting
 311          * (module param), we set the moderation paramters as follows:
 312          * - moder_cnt is set to the number of mtu sized packets to
 313          *   satisfy our coelsing target.
 314          * - moder_time is set to a fixed value.
 315          */
 316         priv->rx_frames = MLX4_EN_RX_COAL_TARGET / priv->dev->if_mtu + 1;
 317         priv->rx_usecs = MLX4_EN_RX_COAL_TIME;
 318         en_dbg(INTR, priv, "Default coalesing params for mtu:%ld - "
 319                            "rx_frames:%d rx_usecs:%d\n",
 320                  priv->dev->if_mtu, priv->rx_frames, priv->rx_usecs);
 321
 322         /* Setup cq moderation params */
 323         for (i = 0; i < priv->rx_ring_num; i++) {
 324                 cq = &priv->rx_cq[i];
 325                 cq->moder_cnt = priv->rx_frames;
 326                 cq->moder_time = priv->rx_usecs;
 327                 priv->last_moder_time[i] = MLX4_EN_AUTO_CONF;
 328                 priv->last_moder_packets[i] = 0;
 329                 priv->last_moder_bytes[i] = 0;
 330         }
 331
 332         for (i = 0; i < priv->tx_ring_num; i++) {
 333                 cq = &priv->tx_cq[i];
 334                 cq->moder_cnt = MLX4_EN_TX_COAL_PKTS;
 335                 cq->moder_time = MLX4_EN_TX_COAL_TIME;
 336         }
 337
 338         /* Reset auto-moderation params */
 339         priv->pkt_rate_low = MLX4_EN_RX_RATE_LOW;
 340         priv->rx_usecs_low = MLX4_EN_RX_COAL_TIME_LOW;
 341         priv->pkt_rate_high = MLX4_EN_RX_RATE_HIGH;
 342         priv->rx_usecs_high = MLX4_EN_RX_COAL_TIME_HIGH;
 343         priv->sample_interval = MLX4_EN_SAMPLE_INTERVAL;
 344         priv->adaptive_rx_coal = 1;
 345         priv->last_moder_jiffies = 0;
 346         priv->last_moder_tx_packets = 0;
 347 }
 348
 349 static void mlx4_en_auto_moderation(struct mlx4_en_priv *priv)
 350 {
 351         unsigned long period = (unsigned long) (jiffies - priv->last_moder_jiffies);
 352         struct mlx4_en_cq *cq;
 353         unsigned long packets;
 354         unsigned long rate;
 355         unsigned long avg_pkt_size;
 356         unsigned long rx_packets;
 357         unsigned long rx_bytes;
 358         unsigned long rx_pkt_diff;
 359         int moder_time;
 360         int ring, err;
 361
 362         if (!priv->adaptive_rx_coal || period < priv->sample_interval * HZ)
 363                 return;
 364         for (ring = 0; ring < priv->rx_ring_num; ring++) {
 365                 spin_lock(&priv->stats_lock);
 366                 rx_packets = priv->rx_ring[ring].packets;
 367                 rx_bytes = priv->rx_ring[ring].bytes;
 368                 spin_unlock(&priv->stats_lock);
 369
 370                 rx_pkt_diff = ((unsigned long) (rx_packets -
 371                                 priv->last_moder_packets[ring]));
 372                 packets = rx_pkt_diff;
 373                 rate = packets * HZ / period;
 374                 avg_pkt_size = packets ? ((unsigned long) (rx_bytes -
 375                                 priv->last_moder_bytes[ring])) / packets : 0;
 376
 377                 /* Apply auto-moderation only when packet rate
 378                 * exceeds a rate that it matters */
 379                 if (rate > (MLX4_EN_RX_RATE_THRESH / priv->rx_ring_num) &&
 380                                 avg_pkt_size > MLX4_EN_AVG_PKT_SMALL) {
 381                         if (rate < priv->pkt_rate_low ||
 382                             avg_pkt_size < MLX4_EN_AVG_PKT_SMALL)
 383                                 moder_time = priv->rx_usecs_low;
 384                         else if (rate > priv->pkt_rate_high)
 385                                 moder_time = priv->rx_usecs_high;
 386                         else
 387                                 moder_time = (rate - priv->pkt_rate_low) *
 388                                         (priv->rx_usecs_high - priv->rx_usecs_low) /
 389                                         (priv->pkt_rate_high - priv->pkt_rate_low) +
 390                                         priv->rx_usecs_low;
 391                 } else {
 392                         moder_time = priv->rx_usecs_low;
 393                 }
 394
 395                 if (moder_time != priv->last_moder_time[ring]) {
 396                         priv->last_moder_time[ring] = moder_time;
 397                         cq = &priv->rx_cq[ring];
 398                         cq->moder_time = moder_time;
 399                         err = mlx4_en_set_cq_moder(priv, cq);
 400                         if (err)
 401                                 en_err(priv, "Failed modifying moderation "
 402                                         "for cq:%d\n", ring);
 403                 }
 404                 priv->last_moder_packets[ring] = rx_packets;
 405                 priv->last_moder_bytes[ring] = rx_bytes;
 406         }
 407
 408         priv->last_moder_jiffies = jiffies;
 409 }
 410
 411 static void mlx4_en_handle_vlans(struct mlx4_en_priv *priv)
 412 {
 413         u8 vlan_register[VLAN_FLTR_SIZE];
 414         u8 vlan_unregister[VLAN_FLTR_SIZE];
 415         int i, j, idx;
 416         u16 vid;
 417
 418         /* cache the vlan data for processing
 419          * done under lock to avoid changes during work */
 420         spin_lock(&priv->vlan_lock);
 421         for (i = 0; i < VLAN_FLTR_SIZE; i++) {
 422                 vlan_register[i] = priv->vlan_register[i];
 423                 priv->vlan_register[i] = 0;
 424                 vlan_unregister[i] = priv->vlan_unregister[i];
 425                 priv->vlan_unregister[i] = 0;
 426         }
 427         priv->vlgrp_modified = false;
 428         spin_unlock(&priv->vlan_lock);
 429
 430         /* Configure the vlan filter
 431          * The vlgrp is updated with all the vids that need to be allowed */
 432         if (mlx4_SET_VLAN_FLTR(priv->mdev->dev, priv->port, priv->vlans))
 433                 en_err(priv, "Failed configuring VLAN filter\n");
 434
 435         /* Configure the VLAN table */
 436         for (i = 0; i < VLAN_FLTR_SIZE; i++) {
 437                 for (j = 0; j < 32; j++) {
 438                         vid = (i << 5) + j;
 439                         if (vlan_register[i] & (1 << j))
 440                                 if (mlx4_register_vlan(priv->mdev->dev, priv->port, vid, &idx))
 441                                         en_dbg(HW, priv, "failed registering vlan %d\n", vid);
 442                         if (vlan_unregister[i] & (1 << j)) {
 443                                 if (!mlx4_find_cached_vlan(priv->mdev->dev, priv->port, vid, &idx))
 444                                         mlx4_unregister_vlan(priv->mdev->dev, priv->port, idx);
 445                                 else
 446                                         en_dbg(HW, priv, "could not find vid %d in cache\n", vid);
 447                         }
 448                 }
 449         }
 450 }
 451
 452 static void mlx4_en_do_get_stats(struct work_struct *work)
 453 {
 454         struct delayed_work *delay = to_delayed_work(work);
 455         struct mlx4_en_priv *priv = container_of(delay, struct mlx4_en_priv,
 456                                                  stats_task);
 457         struct mlx4_en_dev *mdev = priv->mdev;
 458         int err;
 459
 460         err = mlx4_en_DUMP_ETH_STATS(mdev, priv->port, 0);
 461         if (err)
 462                 en_dbg(HW, priv, "Could not update stats \n");
 463
 464
 465         mutex_lock(&mdev->state_lock);
 466         if (mdev->device_up) {
 467                 if (priv->port_up) {
 468                         if (priv->vlgrp_modified)
 469                                 mlx4_en_handle_vlans(priv);
 470
 471                         mlx4_en_auto_moderation(priv);
 472                 }
 473
 474                 queue_delayed_work(mdev->workqueue, &priv->stats_task, STATS_DELAY);
 475         }
 476         mutex_unlock(&mdev->state_lock);
 477 }
 478
 479 static void mlx4_en_linkstate(struct work_struct *work)
 480 {
 481         struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
 482                                                  linkstate_task);
 483         struct mlx4_en_dev *mdev = priv->mdev;
 484         int linkstate = priv->link_state;
 485
 486         mutex_lock(&mdev->state_lock);
 487         /* If observable port state changed set carrier state and
 488          * report to system log */
 489         if (priv->last_link_state != linkstate) {
 490                 if (linkstate == MLX4_DEV_EVENT_PORT_DOWN) {
 491                         if_link_state_change(priv->dev, LINK_STATE_DOWN);
 492                 } else {
 493                         en_info(priv, "Link Up\n");
 494                         if_link_state_change(priv->dev, LINK_STATE_UP);
 495                 }
 496         }
 497         priv->last_link_state = linkstate;
 498         mutex_unlock(&mdev->state_lock);
 499 }
 500
 501
 502 int mlx4_en_start_port(struct net_device *dev)
 503 {
 504         struct mlx4_en_priv *priv = netdev_priv(dev);
 505         struct mlx4_en_dev *mdev = priv->mdev;
 506         struct mlx4_en_cq *cq;
 507         struct mlx4_en_tx_ring *tx_ring;
 508         u64 config;
 509         int rx_index = 0;
 510         int tx_index = 0;
 511         int err = 0;
 512         int i;
 513         int j;
 514
 515         if (priv->port_up) {
 516                 en_dbg(DRV, priv, "start port called while port already up\n");
 517                 return 0;
 518         }
 519
 520         /* Calculate Rx buf size */
 521         dev->if_mtu = min(dev->if_mtu, priv->max_mtu);
 522         mlx4_en_calc_rx_buf(dev);
 523         en_dbg(DRV, priv, "Rx buf size:%d\n", priv->rx_mb_size);
 524
 525         /* Configure rx cq's and rings */
 526         err = mlx4_en_activate_rx_rings(priv);
 527         if (err) {
 528                 en_err(priv, "Failed to activate RX rings\n");
 529                 return err;
 530         }
 531
 532         for (i = 0; i < priv->rx_ring_num; i++) {
 533                 cq = &priv->rx_cq[i];
 534
 535                 err = mlx4_en_activate_cq(priv, cq);
 536                 if (err) {
 537                         en_err(priv, "Failed activating Rx CQ\n");
 538                         goto cq_err;
 539                 }
 540                 for (j = 0; j < cq->size; j++)
 541                         cq->buf[j].owner_sr_opcode = MLX4_CQE_OWNER_MASK;
 542                 err = mlx4_en_set_cq_moder(priv, cq);
 543                 if (err) {
 544                         en_err(priv, "Failed setting cq moderation parameters");
 545                         mlx4_en_deactivate_cq(priv, cq);
 546                         goto cq_err;
 547                 }
 548                 mlx4_en_arm_cq(priv, cq);
 549                 priv->rx_ring[i].cqn = cq->mcq.cqn;
 550                 ++rx_index;
 551         }
 552
 553         err = mlx4_en_config_rss_steer(priv);
 554         if (err) {
 555                 en_err(priv, "Failed configuring rss steering\n");
 556                 goto cq_err;
 557         }
 558
 559         /* Configure tx cq's and rings */
 560         for (i = 0; i < priv->tx_ring_num; i++) {
 561                 /* Configure cq */
 562                 cq = &priv->tx_cq[i];
 563                 err = mlx4_en_activate_cq(priv, cq);
 564                 if (err) {
 565                         en_err(priv, "Failed allocating Tx CQ\n");
 566                         goto tx_err;
 567                 }
 568                 err = mlx4_en_set_cq_moder(priv, cq);
 569                 if (err) {
 570                         en_err(priv, "Failed setting cq moderation parameters");
 571                         mlx4_en_deactivate_cq(priv, cq);
 572                         goto tx_err;
 573                 }
 574                 en_dbg(DRV, priv, "Resetting index of collapsed CQ:%d to -1\n", i);
 575                 cq->buf->wqe_index = cpu_to_be16(0xffff);
 576
 577                 /* Configure ring */
 578                 tx_ring = &priv->tx_ring[i];
 579                 err = mlx4_en_activate_tx_ring(priv, tx_ring, cq->mcq.cqn);
 580                 if (err) {
 581                         en_err(priv, "Failed allocating Tx ring\n");
 582                         mlx4_en_deactivate_cq(priv, cq);
 583                         goto tx_err;
 584                 }
 585                 /* Set initial ownership of all Tx TXBBs to SW (1) */
 586                 for (j = 0; j < tx_ring->buf_size; j += STAMP_STRIDE)
 587                         *((u32 *) (tx_ring->buf + j)) = 0xffffffff;
 588                 ++tx_index;
 589         }
 590
 591         /* Configure port */
 592         err = mlx4_SET_PORT_general(mdev->dev, priv->port,
 593                                     priv->rx_mb_size + ETHER_CRC_LEN,
 594                                     priv->prof->tx_pause,
 595                                     priv->prof->tx_ppp,
 596                                     priv->prof->rx_pause,
 597                                     priv->prof->rx_ppp);
 598         if (err) {
 599                 en_err(priv, "Failed setting port general configurations "
 600                              "for port %d, with error %d\n", priv->port, err);
 601                 goto tx_err;
 602         }
 603         /* Set default qp number */
 604         err = mlx4_SET_PORT_qpn_calc(mdev->dev, priv->port, priv->base_qpn, 0);
 605         if (err) {
 606                 en_err(priv, "Failed setting default qp numbers\n");
 607                 goto tx_err;
 608         }
 609         /* Set port mac number */
 610         en_dbg(DRV, priv, "Setting mac for port %d\n", priv->port);
 611         err = mlx4_register_mac(mdev->dev, priv->port,
 612                                 mlx4_en_mac_to_u64(IF_LLADDR(dev)));
 613         if (err < 0) {
 614                 en_err(priv, "Failed setting port mac err=%d\n", err);
 615                 goto tx_err;
 616         }
 617         mdev->mac_removed[priv->port] = 0;
 618
 619         /* Init port */
 620         en_dbg(HW, priv, "Initializing port\n");
 621         err = mlx4_INIT_PORT(mdev->dev, priv->port);
 622         if (err) {
 623                 en_err(priv, "Failed Initializing port\n");
 624                 goto mac_err;
 625         }
 626
 627         /* Set the various hardware offload abilities */
 628         dev->if_hwassist = 0;
 629         if (dev->if_capenable & IFCAP_TSO4)
 630                 dev->if_hwassist |= CSUM_TSO;
 631         if (dev->if_capenable & IFCAP_TXCSUM)
 632                 dev->if_hwassist |= (CSUM_TCP | CSUM_UDP | CSUM_IP);
 633         if (dev->if_capenable & IFCAP_RXCSUM)
 634                 priv->rx_csum = 1;
 635         else
 636                 priv->rx_csum = 0;
 637
 638         err = mlx4_wol_read(priv->mdev->dev, &config, priv->port);
 639         if (err) {
 640                 en_err(priv, "Failed to get WoL info, unable to modify\n");
 641                 goto wol_err;
 642         }
 643         if (dev->if_capenable & IFCAP_WOL_MAGIC) {
 644                 config |= MLX4_EN_WOL_DO_MODIFY | MLX4_EN_WOL_ENABLED |
 645                     MLX4_EN_WOL_MAGIC;
 646         } else {
 647                 config &= ~(MLX4_EN_WOL_ENABLED | MLX4_EN_WOL_MAGIC);
 648                 config |= MLX4_EN_WOL_DO_MODIFY;
 649         }
 650
 651         err = mlx4_wol_write(priv->mdev->dev, config, priv->port);
 652         if (err) {
 653                 en_err(priv, "Failed to set WoL information\n");
 654                 goto wol_err;
 655         }
 656
 657         priv->port_up = true;
 658
 659         /* Populate multicast list */
 660         mlx4_en_set_multicast(dev);
 661
 662         /* Enable the queues. */
 663         dev->if_drv_flags &= ~IFF_DRV_OACTIVE;
 664         dev->if_drv_flags |= IFF_DRV_RUNNING;
 665
 666         callout_reset(&priv->watchdog_timer, MLX4_EN_WATCHDOG_TIMEOUT,
 667             mlx4_en_watchdog_timeout, priv);
 668
 669         return 0;
 670
 671 wol_err:
 672         /* close port*/
 673         mlx4_CLOSE_PORT(mdev->dev, priv->port);
 674
 675 mac_err:
 676         mlx4_unregister_mac(mdev->dev, priv->port, priv->mac);
 677 tx_err:
 678         while (tx_index--) {
 679                 mlx4_en_deactivate_tx_ring(priv, &priv->tx_ring[tx_index]);
 680                 mlx4_en_deactivate_cq(priv, &priv->tx_cq[tx_index]);
 681         }
 682
 683         mlx4_en_release_rss_steer(priv);
 684 cq_err:
 685         while (rx_index--)
 686                 mlx4_en_deactivate_cq(priv, &priv->rx_cq[rx_index]);
 687         for (i = 0; i < priv->rx_ring_num; i++)
 688                 mlx4_en_deactivate_rx_ring(priv, &priv->rx_ring[i]);
 689
 690         return err; /* need to close devices */
 691 }
 692
 693
 694 void mlx4_en_stop_port(struct net_device *dev)
 695 {
 696         struct mlx4_en_priv *priv = netdev_priv(dev);
 697         struct mlx4_en_dev *mdev = priv->mdev;
 698         int i;
 699
 700         if (!priv->port_up) {
 701                 en_dbg(DRV, priv, "stop port called while port already down\n");
 702                 return;
 703         }
 704
 705         /* Set port as not active */
 706         priv->port_up = false;
 707
 708         /* Unregister Mac address for the port */
 709         mlx4_unregister_mac(mdev->dev, priv->port, priv->mac);
 710         mdev->mac_removed[priv->port] = 1;
 711
 712         /* Free TX Rings */
 713         for (i = 0; i < priv->tx_ring_num; i++) {
 714                 mlx4_en_deactivate_tx_ring(priv, &priv->tx_ring[i]);
 715                 mlx4_en_deactivate_cq(priv, &priv->tx_cq[i]);
 716         }
 717         msleep(10);
 718
 719         for (i = 0; i < priv->tx_ring_num; i++)
 720                 mlx4_en_free_tx_buf(dev, &priv->tx_ring[i]);
 721
 722         /* Free RSS qps */
 723         mlx4_en_release_rss_steer(priv);
 724
 725         /* Free RX Rings */
 726         for (i = 0; i < priv->rx_ring_num; i++) {
 727                 mlx4_en_deactivate_rx_ring(priv, &priv->rx_ring[i]);
 728                 mlx4_en_deactivate_cq(priv, &priv->rx_cq[i]);
 729         }
 730
 731         /* close port*/
 732         mlx4_CLOSE_PORT(mdev->dev, priv->port);
 733
 734         callout_stop(&priv->watchdog_timer);
 735
 736         dev->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
 737 }
 738
 739 static void mlx4_en_restart(struct work_struct *work)
 740 {
 741         struct mlx4_en_priv *priv = container_of(work, struct mlx4_en_priv,
 742                                                  watchdog_task);
 743         struct mlx4_en_dev *mdev = priv->mdev;
 744         struct net_device *dev = priv->dev;
 745         struct mlx4_en_tx_ring *ring;
 746         int i;
 747
 748         if (priv->blocked == 0 || priv->port_up == 0)
 749                 return;
 750         for (i = 0; i < priv->tx_ring_num; i++) {
 751                 ring = &priv->tx_ring[i];
 752                 if (ring->blocked &&
 753                     ring->watchdog_time + MLX4_EN_WATCHDOG_TIMEOUT < ticks)
 754                         goto reset;
 755         }
 756         return;
 757
 758 reset:
 759         priv->port_stats.tx_timeout++;
 760         en_dbg(DRV, priv, "Watchdog task called for port %d\n", priv->port);
 761
 762         mutex_lock(&mdev->state_lock);
 763         if (priv->port_up) {
 764                 mlx4_en_stop_port(dev);
 765                 if (mlx4_en_start_port(dev))
 766                         en_err(priv, "Failed restarting port %d\n", priv->port);
 767         }
 768         mutex_unlock(&mdev->state_lock);
 769 }
 770
 771
 772 static void
 773 mlx4_en_init(void *arg)
 774 {
 775         struct mlx4_en_priv *priv;
 776         struct mlx4_en_dev *mdev;
 777
 778         priv = arg;
 779         mdev = priv->mdev;
 780         mutex_lock(&mdev->state_lock);
 781         mlx4_en_init_locked(priv);
 782         mutex_unlock(&mdev->state_lock);
 783 }
 784
 785 static void
 786 mlx4_en_init_locked(struct mlx4_en_priv *priv)
 787 {
 788
 789         struct mlx4_en_dev *mdev;
 790         struct ifnet *dev;
 791         int i;
 792
 793         dev = priv->dev;
 794         mdev = priv->mdev;
 795         if (dev->if_drv_flags & IFF_DRV_RUNNING)
 796                 mlx4_en_stop_port(dev);
 797
 798         if (!mdev->device_up) {
 799                 en_err(priv, "Cannot open - device down/disabled\n");
 800                 return;
 801         }
 802
 803         /* Reset HW statistics and performance counters */
 804         if (mlx4_en_DUMP_ETH_STATS(mdev, priv->port, 1))
 805                 en_dbg(HW, priv, "Failed dumping statistics\n");
 806
 807         memset(&priv->pstats, 0, sizeof(priv->pstats));
 808
 809         for (i = 0; i < priv->tx_ring_num; i++) {
 810                 priv->tx_ring[i].bytes = 0;
 811                 priv->tx_ring[i].packets = 0;
 812         }
 813         for (i = 0; i < priv->rx_ring_num; i++) {
 814                 priv->rx_ring[i].bytes = 0;
 815                 priv->rx_ring[i].packets = 0;
 816         }
 817
 818         mlx4_en_set_default_moderation(priv);
 819         if (mlx4_en_start_port(dev))
 820                 en_err(priv, "Failed starting port:%d\n", priv->port);
 821 }
 822
 823 void mlx4_en_free_resources(struct mlx4_en_priv *priv)
 824 {
 825         int i;
 826
 827         for (i = 0; i < priv->tx_ring_num; i++) {
 828                 if (priv->tx_ring[i].tx_info)
 829                         mlx4_en_destroy_tx_ring(priv, &priv->tx_ring[i]);
 830                 if (priv->tx_cq[i].buf)
 831                         mlx4_en_destroy_cq(priv, &priv->tx_cq[i]);
 832         }
 833
 834         for (i = 0; i < priv->rx_ring_num; i++) {
 835                 if (priv->rx_ring[i].rx_info)
 836                         mlx4_en_destroy_rx_ring(priv, &priv->rx_ring[i]);
 837                 if (priv->rx_cq[i].buf)
 838                         mlx4_en_destroy_cq(priv, &priv->rx_cq[i]);
 839         }
 840         /* Free the stats tree when we resize the rings. */
 841         if (priv->sysctl)
 842                 sysctl_ctx_free(&priv->stat_ctx);
 843
 844 }
 845
 846 int mlx4_en_alloc_resources(struct mlx4_en_priv *priv)
 847 {
 848         struct mlx4_en_port_profile *prof = priv->prof;
 849         int i;
 850
 851         /* Create tx Rings */
 852         for (i = 0; i < priv->tx_ring_num; i++) {
 853                 if (mlx4_en_create_cq(priv, &priv->tx_cq[i],
 854                                       prof->tx_ring_size, i, TX))
 855                         goto err;
 856
 857                 if (mlx4_en_create_tx_ring(priv, &priv->tx_ring[i],
 858                                            prof->tx_ring_size, TXBB_SIZE))
 859                         goto err;
 860         }
 861
 862         /* Create rx Rings */
 863         for (i = 0; i < priv->rx_ring_num; i++) {
 864                 if (mlx4_en_create_cq(priv, &priv->rx_cq[i],
 865                                       prof->rx_ring_size, i, RX))
 866                         goto err;
 867
 868                 if (mlx4_en_create_rx_ring(priv, &priv->rx_ring[i],
 869                                            prof->rx_ring_size))
 870                         goto err;
 871         }
 872
 873         /* Re-create stat sysctls in case the number of rings changed. */
 874         mlx4_en_sysctl_stat(priv);
 875
 876         /* Populate Tx priority mappings */
 877         mlx4_en_set_prio_map(priv, priv->tx_prio_map,
 878                              priv->tx_ring_num - MLX4_EN_NUM_HASH_RINGS);
 879
 880         return 0;
 881
 882 err:
 883         en_err(priv, "Failed to allocate NIC resources\n");
 884         return -ENOMEM;
 885 }
 886
 887
 888 void mlx4_en_destroy_netdev(struct net_device *dev)
 889 {
 890         struct mlx4_en_priv *priv = netdev_priv(dev);
 891         struct mlx4_en_dev *mdev = priv->mdev;
 892
 893         en_dbg(DRV, priv, "Destroying netdev on port:%d\n", priv->port);
 894
 895         if (priv->vlan_attach != NULL)
 896                 EVENTHANDLER_DEREGISTER(vlan_config, priv->vlan_attach);
 897         if (priv->vlan_detach != NULL)
 898                 EVENTHANDLER_DEREGISTER(vlan_unconfig, priv->vlan_detach);
 899
 900         /* Unregister device - this will close the port if it was up */
 901         if (priv->registered)
 902                 ether_ifdetach(dev);
 903
 904         if (priv->allocated)
 905                 mlx4_free_hwq_res(mdev->dev, &priv->res, MLX4_EN_PAGE_SIZE);
 906
 907         mutex_lock(&mdev->state_lock);
 908         mlx4_en_stop_port(dev);
 909         mutex_unlock(&mdev->state_lock);
 910
 911         cancel_delayed_work(&priv->stats_task);
 912         /* flush any pending task for this netdev */
 913         flush_workqueue(mdev->workqueue);
 914         callout_drain(&priv->watchdog_timer);
 915
 916         /* Detach the netdev so tasks would not attempt to access it */
 917         mutex_lock(&mdev->state_lock);
 918         mdev->pndev[priv->port] = NULL;
 919         mutex_unlock(&mdev->state_lock);
 920
 921         mlx4_en_free_resources(priv);
 922
 923         if (priv->sysctl)
 924                 sysctl_ctx_free(&priv->conf_ctx);
 925
 926         mtx_destroy(&priv->stats_lock.m);
 927         mtx_destroy(&priv->vlan_lock.m);
 928         mtx_destroy(&priv->ioctl_lock.m);
 929         kfree(priv);
 930         if_free(dev);
 931 }
 932
 933 static int mlx4_en_change_mtu(struct net_device *dev, int new_mtu)
 934 {
 935         struct mlx4_en_priv *priv = netdev_priv(dev);
 936         struct mlx4_en_dev *mdev = priv->mdev;
 937         int err = 0;
 938
 939         en_dbg(DRV, priv, "Change MTU called - current:%ld new:%d\n",
 940                  dev->if_mtu, new_mtu);
 941
 942         if ((new_mtu < MLX4_EN_MIN_MTU) || (new_mtu > priv->max_mtu)) {
 943                 en_err(priv, "Bad MTU size:%d.\n", new_mtu);
 944                 return -EPERM;
 945         }
 946         mutex_lock(&mdev->state_lock);
 947         dev->if_mtu = new_mtu;
 948         if (dev->if_drv_flags & IFF_DRV_RUNNING) {
 949                 if (!mdev->device_up) {
 950                         /* NIC is probably restarting - let watchdog task reset
 951                          * the port */
 952                         en_dbg(DRV, priv, "Change MTU called with card down!?\n");
 953                 } else {
 954                         mlx4_en_stop_port(dev);
 955                         mlx4_en_set_default_moderation(priv);
 956                         err = mlx4_en_start_port(dev);
 957                         if (err) {
 958                                 en_err(priv, "Failed restarting port:%d\n",
 959                                          priv->port);
 960                                 queue_work(mdev->workqueue, &priv->watchdog_task);
 961                         }
 962                 }
 963         }
 964         mutex_unlock(&mdev->state_lock);
 965         return 0;
 966 }
 967
 968 static int mlx4_en_calc_media(struct mlx4_en_priv *priv)
 969 {
 970         int trans_type;
 971         int active;
 972
 973         active = IFM_ETHER;
 974         if (priv->last_link_state == MLX4_DEV_EVENT_PORT_DOWN)
 975                 return (active);
 976         if (mlx4_en_QUERY_PORT(priv->mdev, priv->port))
 977                 return (active);
 978         active |= IFM_FDX;
 979         trans_type = priv->port_state.transciver;
 980         /* XXX I don't know all of the transceiver values. */
 981         switch (priv->port_state.link_speed) {
 982         case 1000:
 983                 active |= IFM_1000_T;
 984                 break;
 985         case 10000:
 986                 if (trans_type > 0 && trans_type <= 0xC)
 987                         active |= IFM_10G_SR;
 988                 else if (trans_type == 0x80 || trans_type == 0)
 989                         active |= IFM_10G_CX4;
 990                 break;
 991         case 40000:
 992                 active |= IFM_40G_CR4;
 993                 break;
 994         }
 995         if (priv->prof->tx_pause)
 996                 active |= IFM_ETH_TXPAUSE;
 997         if (priv->prof->rx_pause)
 998                 active |= IFM_ETH_RXPAUSE;
 999
1000         return (active);
1001 }
1002
1003
1004 static void mlx4_en_media_status(struct ifnet *dev, struct ifmediareq *ifmr)
1005 {
1006         struct mlx4_en_priv *priv;
1007
1008         priv = dev->if_softc;
1009         ifmr->ifm_status = IFM_AVALID;
1010         if (priv->last_link_state != MLX4_DEV_EVENT_PORT_DOWN)
1011                 ifmr->ifm_status |= IFM_ACTIVE;
1012         ifmr->ifm_active = mlx4_en_calc_media(priv);
1013
1014         return;
1015 }
1016
1017 static int mlx4_en_media_change(struct ifnet *dev)
1018 {
1019         struct mlx4_en_priv *priv;
1020         struct ifmedia *ifm;
1021         int rxpause;
1022         int txpause;
1023         int error;
1024
1025         priv = dev->if_softc;
1026         ifm = &priv->media;
1027         rxpause = txpause = 0;
1028         error = 0;
1029
1030         if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
1031                 return (EINVAL);
1032         switch (IFM_SUBTYPE(ifm->ifm_media)) {
1033         case IFM_AUTO:
1034                 break;
1035         case IFM_10G_SR:
1036         case IFM_10G_CX4:
1037         case IFM_1000_T:
1038                 if (IFM_SUBTYPE(ifm->ifm_media) ==
1039                     IFM_SUBTYPE(mlx4_en_calc_media(priv)) &&
1040                     (ifm->ifm_media & IFM_FDX))
1041                         break;
1042                 /* Fallthrough */
1043         default:
1044                 printf("%s: Only auto media type\n", if_name(dev));
1045                 return (EINVAL);
1046         }
1047         /* Allow user to set/clear pause */
1048         if (IFM_OPTIONS(ifm->ifm_media) & IFM_ETH_RXPAUSE)
1049                 rxpause = 1;
1050         if (IFM_OPTIONS(ifm->ifm_media) & IFM_ETH_TXPAUSE)
1051                 txpause = 1;
1052         if (priv->prof->tx_pause != txpause || priv->prof->rx_pause != rxpause) {
1053                 priv->prof->tx_pause = txpause;
1054                 priv->prof->rx_pause = rxpause;
1055                 error = -mlx4_SET_PORT_general(priv->mdev->dev, priv->port,
1056                      priv->rx_mb_size + ETHER_CRC_LEN, priv->prof->tx_pause,
1057                      priv->prof->tx_ppp, priv->prof->rx_pause,
1058                      priv->prof->rx_ppp);
1059         }
1060         return (error);
1061 }
1062
1063 static int mlx4_en_ioctl(struct ifnet *dev, u_long command, caddr_t data)
1064 {
1065         struct mlx4_en_priv *priv;
1066         struct mlx4_en_dev *mdev;
1067         struct ifreq *ifr;
1068         int error;
1069         int mask;
1070
1071         error = 0;
1072         mask = 0;
1073         priv = dev->if_softc;
1074         mdev = priv->mdev;
1075         ifr = (struct ifreq *) data;
1076         switch (command) {
1077         case SIOCSIFMTU:
1078                 error = -mlx4_en_change_mtu(dev, ifr->ifr_mtu);
1079                 break;
1080         case SIOCSIFFLAGS:
1081                 mutex_lock(&mdev->state_lock);
1082                 if (dev->if_flags & IFF_UP) {
1083                         if ((dev->if_drv_flags & IFF_DRV_RUNNING) == 0)
1084                                 mlx4_en_start_port(dev);
1085                         else
1086                                 mlx4_en_set_multicast(dev);
1087                 } else {
1088                         if (dev->if_drv_flags & IFF_DRV_RUNNING) {
1089                                 mlx4_en_stop_port(dev);
1090                                 if_link_state_change(dev, LINK_STATE_DOWN);
1091                         }
1092                 }
1093                 mutex_unlock(&mdev->state_lock);
1094                 break;
1095         case SIOCADDMULTI:
1096         case SIOCDELMULTI:
1097                 spin_lock(&priv->ioctl_lock);
1098                 mlx4_en_set_multicast(dev);
1099                 spin_unlock(&priv->ioctl_lock);
1100                 break;
1101         case SIOCSIFMEDIA:
1102         case SIOCGIFMEDIA:
1103                 error = ifmedia_ioctl(dev, ifr, &priv->media, command);
1104                 break;
1105         case SIOCSIFCAP:
1106                 mutex_lock(&mdev->state_lock);
1107                 mask = ifr->ifr_reqcap ^ dev->if_capenable;
1108                 if (mask & IFCAP_HWCSUM)
1109                         dev->if_capenable ^= IFCAP_HWCSUM;
1110                 if (mask & IFCAP_TSO4)
1111                         dev->if_capenable ^= IFCAP_TSO4;
1112                 if (mask & IFCAP_LRO)
1113                         dev->if_capenable ^= IFCAP_LRO;
1114                 if (mask & IFCAP_VLAN_HWTAGGING)
1115                         dev->if_capenable ^= IFCAP_VLAN_HWTAGGING;
1116                 if (mask & IFCAP_VLAN_HWFILTER)
1117                         dev->if_capenable ^= IFCAP_VLAN_HWFILTER;
1118                 if (mask & IFCAP_WOL_MAGIC)
1119                         dev->if_capenable ^= IFCAP_WOL_MAGIC;
1120                 if (dev->if_drv_flags & IFF_DRV_RUNNING)
1121                         mlx4_en_init_locked(priv);
1122                 mutex_unlock(&mdev->state_lock);
1123                 VLAN_CAPABILITIES(dev);
1124                 break;
1125         default:
1126                 error = ether_ioctl(dev, command, data);
1127                 break;
1128         }
1129
1130         return (error);
1131 }
1132
1133 static int mlx4_en_set_ring_size(struct net_device *dev,
1134     int rx_size, int tx_size)
1135 {
1136         struct mlx4_en_priv *priv = netdev_priv(dev);
1137         struct mlx4_en_dev *mdev = priv->mdev;
1138         int port_up = 0;
1139         int err = 0;
1140
1141         rx_size = roundup_pow_of_two(rx_size);
1142         rx_size = max_t(u32, rx_size, MLX4_EN_MIN_RX_SIZE);
1143         rx_size = min_t(u32, rx_size, MLX4_EN_MAX_RX_SIZE);
1144         tx_size = roundup_pow_of_two(tx_size);
1145         tx_size = max_t(u32, tx_size, MLX4_EN_MIN_TX_SIZE);
1146         tx_size = min_t(u32, tx_size, MLX4_EN_MAX_TX_SIZE);
1147
1148         if (rx_size == (priv->port_up ?
1149             priv->rx_ring[0].actual_size : priv->rx_ring[0].size) &&
1150             tx_size == priv->tx_ring[0].size)
1151                 return 0;
1152
1153         mutex_lock(&mdev->state_lock);
1154         if (priv->port_up) {
1155                 port_up = 1;
1156                 mlx4_en_stop_port(dev);
1157         }
1158         mlx4_en_free_resources(priv);
1159         priv->prof->tx_ring_size = tx_size;
1160         priv->prof->rx_ring_size = rx_size;
1161         err = mlx4_en_alloc_resources(priv);
1162         if (err) {
1163                 en_err(priv, "Failed reallocating port resources\n");
1164                 goto out;
1165         }
1166         if (port_up) {
1167                 err = mlx4_en_start_port(dev);
1168                 if (err)
1169                         en_err(priv, "Failed starting port\n");
1170         }
1171 out:
1172         mutex_unlock(&mdev->state_lock);
1173         return err;
1174 }
1175
1176 static int mlx4_en_set_rx_ring_size(SYSCTL_HANDLER_ARGS)
1177 {
1178         struct mlx4_en_priv *priv;
1179         int size;
1180         int error;
1181
1182         priv = arg1;
1183         size = priv->prof->rx_ring_size;
1184         error = sysctl_handle_int(oidp, &size, 0, req);
1185         if (error || !req->newptr)
1186                 return (error);
1187         error = -mlx4_en_set_ring_size(priv->dev, size,
1188             priv->prof->tx_ring_size);
1189
1190         return (error);
1191 }
1192
1193 static int mlx4_en_set_tx_ring_size(SYSCTL_HANDLER_ARGS)
1194 {
1195         struct mlx4_en_priv *priv;
1196         int size;
1197         int error;
1198
1199         priv = arg1;
1200         size = priv->prof->tx_ring_size;
1201         error = sysctl_handle_int(oidp, &size, 0, req);
1202         if (error || !req->newptr)
1203                 return (error);
1204         error = -mlx4_en_set_ring_size(priv->dev, priv->prof->rx_ring_size,
1205             size);
1206
1207         return (error);
1208 }
1209
1210 static int mlx4_en_set_tx_ppp(SYSCTL_HANDLER_ARGS)
1211 {
1212         struct mlx4_en_priv *priv;
1213         int ppp;
1214         int error;
1215
1216         priv = arg1;
1217         ppp = priv->prof->tx_ppp;
1218         error = sysctl_handle_int(oidp, &ppp, 0, req);
1219         if (error || !req->newptr)
1220                 return (error);
1221         if (ppp > 0xff || ppp < 0)
1222                 return (-EINVAL);
1223         priv->prof->tx_ppp = ppp;
1224         error = -mlx4_SET_PORT_general(priv->mdev->dev, priv->port,
1225                                        priv->rx_mb_size + ETHER_CRC_LEN,
1226                                        priv->prof->tx_pause,
1227                                        priv->prof->tx_ppp,
1228                                        priv->prof->rx_pause,
1229                                        priv->prof->rx_ppp);
1230
1231         return (error);
1232 }
1233
1234 static int mlx4_en_set_rx_ppp(SYSCTL_HANDLER_ARGS)
1235 {
1236         struct mlx4_en_priv *priv;
1237         struct mlx4_en_dev *mdev;
1238         int tx_ring_num;
1239         int ppp;
1240         int error;
1241         int port_up;
1242
1243         port_up = 0;
1244         priv = arg1;
1245         mdev = priv->mdev;
1246         ppp = priv->prof->rx_ppp;
1247         error = sysctl_handle_int(oidp, &ppp, 0, req);
1248         if (error || !req->newptr)
1249                 return (error);
1250         if (ppp > 0xff || ppp < 0)
1251                 return (-EINVAL);
1252         /* See if we have to change the number of tx queues. */
1253         if (!ppp != !priv->prof->rx_ppp) {
1254                 tx_ring_num = MLX4_EN_NUM_HASH_RINGS + 1 +
1255                     (!!ppp) * MLX4_EN_NUM_PPP_RINGS;
1256                 mutex_lock(&mdev->state_lock);
1257                 if (priv->port_up) {
1258                         port_up = 1;
1259                         mlx4_en_stop_port(priv->dev);
1260                 }
1261                 mlx4_en_free_resources(priv);
1262                 priv->tx_ring_num = tx_ring_num;
1263                 priv->prof->rx_ppp = ppp;
1264                 error = -mlx4_en_alloc_resources(priv);
1265                 if (error)
1266                         en_err(priv, "Failed reallocating port resources\n");
1267                 if (error == 0 && port_up) {
1268                         error = -mlx4_en_start_port(priv->dev);
1269                         if (error)
1270                                 en_err(priv, "Failed starting port\n");
1271                 }
1272                 mutex_unlock(&mdev->state_lock);
1273                 return (error);
1274
1275         }
1276         priv->prof->rx_ppp = ppp;
1277         error = -mlx4_SET_PORT_general(priv->mdev->dev, priv->port,
1278                                        priv->rx_mb_size + ETHER_CRC_LEN,
1279                                        priv->prof->tx_pause,
1280                                        priv->prof->tx_ppp,
1281                                        priv->prof->rx_pause,
1282                                        priv->prof->rx_ppp);
1283
1284         return (error);
1285 }
1286
1287 static void mlx4_en_sysctl_conf(struct mlx4_en_priv *priv)
1288 {
1289         struct net_device *dev;
1290         struct sysctl_ctx_list *ctx;
1291         struct sysctl_oid *node;
1292         struct sysctl_oid_list *node_list;
1293         struct sysctl_oid *coal;
1294         struct sysctl_oid_list *coal_list;
1295
1296         dev = priv->dev;
1297         ctx = &priv->conf_ctx;
1298
1299         sysctl_ctx_init(ctx);
1300         priv->sysctl = SYSCTL_ADD_NODE(ctx, SYSCTL_STATIC_CHILDREN(_hw),
1301             OID_AUTO, dev->if_xname, CTLFLAG_RD, 0, "mlx4 10gig ethernet");
1302         node = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(priv->sysctl), OID_AUTO,
1303             "conf", CTLFLAG_RD, NULL, "Configuration");
1304         node_list = SYSCTL_CHILDREN(node);
1305
1306         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "msg_enable",
1307             CTLFLAG_RW, &priv->msg_enable, 0,
1308             "Driver message enable bitfield");
1309         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "rx_rings",
1310             CTLTYPE_INT | CTLFLAG_RD, &priv->rx_ring_num, 0,
1311             "Number of receive rings");
1312         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "tx_rings",
1313             CTLTYPE_INT | CTLFLAG_RD, &priv->tx_ring_num, 0,
1314             "Number of transmit rings");
1315         SYSCTL_ADD_PROC(ctx, node_list, OID_AUTO, "rx_size",
1316             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, priv, 0,
1317             mlx4_en_set_rx_ring_size, "I", "Receive ring size");
1318         SYSCTL_ADD_PROC(ctx, node_list, OID_AUTO, "tx_size",
1319             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, priv, 0,
1320             mlx4_en_set_tx_ring_size, "I", "Transmit ring size");
1321         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "ip_reasm",
1322             CTLFLAG_RW, &priv->ip_reasm, 0,
1323             "Allow reassembly of IP fragments.");
1324         SYSCTL_ADD_PROC(ctx, node_list, OID_AUTO, "tx_ppp",
1325             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, priv, 0,
1326             mlx4_en_set_tx_ppp, "I", "TX Per-priority pause");
1327         SYSCTL_ADD_PROC(ctx, node_list, OID_AUTO, "rx_ppp",
1328             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, priv, 0,
1329             mlx4_en_set_rx_ppp, "I", "RX Per-priority pause");
1330
1331         /* Add coalescer configuration. */
1332         coal = SYSCTL_ADD_NODE(ctx, node_list, OID_AUTO,
1333             "coalesce", CTLFLAG_RD, NULL, "Interrupt coalesce configuration");
1334         coal_list = SYSCTL_CHILDREN(node);
1335         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "pkt_rate_low",
1336             CTLFLAG_RW, &priv->pkt_rate_low, 0,
1337             "Packets per-second for minimum delay");
1338         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "rx_usecs_low",
1339             CTLFLAG_RW, &priv->rx_usecs_low, 0,
1340             "Minimum RX delay in micro-seconds");
1341         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "pkt_rate_high",
1342             CTLFLAG_RW, &priv->pkt_rate_high, 0,
1343             "Packets per-second for maximum delay");
1344         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "rx_usecs_high",
1345             CTLFLAG_RW, &priv->rx_usecs_high, 0,
1346             "Maximum RX delay in micro-seconds");
1347         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "sample_interval",
1348             CTLFLAG_RW, &priv->sample_interval, 0,
1349             "adaptive frequency in units of HZ ticks");
1350         SYSCTL_ADD_UINT(ctx, coal_list, OID_AUTO, "adaptive_rx_coal",
1351             CTLFLAG_RW, &priv->adaptive_rx_coal, 0,
1352             "Enable adaptive rx coalescing");
1353 }
1354
1355 static void mlx4_en_sysctl_stat(struct mlx4_en_priv *priv)
1356 {
1357         struct net_device *dev;
1358         struct sysctl_ctx_list *ctx;
1359         struct sysctl_oid *node;
1360         struct sysctl_oid_list *node_list;
1361         struct sysctl_oid *ring_node;
1362         struct sysctl_oid_list *ring_list;
1363         struct mlx4_en_tx_ring *tx_ring;
1364         struct mlx4_en_rx_ring *rx_ring;
1365         char namebuf[128];
1366         int i;
1367
1368         dev = priv->dev;
1369
1370         ctx = &priv->stat_ctx;
1371         sysctl_ctx_init(ctx);
1372         node = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(priv->sysctl), OID_AUTO,
1373             "stat", CTLFLAG_RD, NULL, "Statistics");
1374         node_list = SYSCTL_CHILDREN(node);
1375
1376 #ifdef MLX4_EN_PERF_STAT
1377         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "tx_poll", CTLFLAG_RD,
1378             &priv->pstats.tx_poll, "TX Poll calls");
1379         SYSCTL_ADD_QUAD(ctx, node_list, OID_AUTO, "tx_pktsz_avg", CTLFLAG_RD,
1380             &priv->pstats.tx_pktsz_avg, "TX average packet size");
1381         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "inflight_avg", CTLFLAG_RD,
1382             &priv->pstats.inflight_avg, "TX average packets in-flight");
1383         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "tx_coal_avg", CTLFLAG_RD,
1384             &priv->pstats.tx_coal_avg, "TX average coalesced completions");
1385         SYSCTL_ADD_UINT(ctx, node_list, OID_AUTO, "rx_coal_avg", CTLFLAG_RD,
1386             &priv->pstats.rx_coal_avg, "RX average coalesced completions");
1387 #endif
1388
1389         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tso_packets", CTLFLAG_RD,
1390             &priv->port_stats.tso_packets, "TSO packets sent");
1391         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "queue_stopped", CTLFLAG_RD,
1392             &priv->port_stats.queue_stopped, "Queue full");
1393         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "wake_queue", CTLFLAG_RD,
1394             &priv->port_stats.wake_queue, "Queue resumed after full");
1395         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_timeout", CTLFLAG_RD,
1396             &priv->port_stats.tx_timeout, "Transmit timeouts");
1397         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_alloc_failed", CTLFLAG_RD,
1398             &priv->port_stats.rx_alloc_failed, "RX failed to allocate mbuf");
1399         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_chksum_good", CTLFLAG_RD,
1400             &priv->port_stats.rx_chksum_good, "RX checksum offload success");
1401         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_chksum_none", CTLFLAG_RD,
1402             &priv->port_stats.rx_chksum_none, "RX without checksum offload");
1403         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_chksum_offload",
1404             CTLFLAG_RD, &priv->port_stats.tx_chksum_offload,
1405             "TX checksum offloads");
1406
1407         /* Could strdup the names and add in a loop.  This is simpler. */
1408         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "broadcast", CTLFLAG_RD,
1409             &priv->pkstats.broadcast, "Broadcast packets");
1410         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio0", CTLFLAG_RD,
1411             &priv->pkstats.tx_prio[0], "TX Priority 0 packets");
1412         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio1", CTLFLAG_RD,
1413             &priv->pkstats.tx_prio[1], "TX Priority 1 packets");
1414         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio2", CTLFLAG_RD,
1415             &priv->pkstats.tx_prio[2], "TX Priority 2 packets");
1416         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio3", CTLFLAG_RD,
1417             &priv->pkstats.tx_prio[3], "TX Priority 3 packets");
1418         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio4", CTLFLAG_RD,
1419             &priv->pkstats.tx_prio[4], "TX Priority 4 packets");
1420         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio5", CTLFLAG_RD,
1421             &priv->pkstats.tx_prio[5], "TX Priority 5 packets");
1422         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio6", CTLFLAG_RD,
1423             &priv->pkstats.tx_prio[6], "TX Priority 6 packets");
1424         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "tx_prio7", CTLFLAG_RD,
1425             &priv->pkstats.tx_prio[7], "TX Priority 7 packets");
1426         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio0", CTLFLAG_RD,
1427             &priv->pkstats.rx_prio[0], "RX Priority 0 packets");
1428         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio1", CTLFLAG_RD,
1429             &priv->pkstats.rx_prio[1], "RX Priority 1 packets");
1430         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio2", CTLFLAG_RD,
1431             &priv->pkstats.rx_prio[2], "RX Priority 2 packets");
1432         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio3", CTLFLAG_RD,
1433             &priv->pkstats.rx_prio[3], "RX Priority 3 packets");
1434         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio4", CTLFLAG_RD,
1435             &priv->pkstats.rx_prio[4], "RX Priority 4 packets");
1436         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio5", CTLFLAG_RD,
1437             &priv->pkstats.rx_prio[5], "RX Priority 5 packets");
1438         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio6", CTLFLAG_RD,
1439             &priv->pkstats.rx_prio[6], "RX Priority 6 packets");
1440         SYSCTL_ADD_ULONG(ctx, node_list, OID_AUTO, "rx_prio7", CTLFLAG_RD,
1441             &priv->pkstats.rx_prio[7], "RX Priority 7 packets");
1442
1443         for (i = 0; i < priv->tx_ring_num; i++) {
1444                 tx_ring = &priv->tx_ring[i];
1445                 snprintf(namebuf, sizeof(namebuf), "tx_ring%d", i);
1446                 ring_node = SYSCTL_ADD_NODE(ctx, node_list, OID_AUTO, namebuf,
1447                     CTLFLAG_RD, NULL, "TX Ring");
1448                 ring_list = SYSCTL_CHILDREN(ring_node);
1449                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "packets",
1450                     CTLFLAG_RD, &tx_ring->packets, "TX packets");
1451                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "bytes",
1452                     CTLFLAG_RD, &tx_ring->bytes, "TX bytes");
1453                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "error",
1454                     CTLFLAG_RD, &tx_ring->errors, "TX soft errors");
1455
1456         }
1457         for (i = 0; i < priv->rx_ring_num; i++) {
1458                 rx_ring = &priv->rx_ring[i];
1459                 snprintf(namebuf, sizeof(namebuf), "rx_ring%d", i);
1460                 ring_node = SYSCTL_ADD_NODE(ctx, node_list, OID_AUTO, namebuf,
1461                     CTLFLAG_RD, NULL, "RX Ring");
1462                 ring_list = SYSCTL_CHILDREN(ring_node);
1463                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "packets",
1464                     CTLFLAG_RD, &rx_ring->packets, "RX packets");
1465                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "bytes",
1466                     CTLFLAG_RD, &rx_ring->bytes, "RX bytes");
1467                 SYSCTL_ADD_ULONG(ctx, ring_list, OID_AUTO, "error",
1468                     CTLFLAG_RD, &rx_ring->errors, "RX soft errors");
1469                 SYSCTL_ADD_UINT(ctx, ring_list, OID_AUTO, "lro_queued",
1470                     CTLFLAG_RD, &rx_ring->lro.lro_queued, 0, "LRO Queued");
1471                 SYSCTL_ADD_UINT(ctx, ring_list, OID_AUTO, "lro_flushed",
1472                     CTLFLAG_RD, &rx_ring->lro.lro_flushed, 0, "LRO Flushed");
1473         }
1474 }
1475
1476 int mlx4_en_init_netdev(struct mlx4_en_dev *mdev, int port,
1477                         struct mlx4_en_port_profile *prof)
1478 {
1479         static volatile int mlx4_en_unit;
1480         struct net_device *dev;
1481         struct mlx4_en_priv *priv;
1482         uint8_t dev_addr[ETHER_ADDR_LEN];
1483         int err;
1484         int i;
1485
1486         priv = kzalloc(sizeof(*priv), GFP_KERNEL);
1487         dev = priv->dev = if_alloc(IFT_ETHER);
1488         if (dev == NULL) {
1489                 mlx4_err(mdev, "Net device allocation failed\n");
1490                 kfree(priv);
1491                 return -ENOMEM;
1492         }
1493         dev->if_softc = priv;
1494         if_initname(dev, "mlxen", atomic_fetchadd_int(&mlx4_en_unit, 1));
1495         dev->if_mtu = ETHERMTU;
1496         dev->if_baudrate = 1000000000;
1497         dev->if_init = mlx4_en_init;
1498         dev->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
1499         dev->if_ioctl = mlx4_en_ioctl;
1500         dev->if_transmit = mlx4_en_transmit;
1501         dev->if_qflush = mlx4_en_qflush;
1502         dev->if_snd.ifq_maxlen = prof->tx_ring_size;
1503
1504         /*
1505          * Initialize driver private data
1506          */
1507         priv->dev = dev;
1508         priv->mdev = mdev;
1509         priv->prof = prof;
1510         priv->port = port;
1511         priv->port_up = false;
1512         priv->rx_csum = 1;
1513         priv->flags = prof->flags;
1514         priv->tx_ring_num = prof->tx_ring_num;
1515         priv->rx_ring_num = prof->rx_ring_num;
1516         priv->mac_index = -1;
1517         priv->msg_enable = MLX4_EN_MSG_LEVEL;
1518         priv->ip_reasm = priv->mdev->profile.ip_reasm;
1519         mtx_init(&priv->stats_lock.m, "mlx4 stats", NULL, MTX_DEF);
1520         mtx_init(&priv->ioctl_lock.m, "mlx4 ioctl", NULL, MTX_DEF);
1521         mtx_init(&priv->vlan_lock.m, "mlx4 vlan", NULL, MTX_DEF);
1522         INIT_WORK(&priv->mcast_task, mlx4_en_do_set_multicast);
1523         INIT_WORK(&priv->watchdog_task, mlx4_en_restart);
1524         INIT_WORK(&priv->linkstate_task, mlx4_en_linkstate);
1525         INIT_DELAYED_WORK(&priv->stats_task, mlx4_en_do_get_stats);
1526         callout_init(&priv->watchdog_timer, 1);
1527
1528         /* Query for default mac and max mtu */
1529         priv->max_mtu = mdev->dev->caps.eth_mtu_cap[priv->port];
1530         priv->mac = mdev->dev->caps.def_mac[priv->port];
1531
1532         if (ILLEGAL_MAC(priv->mac)) {
1533                 en_err(priv, "Port: %d, invalid mac burned: 0x%llx, quiting\n",
1534                          priv->port, priv->mac);
1535                 err = -EINVAL;
1536                 goto out;
1537         }
1538
1539         mlx4_en_sysctl_conf(priv);
1540
1541         err = mlx4_en_alloc_resources(priv);
1542         if (err)
1543                 goto out;
1544
1545         /* Allocate page for receive rings */
1546         err = mlx4_alloc_hwq_res(mdev->dev, &priv->res,
1547                                 MLX4_EN_PAGE_SIZE, MLX4_EN_PAGE_SIZE);
1548         if (err) {
1549                 en_err(priv, "Failed to allocate page for rx qps\n");
1550                 goto out;
1551         }
1552         priv->allocated = 1;
1553
1554         /*
1555          * Set driver features
1556          */
1557         dev->if_capabilities |= IFCAP_RXCSUM | IFCAP_TXCSUM;
1558         dev->if_capabilities |= IFCAP_VLAN_MTU | IFCAP_VLAN_HWTAGGING;
1559         dev->if_capabilities |= IFCAP_VLAN_HWCSUM | IFCAP_VLAN_HWFILTER;
1560         dev->if_capabilities |= IFCAP_LINKSTATE | IFCAP_JUMBO_MTU;
1561         if (mdev->LSO_support)
1562                 dev->if_capabilities |= IFCAP_TSO4 | IFCAP_VLAN_HWTSO;
1563         if (mdev->profile.num_lro)
1564                 dev->if_capabilities |= IFCAP_LRO;
1565         dev->if_capenable = dev->if_capabilities;
1566         /*
1567          * Setup wake-on-lan.
1568          */
1569 #if 0
1570         if (priv->mdev->dev->caps.wol) {
1571                 u64 config;
1572                 if (mlx4_wol_read(priv->mdev->dev, &config, priv->port) == 0) {
1573                         if (config & MLX4_EN_WOL_MAGIC)
1574                                 dev->if_capabilities |= IFCAP_WOL_MAGIC;
1575                         if (config & MLX4_EN_WOL_ENABLED)
1576                                 dev->if_capenable |= IFCAP_WOL_MAGIC;
1577                 }
1578         }
1579 #endif
1580
1581         /* Register for VLAN events */
1582         priv->vlan_attach = EVENTHANDLER_REGISTER(vlan_config,
1583             mlx4_en_vlan_rx_add_vid, priv, EVENTHANDLER_PRI_FIRST);
1584         priv->vlan_detach = EVENTHANDLER_REGISTER(vlan_unconfig,
1585             mlx4_en_vlan_rx_kill_vid, priv, EVENTHANDLER_PRI_FIRST);
1586
1587         mdev->pndev[priv->port] = dev;
1588
1589         priv->last_link_state = MLX4_DEV_EVENT_PORT_DOWN;
1590         if_link_state_change(dev, LINK_STATE_DOWN);
1591
1592         /* Set default MAC */
1593         for (i = 0; i < ETHER_ADDR_LEN; i++)
1594                 dev_addr[ETHER_ADDR_LEN - 1 - i] = (u8) (priv->mac >> (8 * i));
1595
1596         ether_ifattach(dev, dev_addr);
1597         ifmedia_init(&priv->media, IFM_IMASK | IFM_ETH_FMASK,
1598             mlx4_en_media_change, mlx4_en_media_status);
1599         ifmedia_add(&priv->media, IFM_ETHER | IFM_FDX | IFM_1000_T, 0, NULL);
1600         ifmedia_add(&priv->media, IFM_ETHER | IFM_FDX | IFM_10G_SR, 0, NULL);
1601         ifmedia_add(&priv->media, IFM_ETHER | IFM_FDX | IFM_10G_CX4, 0, NULL);
1602         ifmedia_add(&priv->media, IFM_ETHER | IFM_AUTO, 0, NULL);
1603         ifmedia_set(&priv->media, IFM_ETHER | IFM_AUTO);
1604
1605         en_warn(priv, "Using %d TX rings\n", prof->tx_ring_num);
1606         en_warn(priv, "Using %d RX rings\n", prof->rx_ring_num);
1607
1608         priv->registered = 1;
1609         queue_delayed_work(mdev->workqueue, &priv->stats_task, STATS_DELAY);
1610
1611         return 0;
1612
1613 out:
1614         mlx4_en_destroy_netdev(dev);
1615         return err;
1616 }
1617