Pileus Git - ~andy/linux/blob - drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c

   1 /*
   2  * QLogic qlcnic NIC Driver
   3  * Copyright (c)  2009-2010 QLogic Corporation
   4  *
   5  * See LICENSE.qlcnic for copyright and licensing details.
   6  */
   7
   8 #include <linux/slab.h>
   9 #include <linux/vmalloc.h>
  10 #include <linux/interrupt.h>
  11
  12 #include "qlcnic.h"
  13
  14 #include <linux/swab.h>
  15 #include <linux/dma-mapping.h>
  16 #include <net/ip.h>
  17 #include <linux/ipv6.h>
  18 #include <linux/inetdevice.h>
  19 #include <linux/sysfs.h>
  20 #include <linux/aer.h>
  21 #include <linux/log2.h>
  22
  23 MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
  24 MODULE_LICENSE("GPL");
  25 MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
  26 MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
  27
  28 char qlcnic_driver_name[] = "qlcnic";
  29 static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
  30         "Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
  31
  32 static struct workqueue_struct *qlcnic_wq;
  33 static int qlcnic_mac_learn;
  34 module_param(qlcnic_mac_learn, int, 0444);
  35 MODULE_PARM_DESC(qlcnic_mac_learn, "Mac Filter (0=disabled, 1=enabled)");
  36
  37 static int use_msi = 1;
  38 module_param(use_msi, int, 0444);
  39 MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled");
  40
  41 static int use_msi_x = 1;
  42 module_param(use_msi_x, int, 0444);
  43 MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled");
  44
  45 static int auto_fw_reset = 1;
  46 module_param(auto_fw_reset, int, 0644);
  47 MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled");
  48
  49 static int load_fw_file;
  50 module_param(load_fw_file, int, 0444);
  51 MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file");
  52
  53 static int qlcnic_config_npars;
  54 module_param(qlcnic_config_npars, int, 0444);
  55 MODULE_PARM_DESC(qlcnic_config_npars, "Configure NPARs (0=disabled, 1=enabled");
  56
  57 static int __devinit qlcnic_probe(struct pci_dev *pdev,
  58                 const struct pci_device_id *ent);
  59 static void __devexit qlcnic_remove(struct pci_dev *pdev);
  60 static int qlcnic_open(struct net_device *netdev);
  61 static int qlcnic_close(struct net_device *netdev);
  62 static void qlcnic_tx_timeout(struct net_device *netdev);
  63 static void qlcnic_attach_work(struct work_struct *work);
  64 static void qlcnic_fwinit_work(struct work_struct *work);
  65 static void qlcnic_fw_poll_work(struct work_struct *work);
  66 static void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
  67                 work_func_t func, int delay);
  68 static void qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter);
  69 static int qlcnic_poll(struct napi_struct *napi, int budget);
  70 static int qlcnic_rx_poll(struct napi_struct *napi, int budget);
  71 #ifdef CONFIG_NET_POLL_CONTROLLER
  72 static void qlcnic_poll_controller(struct net_device *netdev);
  73 #endif
  74
  75 static void qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter);
  76 static void qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter);
  77 static void qlcnic_create_diag_entries(struct qlcnic_adapter *adapter);
  78 static void qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter);
  79
  80 static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
  81 static void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8);
  82 static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
  83
  84 static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
  85 static irqreturn_t qlcnic_intr(int irq, void *data);
  86 static irqreturn_t qlcnic_msi_intr(int irq, void *data);
  87 static irqreturn_t qlcnic_msix_intr(int irq, void *data);
  88
  89 static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
  90 static void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long);
  91 static int qlcnic_start_firmware(struct qlcnic_adapter *);
  92
  93 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
  94 static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
  95 static int qlcnicvf_config_led(struct qlcnic_adapter *, u32, u32);
  96 static int qlcnicvf_config_bridged_mode(struct qlcnic_adapter *, u32);
  97 static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
  98 static void qlcnic_set_netdev_features(struct qlcnic_adapter *,
  99                                 struct qlcnic_esw_func_cfg *);
 100 static int qlcnic_vlan_rx_add(struct net_device *, u16);
 101 static int qlcnic_vlan_rx_del(struct net_device *, u16);
 102
 103 /*  PCI Device ID Table  */
 104 #define ENTRY(device) \
 105         {PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
 106         .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
 107
 108 #define PCI_DEVICE_ID_QLOGIC_QLE824X  0x8020
 109
 110 static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
 111         ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
 112         {0,}
 113 };
 114
 115 MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
 116
 117
 118 inline void
 119 qlcnic_update_cmd_producer(struct qlcnic_adapter *adapter,
 120                 struct qlcnic_host_tx_ring *tx_ring)
 121 {
 122         writel(tx_ring->producer, tx_ring->crb_cmd_producer);
 123 }
 124
 125 static const u32 msi_tgt_status[8] = {
 126         ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
 127         ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
 128         ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
 129         ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
 130 };
 131
 132 static const
 133 struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
 134
 135 static inline void qlcnic_disable_int(struct qlcnic_host_sds_ring *sds_ring)
 136 {
 137         writel(0, sds_ring->crb_intr_mask);
 138 }
 139
 140 static inline void qlcnic_enable_int(struct qlcnic_host_sds_ring *sds_ring)
 141 {
 142         struct qlcnic_adapter *adapter = sds_ring->adapter;
 143
 144         writel(0x1, sds_ring->crb_intr_mask);
 145
 146         if (!QLCNIC_IS_MSI_FAMILY(adapter))
 147                 writel(0xfbff, adapter->tgt_mask_reg);
 148 }
 149
 150 static int
 151 qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
 152 {
 153         int size = sizeof(struct qlcnic_host_sds_ring) * count;
 154
 155         recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
 156
 157         return recv_ctx->sds_rings == NULL;
 158 }
 159
 160 static void
 161 qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
 162 {
 163         if (recv_ctx->sds_rings != NULL)
 164                 kfree(recv_ctx->sds_rings);
 165
 166         recv_ctx->sds_rings = NULL;
 167 }
 168
 169 static int
 170 qlcnic_napi_add(struct qlcnic_adapter *adapter, struct net_device *netdev)
 171 {
 172         int ring;
 173         struct qlcnic_host_sds_ring *sds_ring;
 174         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
 175
 176         if (qlcnic_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
 177                 return -ENOMEM;
 178
 179         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
 180                 sds_ring = &recv_ctx->sds_rings[ring];
 181
 182                 if (ring == adapter->max_sds_rings - 1)
 183                         netif_napi_add(netdev, &sds_ring->napi, qlcnic_poll,
 184                                 QLCNIC_NETDEV_WEIGHT/adapter->max_sds_rings);
 185                 else
 186                         netif_napi_add(netdev, &sds_ring->napi,
 187                                 qlcnic_rx_poll, QLCNIC_NETDEV_WEIGHT*2);
 188         }
 189
 190         return 0;
 191 }
 192
 193 static void
 194 qlcnic_napi_del(struct qlcnic_adapter *adapter)
 195 {
 196         int ring;
 197         struct qlcnic_host_sds_ring *sds_ring;
 198         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
 199
 200         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
 201                 sds_ring = &recv_ctx->sds_rings[ring];
 202                 netif_napi_del(&sds_ring->napi);
 203         }
 204
 205         qlcnic_free_sds_rings(adapter->recv_ctx);
 206 }
 207
 208 static void
 209 qlcnic_napi_enable(struct qlcnic_adapter *adapter)
 210 {
 211         int ring;
 212         struct qlcnic_host_sds_ring *sds_ring;
 213         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
 214
 215         if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
 216                 return;
 217
 218         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
 219                 sds_ring = &recv_ctx->sds_rings[ring];
 220                 napi_enable(&sds_ring->napi);
 221                 qlcnic_enable_int(sds_ring);
 222         }
 223 }
 224
 225 static void
 226 qlcnic_napi_disable(struct qlcnic_adapter *adapter)
 227 {
 228         int ring;
 229         struct qlcnic_host_sds_ring *sds_ring;
 230         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
 231
 232         if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
 233                 return;
 234
 235         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
 236                 sds_ring = &recv_ctx->sds_rings[ring];
 237                 qlcnic_disable_int(sds_ring);
 238                 napi_synchronize(&sds_ring->napi);
 239                 napi_disable(&sds_ring->napi);
 240         }
 241 }
 242
 243 static void qlcnic_clear_stats(struct qlcnic_adapter *adapter)
 244 {
 245         memset(&adapter->stats, 0, sizeof(adapter->stats));
 246 }
 247
 248 static void qlcnic_set_msix_bit(struct pci_dev *pdev, int enable)
 249 {
 250         u32 control;
 251         int pos;
 252
 253         pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
 254         if (pos) {
 255                 pci_read_config_dword(pdev, pos, &control);
 256                 if (enable)
 257                         control |= PCI_MSIX_FLAGS_ENABLE;
 258                 else
 259                         control = 0;
 260                 pci_write_config_dword(pdev, pos, control);
 261         }
 262 }
 263
 264 static void qlcnic_init_msix_entries(struct qlcnic_adapter *adapter, int count)
 265 {
 266         int i;
 267
 268         for (i = 0; i < count; i++)
 269                 adapter->msix_entries[i].entry = i;
 270 }
 271
 272 static int
 273 qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
 274 {
 275         u8 mac_addr[ETH_ALEN];
 276         struct net_device *netdev = adapter->netdev;
 277         struct pci_dev *pdev = adapter->pdev;
 278
 279         if (qlcnic_get_mac_address(adapter, mac_addr) != 0)
 280                 return -EIO;
 281
 282         memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
 283         memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len);
 284         memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
 285
 286         /* set station address */
 287
 288         if (!is_valid_ether_addr(netdev->perm_addr))
 289                 dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
 290                                         netdev->dev_addr);
 291
 292         return 0;
 293 }
 294
 295 static int qlcnic_set_mac(struct net_device *netdev, void *p)
 296 {
 297         struct qlcnic_adapter *adapter = netdev_priv(netdev);
 298         struct sockaddr *addr = p;
 299
 300         if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
 301                 return -EOPNOTSUPP;
 302
 303         if (!is_valid_ether_addr(addr->sa_data))
 304                 return -EADDRNOTAVAIL;
 305
 306         if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 307                 netif_device_detach(netdev);
 308                 qlcnic_napi_disable(adapter);
 309         }
 310
 311         memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
 312         memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
 313         qlcnic_set_multi(adapter->netdev);
 314
 315         if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
 316                 netif_device_attach(netdev);
 317                 qlcnic_napi_enable(adapter);
 318         }
 319         return 0;
 320 }
 321
 322 static const struct net_device_ops qlcnic_netdev_ops = {
 323         .ndo_open          = qlcnic_open,
 324         .ndo_stop          = qlcnic_close,
 325         .ndo_start_xmit    = qlcnic_xmit_frame,
 326         .ndo_get_stats     = qlcnic_get_stats,
 327         .ndo_validate_addr = eth_validate_addr,
 328         .ndo_set_rx_mode   = qlcnic_set_multi,
 329         .ndo_set_mac_address    = qlcnic_set_mac,
 330         .ndo_change_mtu    = qlcnic_change_mtu,
 331         .ndo_fix_features  = qlcnic_fix_features,
 332         .ndo_set_features  = qlcnic_set_features,
 333         .ndo_tx_timeout    = qlcnic_tx_timeout,
 334         .ndo_vlan_rx_add_vid    = qlcnic_vlan_rx_add,
 335         .ndo_vlan_rx_kill_vid   = qlcnic_vlan_rx_del,
 336 #ifdef CONFIG_NET_POLL_CONTROLLER
 337         .ndo_poll_controller = qlcnic_poll_controller,
 338 #endif
 339 };
 340
 341 static const struct net_device_ops qlcnic_netdev_failed_ops = {
 342         .ndo_open          = qlcnic_open,
 343 };
 344
 345 static struct qlcnic_nic_template qlcnic_ops = {
 346         .config_bridged_mode = qlcnic_config_bridged_mode,
 347         .config_led = qlcnic_config_led,
 348         .start_firmware = qlcnic_start_firmware
 349 };
 350
 351 static struct qlcnic_nic_template qlcnic_vf_ops = {
 352         .config_bridged_mode = qlcnicvf_config_bridged_mode,
 353         .config_led = qlcnicvf_config_led,
 354         .start_firmware = qlcnicvf_start_firmware
 355 };
 356
 357 static int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
 358 {
 359         struct pci_dev *pdev = adapter->pdev;
 360         int err = -1;
 361
 362         adapter->max_sds_rings = 1;
 363         adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
 364         qlcnic_set_msix_bit(pdev, 0);
 365
 366         if (adapter->msix_supported) {
 367  enable_msix:
 368                 qlcnic_init_msix_entries(adapter, num_msix);
 369                 err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
 370                 if (err == 0) {
 371                         adapter->flags |= QLCNIC_MSIX_ENABLED;
 372                         qlcnic_set_msix_bit(pdev, 1);
 373
 374                         adapter->max_sds_rings = num_msix;
 375
 376                         dev_info(&pdev->dev, "using msi-x interrupts\n");
 377                         return err;
 378                 }
 379                 if (err > 0) {
 380                         num_msix = rounddown_pow_of_two(err);
 381                         if (num_msix)
 382                                 goto enable_msix;
 383                 }
 384         }
 385         return err;
 386 }
 387
 388
 389 static void qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
 390 {
 391         const struct qlcnic_legacy_intr_set *legacy_intrp;
 392         struct pci_dev *pdev = adapter->pdev;
 393
 394         if (use_msi && !pci_enable_msi(pdev)) {
 395                 adapter->flags |= QLCNIC_MSI_ENABLED;
 396                 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
 397                                 msi_tgt_status[adapter->ahw->pci_func]);
 398                 dev_info(&pdev->dev, "using msi interrupts\n");
 399                 adapter->msix_entries[0].vector = pdev->irq;
 400                 return;
 401         }
 402
 403         legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
 404
 405         adapter->int_vec_bit = legacy_intrp->int_vec_bit;
 406         adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
 407                         legacy_intrp->tgt_status_reg);
 408         adapter->tgt_mask_reg = qlcnic_get_ioaddr(adapter,
 409                         legacy_intrp->tgt_mask_reg);
 410         adapter->isr_int_vec = qlcnic_get_ioaddr(adapter, ISR_INT_VECTOR);
 411
 412         adapter->crb_int_state_reg = qlcnic_get_ioaddr(adapter,
 413                         ISR_INT_STATE_REG);
 414         dev_info(&pdev->dev, "using legacy interrupts\n");
 415         adapter->msix_entries[0].vector = pdev->irq;
 416 }
 417
 418 static void
 419 qlcnic_setup_intr(struct qlcnic_adapter *adapter)
 420 {
 421         int num_msix;
 422
 423         if (adapter->msix_supported) {
 424                 num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
 425                                 QLCNIC_DEF_NUM_STS_DESC_RINGS));
 426         } else
 427                 num_msix = 1;
 428
 429         if (!qlcnic_enable_msix(adapter, num_msix))
 430                 return;
 431
 432         qlcnic_enable_msi_legacy(adapter);
 433 }
 434
 435 static void
 436 qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
 437 {
 438         if (adapter->flags & QLCNIC_MSIX_ENABLED)
 439                 pci_disable_msix(adapter->pdev);
 440         if (adapter->flags & QLCNIC_MSI_ENABLED)
 441                 pci_disable_msi(adapter->pdev);
 442 }
 443
 444 static void
 445 qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
 446 {
 447         if (adapter->ahw->pci_base0 != NULL)
 448                 iounmap(adapter->ahw->pci_base0);
 449 }
 450
 451 static int
 452 qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
 453 {
 454         struct qlcnic_pci_info *pci_info;
 455         int i, ret = 0;
 456         u8 pfn;
 457
 458         pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
 459         if (!pci_info)
 460                 return -ENOMEM;
 461
 462         adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
 463                                 QLCNIC_MAX_PCI_FUNC, GFP_KERNEL);
 464         if (!adapter->npars) {
 465                 ret = -ENOMEM;
 466                 goto err_pci_info;
 467         }
 468
 469         adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
 470                                 QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
 471         if (!adapter->eswitch) {
 472                 ret = -ENOMEM;
 473                 goto err_npars;
 474         }
 475
 476         ret = qlcnic_get_pci_info(adapter, pci_info);
 477         if (ret)
 478                 goto err_eswitch;
 479
 480         for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
 481                 pfn = pci_info[i].id;
 482                 if (pfn >= QLCNIC_MAX_PCI_FUNC) {
 483                         ret = QL_STATUS_INVALID_PARAM;
 484                         goto err_eswitch;
 485                 }
 486                 adapter->npars[pfn].active = (u8)pci_info[i].active;
 487                 adapter->npars[pfn].type = (u8)pci_info[i].type;
 488                 adapter->npars[pfn].phy_port = (u8)pci_info[i].default_port;
 489                 adapter->npars[pfn].min_bw = pci_info[i].tx_min_bw;
 490                 adapter->npars[pfn].max_bw = pci_info[i].tx_max_bw;
 491         }
 492
 493         for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
 494                 adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
 495
 496         kfree(pci_info);
 497         return 0;
 498
 499 err_eswitch:
 500         kfree(adapter->eswitch);
 501         adapter->eswitch = NULL;
 502 err_npars:
 503         kfree(adapter->npars);
 504         adapter->npars = NULL;
 505 err_pci_info:
 506         kfree(pci_info);
 507
 508         return ret;
 509 }
 510
 511 static int
 512 qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
 513 {
 514         u8 id;
 515         u32 ref_count;
 516         int i, ret = 1;
 517         u32 data = QLCNIC_MGMT_FUNC;
 518         void __iomem *priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
 519
 520         /* If other drivers are not in use set their privilege level */
 521         ref_count = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
 522         ret = qlcnic_api_lock(adapter);
 523         if (ret)
 524                 goto err_lock;
 525
 526         if (qlcnic_config_npars) {
 527                 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
 528                         id = i;
 529                         if (adapter->npars[i].type != QLCNIC_TYPE_NIC ||
 530                                 id == adapter->ahw->pci_func)
 531                                 continue;
 532                         data |= (qlcnic_config_npars &
 533                                         QLC_DEV_SET_DRV(0xf, id));
 534                 }
 535         } else {
 536                 data = readl(priv_op);
 537                 data = (data & ~QLC_DEV_SET_DRV(0xf, adapter->ahw->pci_func)) |
 538                         (QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC,
 539                         adapter->ahw->pci_func));
 540         }
 541         writel(data, priv_op);
 542         qlcnic_api_unlock(adapter);
 543 err_lock:
 544         return ret;
 545 }
 546
 547 static void
 548 qlcnic_check_vf(struct qlcnic_adapter *adapter)
 549 {
 550         void __iomem *msix_base_addr;
 551         void __iomem *priv_op;
 552         u32 func;
 553         u32 msix_base;
 554         u32 op_mode, priv_level;
 555
 556         /* Determine FW API version */
 557         adapter->fw_hal_version = readl(adapter->ahw->pci_base0 +
 558                                         QLCNIC_FW_API);
 559
 560         /* Find PCI function number */
 561         pci_read_config_dword(adapter->pdev, QLCNIC_MSIX_TABLE_OFFSET, &func);
 562         msix_base_addr = adapter->ahw->pci_base0 + QLCNIC_MSIX_BASE;
 563         msix_base = readl(msix_base_addr);
 564         func = (func - msix_base)/QLCNIC_MSIX_TBL_PGSIZE;
 565         adapter->ahw->pci_func = func;
 566
 567         /* Determine function privilege level */
 568         priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
 569         op_mode = readl(priv_op);
 570         if (op_mode == QLC_DEV_DRV_DEFAULT)
 571                 priv_level = QLCNIC_MGMT_FUNC;
 572         else
 573                 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
 574
 575         if (priv_level == QLCNIC_NON_PRIV_FUNC) {
 576                 adapter->op_mode = QLCNIC_NON_PRIV_FUNC;
 577                 dev_info(&adapter->pdev->dev,
 578                         "HAL Version: %d Non Privileged function\n",
 579                         adapter->fw_hal_version);
 580                 adapter->nic_ops = &qlcnic_vf_ops;
 581         } else
 582                 adapter->nic_ops = &qlcnic_ops;
 583 }
 584
 585 static int
 586 qlcnic_setup_pci_map(struct qlcnic_adapter *adapter)
 587 {
 588         void __iomem *mem_ptr0 = NULL;
 589         resource_size_t mem_base;
 590         unsigned long mem_len, pci_len0 = 0;
 591
 592         struct pci_dev *pdev = adapter->pdev;
 593
 594         /* remap phys address */
 595         mem_base = pci_resource_start(pdev, 0); /* 0 is for BAR 0 */
 596         mem_len = pci_resource_len(pdev, 0);
 597
 598         if (mem_len == QLCNIC_PCI_2MB_SIZE) {
 599
 600                 mem_ptr0 = pci_ioremap_bar(pdev, 0);
 601                 if (mem_ptr0 == NULL) {
 602                         dev_err(&pdev->dev, "failed to map PCI bar 0\n");
 603                         return -EIO;
 604                 }
 605                 pci_len0 = mem_len;
 606         } else {
 607                 return -EIO;
 608         }
 609
 610         dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20));
 611
 612         adapter->ahw->pci_base0 = mem_ptr0;
 613         adapter->ahw->pci_len0 = pci_len0;
 614
 615         qlcnic_check_vf(adapter);
 616
 617         adapter->ahw->ocm_win_crb = qlcnic_get_ioaddr(adapter,
 618                 QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(
 619                         adapter->ahw->pci_func)));
 620
 621         return 0;
 622 }
 623
 624 static void get_brd_name(struct qlcnic_adapter *adapter, char *name)
 625 {
 626         struct pci_dev *pdev = adapter->pdev;
 627         int i, found = 0;
 628
 629         for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
 630                 if (qlcnic_boards[i].vendor == pdev->vendor &&
 631                         qlcnic_boards[i].device == pdev->device &&
 632                         qlcnic_boards[i].sub_vendor == pdev->subsystem_vendor &&
 633                         qlcnic_boards[i].sub_device == pdev->subsystem_device) {
 634                                 sprintf(name, "%pM: %s" ,
 635                                         adapter->mac_addr,
 636                                         qlcnic_boards[i].short_name);
 637                                 found = 1;
 638                                 break;
 639                 }
 640
 641         }
 642
 643         if (!found)
 644                 sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
 645 }
 646
 647 static void
 648 qlcnic_check_options(struct qlcnic_adapter *adapter)
 649 {
 650         u32 fw_major, fw_minor, fw_build, prev_fw_version;
 651         struct pci_dev *pdev = adapter->pdev;
 652         struct qlcnic_fw_dump *fw_dump = &adapter->ahw->fw_dump;
 653
 654         prev_fw_version = adapter->fw_version;
 655
 656         fw_major = QLCRD32(adapter, QLCNIC_FW_VERSION_MAJOR);
 657         fw_minor = QLCRD32(adapter, QLCNIC_FW_VERSION_MINOR);
 658         fw_build = QLCRD32(adapter, QLCNIC_FW_VERSION_SUB);
 659
 660         adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
 661
 662         if (adapter->op_mode != QLCNIC_NON_PRIV_FUNC) {
 663                 if (fw_dump->tmpl_hdr == NULL ||
 664                                 adapter->fw_version > prev_fw_version) {
 665                         if (fw_dump->tmpl_hdr)
 666                                 vfree(fw_dump->tmpl_hdr);
 667                         if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
 668                                 dev_info(&pdev->dev,
 669                                         "Supports FW dump capability\n");
 670                 }
 671         }
 672
 673         dev_info(&pdev->dev, "firmware v%d.%d.%d\n",
 674                         fw_major, fw_minor, fw_build);
 675         if (adapter->ahw->port_type == QLCNIC_XGBE) {
 676                 if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
 677                         adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
 678                         adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
 679                 } else {
 680                         adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
 681                         adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
 682                 }
 683
 684                 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
 685                 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
 686
 687         } else if (adapter->ahw->port_type == QLCNIC_GBE) {
 688                 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
 689                 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
 690                 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
 691                 adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
 692         }
 693
 694         adapter->msix_supported = !!use_msi_x;
 695
 696         adapter->num_txd = MAX_CMD_DESCRIPTORS;
 697
 698         adapter->max_rds_rings = MAX_RDS_RINGS;
 699 }
 700
 701 static int
 702 qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
 703 {
 704         int err;
 705         struct qlcnic_info nic_info;
 706
 707         err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
 708         if (err)
 709                 return err;
 710
 711         adapter->physical_port = (u8)nic_info.phys_port;
 712         adapter->switch_mode = nic_info.switch_mode;
 713         adapter->max_tx_ques = nic_info.max_tx_ques;
 714         adapter->max_rx_ques = nic_info.max_rx_ques;
 715         adapter->capabilities = nic_info.capabilities;
 716         adapter->max_mac_filters = nic_info.max_mac_filters;
 717         adapter->max_mtu = nic_info.max_mtu;
 718
 719         if (adapter->capabilities & BIT_6)
 720                 adapter->flags |= QLCNIC_ESWITCH_ENABLED;
 721         else
 722                 adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;
 723
 724         return err;
 725 }
 726
 727 static void
 728 qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
 729                 struct qlcnic_esw_func_cfg *esw_cfg)
 730 {
 731         if (esw_cfg->discard_tagged)
 732                 adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
 733         else
 734                 adapter->flags |= QLCNIC_TAGGING_ENABLED;
 735
 736         if (esw_cfg->vlan_id)
 737                 adapter->pvid = esw_cfg->vlan_id;
 738         else
 739                 adapter->pvid = 0;
 740 }
 741
 742 static int
 743 qlcnic_vlan_rx_add(struct net_device *netdev, u16 vid)
 744 {
 745         struct qlcnic_adapter *adapter = netdev_priv(netdev);
 746         set_bit(vid, adapter->vlans);
 747         return 0;
 748 }
 749
 750 static int
 751 qlcnic_vlan_rx_del(struct net_device *netdev, u16 vid)
 752 {
 753         struct qlcnic_adapter *adapter = netdev_priv(netdev);
 754
 755         qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
 756         clear_bit(vid, adapter->vlans);
 757         return 0;
 758 }
 759
 760 static void
 761 qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
 762                 struct qlcnic_esw_func_cfg *esw_cfg)
 763 {
 764         adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
 765                                 QLCNIC_PROMISC_DISABLED);
 766
 767         if (esw_cfg->mac_anti_spoof)
 768                 adapter->flags |= QLCNIC_MACSPOOF;
 769
 770         if (!esw_cfg->mac_override)
 771                 adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;
 772
 773         if (!esw_cfg->promisc_mode)
 774                 adapter->flags |= QLCNIC_PROMISC_DISABLED;
 775
 776         qlcnic_set_netdev_features(adapter, esw_cfg);
 777 }
 778
 779 static int
 780 qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
 781 {
 782         struct qlcnic_esw_func_cfg esw_cfg;
 783
 784         if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
 785                 return 0;
 786
 787         esw_cfg.pci_func = adapter->ahw->pci_func;
 788         if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
 789                         return -EIO;
 790         qlcnic_set_vlan_config(adapter, &esw_cfg);
 791         qlcnic_set_eswitch_port_features(adapter, &esw_cfg);
 792
 793         return 0;
 794 }
 795
 796 static void
 797 qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
 798                 struct qlcnic_esw_func_cfg *esw_cfg)
 799 {
 800         struct net_device *netdev = adapter->netdev;
 801         netdev_features_t features, vlan_features;
 802
 803         features = (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
 804                         NETIF_F_IPV6_CSUM | NETIF_F_GRO);
 805         vlan_features = (NETIF_F_SG | NETIF_F_IP_CSUM |
 806                         NETIF_F_IPV6_CSUM | NETIF_F_HW_VLAN_FILTER);
 807
 808         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO) {
 809                 features |= (NETIF_F_TSO | NETIF_F_TSO6);
 810                 vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
 811         }
 812
 813         if (netdev->features & NETIF_F_LRO)
 814                 features |= NETIF_F_LRO;
 815
 816         if (esw_cfg->offload_flags & BIT_0) {
 817                 netdev->features |= features;
 818                 if (!(esw_cfg->offload_flags & BIT_1))
 819                         netdev->features &= ~NETIF_F_TSO;
 820                 if (!(esw_cfg->offload_flags & BIT_2))
 821                         netdev->features &= ~NETIF_F_TSO6;
 822         } else {
 823                 netdev->features &= ~features;
 824         }
 825
 826         netdev->vlan_features = (features & vlan_features);
 827 }
 828
 829 static int
 830 qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
 831 {
 832         void __iomem *priv_op;
 833         u32 op_mode, priv_level;
 834         int err = 0;
 835
 836         err = qlcnic_initialize_nic(adapter);
 837         if (err)
 838                 return err;
 839
 840         if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
 841                 return 0;
 842
 843         priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
 844         op_mode = readl(priv_op);
 845         priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
 846
 847         if (op_mode == QLC_DEV_DRV_DEFAULT)
 848                 priv_level = QLCNIC_MGMT_FUNC;
 849         else
 850                 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
 851
 852         if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
 853                 if (priv_level == QLCNIC_MGMT_FUNC) {
 854                         adapter->op_mode = QLCNIC_MGMT_FUNC;
 855                         err = qlcnic_init_pci_info(adapter);
 856                         if (err)
 857                                 return err;
 858                         /* Set privilege level for other functions */
 859                         qlcnic_set_function_modes(adapter);
 860                         dev_info(&adapter->pdev->dev,
 861                                 "HAL Version: %d, Management function\n",
 862                                 adapter->fw_hal_version);
 863                 } else if (priv_level == QLCNIC_PRIV_FUNC) {
 864                         adapter->op_mode = QLCNIC_PRIV_FUNC;
 865                         dev_info(&adapter->pdev->dev,
 866                                 "HAL Version: %d, Privileged function\n",
 867                                 adapter->fw_hal_version);
 868                 }
 869         }
 870
 871         adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
 872
 873         return err;
 874 }
 875
 876 static int
 877 qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
 878 {
 879         struct qlcnic_esw_func_cfg esw_cfg;
 880         struct qlcnic_npar_info *npar;
 881         u8 i;
 882
 883         if (adapter->need_fw_reset)
 884                 return 0;
 885
 886         for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
 887                 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
 888                         continue;
 889                 memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
 890                 esw_cfg.pci_func = i;
 891                 esw_cfg.offload_flags = BIT_0;
 892                 esw_cfg.mac_override = BIT_0;
 893                 esw_cfg.promisc_mode = BIT_0;
 894                 if (adapter->capabilities  & QLCNIC_FW_CAPABILITY_TSO)
 895                         esw_cfg.offload_flags |= (BIT_1 | BIT_2);
 896                 if (qlcnic_config_switch_port(adapter, &esw_cfg))
 897                         return -EIO;
 898                 npar = &adapter->npars[i];
 899                 npar->pvid = esw_cfg.vlan_id;
 900                 npar->mac_override = esw_cfg.mac_override;
 901                 npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
 902                 npar->discard_tagged = esw_cfg.discard_tagged;
 903                 npar->promisc_mode = esw_cfg.promisc_mode;
 904                 npar->offload_flags = esw_cfg.offload_flags;
 905         }
 906
 907         return 0;
 908 }
 909
 910 static int
 911 qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
 912                         struct qlcnic_npar_info *npar, int pci_func)
 913 {
 914         struct qlcnic_esw_func_cfg esw_cfg;
 915         esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
 916         esw_cfg.pci_func = pci_func;
 917         esw_cfg.vlan_id = npar->pvid;
 918         esw_cfg.mac_override = npar->mac_override;
 919         esw_cfg.discard_tagged = npar->discard_tagged;
 920         esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
 921         esw_cfg.offload_flags = npar->offload_flags;
 922         esw_cfg.promisc_mode = npar->promisc_mode;
 923         if (qlcnic_config_switch_port(adapter, &esw_cfg))
 924                 return -EIO;
 925
 926         esw_cfg.op_mode = QLCNIC_ADD_VLAN;
 927         if (qlcnic_config_switch_port(adapter, &esw_cfg))
 928                 return -EIO;
 929
 930         return 0;
 931 }
 932
 933 static int
 934 qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
 935 {
 936         int i, err;
 937         struct qlcnic_npar_info *npar;
 938         struct qlcnic_info nic_info;
 939
 940         if (!adapter->need_fw_reset)
 941                 return 0;
 942
 943         /* Set the NPAR config data after FW reset */
 944         for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
 945                 npar = &adapter->npars[i];
 946                 if (npar->type != QLCNIC_TYPE_NIC)
 947                         continue;
 948                 err = qlcnic_get_nic_info(adapter, &nic_info, i);
 949                 if (err)
 950                         return err;
 951                 nic_info.min_tx_bw = npar->min_bw;
 952                 nic_info.max_tx_bw = npar->max_bw;
 953                 err = qlcnic_set_nic_info(adapter, &nic_info);
 954                 if (err)
 955                         return err;
 956
 957                 if (npar->enable_pm) {
 958                         err = qlcnic_config_port_mirroring(adapter,
 959                                                         npar->dest_npar, 1, i);
 960                         if (err)
 961                                 return err;
 962                 }
 963                 err = qlcnic_reset_eswitch_config(adapter, npar, i);
 964                 if (err)
 965                         return err;
 966         }
 967         return 0;
 968 }
 969
 970 static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
 971 {
 972         u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
 973         u32 npar_state;
 974
 975         if (adapter->op_mode == QLCNIC_MGMT_FUNC)
 976                 return 0;
 977
 978         npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
 979         while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
 980                 msleep(1000);
 981                 npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
 982         }
 983         if (!npar_opt_timeo) {
 984                 dev_err(&adapter->pdev->dev,
 985                         "Waiting for NPAR state to opertional timeout\n");
 986                 return -EIO;
 987         }
 988         return 0;
 989 }
 990
 991 static int
 992 qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
 993 {
 994         int err;
 995
 996         if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
 997                     adapter->op_mode != QLCNIC_MGMT_FUNC)
 998                 return 0;
 999
