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