1000         err = qlcnic_set_default_offload_settings(adapter);
1001         if (err)
1002                 return err;
1003
1004         err = qlcnic_reset_npar_config(adapter);
1005         if (err)
1006                 return err;
1007
1008         qlcnic_dev_set_npar_ready(adapter);
1009
1010         return err;
1011 }
1012
1013 static int
1014 qlcnic_start_firmware(struct qlcnic_adapter *adapter)
1015 {
1016         int err;
1017
1018         err = qlcnic_can_start_firmware(adapter);
1019         if (err < 0)
1020                 return err;
1021         else if (!err)
1022                 goto check_fw_status;
1023
1024         if (load_fw_file)
1025                 qlcnic_request_firmware(adapter);
1026         else {
1027                 err = qlcnic_check_flash_fw_ver(adapter);
1028                 if (err)
1029                         goto err_out;
1030
1031                 adapter->fw_type = QLCNIC_FLASH_ROMIMAGE;
1032         }
1033
1034         err = qlcnic_need_fw_reset(adapter);
1035         if (err == 0)
1036                 goto check_fw_status;
1037
1038         err = qlcnic_pinit_from_rom(adapter);
1039         if (err)
1040                 goto err_out;
1041
1042         err = qlcnic_load_firmware(adapter);
1043         if (err)
1044                 goto err_out;
1045
1046         qlcnic_release_firmware(adapter);
1047         QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1048
1049 check_fw_status:
1050         err = qlcnic_check_fw_status(adapter);
1051         if (err)
1052                 goto err_out;
1053
1054         QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1055         qlcnic_idc_debug_info(adapter, 1);
1056
1057         err = qlcnic_check_eswitch_mode(adapter);
1058         if (err) {
1059                 dev_err(&adapter->pdev->dev,
1060                         "Memory allocation failed for eswitch\n");
1061                 goto err_out;
1062         }
1063         err = qlcnic_set_mgmt_operations(adapter);
1064         if (err)
1065                 goto err_out;
1066
1067         qlcnic_check_options(adapter);
1068         adapter->need_fw_reset = 0;
1069
1070         qlcnic_release_firmware(adapter);
1071         return 0;
1072
1073 err_out:
1074         QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1075         dev_err(&adapter->pdev->dev, "Device state set to failed\n");
1076
1077         qlcnic_release_firmware(adapter);
1078         return err;
1079 }
1080
1081 static int
1082 qlcnic_request_irq(struct qlcnic_adapter *adapter)
1083 {
1084         irq_handler_t handler;
1085         struct qlcnic_host_sds_ring *sds_ring;
1086         int err, ring;
1087
1088         unsigned long flags = 0;
1089         struct net_device *netdev = adapter->netdev;
1090         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1091
1092         if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1093                 handler = qlcnic_tmp_intr;
1094                 if (!QLCNIC_IS_MSI_FAMILY(adapter))
1095                         flags |= IRQF_SHARED;
1096
1097         } else {
1098                 if (adapter->flags & QLCNIC_MSIX_ENABLED)
1099                         handler = qlcnic_msix_intr;
1100                 else if (adapter->flags & QLCNIC_MSI_ENABLED)
1101                         handler = qlcnic_msi_intr;
1102                 else {
1103                         flags |= IRQF_SHARED;
1104                         handler = qlcnic_intr;
1105                 }
1106         }
1107         adapter->irq = netdev->irq;
1108
1109         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1110                 sds_ring = &recv_ctx->sds_rings[ring];
1111                 sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
1112                 err = request_irq(sds_ring->irq, handler,
1113                                   flags, sds_ring->name, sds_ring);
1114                 if (err)
1115                         return err;
1116         }
1117
1118         return 0;
1119 }
1120
1121 static void
1122 qlcnic_free_irq(struct qlcnic_adapter *adapter)
1123 {
1124         int ring;
1125         struct qlcnic_host_sds_ring *sds_ring;
1126
1127         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1128
1129         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1130                 sds_ring = &recv_ctx->sds_rings[ring];
1131                 free_irq(sds_ring->irq, sds_ring);
1132         }
1133 }
1134
1135 static int
1136 __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1137 {
1138         int ring;
1139         struct qlcnic_host_rds_ring *rds_ring;
1140
1141         if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1142                 return -EIO;
1143
1144         if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1145                 return 0;
1146         if (qlcnic_set_eswitch_port_config(adapter))
1147                 return -EIO;
1148
1149         if (qlcnic_fw_create_ctx(adapter))
1150                 return -EIO;
1151
1152         for (ring = 0; ring < adapter->max_rds_rings; ring++) {
1153                 rds_ring = &adapter->recv_ctx->rds_rings[ring];
1154                 qlcnic_post_rx_buffers(adapter, rds_ring);
1155         }
1156
1157         qlcnic_set_multi(netdev);
1158         qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
1159
1160         adapter->ahw->linkup = 0;
1161
1162         if (adapter->max_sds_rings > 1)
1163                 qlcnic_config_rss(adapter, 1);
1164
1165         qlcnic_config_intr_coalesce(adapter);
1166
1167         if (netdev->features & NETIF_F_LRO)
1168                 qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
1169
1170         qlcnic_napi_enable(adapter);
1171
1172         qlcnic_linkevent_request(adapter, 1);
1173
1174         adapter->reset_context = 0;
1175         set_bit(__QLCNIC_DEV_UP, &adapter->state);
1176         return 0;
1177 }
1178
1179 /* Usage: During resume and firmware recovery module.*/
1180
1181 static int
1182 qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1183 {
1184         int err = 0;
1185
1186         rtnl_lock();
1187         if (netif_running(netdev))
1188                 err = __qlcnic_up(adapter, netdev);
1189         rtnl_unlock();
1190
1191         return err;
1192 }
1193
1194 static void
1195 __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1196 {
1197         if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1198                 return;
1199
1200         if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
1201                 return;
1202
1203         smp_mb();
1204         spin_lock(&adapter->tx_clean_lock);
1205         netif_carrier_off(netdev);
1206         netif_tx_disable(netdev);
1207
1208         qlcnic_free_mac_list(adapter);
1209
1210         if (adapter->fhash.fnum)
1211                 qlcnic_delete_lb_filters(adapter);
1212
1213         qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
1214
1215         qlcnic_napi_disable(adapter);
1216
1217         qlcnic_fw_destroy_ctx(adapter);
1218
1219         qlcnic_reset_rx_buffers_list(adapter);
1220         qlcnic_release_tx_buffers(adapter);
1221         spin_unlock(&adapter->tx_clean_lock);
1222 }
1223
1224 /* Usage: During suspend and firmware recovery module */
1225
1226 static void
1227 qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1228 {
1229         rtnl_lock();
1230         if (netif_running(netdev))
1231                 __qlcnic_down(adapter, netdev);
1232         rtnl_unlock();
1233
1234 }
1235
1236 static int
1237 qlcnic_attach(struct qlcnic_adapter *adapter)
1238 {
1239         struct net_device *netdev = adapter->netdev;
1240         struct pci_dev *pdev = adapter->pdev;
1241         int err;
1242
1243         if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
1244                 return 0;
1245
1246         err = qlcnic_napi_add(adapter, netdev);
1247         if (err)
1248                 return err;
1249
1250         err = qlcnic_alloc_sw_resources(adapter);
1251         if (err) {
1252                 dev_err(&pdev->dev, "Error in setting sw resources\n");
1253                 goto err_out_napi_del;
1254         }
1255
1256         err = qlcnic_alloc_hw_resources(adapter);
1257         if (err) {
1258                 dev_err(&pdev->dev, "Error in setting hw resources\n");
1259                 goto err_out_free_sw;
1260         }
1261
1262         err = qlcnic_request_irq(adapter);
1263         if (err) {
1264                 dev_err(&pdev->dev, "failed to setup interrupt\n");
1265                 goto err_out_free_hw;
1266         }
1267
1268         qlcnic_create_sysfs_entries(adapter);
1269
1270         adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
1271         return 0;
1272
1273 err_out_free_hw:
1274         qlcnic_free_hw_resources(adapter);
1275 err_out_free_sw:
1276         qlcnic_free_sw_resources(adapter);
1277 err_out_napi_del:
1278         qlcnic_napi_del(adapter);
1279         return err;
1280 }
1281
1282 static void
1283 qlcnic_detach(struct qlcnic_adapter *adapter)
1284 {
1285         if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1286                 return;
1287
1288         qlcnic_remove_sysfs_entries(adapter);
1289
1290         qlcnic_free_hw_resources(adapter);
1291         qlcnic_release_rx_buffers(adapter);
1292         qlcnic_free_irq(adapter);
1293         qlcnic_napi_del(adapter);
1294         qlcnic_free_sw_resources(adapter);
1295
1296         adapter->is_up = 0;
1297 }
1298
1299 void qlcnic_diag_free_res(struct net_device *netdev, int max_sds_rings)
1300 {
1301         struct qlcnic_adapter *adapter = netdev_priv(netdev);
1302         struct qlcnic_host_sds_ring *sds_ring;
1303         int ring;
1304
1305         clear_bit(__QLCNIC_DEV_UP, &adapter->state);
1306         if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1307                 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1308                         sds_ring = &adapter->recv_ctx->sds_rings[ring];
1309                         qlcnic_disable_int(sds_ring);
1310                 }
1311         }
1312
1313         qlcnic_fw_destroy_ctx(adapter);
1314
1315         qlcnic_detach(adapter);
1316
1317         adapter->diag_test = 0;
1318         adapter->max_sds_rings = max_sds_rings;
1319
1320         if (qlcnic_attach(adapter))
1321                 goto out;
1322
1323         if (netif_running(netdev))
1324                 __qlcnic_up(adapter, netdev);
1325 out:
1326         netif_device_attach(netdev);
1327 }
1328
1329 static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
1330 {
1331         int err = 0;
1332         adapter->ahw = kzalloc(sizeof(struct qlcnic_hardware_context),
1333                                 GFP_KERNEL);
1334         if (!adapter->ahw) {
1335                 dev_err(&adapter->pdev->dev,
1336                         "Failed to allocate recv ctx resources for adapter\n");
1337                 err = -ENOMEM;
1338                 goto err_out;
1339         }
1340         adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
1341                                 GFP_KERNEL);
1342         if (!adapter->recv_ctx) {
1343                 dev_err(&adapter->pdev->dev,
1344                         "Failed to allocate recv ctx resources for adapter\n");
1345                 kfree(adapter->ahw);
1346                 adapter->ahw = NULL;
1347                 err = -ENOMEM;
1348                 goto err_out;
1349         }
1350         /* Initialize interrupt coalesce parameters */
1351         adapter->ahw->coal.flag = QLCNIC_INTR_DEFAULT;
1352         adapter->ahw->coal.rx_time_us = QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US;
1353         adapter->ahw->coal.rx_packets = QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS;
1354 err_out:
1355         return err;
1356 }
1357
1358 static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
1359 {
1360         kfree(adapter->recv_ctx);
1361         adapter->recv_ctx = NULL;
1362
1363         if (adapter->ahw->fw_dump.tmpl_hdr) {
1364                 vfree(adapter->ahw->fw_dump.tmpl_hdr);
1365                 adapter->ahw->fw_dump.tmpl_hdr = NULL;
1366         }
1367         kfree(adapter->ahw);
1368         adapter->ahw = NULL;
1369 }
1370
1371 int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
1372 {
1373         struct qlcnic_adapter *adapter = netdev_priv(netdev);
1374         struct qlcnic_host_sds_ring *sds_ring;
1375         struct qlcnic_host_rds_ring *rds_ring;
1376         int ring;
1377         int ret;
1378
1379         netif_device_detach(netdev);
1380
1381         if (netif_running(netdev))
1382                 __qlcnic_down(adapter, netdev);
1383
1384         qlcnic_detach(adapter);
1385
1386         adapter->max_sds_rings = 1;
1387         adapter->diag_test = test;
1388
1389         ret = qlcnic_attach(adapter);
1390         if (ret) {
1391                 netif_device_attach(netdev);
1392                 return ret;
1393         }
1394
1395         ret = qlcnic_fw_create_ctx(adapter);
1396         if (ret) {
1397                 qlcnic_detach(adapter);
1398                 netif_device_attach(netdev);
1399                 return ret;
1400         }
1401
1402         for (ring = 0; ring < adapter->max_rds_rings; ring++) {
1403                 rds_ring = &adapter->recv_ctx->rds_rings[ring];
1404                 qlcnic_post_rx_buffers(adapter, rds_ring);
1405         }
1406
1407         if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1408                 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1409                         sds_ring = &adapter->recv_ctx->sds_rings[ring];
1410                         qlcnic_enable_int(sds_ring);
1411                 }
1412         }
1413
1414         if (adapter->diag_test == QLCNIC_LOOPBACK_TEST) {
1415                 adapter->ahw->loopback_state = 0;
1416                 qlcnic_linkevent_request(adapter, 1);
1417         }
1418
1419         set_bit(__QLCNIC_DEV_UP, &adapter->state);
1420
1421         return 0;
1422 }
1423
1424 /* Reset context in hardware only */
1425 static int
1426 qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
1427 {
1428         struct net_device *netdev = adapter->netdev;
1429
1430         if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1431                 return -EBUSY;
1432
1433         netif_device_detach(netdev);
1434
1435         qlcnic_down(adapter, netdev);
1436
1437         qlcnic_up(adapter, netdev);
1438
1439         netif_device_attach(netdev);
1440
1441         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1442         return 0;
1443 }
1444
1445 int
1446 qlcnic_reset_context(struct qlcnic_adapter *adapter)
1447 {
1448         int err = 0;
1449         struct net_device *netdev = adapter->netdev;
1450
1451         if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1452                 return -EBUSY;
1453
1454         if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
1455
1456                 netif_device_detach(netdev);
1457
1458                 if (netif_running(netdev))
1459                         __qlcnic_down(adapter, netdev);
1460
1461                 qlcnic_detach(adapter);
1462
1463                 if (netif_running(netdev)) {
1464                         err = qlcnic_attach(adapter);
1465                         if (!err) {
1466                                 __qlcnic_up(adapter, netdev);
1467                                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
1468                         }
1469                 }
1470
1471                 netif_device_attach(netdev);
1472         }
1473
1474         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1475         return err;
1476 }
1477
1478 static int
1479 qlcnic_setup_netdev(struct qlcnic_adapter *adapter,
1480                 struct net_device *netdev, u8 pci_using_dac)
1481 {
1482         int err;
1483         struct pci_dev *pdev = adapter->pdev;
1484
1485         adapter->mc_enabled = 0;
1486         adapter->max_mc_count = 38;
1487
1488         netdev->netdev_ops         = &qlcnic_netdev_ops;
1489         netdev->watchdog_timeo     = 5*HZ;
1490
1491         qlcnic_change_mtu(netdev, netdev->mtu);
1492
1493         SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);
1494
1495         netdev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM |
1496                 NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM;
1497
1498         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO)
1499                 netdev->hw_features |= NETIF_F_TSO | NETIF_F_TSO6;
1500         if (pci_using_dac)
1501                 netdev->hw_features |= NETIF_F_HIGHDMA;
1502
1503         netdev->vlan_features = netdev->hw_features;
1504
1505         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX)
1506                 netdev->hw_features |= NETIF_F_HW_VLAN_TX;
1507         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
1508                 netdev->hw_features |= NETIF_F_LRO;
1509
1510         netdev->features |= netdev->hw_features |
1511                 NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_FILTER;
1512
1513         netdev->irq = adapter->msix_entries[0].vector;
1514
1515         err = register_netdev(netdev);
1516         if (err) {
1517                 dev_err(&pdev->dev, "failed to register net device\n");
1518                 return err;
1519         }
1520
1521         return 0;
1522 }
1523
1524 static int qlcnic_set_dma_mask(struct pci_dev *pdev, u8 *pci_using_dac)
1525 {
1526         if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
1527                         !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
1528                 *pci_using_dac = 1;
1529         else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
1530                         !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
1531                 *pci_using_dac = 0;
1532         else {
1533                 dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
1534                 return -EIO;
1535         }
1536
1537         return 0;
1538 }
1539
1540 static int
1541 qlcnic_alloc_msix_entries(struct qlcnic_adapter *adapter, u16 count)
1542 {
1543         adapter->msix_entries = kcalloc(count, sizeof(struct msix_entry),
1544                                         GFP_KERNEL);
1545
1546         if (adapter->msix_entries)
1547                 return 0;
1548
1549         dev_err(&adapter->pdev->dev, "failed allocating msix_entries\n");
1550         return -ENOMEM;
1551 }
1552
1553 static int __devinit
1554 qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
1555 {
1556         struct net_device *netdev = NULL;
1557         struct qlcnic_adapter *adapter = NULL;
1558         int err;
1559         uint8_t revision_id;
1560         uint8_t pci_using_dac;
1561         char brd_name[QLCNIC_MAX_BOARD_NAME_LEN];
1562
1563         err = pci_enable_device(pdev);
1564         if (err)
1565                 return err;
1566
1567         if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
1568                 err = -ENODEV;
1569                 goto err_out_disable_pdev;
1570         }
1571
1572         err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
1573         if (err)
1574                 goto err_out_disable_pdev;
1575
1576         err = pci_request_regions(pdev, qlcnic_driver_name);
1577         if (err)
1578                 goto err_out_disable_pdev;
1579
1580         pci_set_master(pdev);
1581         pci_enable_pcie_error_reporting(pdev);
1582
1583         netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
1584         if (!netdev) {
1585                 err = -ENOMEM;
1586                 goto err_out_free_res;
1587         }
1588
1589         SET_NETDEV_DEV(netdev, &pdev->dev);
1590
1591         adapter = netdev_priv(netdev);
1592         adapter->netdev  = netdev;
1593         adapter->pdev    = pdev;
1594
1595         if (qlcnic_alloc_adapter_resources(adapter))
1596                 goto err_out_free_netdev;
1597
1598         adapter->dev_rst_time = jiffies;
1599         revision_id = pdev->revision;
1600         adapter->ahw->revision_id = revision_id;
1601         adapter->mac_learn = qlcnic_mac_learn;
1602
1603         rwlock_init(&adapter->ahw->crb_lock);
1604         mutex_init(&adapter->ahw->mem_lock);
1605
1606         spin_lock_init(&adapter->tx_clean_lock);
1607         INIT_LIST_HEAD(&adapter->mac_list);
1608
1609         err = qlcnic_setup_pci_map(adapter);
1610         if (err)
1611                 goto err_out_free_hw;
1612
1613         /* This will be reset for mezz cards  */
1614         adapter->portnum = adapter->ahw->pci_func;
1615
1616         err = qlcnic_get_board_info(adapter);
1617         if (err) {
1618                 dev_err(&pdev->dev, "Error getting board config info.\n");
1619                 goto err_out_iounmap;
1620         }
1621
1622         err = qlcnic_setup_idc_param(adapter);
1623         if (err)
1624                 goto err_out_iounmap;
1625
1626         adapter->flags |= QLCNIC_NEED_FLR;
1627
1628         err = adapter->nic_ops->start_firmware(adapter);
1629         if (err) {
1630                 dev_err(&pdev->dev, "Loading fw failed. Please Reboot\n"
1631                         "\t\tIf reboot doesn't help, try flashing the card\n");
1632                 goto err_out_maintenance_mode;
1633         }
1634
1635         if (qlcnic_read_mac_addr(adapter))
1636                 dev_warn(&pdev->dev, "failed to read mac addr\n");
1637
1638         if (adapter->portnum == 0) {
1639                 get_brd_name(adapter, brd_name);
1640
1641                 pr_info("%s: %s Board Chip rev 0x%x\n",
1642                                 module_name(THIS_MODULE),
1643                                 brd_name, adapter->ahw->revision_id);
1644         }
1645
1646         qlcnic_clear_stats(adapter);
1647
1648         err = qlcnic_alloc_msix_entries(adapter, adapter->max_rx_ques);
1649         if (err)
1650                 goto err_out_decr_ref;
1651
1652         qlcnic_setup_intr(adapter);
1653
1654         err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
1655         if (err)
1656                 goto err_out_disable_msi;
1657
1658         pci_set_drvdata(pdev, adapter);
1659
1660         qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1661
1662         switch (adapter->ahw->port_type) {
1663         case QLCNIC_GBE:
1664                 dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
1665                                 adapter->netdev->name);
1666                 break;
1667         case QLCNIC_XGBE:
1668                 dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
1669                                 adapter->netdev->name);
1670                 break;
1671         }
1672
1673         if (adapter->mac_learn)
1674                 qlcnic_alloc_lb_filters_mem(adapter);
1675
1676         qlcnic_create_diag_entries(adapter);
1677
1678         return 0;
1679
1680 err_out_disable_msi:
1681         qlcnic_teardown_intr(adapter);
1682         kfree(adapter->msix_entries);
1683
1684 err_out_decr_ref:
1685         qlcnic_clr_all_drv_state(adapter, 0);
1686
1687 err_out_iounmap:
1688         qlcnic_cleanup_pci_map(adapter);
1689
1690 err_out_free_hw:
1691         qlcnic_free_adapter_resources(adapter);
1692
1693 err_out_free_netdev:
1694         free_netdev(netdev);
1695
1696 err_out_free_res:
1697         pci_release_regions(pdev);
1698
1699 err_out_disable_pdev:
1700         pci_set_drvdata(pdev, NULL);
1701         pci_disable_device(pdev);
1702         return err;
1703
1704 err_out_maintenance_mode:
1705         netdev->netdev_ops = &qlcnic_netdev_failed_ops;
1706         SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_failed_ops);
1707         err = register_netdev(netdev);
1708         if (err) {
1709                 dev_err(&pdev->dev, "failed to register net device\n");
1710                 goto err_out_decr_ref;
1711         }
1712         pci_set_drvdata(pdev, adapter);
1713         qlcnic_create_diag_entries(adapter);
1714         return 0;
1715 }
1716
1717 static void __devexit qlcnic_remove(struct pci_dev *pdev)
1718 {
1719         struct qlcnic_adapter *adapter;
1720         struct net_device *netdev;
1721
1722         adapter = pci_get_drvdata(pdev);
1723         if (adapter == NULL)
1724                 return;
1725
1726         netdev = adapter->netdev;
1727
1728         qlcnic_cancel_fw_work(adapter);
1729
1730         unregister_netdev(netdev);
1731
1732         qlcnic_detach(adapter);
1733
1734         if (adapter->npars != NULL)
1735                 kfree(adapter->npars);
1736         if (adapter->eswitch != NULL)
1737                 kfree(adapter->eswitch);
1738
1739         qlcnic_clr_all_drv_state(adapter, 0);
1740
1741         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1742
1743         qlcnic_free_lb_filters_mem(adapter);
1744
1745         qlcnic_teardown_intr(adapter);
1746         kfree(adapter->msix_entries);
1747
1748         qlcnic_remove_diag_entries(adapter);
1749
1750         qlcnic_cleanup_pci_map(adapter);
1751
1752         qlcnic_release_firmware(adapter);
1753
1754         pci_disable_pcie_error_reporting(pdev);
1755         pci_release_regions(pdev);
1756         pci_disable_device(pdev);
1757         pci_set_drvdata(pdev, NULL);
1758
1759         qlcnic_free_adapter_resources(adapter);
1760         free_netdev(netdev);
1761 }
1762 static int __qlcnic_shutdown(struct pci_dev *pdev)
1763 {
1764         struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1765         struct net_device *netdev = adapter->netdev;
1766         int retval;
1767
1768         netif_device_detach(netdev);
1769
1770         qlcnic_cancel_fw_work(adapter);
1771
1772         if (netif_running(netdev))
1773                 qlcnic_down(adapter, netdev);
1774
1775         qlcnic_clr_all_drv_state(adapter, 0);
1776
1777         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1778
1779         retval = pci_save_state(pdev);
1780         if (retval)
1781                 return retval;
1782
1783         if (qlcnic_wol_supported(adapter)) {
1784                 pci_enable_wake(pdev, PCI_D3cold, 1);
1785                 pci_enable_wake(pdev, PCI_D3hot, 1);
1786         }
1787
1788         return 0;
1789 }
1790
1791 static void qlcnic_shutdown(struct pci_dev *pdev)
1792 {
1793         if (__qlcnic_shutdown(pdev))
1794                 return;
1795
1796         pci_disable_device(pdev);
1797 }
1798
1799 #ifdef CONFIG_PM
1800 static int
1801 qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
1802 {
1803         int retval;
1804
1805         retval = __qlcnic_shutdown(pdev);
1806         if (retval)
1807                 return retval;
1808
1809         pci_set_power_state(pdev, pci_choose_state(pdev, state));
1810         return 0;
1811 }
1812
1813 static int
1814 qlcnic_resume(struct pci_dev *pdev)
1815 {
1816         struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1817         struct net_device *netdev = adapter->netdev;
1818         int err;
1819
1820         err = pci_enable_device(pdev);
1821         if (err)
1822                 return err;
1823
1824         pci_set_power_state(pdev, PCI_D0);
1825         pci_set_master(pdev);
1826         pci_restore_state(pdev);
1827
1828         err = adapter->nic_ops->start_firmware(adapter);
1829         if (err) {
1830                 dev_err(&pdev->dev, "failed to start firmware\n");
1831                 return err;
1832         }
1833
1834         if (netif_running(netdev)) {
1835                 err = qlcnic_up(adapter, netdev);
1836                 if (err)
1837                         goto done;
1838
1839                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
1840         }
1841 done:
1842         netif_device_attach(netdev);
1843         qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1844         return 0;
1845 }
1846 #endif
1847
1848 static int qlcnic_open(struct net_device *netdev)
1849 {
1850         struct qlcnic_adapter *adapter = netdev_priv(netdev);
1851         u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
1852         int err;
1853
1854         if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
1855                 netdev_err(netdev, "Device in FAILED state\n");
1856                 return -EIO;
1857         }
1858
1859         netif_carrier_off(netdev);
1860
1861         err = qlcnic_attach(adapter);
1862         if (err)
1863                 return err;
1864
1865         err = __qlcnic_up(adapter, netdev);
1866         if (err)
1867                 goto err_out;
1868
1869         netif_start_queue(netdev);
1870
1871         return 0;
1872
1873 err_out:
1874         qlcnic_detach(adapter);
1875         return err;
1876 }
1877
1878 /*
1879  * qlcnic_close - Disables a network interface entry point
1880  */
1881 static int qlcnic_close(struct net_device *netdev)
1882 {
1883         struct qlcnic_adapter *adapter = netdev_priv(netdev);
1884
1885         __qlcnic_down(adapter, netdev);
1886         return 0;
1887 }
1888
1889 void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
1890 {
1891         void *head;
1892         int i;
1893
1894         if (adapter->fhash.fmax && adapter->fhash.fhead)
1895                 return;
1896
1897         spin_lock_init(&adapter->mac_learn_lock);
1898
1899         head = kcalloc(QLCNIC_LB_MAX_FILTERS, sizeof(struct hlist_head),
1900                                                                 GFP_KERNEL);
1901         if (!head)
1902                 return;
1903
1904         adapter->fhash.fmax = QLCNIC_LB_MAX_FILTERS;
1905         adapter->fhash.fhead = head;
1906
1907         for (i = 0; i < adapter->fhash.fmax; i++)
1908                 INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
1909 }
1910
1911 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
1912 {
1913         if (adapter->fhash.fmax && adapter->fhash.fhead)
1914                 kfree(adapter->fhash.fhead);
1915
1916         adapter->fhash.fhead = NULL;
1917         adapter->fhash.fmax = 0;
1918 }
1919
1920 static void qlcnic_change_filter(struct qlcnic_adapter *adapter,
1921                 u64 uaddr, __le16 vlan_id, struct qlcnic_host_tx_ring *tx_ring)
1922 {
1923         struct cmd_desc_type0 *hwdesc;
1924         struct qlcnic_nic_req *req;
1925         struct qlcnic_mac_req *mac_req;
1926         struct qlcnic_vlan_req *vlan_req;
1927         u32 producer;
1928         u64 word;
1929
1930         producer = tx_ring->producer;
1931         hwdesc = &tx_ring->desc_head[tx_ring->producer];
1932
1933         req = (struct qlcnic_nic_req *)hwdesc;
1934         memset(req, 0, sizeof(struct qlcnic_nic_req));
1935         req->qhdr = cpu_to_le64(QLCNIC_REQUEST << 23);
1936
1937         word = QLCNIC_MAC_EVENT | ((u64)(adapter->portnum) << 16);
1938         req->req_hdr = cpu_to_le64(word);
1939
1940         mac_req = (struct qlcnic_mac_req *)&(req->words[0]);
1941         mac_req->op = vlan_id ? QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_ADD;
1942         memcpy(mac_req->mac_addr, &uaddr, ETH_ALEN);
1943
1944         vlan_req = (struct qlcnic_vlan_req *)&req->words[1];
1945         vlan_req->vlan_id = vlan_id;
1946
1947         tx_ring->producer = get_next_index(producer, tx_ring->num_desc);
1948         smp_mb();
1949 }
1950
1951 #define QLCNIC_MAC_HASH(MAC)\
1952         ((((MAC) & 0x70000) >> 0x10) | (((MAC) & 0x70000000000ULL) >> 0x25))
1953
1954 static void
1955 qlcnic_send_filter(struct qlcnic_adapter *adapter,
1956                 struct qlcnic_host_tx_ring *tx_ring,
1957                 struct cmd_desc_type0 *first_desc,
1958                 struct sk_buff *skb)
1959 {
1960         struct ethhdr *phdr = (struct ethhdr *)(skb->data);
1961         struct qlcnic_filter *fil, *tmp_fil;
1962         struct hlist_node *tmp_hnode, *n;
1963         struct hlist_head *head;
1964         u64 src_addr = 0;
1965         __le16 vlan_id = 0;
1966         u8 hindex;
1967
1968         if (ether_addr_equal(phdr->h_source, adapter->mac_addr))
1969                 return;
1970
1971         if (adapter->fhash.fnum >= adapter->fhash.fmax)
1972                 return;
1973
1974         /* Only NPAR capable devices support vlan based learning*/
1975         if (adapter->flags & QLCNIC_ESWITCH_ENABLED)
1976                 vlan_id = first_desc->vlan_TCI;
1977         memcpy(&src_addr, phdr->h_source, ETH_ALEN);
1978         hindex = QLCNIC_MAC_HASH(src_addr) & (QLCNIC_LB_MAX_FILTERS - 1);
1979         head = &(adapter->fhash.fhead[hindex]);
1980
1981         hlist_for_each_entry_safe(tmp_fil, tmp_hnode, n, head, fnode) {
1982                 if (!memcmp(tmp_fil->faddr, &src_addr, ETH_ALEN) &&
1983                             tmp_fil->vlan_id == vlan_id) {
1984
1985                         if (jiffies >
1986                             (QLCNIC_READD_AGE * HZ + tmp_fil->ftime))
1987                                 qlcnic_change_filter(adapter, src_addr, vlan_id,
1988                                                                 tx_ring);
1989                         tmp_fil->ftime = jiffies;
1990                         return;
1991                 }
1992         }
1993
1994         fil = kzalloc(sizeof(struct qlcnic_filter), GFP_ATOMIC);
1995         if (!fil)
1996                 return;
1997
1998         qlcnic_change_filter(adapter, src_addr, vlan_id, tx_ring);
1999
2000         fil->ftime = jiffies;
2001         fil->vlan_id = vlan_id;
2002         memcpy(fil->faddr, &src_addr, ETH_ALEN);
2003         spin_lock(&adapter->mac_learn_lock);
2004         hlist_add_head(&(fil->fnode), head);
2005         adapter->fhash.fnum++;
2006         spin_unlock(&adapter->mac_learn_lock);
2007 }
2008
2009 static int
2010 qlcnic_tx_pkt(struct qlcnic_adapter *adapter,
2011                 struct cmd_desc_type0 *first_desc,
2012                 struct sk_buff *skb)
2013 {
2014         u8 opcode = 0, hdr_len = 0;
2015         u16 flags = 0, vlan_tci = 0;
2016         int copied, offset, copy_len;
2017         struct cmd_desc_type0 *hwdesc;
2018         struct vlan_ethhdr *vh;
2019         struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2020         u16 protocol = ntohs(skb->protocol);
2021         u32 producer = tx_ring->producer;
2022
2023         if (protocol == ETH_P_8021Q) {
2024                 vh = (struct vlan_ethhdr *)skb->data;
2025                 flags = FLAGS_VLAN_TAGGED;
2026                 vlan_tci = vh->h_vlan_TCI;
2027         } else if (vlan_tx_tag_present(skb)) {
2028                 flags = FLAGS_VLAN_OOB;
2029                 vlan_tci = vlan_tx_tag_get(skb);
2030         }
2031         if (unlikely(adapter->pvid)) {
2032                 if (vlan_tci && !(adapter->flags & QLCNIC_TAGGING_ENABLED))
2033                         return -EIO;
2034                 if (vlan_tci && (adapter->flags & QLCNIC_TAGGING_ENABLED))
2035                         goto set_flags;
2036
2037                 flags = FLAGS_VLAN_OOB;
2038                 vlan_tci = adapter->pvid;
2039         }
2040 set_flags:
2041         qlcnic_set_tx_vlan_tci(first_desc, vlan_tci);
2042         qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
2043
2044         if (*(skb->data) & BIT_0) {
2045                 flags |= BIT_0;
2046                 memcpy(&first_desc->eth_addr, skb->data, ETH_ALEN);
2047         }
2048         opcode = TX_ETHER_PKT;
2049         if ((adapter->netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) &&
2050                         skb_shinfo(skb)->gso_size > 0) {
2051
2052                 hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
2053
2054                 first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
2055                 first_desc->total_hdr_length = hdr_len;
2056
2057                 opcode = (protocol == ETH_P_IPV6) ? TX_TCP_LSO6 : TX_TCP_LSO;
2058
2059                 /* For LSO, we need to copy the MAC/IP/TCP headers into
2060                 * the descriptor ring */
2061                 copied = 0;
2062                 offset = 2;
2063
2064                 if (flags & FLAGS_VLAN_OOB) {
2065                         first_desc->total_hdr_length += VLAN_HLEN;
2066                         first_desc->tcp_hdr_offset = VLAN_HLEN;
2067                         first_desc->ip_hdr_offset = VLAN_HLEN;
2068                         /* Only in case of TSO on vlan device */
2069                         flags |= FLAGS_VLAN_TAGGED;
2070
2071                         /* Create a TSO vlan header template for firmware */
2072
2073                         hwdesc = &tx_ring->desc_head[producer];
2074                         tx_ring->cmd_buf_arr[producer].skb = NULL;
2075
2076                         copy_len = min((int)sizeof(struct cmd_desc_type0) -
2077                                 offset, hdr_len + VLAN_HLEN);
2078
2079                         vh = (struct vlan_ethhdr *)((char *) hwdesc + 2);
2080                         skb_copy_from_linear_data(skb, vh, 12);
2081                         vh->h_vlan_proto = htons(ETH_P_8021Q);
2082                         vh->h_vlan_TCI = htons(vlan_tci);
2083
2084                         skb_copy_from_linear_data_offset(skb, 12,
2085                                 (char *)vh + 16, copy_len - 16);
2086
2087                         copied = copy_len - VLAN_HLEN;
2088                         offset = 0;
2089
2090                         producer = get_next_index(producer, tx_ring->num_desc);
2091                 }
2092
2093                 while (copied < hdr_len) {
2094
2095                         copy_len = min((int)sizeof(struct cmd_desc_type0) -
2096                                 offset, (hdr_len - copied));
2097
2098                         hwdesc = &tx_ring->desc_head[producer];
2099                         tx_ring->cmd_buf_arr[producer].skb = NULL;
2100
2101                         skb_copy_from_linear_data_offset(skb, copied,
2102                                  (char *) hwdesc + offset, copy_len);
2103
2104                         copied += copy_len;
2105                         offset = 0;
2106
2107                         producer = get_next_index(producer, tx_ring->num_desc);
2108                 }
2109
2110                 tx_ring->producer = producer;
2111                 smp_mb();
2112                 adapter->stats.lso_frames++;
2113
2114         } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
2115                 u8 l4proto;
2116
2117                 if (protocol == ETH_P_IP) {
2118                         l4proto = ip_hdr(skb)->protocol;
2119
2120                         if (l4proto == IPPROTO_TCP)
2121                                 opcode = TX_TCP_PKT;
2122                         else if (l4proto == IPPROTO_UDP)
2123                                 opcode = TX_UDP_PKT;
2124                 } else if (protocol == ETH_P_IPV6) {
2125                         l4proto = ipv6_hdr(skb)->nexthdr;
2126
2127                         if (l4proto == IPPROTO_TCP)
2128                                 opcode = TX_TCPV6_PKT;
2129                         else if (l4proto == IPPROTO_UDP)
2130                                 opcode = TX_UDPV6_PKT;
2131                 }
2132         }
2133         first_desc->tcp_hdr_offset += skb_transport_offset(skb);
2134         first_desc->ip_hdr_offset += skb_network_offset(skb);
2135         qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
2136
2137         return 0;
2138 }
2139
2140 static int
2141 qlcnic_map_tx_skb(struct pci_dev *pdev,
2142                 struct sk_buff *skb, struct qlcnic_cmd_buffer *pbuf)
2143 {
2144         struct qlcnic_skb_frag *nf;
2145         struct skb_frag_struct *frag;
2146         int i, nr_frags;
2147         dma_addr_t map;
2148
2149         nr_frags = skb_shinfo(skb)->nr_frags;
2150         nf = &pbuf->frag_array[0];
2151
2152         map = pci_map_single(pdev, skb->data,
2153                         skb_headlen(skb), PCI_DMA_TODEVICE);
2154         if (pci_dma_mapping_error(pdev, map))
2155                 goto out_err;
2156
2157         nf->dma = map;
2158         nf->length = skb_headlen(skb);
2159
2160         for (i = 0; i < nr_frags; i++) {
2161                 frag = &skb_shinfo(skb)->frags[i];
2162                 nf = &pbuf->frag_array[i+1];
2163
2164                 map = skb_frag_dma_map(&pdev->dev, frag, 0, skb_frag_size(frag),
2165                                        DMA_TO_DEVICE);
2166                 if (dma_mapping_error(&pdev->dev, map))
2167                         goto unwind;
2168
2169                 nf->dma = map;
2170                 nf->length = skb_frag_size(frag);
2171         }
2172
2173         return 0;
2174
2175 unwind:
2176         while (--i >= 0) {
2177                 nf = &pbuf->frag_array[i+1];
2178                 pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
2179         }
2180
2181         nf = &pbuf->frag_array[0];
2182         pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
2183
2184 out_err:
2185         return -ENOMEM;
2186 }
2187
2188 static void
2189 qlcnic_unmap_buffers(struct pci_dev *pdev, struct sk_buff *skb,
2190                         struct qlcnic_cmd_buffer *pbuf)
2191 {
2192         struct qlcnic_skb_frag *nf = &pbuf->frag_array[0];
2193         int nr_frags = skb_shinfo(skb)->nr_frags;
2194         int i;
2195
2196         for (i = 0; i < nr_frags; i++) {
2197                 nf = &pbuf->frag_array[i+1];
2198                 pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
2199         }
2200
2201         nf = &pbuf->frag_array[0];
2202         pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
2203         pbuf->skb = NULL;
2204 }
2205
2206 static inline void
2207 qlcnic_clear_cmddesc(u64 *desc)
2208 {
2209         desc[0] = 0ULL;
2210         desc[2] = 0ULL;
2211         desc[7] = 0ULL;
2212 }
2213
2214 netdev_tx_t
2215 qlcnic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
2216 {
2217         struct qlcnic_adapter *adapter = netdev_priv(netdev);
2218         struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2219         struct qlcnic_cmd_buffer *pbuf;
2220         struct qlcnic_skb_frag *buffrag;
2221         struct cmd_desc_type0 *hwdesc, *first_desc;
2222         struct pci_dev *pdev;
2223         struct ethhdr *phdr;
2224         int delta = 0;
2225         int i, k;
2226
2227         u32 producer;
2228         int frag_count;
2229         u32 num_txd = tx_ring->num_desc;
2230
2231         if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
2232                 netif_stop_queue(netdev);
2233                 return NETDEV_TX_BUSY;
2234         }
2235
2236         if (adapter->flags & QLCNIC_MACSPOOF) {
2237                 phdr = (struct ethhdr *)skb->data;
2238                 if (!ether_addr_equal(phdr->h_source, adapter->mac_addr))
2239                         goto drop_packet;
2240         }
2241
2242         frag_count = skb_shinfo(skb)->nr_frags + 1;
2243         /* 14 frags supported for normal packet and
2244          * 32 frags supported for TSO packet
2245          */
2246         if (!skb_is_gso(skb) && frag_count > QLCNIC_MAX_FRAGS_PER_TX) {
2247
2248                 for (i = 0; i < (frag_count - QLCNIC_MAX_FRAGS_PER_TX); i++)
2249                         delta += skb_frag_size(&skb_shinfo(skb)->frags[i]);
2250
2251                 if (!__pskb_pull_tail(skb, delta))
2252                         goto drop_packet;
2253
2254                 frag_count = 1 + skb_shinfo(skb)->nr_frags;
2255         }
2256
2257         if (unlikely(qlcnic_tx_avail(tx_ring) <= TX_STOP_THRESH)) {
2258                 netif_stop_queue(netdev);
2259                 if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH)
2260                         netif_start_queue(netdev);
2261                 else {
2262                         adapter->stats.xmit_off++;
2263                         return NETDEV_TX_BUSY;
2264                 }
2265         }
2266
2267         producer = tx_ring->producer;
2268         pbuf = &tx_ring->cmd_buf_arr[producer];
2269
2270         pdev = adapter->pdev;
2271
2272         first_desc = hwdesc = &tx_ring->desc_head[producer];
2273         qlcnic_clear_cmddesc((u64 *)hwdesc);
2274
2275         if (qlcnic_map_tx_skb(pdev, skb, pbuf)) {
2276                 adapter->stats.tx_dma_map_error++;
2277                 goto drop_packet;
2278         }
2279
2280         pbuf->skb = skb;
2281         pbuf->frag_count = frag_count;
2282
2283         qlcnic_set_tx_frags_len(first_desc, frag_count, skb->len);
2284         qlcnic_set_tx_port(first_desc, adapter->portnum);
2285
2286         for (i = 0; i < frag_count; i++) {
2287
2288                 k = i % 4;
2289
2290                 if ((k == 0) && (i > 0)) {
2291                         /* move to next desc.*/
2292                         producer = get_next_index(producer, num_txd);
2293                         hwdesc = &tx_ring->desc_head[producer];
2294                         qlcnic_clear_cmddesc((u64 *)hwdesc);
2295                         tx_ring->cmd_buf_arr[producer].skb = NULL;
2296                 }
2297
2298                 buffrag = &pbuf->frag_array[i];
2299
2300                 hwdesc->buffer_length[k] = cpu_to_le16(buffrag->length);
2301                 switch (k) {
2302                 case 0:
2303                         hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
2304                         break;
2305                 case 1:
2306                         hwdesc->addr_buffer2 = cpu_to_le64(buffrag->dma);
2307                         break;
2308                 case 2:
2309                         hwdesc->addr_buffer3 = cpu_to_le64(buffrag->dma);
2310                         break;
2311                 case 3:
2312                         hwdesc->addr_buffer4 = cpu_to_le64(buffrag->dma);
2313                         break;
2314                 }
2315         }
2316
2317         tx_ring->producer = get_next_index(producer, num_txd);
2318         smp_mb();
2319
2320         if (unlikely(qlcnic_tx_pkt(adapter, first_desc, skb)))
2321                 goto unwind_buff;
2322
2323         if (adapter->mac_learn)
2324                 qlcnic_send_filter(adapter, tx_ring, first_desc, skb);
2325
2326         adapter->stats.txbytes += skb->len;
2327         adapter->stats.xmitcalled++;
2328
2329         qlcnic_update_cmd_producer(adapter, tx_ring);
2330
2331         return NETDEV_TX_OK;
2332
2333 unwind_buff:
2334         qlcnic_unmap_buffers(pdev, skb, pbuf);
2335 drop_packet:
2336         adapter->stats.txdropped++;
2337         dev_kfree_skb_any(skb);
2338         return NETDEV_TX_OK;
2339 }
2340
2341 static int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2342 {
2343         struct net_device *netdev = adapter->netdev;
2344         u32 temp, temp_state, temp_val;
2345         int rv = 0;
2346
2347         temp = QLCRD32(adapter, CRB_TEMP_STATE);
2348
2349         temp_state = qlcnic_get_temp_state(temp);
2350         temp_val = qlcnic_get_temp_val(temp);
2351
2352         if (temp_state == QLCNIC_TEMP_PANIC) {
2353                 dev_err(&netdev->dev,
2354                        "Device temperature %d degrees C exceeds"
2355                        " maximum allowed. Hardware has been shut down.\n",
2356                        temp_val);
2357                 rv = 1;
2358         } else if (temp_state == QLCNIC_TEMP_WARN) {
2359                 if (adapter->temp == QLCNIC_TEMP_NORMAL) {
2360                         dev_err(&netdev->dev,
2361                                "Device temperature %d degrees C "
2362                                "exceeds operating range."
2363                                " Immediate action needed.\n",
2364                                temp_val);
2365                 }
2366         } else {
2367                 if (adapter->temp == QLCNIC_TEMP_WARN) {
2368                         dev_info(&netdev->dev,
2369                                "Device temperature is now %d degrees C"
2370                                " in normal range.\n", temp_val);
2371                 }
2372         }
2373         adapter->temp = temp_state;
2374         return rv;
2375 }
2376
2377 void qlcnic_advert_link_change(struct qlcnic_adapter *adapter, int linkup)
2378 {
2379         struct net_device *netdev = adapter->netdev;
2380
2381         if (adapter->ahw->linkup && !linkup) {
2382                 netdev_info(netdev, "NIC Link is down\n");
2383                 adapter->ahw->linkup = 0;
2384                 if (netif_running(netdev)) {
2385                         netif_carrier_off(netdev);
2386                         netif_stop_queue(netdev);
2387                 }
2388         } else if (!adapter->ahw->linkup && linkup) {
2389                 netdev_info(netdev, "NIC Link is up\n");
2390                 adapter->ahw->linkup = 1;
2391                 if (netif_running(netdev)) {
2392                         netif_carrier_on(netdev);
2393                         netif_wake_queue(netdev);
2394                 }
2395         }
2396 }
2397
2398 static void qlcnic_tx_timeout(struct net_device *netdev)
2399 {
2400         struct qlcnic_adapter *adapter = netdev_priv(netdev);
2401
2402         if (test_bit(__QLCNIC_RESETTING, &adapter->state))
2403                 return;
2404
2405         dev_err(&netdev->dev, "transmit timeout, resetting.\n");
2406
2407         if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS)
2408                 adapter->need_fw_reset = 1;
2409         else
2410                 adapter->reset_context = 1;
2411 }
2412
2413 static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
2414 {
2415         struct qlcnic_adapter *adapter = netdev_priv(netdev);
2416         struct net_device_stats *stats = &netdev->stats;
2417
2418         stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
2419         stats->tx_packets = adapter->stats.xmitfinished;
2420         stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
2421         stats->tx_bytes = adapter->stats.txbytes;
2422         stats->rx_dropped = adapter->stats.rxdropped;
2423         stats->tx_dropped = adapter->stats.txdropped;
2424
2425         return stats;
2426 }
2427
2428 static irqreturn_t qlcnic_clear_legacy_intr(struct qlcnic_adapter *adapter)
2429 {
2430         u32 status;
2431
2432         status = readl(adapter->isr_int_vec);
2433
2434         if (!(status & adapter->int_vec_bit))
2435                 return IRQ_NONE;
2436
2437         /* check interrupt state machine, to be sure */
2438         status = readl(adapter->crb_int_state_reg);
2439         if (!ISR_LEGACY_INT_TRIGGERED(status))
2440                 return IRQ_NONE;
2441
2442         writel(0xffffffff, adapter->tgt_status_reg);
2443         /* read twice to ensure write is flushed */
2444         readl(adapter->isr_int_vec);
2445         readl(adapter->isr_int_vec);
2446
2447         return IRQ_HANDLED;
2448 }
2449
2450 static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
2451 {
2452         struct qlcnic_host_sds_ring *sds_ring = data;
2453         struct qlcnic_adapter *adapter = sds_ring->adapter;
2454
2455         if (adapter->flags & QLCNIC_MSIX_ENABLED)
2456                 goto done;
2457         else if (adapter->flags & QLCNIC_MSI_ENABLED) {
2458                 writel(0xffffffff, adapter->tgt_status_reg);
2459                 goto done;
2460         }
2461
2462         if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
2463                 return IRQ_NONE;
2464
2465 done:
2466         adapter->diag_cnt++;
2467         qlcnic_enable_int(sds_ring);
2468         return IRQ_HANDLED;
2469 }
2470
2471 static irqreturn_t qlcnic_intr(int irq, void *data)
2472 {
2473         struct qlcnic_host_sds_ring *sds_ring = data;
2474         struct qlcnic_adapter *adapter = sds_ring->adapter;
2475
2476         if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
2477                 return IRQ_NONE;
2478
2479         napi_schedule(&sds_ring->napi);
2480
2481         return IRQ_HANDLED;
2482 }
2483
2484 static irqreturn_t qlcnic_msi_intr(int irq, void *data)
2485 {
2486         struct qlcnic_host_sds_ring *sds_ring = data;
2487         struct qlcnic_adapter *adapter = sds_ring->adapter;
2488
2489         /* clear interrupt */
2490         writel(0xffffffff, adapter->tgt_status_reg);
2491
2492         napi_schedule(&sds_ring->napi);
2493         return IRQ_HANDLED;
2494 }
2495
2496 static irqreturn_t qlcnic_msix_intr(int irq, void *data)
2497 {
2498         struct qlcnic_host_sds_ring *sds_ring = data;
2499
2500         napi_schedule(&sds_ring->napi);
2501         return IRQ_HANDLED;
2502 }
2503
2504 static int qlcnic_process_cmd_ring(struct qlcnic_adapter *adapter)
2505 {
2506         u32 sw_consumer, hw_consumer;
2507         int count = 0, i;
2508         struct qlcnic_cmd_buffer *buffer;
2509         struct pci_dev *pdev = adapter->pdev;
2510         struct net_device *netdev = adapter->netdev;
2511         struct qlcnic_skb_frag *frag;
2512         int done;
2513         struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2514
2515         if (!spin_trylock(&adapter->tx_clean_lock))
2516                 return 1;
2517
2518         sw_consumer = tx_ring->sw_consumer;
2519         hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
2520
2521         while (sw_consumer != hw_consumer) {
2522                 buffer = &tx_ring->cmd_buf_arr[sw_consumer];
2523                 if (buffer->skb) {
2524                         frag = &buffer->frag_array[0];
2525                         pci_unmap_single(pdev, frag->dma, frag->length,
2526                                          PCI_DMA_TODEVICE);
2527                         frag->dma = 0ULL;
2528                         for (i = 1; i < buffer->frag_count; i++) {
2529                                 frag++;
2530                                 pci_unmap_page(pdev, frag->dma, frag->length,
2531                                                PCI_DMA_TODEVICE);
2532                                 frag->dma = 0ULL;
2533                         }
2534
2535                         adapter->stats.xmitfinished++;
2536                         dev_kfree_skb_any(buffer->skb);
2537                         buffer->skb = NULL;
2538                 }
2539
2540                 sw_consumer = get_next_index(sw_consumer, tx_ring->num_desc);
2541                 if (++count >= MAX_STATUS_HANDLE)
2542                         break;
2543         }
2544
2545         if (count && netif_running(netdev)) {
2546                 tx_ring->sw_consumer = sw_consumer;
2547
2548                 smp_mb();
2549
2550                 if (netif_queue_stopped(netdev) && netif_carrier_ok(netdev)) {
2551                         if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH) {
2552                                 netif_wake_queue(netdev);
2553                                 adapter->stats.xmit_on++;
2554                         }
2555                 }
2556                 adapter->tx_timeo_cnt = 0;
2557         }
2558         /*
2559          * If everything is freed up to consumer then check if the ring is full
2560          * If the ring is full then check if more needs to be freed and
2561          * schedule the call back again.
2562          *
2563          * This happens when there are 2 CPUs. One could be freeing and the
2564          * other filling it. If the ring is full when we get out of here and
2565          * the card has already interrupted the host then the host can miss the
2566          * interrupt.
2567          *
2568          * There is still a possible race condition and the host could miss an
2569          * interrupt. The card has to take care of this.
2570          */
2571         hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
2572         done = (sw_consumer == hw_consumer);
2573         spin_unlock(&adapter->tx_clean_lock);
2574
2575         return done;
2576 }
2577
2578 static int qlcnic_poll(struct napi_struct *napi, int budget)
2579 {
2580         struct qlcnic_host_sds_ring *sds_ring =
2581                 container_of(napi, struct qlcnic_host_sds_ring, napi);
2582
2583         struct qlcnic_adapter *adapter = sds_ring->adapter;
2584
2585         int tx_complete;
2586         int work_done;
2587
2588         tx_complete = qlcnic_process_cmd_ring(adapter);
2589
2590         work_done = qlcnic_process_rcv_ring(sds_ring, budget);
2591
2592         if ((work_done < budget) && tx_complete) {
2593                 napi_complete(&sds_ring->napi);
2594                 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
2595                         qlcnic_enable_int(sds_ring);
2596         }
2597
2598         return work_done;
2599 }
2600
2601 static int qlcnic_rx_poll(struct napi_struct *napi, int budget)
2602 {
2603         struct qlcnic_host_sds_ring *sds_ring =
2604                 container_of(napi, struct qlcnic_host_sds_ring, napi);
2605
2606         struct qlcnic_adapter *adapter = sds_ring->adapter;
2607         int work_done;
2608
2609         work_done = qlcnic_process_rcv_ring(sds_ring, budget);
2610
2611         if (work_done < budget) {
2612                 napi_complete(&sds_ring->napi);
2613                 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
2614                         qlcnic_enable_int(sds_ring);
2615         }
2616
2617         return work_done;
2618 }
2619
2620 #ifdef CONFIG_NET_POLL_CONTROLLER
2621 static void qlcnic_poll_controller(struct net_device *netdev)
2622 {
2623         int ring;
2624         struct qlcnic_host_sds_ring *sds_ring;
2625         struct qlcnic_adapter *adapter = netdev_priv(netdev);
2626         struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
2627
2628         disable_irq(adapter->irq);
2629         for (ring = 0; ring < adapter->max_sds_rings; ring++) {
2630                 sds_ring = &recv_ctx->sds_rings[ring];
2631                 qlcnic_intr(adapter->irq, sds_ring);
2632         }
2633         enable_irq(adapter->irq);
2634 }
2635 #endif
2636
2637 static void
2638 qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
2639 {
2640         u32 val;
2641
2642         val = adapter->portnum & 0xf;
2643         val |= encoding << 7;
2644         val |= (jiffies - adapter->dev_rst_time) << 8;
2645
2646         QLCWR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
2647         adapter->dev_rst_time = jiffies;
2648 }
2649
2650 static int
2651 qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
2652 {
2653         u32  val;
2654
2655         WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
2656                         state != QLCNIC_DEV_NEED_QUISCENT);
2657
2658         if (qlcnic_api_lock(adapter))
2659                 return -EIO;
2660
2661         val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2662
2663         if (state == QLCNIC_DEV_NEED_RESET)
2664                 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2665         else if (state == QLCNIC_DEV_NEED_QUISCENT)
2666                 QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
2667
2668         QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2669
2670         qlcnic_api_unlock(adapter);
2671
2672         return 0;
2673 }
2674
2675 static int
2676 qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
2677 {
2678         u32  val;
2679
2680         if (qlcnic_api_lock(adapter))
2681                 return -EBUSY;
2682
2683         val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2684         QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2685         QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2686
2687         qlcnic_api_unlock(adapter);
2688
2689         return 0;
2690 }
2691
2692 static void
2693 qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
2694 {
2695         u32  val;
2696
2697         if (qlcnic_api_lock(adapter))
2698                 goto err;
2699
2700         val = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2701         QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
2702         QLCWR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2703
2704         if (failed) {
2705                 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
2706                 dev_info(&adapter->pdev->dev,
2707                                 "Device state set to Failed. Please Reboot\n");
2708         } else if (!(val & 0x11111111))
2709                 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_COLD);
2710
2711         val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2712         QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
2713         QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2714
2715         qlcnic_api_unlock(adapter);
2716 err:
2717         adapter->fw_fail_cnt = 0;
2718         adapter->flags &= ~QLCNIC_FW_HANG;
2719         clear_bit(__QLCNIC_START_FW, &adapter->state);
2720         clear_bit(__QLCNIC_RESETTING, &adapter->state);
2721 }
2722
2723 /* Grab api lock, before checking state */
2724 static int
2725 qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
2726 {
2727         int act, state, active_mask;
2728
2729         state = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2730         act = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2731
2732         if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
2733                 active_mask = (~(1 << (adapter->ahw->pci_func * 4)));
2734                 act = act & active_mask;
2735         }
2736
2737         if (((state & 0x11111111) == (act & 0x11111111)) ||
2738                         ((act & 0x11111111) == ((state >> 1) & 0x11111111)))
2739                 return 0;
2740         else
2741                 return 1;
2742 }
2743
2744 static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
2745 {
2746         u32 val = QLCRD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
2747
2748         if (val != QLCNIC_DRV_IDC_VER) {
2749                 dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
2750                         " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
2751         }
2752
2753         return 0;
2754 }
2755
2756 static int
2757 qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
2758 {
2759         u32 val, prev_state;
2760         u8 dev_init_timeo = adapter->dev_init_timeo;
2761         u8 portnum = adapter->portnum;
2762         u8 ret;
2763
2764         if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
2765                 return 1;
2766
2767         if (qlcnic_api_lock(adapter))
2768                 return -1;
2769
2770         val = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2771         if (!(val & (1 << (portnum * 4)))) {
2772                 QLC_DEV_SET_REF_CNT(val, portnum);
2773                 QLCWR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
2774         }
2775
2776         prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2777         QLCDB(adapter, HW, "Device state = %u\n", prev_state);
2778
2779         switch (prev_state) {
2780         case QLCNIC_DEV_COLD:
2781                 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_INITIALIZING);
2782                 QLCWR32(adapter, QLCNIC_CRB_DRV_IDC_VER, QLCNIC_DRV_IDC_VER);
2783                 qlcnic_idc_debug_info(adapter, 0);
2784                 qlcnic_api_unlock(adapter);
2785                 return 1;
2786
2787         case QLCNIC_DEV_READY:
2788                 ret = qlcnic_check_idc_ver(adapter);
2789                 qlcnic_api_unlock(adapter);
2790                 return ret;
2791
2792         case QLCNIC_DEV_NEED_RESET:
2793                 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2794                 QLC_DEV_SET_RST_RDY(val, portnum);
2795                 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2796                 break;
2797
2798         case QLCNIC_DEV_NEED_QUISCENT:
2799                 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2800                 QLC_DEV_SET_QSCNT_RDY(val, portnum);
2801                 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2802                 break;
2803
2804         case QLCNIC_DEV_FAILED:
2805                 dev_err(&adapter->pdev->dev, "Device in failed state.\n");
2806                 qlcnic_api_unlock(adapter);
2807                 return -1;
2808
2809         case QLCNIC_DEV_INITIALIZING:
2810         case QLCNIC_DEV_QUISCENT:
2811                 break;
2812         }
2813
2814         qlcnic_api_unlock(adapter);
2815
2816         do {
2817                 msleep(1000);
2818                 prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2819
2820                 if (prev_state == QLCNIC_DEV_QUISCENT)
2821                         continue;
2822         } while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
2823
2824         if (!dev_init_timeo) {
2825                 dev_err(&adapter->pdev->dev,
2826                         "Waiting for device to initialize timeout\n");
2827                 return -1;
2828         }
2829
2830         if (qlcnic_api_lock(adapter))
2831                 return -1;
2832
2833         val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2834         QLC_DEV_CLR_RST_QSCNT(val, portnum);
2835         QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2836
2837         ret = qlcnic_check_idc_ver(adapter);
2838         qlcnic_api_unlock(adapter);
2839
2840         return ret;
2841 }
2842
2843 static void
2844 qlcnic_fwinit_work(struct work_struct *work)
2845 {
2846         struct qlcnic_adapter *adapter = container_of(work,
2847                         struct qlcnic_adapter, fw_work.work);
2848         u32 dev_state = 0xf;
2849         u32 val;
2850
2851         if (qlcnic_api_lock(adapter))
2852                 goto err_ret;
2853
2854         dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2855         if (dev_state == QLCNIC_DEV_QUISCENT ||
2856             dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2857                 qlcnic_api_unlock(adapter);
2858                 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
2859                                                 FW_POLL_DELAY * 2);
2860                 return;
2861         }
2862
2863         if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC) {
2864                 qlcnic_api_unlock(adapter);
2865                 goto wait_npar;
2866         }
2867
2868         if (dev_state == QLCNIC_DEV_INITIALIZING ||
2869             dev_state == QLCNIC_DEV_READY) {
2870                 dev_info(&adapter->pdev->dev, "Detected state change from "
2871                                 "DEV_NEED_RESET, skipping ack check\n");
2872                 goto skip_ack_check;
2873         }
2874
2875         if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
2876                 dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
2877                                         adapter->reset_ack_timeo);
2878                 goto skip_ack_check;
2879         }
2880
2881         if (!qlcnic_check_drv_state(adapter)) {
2882 skip_ack_check:
2883                 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2884
2885                 if (dev_state == QLCNIC_DEV_NEED_RESET) {
2886                         QLCWR32(adapter, QLCNIC_CRB_DEV_STATE,
2887                                                 QLCNIC_DEV_INITIALIZING);
2888                         set_bit(__QLCNIC_START_FW, &adapter->state);
2889                         QLCDB(adapter, DRV, "Restarting fw\n");
2890                         qlcnic_idc_debug_info(adapter, 0);
2891                         val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2892                         QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2893                         QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2894                 }
2895
2896                 qlcnic_api_unlock(adapter);
2897
2898                 rtnl_lock();
2899                 if (adapter->ahw->fw_dump.enable &&
2900                     (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
2901                         QLCDB(adapter, DRV, "Take FW dump\n");
2902                         qlcnic_dump_fw(adapter);
2903                         adapter->flags |= QLCNIC_FW_HANG;
2904                 }
2905                 rtnl_unlock();
2906
2907                 adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
2908                 if (!adapter->nic_ops->start_firmware(adapter)) {
2909                         qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2910                         adapter->fw_wait_cnt = 0;
2911                         return;
2912                 }
2913                 goto err_ret;
2914         }
2915
2916         qlcnic_api_unlock(adapter);
2917
2918 wait_npar:
2919         dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2920         QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
2921
2922         switch (dev_state) {
2923         case QLCNIC_DEV_READY:
2924                 if (!adapter->nic_ops->start_firmware(adapter)) {
2925                         qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2926                         adapter->fw_wait_cnt = 0;
2927                         return;
2928                 }
2929         case QLCNIC_DEV_FAILED:
2930                 break;
2931         default:
2932                 qlcnic_schedule_work(adapter,
2933                         qlcnic_fwinit_work, FW_POLL_DELAY);
2934                 return;
2935         }
2936
2937 err_ret:
2938         dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
2939                 "fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
2940         netif_device_attach(adapter->netdev);
2941         qlcnic_clr_all_drv_state(adapter, 0);
2942 }
2943
2944 static void
2945 qlcnic_detach_work(struct work_struct *work)
2946 {
2947         struct qlcnic_adapter *adapter = container_of(work,
2948                         struct qlcnic_adapter, fw_work.work);
2949         struct net_device *netdev = adapter->netdev;
2950         u32 status;
2951
2952         netif_device_detach(netdev);
2953
2954         /* Dont grab rtnl lock during Quiscent mode */
2955         if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2956                 if (netif_running(netdev))
2957                         __qlcnic_down(adapter, netdev);
2958         } else
2959                 qlcnic_down(adapter, netdev);
2960
2961         status = QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2962
2963         if (status & QLCNIC_RCODE_FATAL_ERROR) {
2964                 dev_err(&adapter->pdev->dev,
2965                         "Detaching the device: peg halt status1=0x%x\n",
2966                                         status);
2967
2968                 if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
2969                         dev_err(&adapter->pdev->dev,
2970                         "On board active cooling fan failed. "
2971                                 "Device has been halted.\n");
2972                         dev_err(&adapter->pdev->dev,
2973                                 "Replace the adapter.\n");
2974                 }
2975
2976                 goto err_ret;
2977         }
2978
2979         if (adapter->temp == QLCNIC_TEMP_PANIC) {
2980                 dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
2981                         adapter->temp);
2982                 goto err_ret;
2983         }
2984
2985         /* Dont ack if this instance is the reset owner */
2986         if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
2987                 if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
2988                         dev_err(&adapter->pdev->dev,
2989                                 "Failed to set driver state,"
2990                                         "detaching the device.\n");
2991                         goto err_ret;
2992                 }
2993         }
2994
2995         adapter->fw_wait_cnt = 0;
2996
2997         qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
2998
2999         return;
3000
3001 err_ret:
3002         netif_device_attach(netdev);
3003         qlcnic_clr_all_drv_state(adapter, 1);
3004 }
3005
3006 /*Transit NPAR state to NON Operational */
3007 static void
3008 qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3009 {
3010         u32 state;
3011
3012         state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3013         if (state == QLCNIC_DEV_NPAR_NON_OPER)
3014                 return;
3015
3016         if (qlcnic_api_lock(adapter))
3017                 return;
3018         QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_NON_OPER);
3019         qlcnic_api_unlock(adapter);
3020 }
3021
3022 /*Transit to RESET state from READY state only */
3023 void
3024 qlcnic_dev_request_reset(struct qlcnic_adapter *adapter)
3025 {
3026         u32 state, xg_val = 0, gb_val = 0;
3027
3028         qlcnic_xg_set_xg0_mask(xg_val);
3029         qlcnic_xg_set_xg1_mask(xg_val);
3030         QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3031         qlcnic_gb_set_gb0_mask(gb_val);
3032         qlcnic_gb_set_gb1_mask(gb_val);
3033         qlcnic_gb_set_gb2_mask(gb_val);
3034         qlcnic_gb_set_gb3_mask(gb_val);
3035         QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3036         dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3037                                 " on all ports\n");
3038         adapter->need_fw_reset = 1;
3039         if (qlcnic_api_lock(adapter))
3040                 return;
3041
3042         state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
3043         if (state  == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
3044                 netdev_err(adapter->netdev,
3045                                 "Device is in FAILED state, Please Reboot\n");
3046                 qlcnic_api_unlock(adapter);
3047                 return;
3048         }
3049
3050         if (state == QLCNIC_DEV_READY) {
3051                 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_NEED_RESET);
3052                 adapter->flags |= QLCNIC_FW_RESET_OWNER;
3053                 QLCDB(adapter, DRV, "NEED_RESET state set\n");
3054                 qlcnic_idc_debug_info(adapter, 0);
3055         }
3056
3057         QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_NON_OPER);
3058         qlcnic_api_unlock(adapter);
3059 }
3060
3061 /* Transit to NPAR READY state from NPAR NOT READY state */
3062 static void
3063 qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3064 {
3065         if (qlcnic_api_lock(adapter))
3066                 return;
3067
3068         QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_OPER);
3069         QLCDB(adapter, DRV, "NPAR operational state set\n");
3070
3071         qlcnic_api_unlock(adapter);
3072 }
3073
3074 static void
3075 qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3076                 work_func_t func, int delay)
3077 {
3078         if (test_bit(__QLCNIC_AER, &adapter->state))
3079                 return;
3080
3081         INIT_DELAYED_WORK(&adapter->fw_work, func);
3082         queue_delayed_work(qlcnic_wq, &adapter->fw_work,
3083                                         round_jiffies_relative(delay));
3084 }
3085
3086 static void
3087 qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter)
3088 {
3089         while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
3090                 msleep(10);
3091
3092         if (!adapter->fw_work.work.func)
3093                 return;
3094
3095         cancel_delayed_work_sync(&adapter->fw_work);
3096 }
3097
3098 static void
3099 qlcnic_attach_work(struct work_struct *work)
3100 {
3101         struct qlcnic_adapter *adapter = container_of(work,
3102                                 struct qlcnic_adapter, fw_work.work);
3103         struct net_device *netdev = adapter->netdev;
3104         u32 npar_state;
3105
3106         if (adapter->op_mode != QLCNIC_MGMT_FUNC) {
3107                 npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3108                 if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3109                         qlcnic_clr_all_drv_state(adapter, 0);
3110                 else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3111                         qlcnic_schedule_work(adapter, qlcnic_attach_work,
3112                                                         FW_POLL_DELAY);
3113                 else
3114                         goto attach;
3115                 QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3116                 return;
3117         }
3118 attach:
3119         if (netif_running(netdev)) {
3120                 if (qlcnic_up(adapter, netdev))
3121                         goto done;
3122
3123                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3124         }
3125
3126 done:
3127         netif_device_attach(netdev);
3128         adapter->fw_fail_cnt = 0;
3129         adapter->flags &= ~QLCNIC_FW_HANG;
3130         clear_bit(__QLCNIC_RESETTING, &adapter->state);
3131
3132         if (!qlcnic_clr_drv_state(adapter))
3133                 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3134                                                         FW_POLL_DELAY);
3135 }
3136
3137 static int
3138 qlcnic_check_health(struct qlcnic_adapter *adapter)
3139 {
3140         u32 state = 0, heartbeat;
3141         u32 peg_status;
3142
3143         if (qlcnic_check_temp(adapter))
3144                 goto detach;
3145
3146         if (adapter->need_fw_reset)
3147                 qlcnic_dev_request_reset(adapter);
3148
3149         state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
3150         if (state == QLCNIC_DEV_NEED_RESET) {
3151                 qlcnic_set_npar_non_operational(adapter);
3152                 adapter->need_fw_reset = 1;
3153         } else if (state == QLCNIC_DEV_NEED_QUISCENT)
3154                 goto detach;
3155
3156         heartbeat = QLCRD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3157         if (heartbeat != adapter->heartbeat) {
3158                 adapter->heartbeat = heartbeat;
3159                 adapter->fw_fail_cnt = 0;
3160                 if (adapter->need_fw_reset)
3161                         goto detach;
3162
3163                 if (adapter->reset_context && auto_fw_reset) {
3164                         qlcnic_reset_hw_context(adapter);
3165                         adapter->netdev->trans_start = jiffies;
3166                 }
3167
3168                 return 0;
3169         }
3170
3171         if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3172                 return 0;
3173
3174         adapter->flags |= QLCNIC_FW_HANG;
3175
3176         qlcnic_dev_request_reset(adapter);
3177
3178         if (auto_fw_reset)
3179                 clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
3180
3181         dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3182         dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
3183                         "PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3184                         "PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3185                         "PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3186                         "PEG_NET_4_PC: 0x%x\n",
3187                         QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1),
3188                         QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3189                         QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c),
3190                         QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c),
3191                         QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c),
3192                         QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c),
3193                         QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c));
3194         peg_status = QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3195         if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
3196                 dev_err(&adapter->pdev->dev,
3197                         "Firmware aborted with error code 0x00006700. "
3198                                 "Device is being reset.\n");
3199 detach:
3200         adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3201                 QLCNIC_DEV_NEED_RESET;
3202
3203         if (auto_fw_reset &&
3204                 !test_and_set_bit(__QLCNIC_RESETTING, &adapter->state)) {
3205
3206                 qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
3207                 QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3208         }
3209
3210         return 1;
3211 }
3212
3213 static void
3214 qlcnic_fw_poll_work(struct work_struct *work)
3215 {
3216         struct qlcnic_adapter *adapter = container_of(work,
3217                                 struct qlcnic_adapter, fw_work.work);
3218
3219         if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3220                 goto reschedule;
3221
3222
3223         if (qlcnic_check_health(adapter))
3224                 return;
3225
3226         if (adapter->fhash.fnum)
3227                 qlcnic_prune_lb_filters(adapter);
3228
3229 reschedule:
3230         qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3231 }
3232
3233 static int qlcnic_is_first_func(struct pci_dev *pdev)
3234 {
3235         struct pci_dev *oth_pdev;
3236         int val = pdev->devfn;
3237
3238         while (val-- > 0) {
3239                 oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3240                         (pdev->bus), pdev->bus->number,
3241                         PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
3242                 if (!oth_pdev)
3243                         continue;
3244
3245                 if (oth_pdev->current_state != PCI_D3cold) {
3246                         pci_dev_put(oth_pdev);
3247                         return 0;
3248                 }
3249                 pci_dev_put(oth_pdev);
3250         }
3251         return 1;
3252 }
3253
3254 static int qlcnic_attach_func(struct pci_dev *pdev)
3255 {
3256         int err, first_func;
3257         struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3258         struct net_device *netdev = adapter->netdev;
3259
3260         pdev->error_state = pci_channel_io_normal;
3261
3262         err = pci_enable_device(pdev);
3263         if (err)
3264                 return err;
3265
3266         pci_set_power_state(pdev, PCI_D0);
3267         pci_set_master(pdev);
3268         pci_restore_state(pdev);
3269
3270         first_func = qlcnic_is_first_func(pdev);
3271
3272         if (qlcnic_api_lock(adapter))
3273                 return -EINVAL;
3274
3275         if (adapter->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
3276                 adapter->need_fw_reset = 1;
3277                 set_bit(__QLCNIC_START_FW, &adapter->state);
3278                 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_INITIALIZING);
3279                 QLCDB(adapter, DRV, "Restarting fw\n");
3280         }
3281         qlcnic_api_unlock(adapter);
3282
3283         err = adapter->nic_ops->start_firmware(adapter);
3284         if (err)
3285                 return err;
3286
3287         qlcnic_clr_drv_state(adapter);
3288         qlcnic_setup_intr(adapter);
3289
3290         if (netif_running(netdev)) {
3291                 err = qlcnic_attach(adapter);
3292                 if (err) {
3293                         qlcnic_clr_all_drv_state(adapter, 1);
3294                         clear_bit(__QLCNIC_AER, &adapter->state);
3295                         netif_device_attach(netdev);
3296                         return err;
3297                 }
3298
3299                 err = qlcnic_up(adapter, netdev);
3300                 if (err)
3301                         goto done;
3302
3303                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3304         }
3305  done:
3306         netif_device_attach(netdev);
3307         return err;
3308 }
3309
3310 static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3311                                                 pci_channel_state_t state)
3312 {
3313         struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3314         struct net_device *netdev = adapter->netdev;
3315
3316         if (state == pci_channel_io_perm_failure)
3317                 return PCI_ERS_RESULT_DISCONNECT;
3318
3319         if (state == pci_channel_io_normal)
3320                 return PCI_ERS_RESULT_RECOVERED;
3321
3322         set_bit(__QLCNIC_AER, &adapter->state);
3323         netif_device_detach(netdev);
3324
3325         cancel_delayed_work_sync(&adapter->fw_work);
3326
3327         if (netif_running(netdev))
3328                 qlcnic_down(adapter, netdev);
3329
3330         qlcnic_detach(adapter);
3331         qlcnic_teardown_intr(adapter);
3332
3333         clear_bit(__QLCNIC_RESETTING, &adapter->state);
3334
3335         pci_save_state(pdev);
3336         pci_disable_device(pdev);
3337
3338         return PCI_ERS_RESULT_NEED_RESET;
3339 }
3340
3341 static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3342 {
3343         return qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3344                                 PCI_ERS_RESULT_RECOVERED;
3345 }
3346
3347 static void qlcnic_io_resume(struct pci_dev *pdev)
3348 {
3349         struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3350
3351         pci_cleanup_aer_uncorrect_error_status(pdev);
3352
3353         if (QLCRD32(adapter, QLCNIC_CRB_DEV_STATE) == QLCNIC_DEV_READY &&
3354             test_and_clear_bit(__QLCNIC_AER, &adapter->state))
3355                 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3356                                                 FW_POLL_DELAY);
3357 }
3358
3359 static int
3360 qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
3361 {
3362         int err;
3363
3364         err = qlcnic_can_start_firmware(adapter);
3365         if (err)
3366                 return err;
3367
3368         err = qlcnic_check_npar_opertional(adapter);
3369         if (err)
3370                 return err;
3371
3372         err = qlcnic_initialize_nic(adapter);
3373         if (err)
3374                 return err;
3375
3376         qlcnic_check_options(adapter);
3377
3378         err = qlcnic_set_eswitch_port_config(adapter);
3379         if (err)
3380                 return err;
3381
3382         adapter->need_fw_reset = 0;
3383
3384         return err;
3385 }
3386
3387 static int
3388 qlcnicvf_config_bridged_mode(struct qlcnic_adapter *adapter, u32 enable)
3389 {
3390         return -EOPNOTSUPP;
3391 }
3392
3393 static int
3394 qlcnicvf_config_led(struct qlcnic_adapter *adapter, u32 state, u32 rate)
3395 {
3396         return -EOPNOTSUPP;
3397 }
3398
3399 static ssize_t
3400 qlcnic_store_bridged_mode(struct device *dev,
3401                 struct device_attribute *attr, const char *buf, size_t len)
3402 {
3403         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3404         unsigned long new;
3405         int ret = -EINVAL;
3406
3407         if (!(adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG))
3408                 goto err_out;
3409
3410         if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3411                 goto err_out;
3412
3413         if (strict_strtoul(buf, 2, &new))
3414                 goto err_out;
3415
3416         if (!adapter->nic_ops->config_bridged_mode(adapter, !!new))
3417                 ret = len;
3418
3419 err_out:
3420         return ret;
3421 }
3422
3423 static ssize_t
3424 qlcnic_show_bridged_mode(struct device *dev,
3425                 struct device_attribute *attr, char *buf)
3426 {
3427         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3428         int bridged_mode = 0;
3429
3430         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
3431                 bridged_mode = !!(adapter->flags & QLCNIC_BRIDGE_ENABLED);
3432
3433         return sprintf(buf, "%d\n", bridged_mode);
3434 }
3435
3436 static struct device_attribute dev_attr_bridged_mode = {
3437        .attr = {.name = "bridged_mode", .mode = (S_IRUGO | S_IWUSR)},
3438        .show = qlcnic_show_bridged_mode,
3439        .store = qlcnic_store_bridged_mode,
3440 };
3441
3442 static ssize_t
3443 qlcnic_store_diag_mode(struct device *dev,
3444                 struct device_attribute *attr, const char *buf, size_t len)
3445 {
3446         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3447         unsigned long new;
3448
3449         if (strict_strtoul(buf, 2, &new))
3450                 return -EINVAL;
3451
3452         if (!!new != !!(adapter->flags & QLCNIC_DIAG_ENABLED))
3453                 adapter->flags ^= QLCNIC_DIAG_ENABLED;
3454
3455         return len;
3456 }
3457
3458 static ssize_t
3459 qlcnic_show_diag_mode(struct device *dev,
3460                 struct device_attribute *attr, char *buf)
3461 {
3462         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3463
3464         return sprintf(buf, "%d\n",
3465                         !!(adapter->flags & QLCNIC_DIAG_ENABLED));
3466 }
3467
3468 static struct device_attribute dev_attr_diag_mode = {
3469         .attr = {.name = "diag_mode", .mode = (S_IRUGO | S_IWUSR)},
3470         .show = qlcnic_show_diag_mode,
3471         .store = qlcnic_store_diag_mode,
3472 };
3473
3474 int qlcnic_validate_max_rss(struct net_device *netdev, u8 max_hw, u8 val)
3475 {
3476         if (!use_msi_x && !use_msi) {
3477                 netdev_info(netdev, "no msix or msi support, hence no rss\n");
3478                 return -EINVAL;
3479         }
3480
3481         if ((val > max_hw) || (val <  2) || !is_power_of_2(val)) {
3482                 netdev_info(netdev, "rss_ring valid range [2 - %x] in "
3483                         " powers of 2\n", max_hw);
3484                 return -EINVAL;
3485         }
3486         return 0;
3487
3488 }
3489
3490 int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data)
3491 {
3492         struct net_device *netdev = adapter->netdev;
3493         int err = 0;
3494
3495         if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
3496                 return -EBUSY;
3497
3498         netif_device_detach(netdev);
3499         if (netif_running(netdev))
3500                 __qlcnic_down(adapter, netdev);
3501         qlcnic_detach(adapter);
3502         qlcnic_teardown_intr(adapter);
3503
3504         if (qlcnic_enable_msix(adapter, data)) {
3505                 netdev_info(netdev, "failed setting max_rss; rss disabled\n");
3506                 qlcnic_enable_msi_legacy(adapter);
3507         }
3508
3509         if (netif_running(netdev)) {
3510                 err = qlcnic_attach(adapter);
3511                 if (err)
3512                         goto done;
3513                 err = __qlcnic_up(adapter, netdev);
3514                 if (err)
3515                         goto done;
3516                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3517         }
3518  done:
3519         netif_device_attach(netdev);
3520         clear_bit(__QLCNIC_RESETTING, &adapter->state);
3521         return err;
3522 }
3523
3524 static int
3525 qlcnic_validate_beacon(struct qlcnic_adapter *adapter, u16 beacon, u8 *state,
3526                         u8 *rate)
3527 {
3528         *rate = LSB(beacon);
3529         *state = MSB(beacon);
3530
3531         QLCDB(adapter, DRV, "rate %x state %x\n", *rate, *state);
3532
3533         if (!*state) {
3534                 *rate = __QLCNIC_MAX_LED_RATE;
3535                 return 0;
3536         } else if (*state > __QLCNIC_MAX_LED_STATE)
3537                 return -EINVAL;
3538
3539         if ((!*rate) || (*rate > __QLCNIC_MAX_LED_RATE))
3540                 return -EINVAL;
3541
3542         return 0;
3543 }
3544
3545 static ssize_t
3546 qlcnic_store_beacon(struct device *dev,
3547                 struct device_attribute *attr, const char *buf, size_t len)
3548 {
3549         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3550         int max_sds_rings = adapter->max_sds_rings;
3551         u16 beacon;
3552         u8 b_state, b_rate;
3553         int err;
3554
3555         if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC) {
3556                 dev_warn(dev, "LED test not supported for non "
3557                                 "privilege function\n");
3558                 return -EOPNOTSUPP;
3559         }
3560
3561         if (len != sizeof(u16))
3562                 return QL_STATUS_INVALID_PARAM;
3563
3564         memcpy(&beacon, buf, sizeof(u16));
3565         err = qlcnic_validate_beacon(adapter, beacon, &b_state, &b_rate);
3566         if (err)
3567                 return err;
3568
3569         if (adapter->ahw->beacon_state == b_state)
3570                 return len;
3571
3572         rtnl_lock();
3573
3574         if (!adapter->ahw->beacon_state)
3575                 if (test_and_set_bit(__QLCNIC_LED_ENABLE, &adapter->state)) {
3576                         rtnl_unlock();
3577                         return -EBUSY;
3578                 }
3579
3580         if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
3581                 err = -EIO;
3582                 goto out;
3583         }
3584
3585         if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
3586                 err = qlcnic_diag_alloc_res(adapter->netdev, QLCNIC_LED_TEST);
3587                 if (err)
3588                         goto out;
3589                 set_bit(__QLCNIC_DIAG_RES_ALLOC, &adapter->state);
3590         }
3591
3592         err = qlcnic_config_led(adapter, b_state, b_rate);
3593
3594         if (!err) {
3595                 err = len;
3596                 adapter->ahw->beacon_state = b_state;
3597         }
3598
3599         if (test_and_clear_bit(__QLCNIC_DIAG_RES_ALLOC, &adapter->state))
3600                 qlcnic_diag_free_res(adapter->netdev, max_sds_rings);
3601
3602  out:
3603         if (!adapter->ahw->beacon_state)
3604                 clear_bit(__QLCNIC_LED_ENABLE, &adapter->state);
3605         rtnl_unlock();
3606
3607         return err;
3608 }
3609
3610 static ssize_t
3611 qlcnic_show_beacon(struct device *dev,
3612                 struct device_attribute *attr, char *buf)
3613 {
3614         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3615
3616         return sprintf(buf, "%d\n", adapter->ahw->beacon_state);
3617 }
3618
3619 static struct device_attribute dev_attr_beacon = {
3620         .attr = {.name = "beacon", .mode = (S_IRUGO | S_IWUSR)},
3621         .show = qlcnic_show_beacon,
3622         .store = qlcnic_store_beacon,
3623 };
3624
3625 static int
3626 qlcnic_sysfs_validate_crb(struct qlcnic_adapter *adapter,
3627                 loff_t offset, size_t size)
3628 {
3629         size_t crb_size = 4;
3630
3631         if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
3632                 return -EIO;
3633
3634         if (offset < QLCNIC_PCI_CRBSPACE) {
3635                 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM,
3636                                         QLCNIC_PCI_CAMQM_END))
3637                         crb_size = 8;
3638                 else
3639                         return -EINVAL;
3640         }
3641
3642         if ((size != crb_size) || (offset & (crb_size-1)))
3643                 return  -EINVAL;
3644
3645         return 0;
3646 }
3647
3648 static ssize_t
3649 qlcnic_sysfs_read_crb(struct file *filp, struct kobject *kobj,
3650                 struct bin_attribute *attr,
3651                 char *buf, loff_t offset, size_t size)
3652 {
3653         struct device *dev = container_of(kobj, struct device, kobj);
3654         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3655         u32 data;
3656         u64 qmdata;
3657         int ret;
3658
3659         ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
3660         if (ret != 0)
3661                 return ret;
3662
3663         if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
3664                 qlcnic_pci_camqm_read_2M(adapter, offset, &qmdata);
3665                 memcpy(buf, &qmdata, size);
3666         } else {
3667                 data = QLCRD32(adapter, offset);
3668                 memcpy(buf, &data, size);
3669         }
3670         return size;
3671 }
3672
3673 static ssize_t
3674 qlcnic_sysfs_write_crb(struct file *filp, struct kobject *kobj,
3675                 struct bin_attribute *attr,
3676                 char *buf, loff_t offset, size_t size)
3677 {
3678         struct device *dev = container_of(kobj, struct device, kobj);
3679         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3680         u32 data;
3681         u64 qmdata;
3682         int ret;
3683
3684         ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
3685         if (ret != 0)
3686                 return ret;
3687
3688         if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
3689                 memcpy(&qmdata, buf, size);
3690                 qlcnic_pci_camqm_write_2M(adapter, offset, qmdata);
3691         } else {
3692                 memcpy(&data, buf, size);
3693                 QLCWR32(adapter, offset, data);
3694         }
3695         return size;
3696 }
3697
3698 static int
3699 qlcnic_sysfs_validate_mem(struct qlcnic_adapter *adapter,
3700                 loff_t offset, size_t size)
3701 {
3702         if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
3703                 return -EIO;
3704
3705         if ((size != 8) || (offset & 0x7))
3706                 return  -EIO;
3707
3708         return 0;
3709 }
3710
3711 static ssize_t
3712 qlcnic_sysfs_read_mem(struct file *filp, struct kobject *kobj,
3713                 struct bin_attribute *attr,
3714                 char *buf, loff_t offset, size_t size)
3715 {
3716         struct device *dev = container_of(kobj, struct device, kobj);
3717         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3718         u64 data;
3719         int ret;
3720
3721         ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
3722         if (ret != 0)
3723                 return ret;
3724
3725         if (qlcnic_pci_mem_read_2M(adapter, offset, &data))
3726                 return -EIO;
3727
3728         memcpy(buf, &data, size);
3729
3730         return size;
3731 }
3732
3733 static ssize_t
3734 qlcnic_sysfs_write_mem(struct file *filp, struct kobject *kobj,
3735                 struct bin_attribute *attr,
3736                 char *buf, loff_t offset, size_t size)
3737 {
3738         struct device *dev = container_of(kobj, struct device, kobj);
3739         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3740         u64 data;
3741         int ret;
3742
3743         ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
3744         if (ret != 0)
3745                 return ret;
3746
3747         memcpy(&data, buf, size);
3748
3749         if (qlcnic_pci_mem_write_2M(adapter, offset, data))
3750                 return -EIO;
3751
3752         return size;
3753 }
3754
3755 static struct bin_attribute bin_attr_crb = {
3756         .attr = {.name = "crb", .mode = (S_IRUGO | S_IWUSR)},
3757         .size = 0,
3758         .read = qlcnic_sysfs_read_crb,
3759         .write = qlcnic_sysfs_write_crb,
3760 };
3761
3762 static struct bin_attribute bin_attr_mem = {
3763         .attr = {.name = "mem", .mode = (S_IRUGO | S_IWUSR)},
3764         .size = 0,
3765         .read = qlcnic_sysfs_read_mem,
3766         .write = qlcnic_sysfs_write_mem,
3767 };
3768
3769 static int
3770 validate_pm_config(struct qlcnic_adapter *adapter,
3771                         struct qlcnic_pm_func_cfg *pm_cfg, int count)
3772 {
3773
3774         u8 src_pci_func, s_esw_id, d_esw_id;
3775         u8 dest_pci_func;
3776         int i;
3777
3778         for (i = 0; i < count; i++) {
3779                 src_pci_func = pm_cfg[i].pci_func;
3780                 dest_pci_func = pm_cfg[i].dest_npar;
3781                 if (src_pci_func >= QLCNIC_MAX_PCI_FUNC
3782                                 || dest_pci_func >= QLCNIC_MAX_PCI_FUNC)
3783                         return QL_STATUS_INVALID_PARAM;
3784
3785                 if (adapter->npars[src_pci_func].type != QLCNIC_TYPE_NIC)
3786                         return QL_STATUS_INVALID_PARAM;
3787
3788                 if (adapter->npars[dest_pci_func].type != QLCNIC_TYPE_NIC)
3789                         return QL_STATUS_INVALID_PARAM;
3790
3791                 s_esw_id = adapter->npars[src_pci_func].phy_port;
3792                 d_esw_id = adapter->npars[dest_pci_func].phy_port;
3793
3794                 if (s_esw_id != d_esw_id)
3795                         return QL_STATUS_INVALID_PARAM;
3796
3797         }
3798         return 0;
3799
3800 }
3801
3802 static ssize_t
3803 qlcnic_sysfs_write_pm_config(struct file *filp, struct kobject *kobj,
3804         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3805 {
3806         struct device *dev = container_of(kobj, struct device, kobj);
3807         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3808         struct qlcnic_pm_func_cfg *pm_cfg;
3809         u32 id, action, pci_func;
3810         int count, rem, i, ret;
3811
3812         count   = size / sizeof(struct qlcnic_pm_func_cfg);
3813         rem     = size % sizeof(struct qlcnic_pm_func_cfg);
3814         if (rem)
3815                 return QL_STATUS_INVALID_PARAM;
3816
3817         pm_cfg = (struct qlcnic_pm_func_cfg *) buf;
3818
3819         ret = validate_pm_config(adapter, pm_cfg, count);
3820         if (ret)
3821                 return ret;
3822         for (i = 0; i < count; i++) {
3823                 pci_func = pm_cfg[i].pci_func;
3824                 action = !!pm_cfg[i].action;
3825                 id = adapter->npars[pci_func].phy_port;
3826                 ret = qlcnic_config_port_mirroring(adapter, id,
3827                                                 action, pci_func);
3828                 if (ret)
3829                         return ret;
3830         }
3831
3832         for (i = 0; i < count; i++) {
3833                 pci_func = pm_cfg[i].pci_func;
3834                 id = adapter->npars[pci_func].phy_port;
3835                 adapter->npars[pci_func].enable_pm = !!pm_cfg[i].action;
3836                 adapter->npars[pci_func].dest_npar = id;
3837         }
3838         return size;
3839 }
3840
3841 static ssize_t
3842 qlcnic_sysfs_read_pm_config(struct file *filp, struct kobject *kobj,
3843         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3844 {
3845         struct device *dev = container_of(kobj, struct device, kobj);
3846         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3847         struct qlcnic_pm_func_cfg pm_cfg[QLCNIC_MAX_PCI_FUNC];
3848         int i;
3849
3850         if (size != sizeof(pm_cfg))
3851                 return QL_STATUS_INVALID_PARAM;
3852
3853         for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
3854                 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
3855                         continue;
3856                 pm_cfg[i].action = adapter->npars[i].enable_pm;
3857                 pm_cfg[i].dest_npar = 0;
3858                 pm_cfg[i].pci_func = i;
3859         }
3860         memcpy(buf, &pm_cfg, size);
3861
3862         return size;
3863 }
3864
3865 static int
3866 validate_esw_config(struct qlcnic_adapter *adapter,
3867         struct qlcnic_esw_func_cfg *esw_cfg, int count)
3868 {
3869         u32 op_mode;
3870         u8 pci_func;
3871         int i;
3872
3873         op_mode = readl(adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE);
3874
3875         for (i = 0; i < count; i++) {
3876                 pci_func = esw_cfg[i].pci_func;
3877                 if (pci_func >= QLCNIC_MAX_PCI_FUNC)
3878                         return QL_STATUS_INVALID_PARAM;
3879
3880                 if (adapter->op_mode == QLCNIC_MGMT_FUNC)
3881                         if (adapter->npars[pci_func].type != QLCNIC_TYPE_NIC)
3882                                 return QL_STATUS_INVALID_PARAM;
3883
3884                 switch (esw_cfg[i].op_mode) {
3885                 case QLCNIC_PORT_DEFAULTS:
3886                         if (QLC_DEV_GET_DRV(op_mode, pci_func) !=
3887                                                 QLCNIC_NON_PRIV_FUNC) {
3888                                 if (esw_cfg[i].mac_anti_spoof != 0)
3889                                         return QL_STATUS_INVALID_PARAM;
3890                                 if (esw_cfg[i].mac_override != 1)
3891                                         return QL_STATUS_INVALID_PARAM;
3892                                 if (esw_cfg[i].promisc_mode != 1)
3893                                         return QL_STATUS_INVALID_PARAM;
3894                         }
3895                         break;
3896                 case QLCNIC_ADD_VLAN:
3897                         if (!IS_VALID_VLAN(esw_cfg[i].vlan_id))
3898                                 return QL_STATUS_INVALID_PARAM;
3899                         if (!esw_cfg[i].op_type)
3900                                 return QL_STATUS_INVALID_PARAM;
3901                         break;
3902                 case QLCNIC_DEL_VLAN:
3903                         if (!esw_cfg[i].op_type)
3904                                 return QL_STATUS_INVALID_PARAM;
3905                         break;
3906                 default:
3907                         return QL_STATUS_INVALID_PARAM;
3908                 }
3909         }
3910         return 0;
3911 }
3912
3913 static ssize_t
3914 qlcnic_sysfs_write_esw_config(struct file *file, struct kobject *kobj,
3915         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3916 {
3917         struct device *dev = container_of(kobj, struct device, kobj);
3918         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3919         struct qlcnic_esw_func_cfg *esw_cfg;
3920         struct qlcnic_npar_info *npar;
3921         int count, rem, i, ret;
3922         u8 pci_func, op_mode = 0;
3923
3924         count   = size / sizeof(struct qlcnic_esw_func_cfg);
3925         rem     = size % sizeof(struct qlcnic_esw_func_cfg);
3926         if (rem)
3927                 return QL_STATUS_INVALID_PARAM;
3928
3929         esw_cfg = (struct qlcnic_esw_func_cfg *) buf;
3930         ret = validate_esw_config(adapter, esw_cfg, count);
3931         if (ret)
3932                 return ret;
3933
3934         for (i = 0; i < count; i++) {
3935                 if (adapter->op_mode == QLCNIC_MGMT_FUNC)
3936                         if (qlcnic_config_switch_port(adapter, &esw_cfg[i]))
3937                                 return QL_STATUS_INVALID_PARAM;
3938
3939                 if (adapter->ahw->pci_func != esw_cfg[i].pci_func)
3940                         continue;
3941
3942                 op_mode = esw_cfg[i].op_mode;
3943                 qlcnic_get_eswitch_port_config(adapter, &esw_cfg[i]);
3944                 esw_cfg[i].op_mode = op_mode;
3945                 esw_cfg[i].pci_func = adapter->ahw->pci_func;
3946
3947                 switch (esw_cfg[i].op_mode) {
3948                 case QLCNIC_PORT_DEFAULTS:
3949                         qlcnic_set_eswitch_port_features(adapter, &esw_cfg[i]);
3950                         break;
3951                 case QLCNIC_ADD_VLAN:
3952                         qlcnic_set_vlan_config(adapter, &esw_cfg[i]);
3953                         break;
3954                 case QLCNIC_DEL_VLAN:
3955                         esw_cfg[i].vlan_id = 0;
3956                         qlcnic_set_vlan_config(adapter, &esw_cfg[i]);
3957                         break;
3958                 }
3959         }
3960
3961         if (adapter->op_mode != QLCNIC_MGMT_FUNC)
3962                 goto out;
3963
3964         for (i = 0; i < count; i++) {
3965                 pci_func = esw_cfg[i].pci_func;
3966                 npar = &adapter->npars[pci_func];
3967                 switch (esw_cfg[i].op_mode) {
3968                 case QLCNIC_PORT_DEFAULTS:
3969                         npar->promisc_mode = esw_cfg[i].promisc_mode;
3970                         npar->mac_override = esw_cfg[i].mac_override;
3971                         npar->offload_flags = esw_cfg[i].offload_flags;
3972                         npar->mac_anti_spoof = esw_cfg[i].mac_anti_spoof;
3973                         npar->discard_tagged = esw_cfg[i].discard_tagged;
3974                         break;
3975                 case QLCNIC_ADD_VLAN:
3976                         npar->pvid = esw_cfg[i].vlan_id;
3977                         break;
3978                 case QLCNIC_DEL_VLAN:
3979                         npar->pvid = 0;
3980                         break;
3981                 }
3982         }
3983 out:
3984         return size;
3985 }
3986
3987 static ssize_t
3988 qlcnic_sysfs_read_esw_config(struct file *file, struct kobject *kobj,
3989         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3990 {
3991         struct device *dev = container_of(kobj, struct device, kobj);
3992         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3993         struct qlcnic_esw_func_cfg esw_cfg[QLCNIC_MAX_PCI_FUNC];
3994         u8 i;
3995
3996         if (size != sizeof(esw_cfg))
3997                 return QL_STATUS_INVALID_PARAM;
3998
3999         for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
4000                 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
4001                         continue;
4002                 esw_cfg[i].pci_func = i;
4003                 if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg[i]))
4004                         return QL_STATUS_INVALID_PARAM;
4005         }
4006         memcpy(buf, &esw_cfg, size);
4007
4008         return size;
4009 }
4010
4011 static int
4012 validate_npar_config(struct qlcnic_adapter *adapter,
4013                                 struct qlcnic_npar_func_cfg *np_cfg, int count)
4014 {
4015         u8 pci_func, i;
4016
4017         for (i = 0; i < count; i++) {
4018                 pci_func = np_cfg[i].pci_func;
4019                 if (pci_func >= QLCNIC_MAX_PCI_FUNC)
4020                         return QL_STATUS_INVALID_PARAM;
4021
4022                 if (adapter->npars[pci_func].type != QLCNIC_TYPE_NIC)
4023                         return QL_STATUS_INVALID_PARAM;
4024
4025                 if (!IS_VALID_BW(np_cfg[i].min_bw) ||
4026                     !IS_VALID_BW(np_cfg[i].max_bw))
4027                         return QL_STATUS_INVALID_PARAM;
4028         }
4029         return 0;
4030 }
4031
4032 static ssize_t
4033 qlcnic_sysfs_write_npar_config(struct file *file, struct kobject *kobj,
4034         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4035 {
4036         struct device *dev = container_of(kobj, struct device, kobj);
4037         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4038         struct qlcnic_info nic_info;
4039         struct qlcnic_npar_func_cfg *np_cfg;
4040         int i, count, rem, ret;
4041         u8 pci_func;
4042
4043         count   = size / sizeof(struct qlcnic_npar_func_cfg);
4044         rem     = size % sizeof(struct qlcnic_npar_func_cfg);
4045         if (rem)
4046                 return QL_STATUS_INVALID_PARAM;
4047
4048         np_cfg = (struct qlcnic_npar_func_cfg *) buf;
4049         ret = validate_npar_config(adapter, np_cfg, count);
4050         if (ret)
4051                 return ret;
4052
4053         for (i = 0; i < count ; i++) {
4054                 pci_func = np_cfg[i].pci_func;
4055                 ret = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
4056                 if (ret)
4057                         return ret;
4058                 nic_info.pci_func = pci_func;
4059                 nic_info.min_tx_bw = np_cfg[i].min_bw;
4060                 nic_info.max_tx_bw = np_cfg[i].max_bw;
4061                 ret = qlcnic_set_nic_info(adapter, &nic_info);
4062                 if (ret)
4063                         return ret;
4064                 adapter->npars[i].min_bw = nic_info.min_tx_bw;
4065                 adapter->npars[i].max_bw = nic_info.max_tx_bw;
4066         }
4067
4068         return size;
4069
4070 }
4071 static ssize_t
4072 qlcnic_sysfs_read_npar_config(struct file *file, struct kobject *kobj,
4073         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4074 {
4075         struct device *dev = container_of(kobj, struct device, kobj);
4076         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4077         struct qlcnic_info nic_info;
4078         struct qlcnic_npar_func_cfg np_cfg[QLCNIC_MAX_PCI_FUNC];
4079         int i, ret;
4080
4081         if (size != sizeof(np_cfg))
4082                 return QL_STATUS_INVALID_PARAM;
4083
4084         for (i = 0; i < QLCNIC_MAX_PCI_FUNC ; i++) {
4085                 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
4086                         continue;
4087                 ret = qlcnic_get_nic_info(adapter, &nic_info, i);
4088                 if (ret)
4089                         return ret;
4090
4091                 np_cfg[i].pci_func = i;
4092                 np_cfg[i].op_mode = (u8)nic_info.op_mode;
4093                 np_cfg[i].port_num = nic_info.phys_port;
4094                 np_cfg[i].fw_capab = nic_info.capabilities;
4095                 np_cfg[i].min_bw = nic_info.min_tx_bw ;
4096                 np_cfg[i].max_bw = nic_info.max_tx_bw;
4097                 np_cfg[i].max_tx_queues = nic_info.max_tx_ques;
4098                 np_cfg[i].max_rx_queues = nic_info.max_rx_ques;
4099         }
4100         memcpy(buf, &np_cfg, size);
4101         return size;
4102 }
4103
4104 static ssize_t
4105 qlcnic_sysfs_get_port_stats(struct file *file, struct kobject *kobj,
4106         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4107 {
4108         struct device *dev = container_of(kobj, struct device, kobj);
4109         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4110         struct qlcnic_esw_statistics port_stats;
4111         int ret;
4112
4113         if (size != sizeof(struct qlcnic_esw_statistics))
4114                 return QL_STATUS_INVALID_PARAM;
4115
4116         if (offset >= QLCNIC_MAX_PCI_FUNC)
4117                 return QL_STATUS_INVALID_PARAM;
4118
4119         memset(&port_stats, 0, size);
4120         ret = qlcnic_get_port_stats(adapter, offset, QLCNIC_QUERY_RX_COUNTER,
4121                                                                 &port_stats.rx);
4122         if (ret)
4123                 return ret;
4124
4125         ret = qlcnic_get_port_stats(adapter, offset, QLCNIC_QUERY_TX_COUNTER,
4126                                                                 &port_stats.tx);
4127         if (ret)
4128                 return ret;
4129
4130         memcpy(buf, &port_stats, size);
4131         return size;
4132 }
4133
4134 static ssize_t
4135 qlcnic_sysfs_get_esw_stats(struct file *file, struct kobject *kobj,
4136         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4137 {
4138         struct device *dev = container_of(kobj, struct device, kobj);
4139         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4140         struct qlcnic_esw_statistics esw_stats;
4141         int ret;
4142
4143         if (size != sizeof(struct qlcnic_esw_statistics))
4144                 return QL_STATUS_INVALID_PARAM;
4145
4146         if (offset >= QLCNIC_NIU_MAX_XG_PORTS)
4147                 return QL_STATUS_INVALID_PARAM;
4148
4149         memset(&esw_stats, 0, size);
4150         ret = qlcnic_get_eswitch_stats(adapter, offset, QLCNIC_QUERY_RX_COUNTER,
4151                                                                 &esw_stats.rx);
4152         if (ret)
4153                 return ret;
4154
4155         ret = qlcnic_get_eswitch_stats(adapter, offset, QLCNIC_QUERY_TX_COUNTER,
4156                                                                 &esw_stats.tx);
4157         if (ret)
4158                 return ret;
4159
4160         memcpy(buf, &esw_stats, size);
4161         return size;
4162 }
4163
4164 static ssize_t
4165 qlcnic_sysfs_clear_esw_stats(struct file *file, struct kobject *kobj,
4166         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4167 {
4168         struct device *dev = container_of(kobj, struct device, kobj);
4169         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4170         int ret;
4171
4172         if (offset >= QLCNIC_NIU_MAX_XG_PORTS)
4173                 return QL_STATUS_INVALID_PARAM;
4174
4175         ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_ESWITCH, offset,
4176                                                 QLCNIC_QUERY_RX_COUNTER);
4177         if (ret)
4178                 return ret;
4179
4180         ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_ESWITCH, offset,
4181                                                 QLCNIC_QUERY_TX_COUNTER);
4182         if (ret)
4183                 return ret;
4184
4185         return size;
4186 }
4187
4188 static ssize_t
4189 qlcnic_sysfs_clear_port_stats(struct file *file, struct kobject *kobj,
4190         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4191 {
4192
4193         struct device *dev = container_of(kobj, struct device, kobj);
4194         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4195         int ret;
4196
4197         if (offset >= QLCNIC_MAX_PCI_FUNC)
4198                 return QL_STATUS_INVALID_PARAM;
4199
4200         ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_PORT, offset,
4201                                                 QLCNIC_QUERY_RX_COUNTER);
4202         if (ret)
4203                 return ret;
4204
4205         ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_PORT, offset,
4206                                                 QLCNIC_QUERY_TX_COUNTER);
4207         if (ret)
4208                 return ret;
4209
4210         return size;
4211 }
4212
4213 static ssize_t
4214 qlcnic_sysfs_read_pci_config(struct file *file, struct kobject *kobj,
4215         struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4216 {
4217         struct device *dev = container_of(kobj, struct device, kobj);
4218         struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4219         struct qlcnic_pci_func_cfg pci_cfg[QLCNIC_MAX_PCI_FUNC];
4220         struct qlcnic_pci_info *pci_info;
4221         int i, ret;
4222
4223         if (size != sizeof(pci_cfg))
4224                 return QL_STATUS_INVALID_PARAM;
4225
4226         pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
4227         if (!pci_info)
4228                 return -ENOMEM;
4229
4230         ret = qlcnic_get_pci_info(adapter, pci_info);
4231         if (ret) {
4232                 kfree(pci_info);
4233                 return ret;
4234         }
4235
4236         for (i = 0; i < QLCNIC_MAX_PCI_FUNC ; i++) {
4237                 pci_cfg[i].pci_func = pci_info[i].id;
4238                 pci_cfg[i].func_type = pci_info[i].type;
4239                 pci_cfg[i].port_num = pci_info[i].default_port;
4240                 pci_cfg[i].min_bw = pci_info[i].tx_min_bw;
4241                 pci_cfg[i].max_bw = pci_info[i].tx_max_bw;
4242                 memcpy(&pci_cfg[i].def_mac_addr, &pci_info[i].mac, ETH_ALEN);
4243         }
4244         memcpy(buf, &pci_cfg, size);
4245         kfree(pci_info);
4246         return size;
4247 }
4248 static struct bin_attribute bin_attr_npar_config = {
4249         .attr = {.name = "npar_config", .mode = (S_IRUGO | S_IWUSR)},
4250         .size = 0,
4251         .read = qlcnic_sysfs_read_npar_config,
4252         .write = qlcnic_sysfs_write_npar_config,
4253 };
4254
4255 static struct bin_attribute bin_attr_pci_config = {
4256         .attr = {.name = "pci_config", .mode = (S_IRUGO | S_IWUSR)},
4257         .size = 0,
4258         .read = qlcnic_sysfs_read_pci_config,
4259         .write = NULL,
4260 };
4261
4262 static struct bin_attribute bin_attr_port_stats = {
4263         .attr = {.name = "port_stats", .mode = (S_IRUGO | S_IWUSR)},
4264         .size = 0,
4265         .read = qlcnic_sysfs_get_port_stats,
4266         .write = qlcnic_sysfs_clear_port_stats,
4267 };
4268
4269 static struct bin_attribute bin_attr_esw_stats = {
4270         .attr = {.name = "esw_stats", .mode = (S_IRUGO | S_IWUSR)},
4271         .size = 0,
4272         .read = qlcnic_sysfs_get_esw_stats,
4273         .write = qlcnic_sysfs_clear_esw_stats,
4274 };
4275
4276 static struct bin_attribute bin_attr_esw_config = {
4277         .attr = {.name = "esw_config", .mode = (S_IRUGO | S_IWUSR)},
4278         .size = 0,
4279         .read = qlcnic_sysfs_read_esw_config,
4280         .write = qlcnic_sysfs_write_esw_config,
4281 };
4282
4283 static struct bin_attribute bin_attr_pm_config = {
4284         .attr = {.name = "pm_config", .mode = (S_IRUGO | S_IWUSR)},
4285         .size = 0,
4286         .read = qlcnic_sysfs_read_pm_config,
4287         .write = qlcnic_sysfs_write_pm_config,
4288 };
4289
4290 static void
4291 qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter)
4292 {
4293         struct device *dev = &adapter->pdev->dev;
4294
4295         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
4296                 if (device_create_file(dev, &dev_attr_bridged_mode))
4297                         dev_warn(dev,
4298                                 "failed to create bridged_mode sysfs entry\n");
4299 }
4300
4301 static void
4302 qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter)
4303 {
4304         struct device *dev = &adapter->pdev->dev;
4305
4306         if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
4307                 device_remove_file(dev, &dev_attr_bridged_mode);
4308 }
4309
4310 static void
4311 qlcnic_create_diag_entries(struct qlcnic_adapter *adapter)
4312 {
4313         struct device *dev = &adapter->pdev->dev;
4314         u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
4315
4316         if (device_create_bin_file(dev, &bin_attr_port_stats))
4317                 dev_info(dev, "failed to create port stats sysfs entry");
4318
4319         if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC)
4320                 return;
4321         if (device_create_file(dev, &dev_attr_diag_mode))
4322                 dev_info(dev, "failed to create diag_mode sysfs entry\n");
4323         if (device_create_bin_file(dev, &bin_attr_crb))
4324                 dev_info(dev, "failed to create crb sysfs entry\n");
4325         if (device_create_bin_file(dev, &bin_attr_mem))
4326                 dev_info(dev, "failed to create mem sysfs entry\n");
4327
4328         if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD))
4329                 return;
4330
4331         if (device_create_bin_file(dev, &bin_attr_pci_config))
4332                 dev_info(dev, "failed to create pci config sysfs entry");
4333         if (device_create_file(dev, &dev_attr_beacon))
4334                 dev_info(dev, "failed to create beacon sysfs entry");
4335
4336         if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
4337                 return;
4338         if (device_create_bin_file(dev, &bin_attr_esw_config))
4339                 dev_info(dev, "failed to create esw config sysfs entry");
4340         if (adapter->op_mode != QLCNIC_MGMT_FUNC)
4341                 return;
4342         if (device_create_bin_file(dev, &bin_attr_npar_config))
4343                 dev_info(dev, "failed to create npar config sysfs entry");
4344         if (device_create_bin_file(dev, &bin_attr_pm_config))
4345                 dev_info(dev, "failed to create pm config sysfs entry");
4346         if (device_create_bin_file(dev, &bin_attr_esw_stats))
4347                 dev_info(dev, "failed to create eswitch stats sysfs entry");
4348 }
4349
4350 static void
4351 qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter)
4352 {
4353         struct device *dev = &adapter->pdev->dev;
4354         u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
4355
4356         device_remove_bin_file(dev, &bin_attr_port_stats);
4357
4358         if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC)
4359                 return;
4360         device_remove_file(dev, &dev_attr_diag_mode);
4361         device_remove_bin_file(dev, &bin_attr_crb);
4362         device_remove_bin_file(dev, &bin_attr_mem);
4363         if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD))
4364                 return;
4365         device_remove_bin_file(dev, &bin_attr_pci_config);
4366         device_remove_file(dev, &dev_attr_beacon);
4367         if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
4368                 return;
4369         device_remove_bin_file(dev, &bin_attr_esw_config);
4370         if (adapter->op_mode != QLCNIC_MGMT_FUNC)
4371                 return;
4372         device_remove_bin_file(dev, &bin_attr_npar_config);
4373         device_remove_bin_file(dev, &bin_attr_pm_config);
4374         device_remove_bin_file(dev, &bin_attr_esw_stats);
4375 }
4376
4377 #ifdef CONFIG_INET
4378
4379 #define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4380
4381 static void
4382 qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4383                         struct net_device *dev, unsigned long event)
4384 {
4385         struct in_device *indev;
4386
4387         indev = in_dev_get(dev);
4388         if (!indev)
4389                 return;
4390
4391         for_ifa(indev) {
4392                 switch (event) {
4393                 case NETDEV_UP:
4394                         qlcnic_config_ipaddr(adapter,
4395                                         ifa->ifa_address, QLCNIC_IP_UP);
4396                         break;
4397                 case NETDEV_DOWN:
4398                         qlcnic_config_ipaddr(adapter,
4399                                         ifa->ifa_address, QLCNIC_IP_DOWN);
4400                         break;
4401                 default:
4402                         break;
4403                 }
4404         } endfor_ifa(indev);
4405
4406         in_dev_put(indev);
4407 }
4408
4409 static void
4410 qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4411 {
4412         struct qlcnic_adapter *adapter = netdev_priv(netdev);
4413         struct net_device *dev;
4414         u16 vid;
4415
4416         qlcnic_config_indev_addr(adapter, netdev, event);
4417
4418         for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
4419                 dev = __vlan_find_dev_deep(netdev, vid);
4420                 if (!dev)
4421                         continue;
4422                 qlcnic_config_indev_addr(adapter, dev, event);
4423         }
4424 }
4425
4426 static int qlcnic_netdev_event(struct notifier_block *this,
4427                                  unsigned long event, void *ptr)
4428 {
4429         struct qlcnic_adapter *adapter;
4430         struct net_device *dev = (struct net_device *)ptr;
4431
4432 recheck:
4433         if (dev == NULL)
4434                 goto done;
4435
4436         if (dev->priv_flags & IFF_802_1Q_VLAN) {
4437                 dev = vlan_dev_real_dev(dev);
4438                 goto recheck;
4439         }
4440
4441         if (!is_qlcnic_netdev(dev))
4442                 goto done;
4443
4444         adapter = netdev_priv(dev);
4445
4446         if (!adapter)
4447                 goto done;
4448
4449         if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4450                 goto done;
4451
4452         qlcnic_config_indev_addr(adapter, dev, event);
4453 done:
4454         return NOTIFY_DONE;
4455 }
4456
4457 static int
4458 qlcnic_inetaddr_event(struct notifier_block *this,
4459                 unsigned long event, void *ptr)
4460 {
4461         struct qlcnic_adapter *adapter;
4462         struct net_device *dev;
4463
4464         struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4465
4466         dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
4467
4468 recheck:
4469         if (dev == NULL)
4470                 goto done;
4471
4472         if (dev->priv_flags & IFF_802_1Q_VLAN) {
4473                 dev = vlan_dev_real_dev(dev);
4474                 goto recheck;
4475         }
4476
4477         if (!is_qlcnic_netdev(dev))
4478                 goto done;
4479
4480         adapter = netdev_priv(dev);
4481
4482         if (!adapter)
4483                 goto done;
4484
4485         if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4486                 goto done;
4487
4488         switch (event) {
4489         case NETDEV_UP:
4490                 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4491                 break;
4492         case NETDEV_DOWN:
4493                 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4494                 break;
4495         default:
4496                 break;
4497         }
4498
4499 done:
4500         return NOTIFY_DONE;
4501 }
4502
4503 static struct notifier_block    qlcnic_netdev_cb = {
4504         .notifier_call = qlcnic_netdev_event,
4505 };
4506
4507 static struct notifier_block qlcnic_inetaddr_cb = {
4508         .notifier_call = qlcnic_inetaddr_event,
4509 };
4510 #else
4511 static void
4512 qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
4513 { }
4514 #endif
4515 static struct pci_error_handlers qlcnic_err_handler = {
4516         .error_detected = qlcnic_io_error_detected,
4517         .slot_reset = qlcnic_io_slot_reset,
4518         .resume = qlcnic_io_resume,
4519 };
4520
4521 static struct pci_driver qlcnic_driver = {
4522         .name = qlcnic_driver_name,
4523         .id_table = qlcnic_pci_tbl,
4524         .probe = qlcnic_probe,
4525         .remove = __devexit_p(qlcnic_remove),
4526 #ifdef CONFIG_PM
4527         .suspend = qlcnic_suspend,
4528         .resume = qlcnic_resume,
4529 #endif
4530         .shutdown = qlcnic_shutdown,
4531         .err_handler = &qlcnic_err_handler
4532
4533 };
4534
4535 static int __init qlcnic_init_module(void)
4536 {
4537         int ret;
4538
4539         printk(KERN_INFO "%s\n", qlcnic_driver_string);
4540
4541         qlcnic_wq = create_singlethread_workqueue("qlcnic");
4542         if (qlcnic_wq == NULL) {
4543                 printk(KERN_ERR "qlcnic: cannot create workqueue\n");
4544                 return -ENOMEM;
4545         }
4546
4547 #ifdef CONFIG_INET
4548         register_netdevice_notifier(&qlcnic_netdev_cb);
4549         register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4550 #endif
4551
4552         ret = pci_register_driver(&qlcnic_driver);
4553         if (ret) {
4554 #ifdef CONFIG_INET
4555                 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4556                 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4557 #endif
4558                 destroy_workqueue(qlcnic_wq);
4559         }
4560
4561         return ret;
4562 }
4563
4564 module_init(qlcnic_init_module);
4565
4566 static void __exit qlcnic_exit_module(void)
4567 {
4568
4569         pci_unregister_driver(&qlcnic_driver);
4570
4571 #ifdef CONFIG_INET
4572         unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4573         unregister_netdevice_notifier(&qlcnic_netdev_cb);
4574 #endif
4575         destroy_workqueue(qlcnic_wq);
4576 }
4577
4578 module_exit(qlcnic_exit_module);