sys/dev/qlxgbe/ql_os.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   3  *
   4  * Copyright (c) 2013-2016 Qlogic Corporation
   5  * All rights reserved.
   6  *
   7  *  Redistribution and use in source and binary forms, with or without
   8  *  modification, are permitted provided that the following conditions
   9  *  are met:
  10  *
  11  *  1. Redistributions of source code must retain the above copyright
  12  *     notice, this list of conditions and the following disclaimer.
  13  *  2. Redistributions in binary form must reproduce the above copyright
  14  *     notice, this list of conditions and the following disclaimer in the
  15  *     documentation and/or other materials provided with the distribution.
  16  *
  17  *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  18  *  and ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  *  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  21  *  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  22  *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  23  *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  24  *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  25  *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  26  *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  27  *  POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 /*
  31  * File: ql_os.c
  32  * Author : David C Somayajulu, Qlogic Corporation, Aliso Viejo, CA 92656.
  33  */
  34
  35 #include <sys/cdefs.h>
  36 __FBSDID("$FreeBSD$");
  37
  38
  39 #include "ql_os.h"
  40 #include "ql_hw.h"
  41 #include "ql_def.h"
  42 #include "ql_inline.h"
  43 #include "ql_ver.h"
  44 #include "ql_glbl.h"
  45 #include "ql_dbg.h"
  46 #include <sys/smp.h>
  47
  48 /*
  49  * Some PCI Configuration Space Related Defines
  50  */
  51
  52 #ifndef PCI_VENDOR_QLOGIC
  53 #define PCI_VENDOR_QLOGIC       0x1077
  54 #endif
  55
  56 #ifndef PCI_PRODUCT_QLOGIC_ISP8030
  57 #define PCI_PRODUCT_QLOGIC_ISP8030      0x8030
  58 #endif
  59
  60 #define PCI_QLOGIC_ISP8030 \
  61         ((PCI_PRODUCT_QLOGIC_ISP8030 << 16) | PCI_VENDOR_QLOGIC)
  62
  63 /*
  64  * static functions
  65  */
  66 static int qla_alloc_parent_dma_tag(qla_host_t *ha);
  67 static void qla_free_parent_dma_tag(qla_host_t *ha);
  68 static int qla_alloc_xmt_bufs(qla_host_t *ha);
  69 static void qla_free_xmt_bufs(qla_host_t *ha);
  70 static int qla_alloc_rcv_bufs(qla_host_t *ha);
  71 static void qla_free_rcv_bufs(qla_host_t *ha);
  72 static void qla_clear_tx_buf(qla_host_t *ha, qla_tx_buf_t *txb);
  73
  74 static void qla_init_ifnet(device_t dev, qla_host_t *ha);
  75 static int qla_sysctl_get_link_status(SYSCTL_HANDLER_ARGS);
  76 static void qla_release(qla_host_t *ha);
  77 static void qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs,
  78                 int error);
  79 static void qla_stop(qla_host_t *ha);
  80 static void qla_get_peer(qla_host_t *ha);
  81 static void qla_error_recovery(void *context, int pending);
  82 static void qla_async_event(void *context, int pending);
  83 static void qla_stats(void *context, int pending);
  84 static int qla_send(qla_host_t *ha, struct mbuf **m_headp, uint32_t txr_idx,
  85                 uint32_t iscsi_pdu);
  86
  87 /*
  88  * Hooks to the Operating Systems
  89  */
  90 static int qla_pci_probe (device_t);
  91 static int qla_pci_attach (device_t);
  92 static int qla_pci_detach (device_t);
  93
  94 static void qla_init(void *arg);
  95 static int qla_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
  96 static int qla_media_change(struct ifnet *ifp);
  97 static void qla_media_status(struct ifnet *ifp, struct ifmediareq *ifmr);
  98
  99 static int qla_transmit(struct ifnet *ifp, struct mbuf  *mp);
 100 static void qla_qflush(struct ifnet *ifp);
 101 static int qla_alloc_tx_br(qla_host_t *ha, qla_tx_fp_t *tx_fp);
 102 static void qla_free_tx_br(qla_host_t *ha, qla_tx_fp_t *tx_fp);
 103 static int qla_create_fp_taskqueues(qla_host_t *ha);
 104 static void qla_destroy_fp_taskqueues(qla_host_t *ha);
 105 static void qla_drain_fp_taskqueues(qla_host_t *ha);
 106
 107 static device_method_t qla_pci_methods[] = {
 108         /* Device interface */
 109         DEVMETHOD(device_probe, qla_pci_probe),
 110         DEVMETHOD(device_attach, qla_pci_attach),
 111         DEVMETHOD(device_detach, qla_pci_detach),
 112         { 0, 0 }
 113 };
 114
 115 static driver_t qla_pci_driver = {
 116         "ql", qla_pci_methods, sizeof (qla_host_t),
 117 };
 118
 119 static devclass_t qla83xx_devclass;
 120
 121 DRIVER_MODULE(qla83xx, pci, qla_pci_driver, qla83xx_devclass, 0, 0);
 122
 123 MODULE_DEPEND(qla83xx, pci, 1, 1, 1);
 124 MODULE_DEPEND(qla83xx, ether, 1, 1, 1);
 125
 126 MALLOC_DEFINE(M_QLA83XXBUF, "qla83xxbuf", "Buffers for qla83xx driver");
 127
 128 #define QL_STD_REPLENISH_THRES          0
 129 #define QL_JUMBO_REPLENISH_THRES        32
 130
 131
 132 static char dev_str[64];
 133 static char ver_str[64];
 134
 135 /*
 136  * Name:        qla_pci_probe
 137  * Function:    Validate the PCI device to be a QLA80XX device
 138  */
 139 static int
 140 qla_pci_probe(device_t dev)
 141 {
 142         switch ((pci_get_device(dev) << 16) | (pci_get_vendor(dev))) {
 143         case PCI_QLOGIC_ISP8030:
 144                 snprintf(dev_str, sizeof(dev_str), "%s v%d.%d.%d",
 145                         "Qlogic ISP 83xx PCI CNA Adapter-Ethernet Function",
 146                         QLA_VERSION_MAJOR, QLA_VERSION_MINOR,
 147                         QLA_VERSION_BUILD);
 148                 snprintf(ver_str, sizeof(ver_str), "v%d.%d.%d",
 149                         QLA_VERSION_MAJOR, QLA_VERSION_MINOR,
 150                         QLA_VERSION_BUILD);
 151                 device_set_desc(dev, dev_str);
 152                 break;
 153         default:
 154                 return (ENXIO);
 155         }
 156
 157         if (bootverbose)
 158                 printf("%s: %s\n ", __func__, dev_str);
 159
 160         return (BUS_PROBE_DEFAULT);
 161 }
 162
 163 static void
 164 qla_add_sysctls(qla_host_t *ha)
 165 {
 166         device_t dev = ha->pci_dev;
 167
 168         SYSCTL_ADD_STRING(device_get_sysctl_ctx(dev),
 169                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 170                 OID_AUTO, "version", CTLFLAG_RD,
 171                 ver_str, 0, "Driver Version");
 172
 173         SYSCTL_ADD_STRING(device_get_sysctl_ctx(dev),
 174                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 175                 OID_AUTO, "fw_version", CTLFLAG_RD,
 176                 ha->fw_ver_str, 0, "firmware version");
 177
 178         SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
 179                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 180                 OID_AUTO, "link_status", CTLTYPE_INT | CTLFLAG_RW,
 181                 (void *)ha, 0,
 182                 qla_sysctl_get_link_status, "I", "Link Status");
 183
 184         ha->dbg_level = 0;
 185         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 186                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 187                 OID_AUTO, "debug", CTLFLAG_RW,
 188                 &ha->dbg_level, ha->dbg_level, "Debug Level");
 189
 190         ha->enable_minidump = 1;
 191         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 192                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 193                 OID_AUTO, "enable_minidump", CTLFLAG_RW,
 194                 &ha->enable_minidump, ha->enable_minidump,
 195                 "Minidump retrival prior to error recovery "
 196                 "is enabled only when this is set");
 197
 198         ha->enable_driverstate_dump = 1;
 199         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 200                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 201                 OID_AUTO, "enable_driverstate_dump", CTLFLAG_RW,
 202                 &ha->enable_driverstate_dump, ha->enable_driverstate_dump,
 203                 "Driver State retrival prior to error recovery "
 204                 "is enabled only when this is set");
 205
 206         ha->enable_error_recovery = 1;
 207         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 208                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 209                 OID_AUTO, "enable_error_recovery", CTLFLAG_RW,
 210                 &ha->enable_error_recovery, ha->enable_error_recovery,
 211                 "when set error recovery is enabled on fatal errors "
 212                 "otherwise the port is turned offline");
 213
 214         ha->ms_delay_after_init = 1000;
 215         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 216                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 217                 OID_AUTO, "ms_delay_after_init", CTLFLAG_RW,
 218                 &ha->ms_delay_after_init, ha->ms_delay_after_init,
 219                 "millisecond delay after hw_init");
 220
 221         ha->std_replenish = QL_STD_REPLENISH_THRES;
 222         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 223                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 224                 OID_AUTO, "std_replenish", CTLFLAG_RW,
 225                 &ha->std_replenish, ha->std_replenish,
 226                 "Threshold for Replenishing Standard Frames");
 227
 228         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 229                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 230                 OID_AUTO, "ipv4_lro",
 231                 CTLFLAG_RD, &ha->ipv4_lro,
 232                 "number of ipv4 lro completions");
 233
 234         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 235                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 236                 OID_AUTO, "ipv6_lro",
 237                 CTLFLAG_RD, &ha->ipv6_lro,
 238                 "number of ipv6 lro completions");
 239
 240         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 241                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 242                 OID_AUTO, "tx_tso_frames",
 243                 CTLFLAG_RD, &ha->tx_tso_frames,
 244                 "number of Tx TSO Frames");
 245
 246         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 247                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 248                 OID_AUTO, "hw_vlan_tx_frames",
 249                 CTLFLAG_RD, &ha->hw_vlan_tx_frames,
 250                 "number of Tx VLAN Frames");
 251
 252         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 253                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 254                 OID_AUTO, "hw_lock_failed",
 255                 CTLFLAG_RD, &ha->hw_lock_failed,
 256                 "number of hw_lock failures");
 257
 258         return;
 259 }
 260
 261 static void
 262 qla_watchdog(void *arg)
 263 {
 264         qla_host_t *ha = arg;
 265         qla_hw_t *hw;
 266         struct ifnet *ifp;
 267
 268         hw = &ha->hw;
 269         ifp = ha->ifp;
 270
 271         if (ha->qla_watchdog_exit) {
 272                 ha->qla_watchdog_exited = 1;
 273                 return;
 274         }
 275         ha->qla_watchdog_exited = 0;
 276
 277         if (!ha->qla_watchdog_pause) {
 278                 if (!ha->offline &&
 279                         (ql_hw_check_health(ha) || ha->qla_initiate_recovery ||
 280                         (ha->msg_from_peer == QL_PEER_MSG_RESET))) {
 281
 282                         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 283                         ql_update_link_state(ha);
 284
 285                         if (ha->enable_error_recovery) {
 286                                 ha->qla_watchdog_paused = 1;
 287                                 ha->qla_watchdog_pause = 1;
 288                                 ha->err_inject = 0;
 289                                 device_printf(ha->pci_dev,
 290                                         "%s: taskqueue_enqueue(err_task) \n",
 291                                         __func__);
 292                                 taskqueue_enqueue(ha->err_tq, &ha->err_task);
 293                         } else {
 294                                 if (ifp != NULL)
 295                                         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 296                                 ha->offline = 1;
 297                         }
 298                         return;
 299
 300                 } else {
 301                         if (ha->qla_interface_up) {
 302
 303                                 ha->watchdog_ticks++;
 304
 305                                 if (ha->watchdog_ticks > 1000)
 306                                         ha->watchdog_ticks = 0;
 307
 308                                 if (!ha->watchdog_ticks && QL_RUNNING(ifp)) {
 309                                         taskqueue_enqueue(ha->stats_tq,
 310                                                 &ha->stats_task);
 311                                 }
 312
 313                                 if (ha->async_event) {
 314                                         taskqueue_enqueue(ha->async_event_tq,
 315                                                 &ha->async_event_task);
 316                                 }
 317
 318                         }
 319                         ha->qla_watchdog_paused = 0;
 320                 }
 321         } else {
 322                 ha->qla_watchdog_paused = 1;
 323         }
 324
 325         callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
 326                 qla_watchdog, ha);
 327 }
 328
 329 /*
 330  * Name:        qla_pci_attach
 331  * Function:    attaches the device to the operating system
 332  */
 333 static int
 334 qla_pci_attach(device_t dev)
 335 {
 336         qla_host_t *ha = NULL;
 337         uint32_t rsrc_len;
 338         int i;
 339         uint32_t num_rcvq = 0;
 340
 341         if ((ha = device_get_softc(dev)) == NULL) {
 342                 device_printf(dev, "cannot get softc\n");
 343                 return (ENOMEM);
 344         }
 345
 346         memset(ha, 0, sizeof (qla_host_t));
 347
 348         if (pci_get_device(dev) != PCI_PRODUCT_QLOGIC_ISP8030) {
 349                 device_printf(dev, "device is not ISP8030\n");
 350                 return (ENXIO);
 351         }
 352
 353         ha->pci_func = pci_get_function(dev) & 0x1;
 354
 355         ha->pci_dev = dev;
 356
 357         pci_enable_busmaster(dev);
 358
 359         ha->reg_rid = PCIR_BAR(0);
 360         ha->pci_reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &ha->reg_rid,
 361                                 RF_ACTIVE);
 362
 363         if (ha->pci_reg == NULL) {
 364                 device_printf(dev, "unable to map any ports\n");
 365                 goto qla_pci_attach_err;
 366         }
 367
 368         rsrc_len = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
 369                                         ha->reg_rid);
 370
 371         mtx_init(&ha->hw_lock, "qla83xx_hw_lock", MTX_NETWORK_LOCK, MTX_DEF);
 372         mtx_init(&ha->sp_log_lock, "qla83xx_sp_log_lock", MTX_NETWORK_LOCK, MTX_DEF);
 373         ha->flags.lock_init = 1;
 374
 375         qla_add_sysctls(ha);
 376
 377         ha->hw.num_sds_rings = MAX_SDS_RINGS;
 378         ha->hw.num_rds_rings = MAX_RDS_RINGS;
 379         ha->hw.num_tx_rings = NUM_TX_RINGS;
 380
 381         ha->reg_rid1 = PCIR_BAR(2);
 382         ha->pci_reg1 = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
 383                         &ha->reg_rid1, RF_ACTIVE);
 384
 385         ha->msix_count = pci_msix_count(dev);
 386
 387         if (ha->msix_count < 1 ) {
 388                 device_printf(dev, "%s: msix_count[%d] not enough\n", __func__,
 389                         ha->msix_count);
 390                 goto qla_pci_attach_err;
 391         }
 392
 393         if (ha->msix_count < (ha->hw.num_sds_rings + 1)) {
 394                 ha->hw.num_sds_rings = ha->msix_count - 1;
 395         }
 396
 397         QL_DPRINT2(ha, (dev, "%s: ha %p pci_func 0x%x rsrc_count 0x%08x"
 398                 " msix_count 0x%x pci_reg %p pci_reg1 %p\n", __func__, ha,
 399                 ha->pci_func, rsrc_len, ha->msix_count, ha->pci_reg,
 400                 ha->pci_reg1));
 401
 402         /* initialize hardware */
 403         if (ql_init_hw(ha)) {
 404                 device_printf(dev, "%s: ql_init_hw failed\n", __func__);
 405                 goto qla_pci_attach_err;
 406         }
 407
 408         device_printf(dev, "%s: firmware[%d.%d.%d.%d]\n", __func__,
 409                 ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
 410                 ha->fw_ver_build);
 411         snprintf(ha->fw_ver_str, sizeof(ha->fw_ver_str), "%d.%d.%d.%d",
 412                         ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
 413                         ha->fw_ver_build);
 414
 415         if (qla_get_nic_partition(ha, NULL, &num_rcvq)) {
 416                 device_printf(dev, "%s: qla_get_nic_partition failed\n",
 417                         __func__);
 418                 goto qla_pci_attach_err;
 419         }
 420         device_printf(dev, "%s: ha %p pci_func 0x%x rsrc_count 0x%08x"
 421                 " msix_count 0x%x pci_reg %p pci_reg1 %p num_rcvq = %d\n",
 422                 __func__, ha, ha->pci_func, rsrc_len, ha->msix_count,
 423                 ha->pci_reg, ha->pci_reg1, num_rcvq);
 424
 425         if ((ha->msix_count  < 64) || (num_rcvq != 32)) {
 426                 if (ha->hw.num_sds_rings > 15) {
 427                         ha->hw.num_sds_rings = 15;
 428                 }
 429         }
 430
 431         ha->hw.num_rds_rings = ha->hw.num_sds_rings;
 432         ha->hw.num_tx_rings = ha->hw.num_sds_rings;
 433
 434 #ifdef QL_ENABLE_ISCSI_TLV
 435         ha->hw.num_tx_rings = ha->hw.num_sds_rings * 2;
 436 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
 437
 438         ql_hw_add_sysctls(ha);
 439
 440         ha->msix_count = ha->hw.num_sds_rings + 1;
 441
 442         if (pci_alloc_msix(dev, &ha->msix_count)) {
 443                 device_printf(dev, "%s: pci_alloc_msi[%d] failed\n", __func__,
 444                         ha->msix_count);
 445                 ha->msix_count = 0;
 446                 goto qla_pci_attach_err;
 447         }
 448
 449         ha->mbx_irq_rid = 1;
 450         ha->mbx_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
 451                                 &ha->mbx_irq_rid,
 452                                 (RF_ACTIVE | RF_SHAREABLE));
 453         if (ha->mbx_irq == NULL) {
 454                 device_printf(dev, "could not allocate mbx interrupt\n");
 455                 goto qla_pci_attach_err;
 456         }
 457         if (bus_setup_intr(dev, ha->mbx_irq, (INTR_TYPE_NET | INTR_MPSAFE),
 458                 NULL, ql_mbx_isr, ha, &ha->mbx_handle)) {
 459                 device_printf(dev, "could not setup mbx interrupt\n");
 460                 goto qla_pci_attach_err;
 461         }
 462
 463         for (i = 0; i < ha->hw.num_sds_rings; i++) {
 464                 ha->irq_vec[i].sds_idx = i;
 465                 ha->irq_vec[i].ha = ha;
 466                 ha->irq_vec[i].irq_rid = 2 + i;
 467
 468                 ha->irq_vec[i].irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
 469                                 &ha->irq_vec[i].irq_rid,
 470                                 (RF_ACTIVE | RF_SHAREABLE));
 471
 472                 if (ha->irq_vec[i].irq == NULL) {
 473                         device_printf(dev, "could not allocate interrupt\n");
 474                         goto qla_pci_attach_err;
 475                 }
 476                 if (bus_setup_intr(dev, ha->irq_vec[i].irq,
 477                         (INTR_TYPE_NET | INTR_MPSAFE),
 478                         NULL, ql_isr, &ha->irq_vec[i],
 479                         &ha->irq_vec[i].handle)) {
 480                         device_printf(dev, "could not setup interrupt\n");
 481                         goto qla_pci_attach_err;
 482                 }
 483
 484                 ha->tx_fp[i].ha = ha;
 485                 ha->tx_fp[i].txr_idx = i;
 486
 487                 if (qla_alloc_tx_br(ha, &ha->tx_fp[i])) {
 488                         device_printf(dev, "%s: could not allocate tx_br[%d]\n",
 489                                 __func__, i);
 490                         goto qla_pci_attach_err;
 491                 }
 492         }
 493
 494         if (qla_create_fp_taskqueues(ha) != 0)
 495                 goto qla_pci_attach_err;
 496
 497         printf("%s: mp__ncpus %d sds %d rds %d msi-x %d\n", __func__, mp_ncpus,
 498                 ha->hw.num_sds_rings, ha->hw.num_rds_rings, ha->msix_count);
 499
 500         ql_read_mac_addr(ha);
 501
 502         /* allocate parent dma tag */
 503         if (qla_alloc_parent_dma_tag(ha)) {
 504                 device_printf(dev, "%s: qla_alloc_parent_dma_tag failed\n",
 505                         __func__);
 506                 goto qla_pci_attach_err;
 507         }
 508
 509         /* alloc all dma buffers */
 510         if (ql_alloc_dma(ha)) {
 511                 device_printf(dev, "%s: ql_alloc_dma failed\n", __func__);
 512                 goto qla_pci_attach_err;
 513         }
 514         qla_get_peer(ha);
 515
 516         if (ql_minidump_init(ha) != 0) {
 517                 device_printf(dev, "%s: ql_minidump_init failed\n", __func__);
 518                 goto qla_pci_attach_err;
 519         }
 520         ql_alloc_drvr_state_buffer(ha);
 521         ql_alloc_sp_log_buffer(ha);
 522         /* create the o.s ethernet interface */
 523         qla_init_ifnet(dev, ha);
 524
 525         ha->flags.qla_watchdog_active = 1;
 526         ha->qla_watchdog_pause = 0;
 527
 528         callout_init(&ha->tx_callout, TRUE);
 529         ha->flags.qla_callout_init = 1;
 530
 531         /* create ioctl device interface */
 532         if (ql_make_cdev(ha)) {
 533                 device_printf(dev, "%s: ql_make_cdev failed\n", __func__);
 534                 goto qla_pci_attach_err;
 535         }
 536
 537         callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
 538                 qla_watchdog, ha);
 539
 540         TASK_INIT(&ha->err_task, 0, qla_error_recovery, ha);
 541         ha->err_tq = taskqueue_create("qla_errq", M_NOWAIT,
 542                         taskqueue_thread_enqueue, &ha->err_tq);
 543         taskqueue_start_threads(&ha->err_tq, 1, PI_NET, "%s errq",
 544                 device_get_nameunit(ha->pci_dev));
 545
 546         TASK_INIT(&ha->async_event_task, 0, qla_async_event, ha);
 547         ha->async_event_tq = taskqueue_create("qla_asyncq", M_NOWAIT,
 548                         taskqueue_thread_enqueue, &ha->async_event_tq);
 549         taskqueue_start_threads(&ha->async_event_tq, 1, PI_NET, "%s asyncq",
 550                 device_get_nameunit(ha->pci_dev));
 551
 552         TASK_INIT(&ha->stats_task, 0, qla_stats, ha);
 553         ha->stats_tq = taskqueue_create("qla_statsq", M_NOWAIT,
 554                         taskqueue_thread_enqueue, &ha->stats_tq);
 555         taskqueue_start_threads(&ha->stats_tq, 1, PI_NET, "%s taskq",
 556                 device_get_nameunit(ha->pci_dev));
 557
 558         QL_DPRINT2(ha, (dev, "%s: exit 0\n", __func__));
 559         return (0);
 560
 561 qla_pci_attach_err:
 562
 563         qla_release(ha);
 564
 565         if (ha->flags.lock_init) {
 566                 mtx_destroy(&ha->hw_lock);
 567                 mtx_destroy(&ha->sp_log_lock);
 568         }
 569
 570         QL_DPRINT2(ha, (dev, "%s: exit ENXIO\n", __func__));
 571         return (ENXIO);
 572 }
 573
 574 /*
 575  * Name:        qla_pci_detach
 576  * Function:    Unhooks the device from the operating system
 577  */
 578 static int
 579 qla_pci_detach(device_t dev)
 580 {
 581         qla_host_t *ha = NULL;
 582         struct ifnet *ifp;
 583
 584
 585         if ((ha = device_get_softc(dev)) == NULL) {
 586                 device_printf(dev, "cannot get softc\n");
 587                 return (ENOMEM);
 588         }
 589
 590         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 591
 592         ifp = ha->ifp;
 593
 594         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 595         QLA_LOCK(ha, __func__, -1, 0);
 596
 597         ha->qla_detach_active = 1;
 598         qla_stop(ha);
 599
 600         qla_release(ha);
 601
 602         QLA_UNLOCK(ha, __func__);
 603
 604         if (ha->flags.lock_init) {
 605                 mtx_destroy(&ha->hw_lock);
 606                 mtx_destroy(&ha->sp_log_lock);
 607         }
 608
 609         QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
 610
 611         return (0);
 612 }
 613
 614 /*
 615  * SYSCTL Related Callbacks
 616  */
 617 static int
 618 qla_sysctl_get_link_status(SYSCTL_HANDLER_ARGS)
 619 {
 620         int err, ret = 0;
 621         qla_host_t *ha;
 622
 623         err = sysctl_handle_int(oidp, &ret, 0, req);
 624
 625         if (err || !req->newptr)
 626                 return (err);
 627
 628         if (ret == 1) {
 629                 ha = (qla_host_t *)arg1;
 630                 ql_hw_link_status(ha);
 631         }
 632         return (err);
 633 }
 634
 635 /*
 636  * Name:        qla_release
 637  * Function:    Releases the resources allocated for the device
 638  */
 639 static void
 640 qla_release(qla_host_t *ha)
 641 {
 642         device_t dev;
 643         int i;
 644
 645         dev = ha->pci_dev;
 646
 647         if (ha->async_event_tq) {
 648                 taskqueue_drain_all(ha->async_event_tq);
 649                 taskqueue_free(ha->async_event_tq);
 650         }
 651
 652         if (ha->err_tq) {
 653                 taskqueue_drain_all(ha->err_tq);
 654                 taskqueue_free(ha->err_tq);
 655         }
 656
 657         if (ha->stats_tq) {
 658                 taskqueue_drain_all(ha->stats_tq);
 659                 taskqueue_free(ha->stats_tq);
 660         }
 661
 662         ql_del_cdev(ha);
 663
 664         if (ha->flags.qla_watchdog_active) {
 665                 ha->qla_watchdog_exit = 1;
 666
 667                 while (ha->qla_watchdog_exited == 0)
 668                         qla_mdelay(__func__, 1);
 669         }
 670
 671         if (ha->flags.qla_callout_init)
 672                 callout_stop(&ha->tx_callout);
 673
 674         if (ha->ifp != NULL)
 675                 ether_ifdetach(ha->ifp);
 676
 677         ql_free_drvr_state_buffer(ha);
 678         ql_free_sp_log_buffer(ha);
 679         ql_free_dma(ha);
 680         qla_free_parent_dma_tag(ha);
 681
 682         if (ha->mbx_handle)
 683                 (void)bus_teardown_intr(dev, ha->mbx_irq, ha->mbx_handle);
 684
 685         if (ha->mbx_irq)
 686                 (void) bus_release_resource(dev, SYS_RES_IRQ, ha->mbx_irq_rid,
 687                                 ha->mbx_irq);
 688
 689         for (i = 0; i < ha->hw.num_sds_rings; i++) {
 690
 691                 if (ha->irq_vec[i].handle) {
 692                         (void)bus_teardown_intr(dev, ha->irq_vec[i].irq,
 693                                         ha->irq_vec[i].handle);
 694                 }
 695
 696                 if (ha->irq_vec[i].irq) {
 697                         (void)bus_release_resource(dev, SYS_RES_IRQ,
 698                                 ha->irq_vec[i].irq_rid,
 699                                 ha->irq_vec[i].irq);
 700                 }
 701
 702                 qla_free_tx_br(ha, &ha->tx_fp[i]);
 703         }
 704         qla_destroy_fp_taskqueues(ha);
 705
 706         if (ha->msix_count)
 707                 pci_release_msi(dev);
 708
 709         if (ha->pci_reg)
 710                 (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid,
 711                                 ha->pci_reg);
 712
 713         if (ha->pci_reg1)
 714                 (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid1,
 715                                 ha->pci_reg1);
 716
 717         return;
 718 }
 719
 720 /*
 721  * DMA Related Functions
 722  */
 723
 724 static void
 725 qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
 726 {
 727         *((bus_addr_t *)arg) = 0;
 728
 729         if (error) {
 730                 printf("%s: bus_dmamap_load failed (%d)\n", __func__, error);
 731                 return;
 732         }
 733
 734         *((bus_addr_t *)arg) = segs[0].ds_addr;
 735
 736         return;
 737 }
 738
 739 int
 740 ql_alloc_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
 741 {
 742         int             ret = 0;
 743         device_t        dev;
 744         bus_addr_t      b_addr;
 745
 746         dev = ha->pci_dev;
 747
 748         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 749
 750         ret = bus_dma_tag_create(
 751                         ha->parent_tag,/* parent */
 752                         dma_buf->alignment,
 753                         ((bus_size_t)(1ULL << 32)),/* boundary */
 754                         BUS_SPACE_MAXADDR,      /* lowaddr */
 755                         BUS_SPACE_MAXADDR,      /* highaddr */
 756                         NULL, NULL,             /* filter, filterarg */
 757                         dma_buf->size,          /* maxsize */
 758                         1,                      /* nsegments */
 759                         dma_buf->size,          /* maxsegsize */
 760                         0,                      /* flags */
 761                         NULL, NULL,             /* lockfunc, lockarg */
 762                         &dma_buf->dma_tag);
 763
 764         if (ret) {
 765                 device_printf(dev, "%s: could not create dma tag\n", __func__);
 766                 goto ql_alloc_dmabuf_exit;
 767         }
 768         ret = bus_dmamem_alloc(dma_buf->dma_tag,
 769                         (void **)&dma_buf->dma_b,
 770                         (BUS_DMA_ZERO | BUS_DMA_COHERENT | BUS_DMA_NOWAIT),
 771                         &dma_buf->dma_map);
 772         if (ret) {
 773                 bus_dma_tag_destroy(dma_buf->dma_tag);
 774                 device_printf(dev, "%s: bus_dmamem_alloc failed\n", __func__);
 775                 goto ql_alloc_dmabuf_exit;
 776         }
 777
 778         ret = bus_dmamap_load(dma_buf->dma_tag,
 779                         dma_buf->dma_map,
 780                         dma_buf->dma_b,
 781                         dma_buf->size,
 782                         qla_dmamap_callback,
 783                         &b_addr, BUS_DMA_NOWAIT);
 784
 785         if (ret || !b_addr) {
 786                 bus_dma_tag_destroy(dma_buf->dma_tag);
 787                 bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b,
 788                         dma_buf->dma_map);
 789                 ret = -1;
 790                 goto ql_alloc_dmabuf_exit;
 791         }
 792
 793         dma_buf->dma_addr = b_addr;
 794
 795 ql_alloc_dmabuf_exit:
 796         QL_DPRINT2(ha, (dev, "%s: exit ret 0x%08x tag %p map %p b %p sz 0x%x\n",
 797                 __func__, ret, (void *)dma_buf->dma_tag,
 798                 (void *)dma_buf->dma_map, (void *)dma_buf->dma_b,
 799                 dma_buf->size));
 800
 801         return ret;
 802 }
 803
 804 void
 805 ql_free_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
 806 {
 807         bus_dmamap_unload(dma_buf->dma_tag, dma_buf->dma_map);
 808         bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b, dma_buf->dma_map);
 809         bus_dma_tag_destroy(dma_buf->dma_tag);
 810 }
 811
 812 static int
 813 qla_alloc_parent_dma_tag(qla_host_t *ha)
 814 {
 815         int             ret;
 816         device_t        dev;
 817
 818         dev = ha->pci_dev;
 819
 820         /*
 821          * Allocate parent DMA Tag
 822          */
 823         ret = bus_dma_tag_create(
 824                         bus_get_dma_tag(dev),   /* parent */
 825                         1,((bus_size_t)(1ULL << 32)),/* alignment, boundary */
 826                         BUS_SPACE_MAXADDR,      /* lowaddr */
 827                         BUS_SPACE_MAXADDR,      /* highaddr */
 828                         NULL, NULL,             /* filter, filterarg */
 829                         BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
 830                         0,                      /* nsegments */
 831                         BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
 832                         0,                      /* flags */
 833                         NULL, NULL,             /* lockfunc, lockarg */
 834                         &ha->parent_tag);
 835
 836         if (ret) {
 837                 device_printf(dev, "%s: could not create parent dma tag\n",
 838                         __func__);
 839                 return (-1);
 840         }
 841
 842         ha->flags.parent_tag = 1;
 843
 844         return (0);
 845 }
 846
 847 static void
 848 qla_free_parent_dma_tag(qla_host_t *ha)
 849 {
 850         if (ha->flags.parent_tag) {
 851                 bus_dma_tag_destroy(ha->parent_tag);
 852                 ha->flags.parent_tag = 0;
 853         }
 854 }
 855
 856 /*
 857  * Name: qla_init_ifnet
 858  * Function: Creates the Network Device Interface and Registers it with the O.S
 859  */
 860
 861 static void
 862 qla_init_ifnet(device_t dev, qla_host_t *ha)
 863 {
 864         struct ifnet *ifp;
 865
 866         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 867
 868         ifp = ha->ifp = if_alloc(IFT_ETHER);
 869
 870         if (ifp == NULL)
 871                 panic("%s: cannot if_alloc()\n", device_get_nameunit(dev));
 872
 873         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
 874
 875         ifp->if_baudrate = IF_Gbps(10);
 876         ifp->if_capabilities = IFCAP_LINKSTATE;
 877         ifp->if_mtu = ETHERMTU;
 878
 879         ifp->if_init = qla_init;
 880         ifp->if_softc = ha;
 881         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
 882         ifp->if_ioctl = qla_ioctl;
 883
 884         ifp->if_transmit = qla_transmit;
 885         ifp->if_qflush = qla_qflush;
 886
 887         IFQ_SET_MAXLEN(&ifp->if_snd, qla_get_ifq_snd_maxlen(ha));
 888         ifp->if_snd.ifq_drv_maxlen = qla_get_ifq_snd_maxlen(ha);
 889         IFQ_SET_READY(&ifp->if_snd);
 890
 891         ha->max_frame_size = ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
 892
 893         ether_ifattach(ifp, qla_get_mac_addr(ha));
 894
 895         ifp->if_capabilities |= IFCAP_HWCSUM |
 896                                 IFCAP_TSO4 |
 897                                 IFCAP_TSO6 |
 898                                 IFCAP_JUMBO_MTU |
 899                                 IFCAP_VLAN_HWTAGGING |
 900                                 IFCAP_VLAN_MTU |
 901                                 IFCAP_VLAN_HWTSO |
 902                                 IFCAP_LRO;
 903
 904         ifp->if_capenable = ifp->if_capabilities;
 905
 906         ifp->if_hdrlen = sizeof(struct ether_vlan_header);
 907
 908         ifmedia_init(&ha->media, IFM_IMASK, qla_media_change, qla_media_status);
 909
 910         ifmedia_add(&ha->media, (IFM_ETHER | qla_get_optics(ha) | IFM_FDX), 0,
 911                 NULL);
 912         ifmedia_add(&ha->media, (IFM_ETHER | IFM_AUTO), 0, NULL);
 913
 914         ifmedia_set(&ha->media, (IFM_ETHER | IFM_AUTO));
 915
 916         QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
 917
 918         return;
 919 }
 920
 921 static void
 922 qla_init_locked(qla_host_t *ha)
 923 {
 924         struct ifnet *ifp = ha->ifp;
 925
 926         ql_sp_log(ha, 14, 0, 0, 0, 0, 0, 0);
 927
 928         qla_stop(ha);
 929
 930         if (qla_alloc_xmt_bufs(ha) != 0)
 931                 return;
 932
 933         qla_confirm_9kb_enable(ha);
 934
 935         if (qla_alloc_rcv_bufs(ha) != 0)
 936                 return;
 937
 938         bcopy(IF_LLADDR(ha->ifp), ha->hw.mac_addr, ETHER_ADDR_LEN);
 939
 940         ifp->if_hwassist = CSUM_TCP | CSUM_UDP | CSUM_TSO;
 941         ifp->if_hwassist |= CSUM_TCP_IPV6 | CSUM_UDP_IPV6;
 942
 943         ha->stop_rcv = 0;
 944         if (ql_init_hw_if(ha) == 0) {
 945                 ifp = ha->ifp;
 946                 ifp->if_drv_flags |= IFF_DRV_RUNNING;
 947                 ha->hw_vlan_tx_frames = 0;
 948                 ha->tx_tso_frames = 0;
 949                 ha->qla_interface_up = 1;
 950                 ql_update_link_state(ha);
 951         } else {
 952                 if (ha->hw.sp_log_stop_events & Q8_SP_LOG_STOP_IF_START_FAILURE)
 953                         ha->hw.sp_log_stop = -1;
 954         }
 955
 956         ha->qla_watchdog_pause = 0;
 957
 958         return;
 959 }
 960
 961 static void
 962 qla_init(void *arg)
 963 {
 964         qla_host_t *ha;
 965
 966         ha = (qla_host_t *)arg;
 967
 968         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
 969
 970         if (QLA_LOCK(ha, __func__, -1, 0) != 0)
 971                 return;
 972
 973         qla_init_locked(ha);
 974
 975         QLA_UNLOCK(ha, __func__);
 976
 977         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
 978 }
 979
 980 static int
 981 qla_set_multi(qla_host_t *ha, uint32_t add_multi)
 982 {
 983         uint8_t mta[Q8_MAX_NUM_MULTICAST_ADDRS * Q8_MAC_ADDR_LEN];
 984         struct ifmultiaddr *ifma;
 985         int mcnt = 0;
 986         struct ifnet *ifp = ha->ifp;
 987         int ret = 0;
 988
 989         if_maddr_rlock(ifp);
 990
 991         CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
 992
 993                 if (ifma->ifma_addr->sa_family != AF_LINK)
 994                         continue;
 995
 996                 if (mcnt == Q8_MAX_NUM_MULTICAST_ADDRS)
 997                         break;
 998
 999                 bcopy(LLADDR((struct sockaddr_dl *) ifma->ifma_addr),
1000                         &mta[mcnt * Q8_MAC_ADDR_LEN], Q8_MAC_ADDR_LEN);
1001
1002                 mcnt++;
1003         }
1004
1005         if_maddr_runlock(ifp);
1006
1007         if (QLA_LOCK(ha, __func__, QLA_LOCK_DEFAULT_MS_TIMEOUT,
1008                 QLA_LOCK_NO_SLEEP) != 0)
1009                 return (-1);
1010
1011         ql_sp_log(ha, 12, 4, ifp->if_drv_flags,
1012                 (ifp->if_drv_flags & IFF_DRV_RUNNING),
1013                 add_multi, (uint32_t)mcnt, 0);
1014
1015         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1016
1017                 if (!add_multi) {
1018                         ret = qla_hw_del_all_mcast(ha);
1019
1020                         if (ret)
1021                                 device_printf(ha->pci_dev,
1022                                         "%s: qla_hw_del_all_mcast() failed\n",
1023                                 __func__);
1024                 }
1025
1026                 if (!ret)
1027                         ret = ql_hw_set_multi(ha, mta, mcnt, 1);
1028
1029         }
1030
1031         QLA_UNLOCK(ha, __func__);
1032
1033         return (ret);
1034 }
1035
1036 static int
1037 qla_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1038 {
1039         int ret = 0;
1040         struct ifreq *ifr = (struct ifreq *)data;
1041         struct ifaddr *ifa = (struct ifaddr *)data;
1042         qla_host_t *ha;
1043
1044         ha = (qla_host_t *)ifp->if_softc;
1045         if (ha->offline || ha->qla_initiate_recovery)
1046                 return (ret);
1047
1048         switch (cmd) {
1049         case SIOCSIFADDR:
1050                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFADDR (0x%lx)\n",
1051                         __func__, cmd));
1052
1053                 if (ifa->ifa_addr->sa_family == AF_INET) {
1054
1055                         ret = QLA_LOCK(ha, __func__,
1056                                         QLA_LOCK_DEFAULT_MS_TIMEOUT,
1057                                         QLA_LOCK_NO_SLEEP);
1058                         if (ret)
1059                                 break;
1060
1061                         ifp->if_flags |= IFF_UP;
1062
1063                         ql_sp_log(ha, 8, 3, ifp->if_drv_flags,
1064                                 (ifp->if_drv_flags & IFF_DRV_RUNNING),
1065                                 ntohl(IA_SIN(ifa)->sin_addr.s_addr), 0, 0);
1066
1067                         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1068                                 qla_init_locked(ha);
1069                         }
1070
1071                         QLA_UNLOCK(ha, __func__);
1072                         QL_DPRINT4(ha, (ha->pci_dev,
1073                                 "%s: SIOCSIFADDR (0x%lx) ipv4 [0x%08x]\n",
1074                                 __func__, cmd,
1075                                 ntohl(IA_SIN(ifa)->sin_addr.s_addr)));
1076
1077                         arp_ifinit(ifp, ifa);
1078                 } else {
1079                         ether_ioctl(ifp, cmd, data);
1080                 }
1081                 break;
1082
1083         case SIOCSIFMTU:
1084                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFMTU (0x%lx)\n",
1085                         __func__, cmd));
1086
1087                 if (ifr->ifr_mtu > QLA_MAX_MTU) {
1088                         ret = EINVAL;
1089                 } else {
1090                         ret = QLA_LOCK(ha, __func__, QLA_LOCK_DEFAULT_MS_TIMEOUT,
1091                                         QLA_LOCK_NO_SLEEP);
1092
1093                         if (ret)
1094                                 break;
1095
1096                         ifp->if_mtu = ifr->ifr_mtu;
1097                         ha->max_frame_size =
1098                                 ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
1099
1100                         ql_sp_log(ha, 9, 4, ifp->if_drv_flags,
1101                                 (ifp->if_drv_flags & IFF_DRV_RUNNING),
1102                                 ha->max_frame_size, ifp->if_mtu, 0);
1103
1104                         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1105                                 qla_init_locked(ha);
1106                         }
1107
1108                         if (ifp->if_mtu > ETHERMTU)
1109                                 ha->std_replenish = QL_JUMBO_REPLENISH_THRES;
1110                         else
1111                                 ha->std_replenish = QL_STD_REPLENISH_THRES;
1112
1113
1114                         QLA_UNLOCK(ha, __func__);
1115                 }
1116
1117                 break;
1118
1119         case SIOCSIFFLAGS:
1120                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFFLAGS (0x%lx)\n",
1121                         __func__, cmd));
1122
1123                 ret = QLA_LOCK(ha, __func__, QLA_LOCK_DEFAULT_MS_TIMEOUT,
1124                                 QLA_LOCK_NO_SLEEP);
1125
1126                 if (ret)
1127                         break;
1128
1129                 ql_sp_log(ha, 10, 4, ifp->if_drv_flags,
1130                         (ifp->if_drv_flags & IFF_DRV_RUNNING),
1131                         ha->if_flags, ifp->if_flags, 0);
1132
1133                 if (ifp->if_flags & IFF_UP) {
1134
1135                         ha->max_frame_size = ifp->if_mtu +
1136                                         ETHER_HDR_LEN + ETHER_CRC_LEN;
1137                         qla_init_locked(ha);
1138
1139                         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1140                                 if ((ifp->if_flags ^ ha->if_flags) &
1141                                         IFF_PROMISC) {
1142                                         ret = ql_set_promisc(ha);
1143                                 } else if ((ifp->if_flags ^ ha->if_flags) &
1144                                         IFF_ALLMULTI) {
1145                                         ret = ql_set_allmulti(ha);
1146                                 }
1147                         }
1148                 } else {
1149                         if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1150                                 qla_stop(ha);
1151                         ha->if_flags = ifp->if_flags;
1152                 }
1153
1154                 QLA_UNLOCK(ha, __func__);
1155                 break;
1156
1157         case SIOCADDMULTI:
1158                 QL_DPRINT4(ha, (ha->pci_dev,
1159                         "%s: %s (0x%lx)\n", __func__, "SIOCADDMULTI", cmd));
1160
1161                 if (qla_set_multi(ha, 1))
1162                         ret = EINVAL;
1163                 break;
1164
1165         case SIOCDELMULTI:
1166                 QL_DPRINT4(ha, (ha->pci_dev,
1167                         "%s: %s (0x%lx)\n", __func__, "SIOCDELMULTI", cmd));
1168
1169                 if (qla_set_multi(ha, 0))
1170                         ret = EINVAL;
1171                 break;
1172
1173         case SIOCSIFMEDIA:
1174         case SIOCGIFMEDIA:
1175                 QL_DPRINT4(ha, (ha->pci_dev,
1176                         "%s: SIOCSIFMEDIA/SIOCGIFMEDIA (0x%lx)\n",
1177                         __func__, cmd));
1178                 ret = ifmedia_ioctl(ifp, ifr, &ha->media, cmd);
1179                 break;
1180
1181         case SIOCSIFCAP:
1182         {
1183                 int mask = ifr->ifr_reqcap ^ ifp->if_capenable;
1184
1185                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFCAP (0x%lx)\n",
1186                         __func__, cmd));
1187
1188                 if (mask & IFCAP_HWCSUM)
1189                         ifp->if_capenable ^= IFCAP_HWCSUM;
1190                 if (mask & IFCAP_TSO4)
1191                         ifp->if_capenable ^= IFCAP_TSO4;
1192                 if (mask & IFCAP_TSO6)
1193                         ifp->if_capenable ^= IFCAP_TSO6;
1194                 if (mask & IFCAP_VLAN_HWTAGGING)
1195                         ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING;
1196                 if (mask & IFCAP_VLAN_HWTSO)
1197                         ifp->if_capenable ^= IFCAP_VLAN_HWTSO;
1198                 if (mask & IFCAP_LRO)
1199                         ifp->if_capenable ^= IFCAP_LRO;
1200
1201                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1202                         ret = QLA_LOCK(ha, __func__, QLA_LOCK_DEFAULT_MS_TIMEOUT,
1203                                 QLA_LOCK_NO_SLEEP);
1204
1205                         if (ret)
1206                                 break;
1207
1208                         ql_sp_log(ha, 11, 4, ifp->if_drv_flags,
1209                                 (ifp->if_drv_flags & IFF_DRV_RUNNING),
1210                                 mask, ifp->if_capenable, 0);
1211
1212                         qla_init_locked(ha);
1213
1214                         QLA_UNLOCK(ha, __func__);
1215
1216                 }
1217                 VLAN_CAPABILITIES(ifp);
1218                 break;
1219         }
1220
1221         default:
1222                 QL_DPRINT4(ha, (ha->pci_dev, "%s: default (0x%lx)\n",
1223                         __func__, cmd));
1224                 ret = ether_ioctl(ifp, cmd, data);
1225                 break;
1226         }
1227
1228         return (ret);
1229 }
1230
1231 static int
1232 qla_media_change(struct ifnet *ifp)
1233 {
1234         qla_host_t *ha;
1235         struct ifmedia *ifm;
1236         int ret = 0;
1237
1238         ha = (qla_host_t *)ifp->if_softc;
1239
1240         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1241
1242         ifm = &ha->media;
1243
1244         if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
1245                 ret = EINVAL;
1246
1247         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1248
1249         return (ret);
1250 }
1251
1252 static void
1253 qla_media_status(struct ifnet *ifp, struct ifmediareq *ifmr)
1254 {
1255         qla_host_t *ha;
1256
1257         ha = (qla_host_t *)ifp->if_softc;
1258
1259         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1260
1261         ifmr->ifm_status = IFM_AVALID;
1262         ifmr->ifm_active = IFM_ETHER;
1263
1264         ql_update_link_state(ha);
1265         if (ha->hw.link_up) {
1266                 ifmr->ifm_status |= IFM_ACTIVE;
1267                 ifmr->ifm_active |= (IFM_FDX | qla_get_optics(ha));
1268         }
1269
1270         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit (%s)\n", __func__,\
1271                 (ha->hw.link_up ? "link_up" : "link_down")));
1272
1273         return;
1274 }
1275
1276
1277 static int
1278 qla_send(qla_host_t *ha, struct mbuf **m_headp, uint32_t txr_idx,
1279         uint32_t iscsi_pdu)
1280 {
1281         bus_dma_segment_t       segs[QLA_MAX_SEGMENTS];
1282         bus_dmamap_t            map;
1283         int                     nsegs;
1284         int                     ret = -1;
1285         uint32_t                tx_idx;
1286         struct mbuf             *m_head = *m_headp;
1287
1288         QL_DPRINT8(ha, (ha->pci_dev, "%s: enter\n", __func__));
1289
1290         tx_idx = ha->hw.tx_cntxt[txr_idx].txr_next;
1291
1292         if ((NULL != ha->tx_ring[txr_idx].tx_buf[tx_idx].m_head) ||
1293                 (QL_ERR_INJECT(ha, INJCT_TXBUF_MBUF_NON_NULL))){
1294                 QL_ASSERT(ha, 0, ("%s [%d]: txr_idx = %d tx_idx = %d "\
1295                         "mbuf = %p\n", __func__, __LINE__, txr_idx, tx_idx,\
1296                         ha->tx_ring[txr_idx].tx_buf[tx_idx].m_head));
1297
1298                 device_printf(ha->pci_dev, "%s [%d]: txr_idx = %d tx_idx = %d "
1299                         "mbuf = %p\n", __func__, __LINE__, txr_idx, tx_idx,
1300                         ha->tx_ring[txr_idx].tx_buf[tx_idx].m_head);
1301
1302                 if (m_head)
1303                         m_freem(m_head);
1304                 *m_headp = NULL;
1305                 QL_INITIATE_RECOVERY(ha);
1306                 return (ret);
1307         }
1308
1309         map = ha->tx_ring[txr_idx].tx_buf[tx_idx].map;
1310
1311         ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head, segs, &nsegs,
1312                         BUS_DMA_NOWAIT);
1313
1314         if (ret == EFBIG) {
1315
1316                 struct mbuf *m;
1317
1318                 QL_DPRINT8(ha, (ha->pci_dev, "%s: EFBIG [%d]\n", __func__,
1319                         m_head->m_pkthdr.len));
1320
1321                 m = m_defrag(m_head, M_NOWAIT);
1322                 if (m == NULL) {
1323                         ha->err_tx_defrag++;
1324                         m_freem(m_head);
1325                         *m_headp = NULL;
1326                         device_printf(ha->pci_dev,
1327                                 "%s: m_defrag() = NULL [%d]\n",
1328                                 __func__, ret);
1329                         return (ENOBUFS);
1330                 }
1331                 m_head = m;
1332                 *m_headp = m_head;
1333
1334                 if ((ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head,
1335                                         segs, &nsegs, BUS_DMA_NOWAIT))) {
1336
1337                         ha->err_tx_dmamap_load++;
1338
1339                         device_printf(ha->pci_dev,
1340                                 "%s: bus_dmamap_load_mbuf_sg failed0[%d, %d]\n",
1341                                 __func__, ret, m_head->m_pkthdr.len);
1342
1343                         if (ret != ENOMEM) {
1344                                 m_freem(m_head);
1345                                 *m_headp = NULL;
1346                         }
1347                         return (ret);
1348                 }
1349
1350         } else if (ret) {
1351
1352                 ha->err_tx_dmamap_load++;
1353
1354                 device_printf(ha->pci_dev,
1355                         "%s: bus_dmamap_load_mbuf_sg failed1[%d, %d]\n",
1356                         __func__, ret, m_head->m_pkthdr.len);
1357
1358                 if (ret != ENOMEM) {
1359                         m_freem(m_head);
1360                         *m_headp = NULL;
1361                 }
1362                 return (ret);
1363         }
1364
1365         QL_ASSERT(ha, (nsegs != 0), ("qla_send: empty packet"));
1366
1367         bus_dmamap_sync(ha->tx_tag, map, BUS_DMASYNC_PREWRITE);
1368
1369         if (!(ret = ql_hw_send(ha, segs, nsegs, tx_idx, m_head, txr_idx,
1370                                 iscsi_pdu))) {
1371                 ha->tx_ring[txr_idx].count++;
1372                 if (iscsi_pdu)
1373                         ha->tx_ring[txr_idx].iscsi_pkt_count++;
1374                 ha->tx_ring[txr_idx].tx_buf[tx_idx].m_head = m_head;
1375         } else {
1376                 bus_dmamap_unload(ha->tx_tag, map);
1377                 if (ret == EINVAL) {
1378                         if (m_head)
1379                                 m_freem(m_head);
1380                         *m_headp = NULL;
1381                 }
1382         }
1383
1384         QL_DPRINT8(ha, (ha->pci_dev, "%s: exit\n", __func__));
1385         return (ret);
1386 }
1387
1388 static int
1389 qla_alloc_tx_br(qla_host_t *ha, qla_tx_fp_t *fp)
1390 {
1391         snprintf(fp->tx_mtx_name, sizeof(fp->tx_mtx_name),
1392                 "qla%d_fp%d_tx_mq_lock", ha->pci_func, fp->txr_idx);
1393
1394         mtx_init(&fp->tx_mtx, fp->tx_mtx_name, NULL, MTX_DEF);
1395
1396         fp->tx_br = buf_ring_alloc(NUM_TX_DESCRIPTORS, M_DEVBUF,
1397                                    M_NOWAIT, &fp->tx_mtx);
1398         if (fp->tx_br == NULL) {
1399             QL_DPRINT1(ha, (ha->pci_dev, "buf_ring_alloc failed for "
1400                 " fp[%d, %d]\n", ha->pci_func, fp->txr_idx));
1401             return (-ENOMEM);
1402         }
1403         return 0;
1404 }
1405
1406 static void
1407 qla_free_tx_br(qla_host_t *ha, qla_tx_fp_t *fp)
1408 {
1409         struct mbuf *mp;
1410         struct ifnet *ifp = ha->ifp;
1411
1412         if (mtx_initialized(&fp->tx_mtx)) {
1413
1414                 if (fp->tx_br != NULL) {
1415
1416                         mtx_lock(&fp->tx_mtx);
1417
1418                         while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
1419                                 m_freem(mp);
1420                         }
1421
1422                         mtx_unlock(&fp->tx_mtx);
1423
1424                         buf_ring_free(fp->tx_br, M_DEVBUF);
1425                         fp->tx_br = NULL;
1426                 }
1427                 mtx_destroy(&fp->tx_mtx);
1428         }
1429         return;
1430 }
1431
1432 static void
1433 qla_fp_taskqueue(void *context, int pending)
1434 {
1435         qla_tx_fp_t *fp;
1436         qla_host_t *ha;
1437         struct ifnet *ifp;
1438         struct mbuf  *mp = NULL;
1439         int ret = 0;
1440         uint32_t txr_idx;
1441         uint32_t iscsi_pdu = 0;
1442         uint32_t rx_pkts_left = -1;
1443
1444         fp = context;
1445
1446         if (fp == NULL)
1447                 return;
1448
1449         ha = (qla_host_t *)fp->ha;
1450
1451         ifp = ha->ifp;
1452
1453         txr_idx = fp->txr_idx;
1454
1455         mtx_lock(&fp->tx_mtx);
1456
1457         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING) || (!ha->hw.link_up)) {
1458                 mtx_unlock(&fp->tx_mtx);
1459                 goto qla_fp_taskqueue_exit;
1460         }
1461
1462         while (rx_pkts_left && !ha->stop_rcv &&
1463                 (ifp->if_drv_flags & IFF_DRV_RUNNING) && ha->hw.link_up) {
1464                 rx_pkts_left = ql_rcv_isr(ha, fp->txr_idx, 64);
1465
1466 #ifdef QL_ENABLE_ISCSI_TLV
1467                 ql_hw_tx_done_locked(ha, fp->txr_idx);
1468                 ql_hw_tx_done_locked(ha, (fp->txr_idx + (ha->hw.num_tx_rings >> 1)));
1469 #else
1470                 ql_hw_tx_done_locked(ha, fp->txr_idx);
1471 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
1472
1473                 mp = drbr_peek(ifp, fp->tx_br);
1474
1475                 while (mp != NULL) {
1476
1477                         if (M_HASHTYPE_GET(mp) != M_HASHTYPE_NONE) {
1478 #ifdef QL_ENABLE_ISCSI_TLV
1479                                 if (ql_iscsi_pdu(ha, mp) == 0) {
1480                                         txr_idx = txr_idx +
1481                                                 (ha->hw.num_tx_rings >> 1);
1482                                         iscsi_pdu = 1;
1483                                 } else {
1484                                         iscsi_pdu = 0;
1485                                         txr_idx = fp->txr_idx;
1486                                 }
1487 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
1488                         }
1489
1490                         ret = qla_send(ha, &mp, txr_idx, iscsi_pdu);
1491
1492                         if (ret) {
1493                                 if (mp != NULL)
1494                                         drbr_putback(ifp, fp->tx_br, mp);
1495                                 else {
1496                                         drbr_advance(ifp, fp->tx_br);
1497                                 }
1498
1499                                 mtx_unlock(&fp->tx_mtx);
1500
1501                                 goto qla_fp_taskqueue_exit0;
1502                         } else {
1503                                 drbr_advance(ifp, fp->tx_br);
1504                         }
1505
1506                         /* Send a copy of the frame to the BPF listener */
1507                         ETHER_BPF_MTAP(ifp, mp);
1508
1509                         if (((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) ||
1510                                 (!ha->hw.link_up))
1511                                 break;
1512
1513                         mp = drbr_peek(ifp, fp->tx_br);
1514                 }
1515         }
1516         mtx_unlock(&fp->tx_mtx);
1517
1518         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0)
1519                 goto qla_fp_taskqueue_exit;
1520
1521 qla_fp_taskqueue_exit0:
1522
1523         if (rx_pkts_left || ((mp != NULL) && ret)) {
1524                 taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
1525         } else {
1526                 if (!ha->stop_rcv) {
1527                         QL_ENABLE_INTERRUPTS(ha, fp->txr_idx);
1528                 }
1529         }
1530
1531 qla_fp_taskqueue_exit:
1532
1533         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
1534         return;
1535 }
1536
1537 static int
1538 qla_create_fp_taskqueues(qla_host_t *ha)
1539 {
1540         int     i;
1541         uint8_t tq_name[32];
1542
1543         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1544
1545                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1546
1547                 bzero(tq_name, sizeof (tq_name));
1548                 snprintf(tq_name, sizeof (tq_name), "ql_fp_tq_%d", i);
1549
1550                 TASK_INIT(&fp->fp_task, 0, qla_fp_taskqueue, fp);
1551
1552                 fp->fp_taskqueue = taskqueue_create_fast(tq_name, M_NOWAIT,
1553                                         taskqueue_thread_enqueue,
1554                                         &fp->fp_taskqueue);
1555
1556                 if (fp->fp_taskqueue == NULL)
1557                         return (-1);
1558
1559                 taskqueue_start_threads(&fp->fp_taskqueue, 1, PI_NET, "%s",
1560                         tq_name);
1561
1562                 QL_DPRINT1(ha, (ha->pci_dev, "%s: %p\n", __func__,
1563                         fp->fp_taskqueue));
1564         }
1565
1566         return (0);
1567 }
1568
1569 static void
1570 qla_destroy_fp_taskqueues(qla_host_t *ha)
1571 {
1572         int     i;
1573
1574         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1575
1576                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1577
1578                 if (fp->fp_taskqueue != NULL) {
1579                         taskqueue_drain_all(fp->fp_taskqueue);
1580                         taskqueue_free(fp->fp_taskqueue);
1581                         fp->fp_taskqueue = NULL;
1582                 }
1583         }
1584         return;
1585 }
1586
1587 static void
1588 qla_drain_fp_taskqueues(qla_host_t *ha)
1589 {
1590         int     i;
1591
1592         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1593                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1594
1595                 if (fp->fp_taskqueue != NULL) {
1596                         taskqueue_drain_all(fp->fp_taskqueue);
1597                 }
1598         }
1599         return;
1600 }
1601
1602 static int
1603 qla_transmit(struct ifnet *ifp, struct mbuf  *mp)
1604 {
1605         qla_host_t *ha = (qla_host_t *)ifp->if_softc;
1606         qla_tx_fp_t *fp;
1607         int rss_id = 0;
1608         int ret = 0;
1609
1610         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1611
1612 #if __FreeBSD_version >= 1100000
1613         if (M_HASHTYPE_GET(mp) != M_HASHTYPE_NONE)
1614 #else
1615         if (mp->m_flags & M_FLOWID)
1616 #endif
1617                 rss_id = (mp->m_pkthdr.flowid & Q8_RSS_IND_TBL_MAX_IDX) %
1618                                         ha->hw.num_sds_rings;
1619         fp = &ha->tx_fp[rss_id];
1620
1621         if (fp->tx_br == NULL) {
1622                 ret = EINVAL;
1623                 goto qla_transmit_exit;
1624         }
1625
1626         if (mp != NULL) {
1627                 ret = drbr_enqueue(ifp, fp->tx_br, mp);
1628         }
1629
1630         if (fp->fp_taskqueue != NULL)
1631                 taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
1632
1633         ret = 0;
1634
1635 qla_transmit_exit:
1636
1637         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
1638         return ret;
1639 }
1640
1641 static void
1642 qla_qflush(struct ifnet *ifp)
1643 {
1644         int                     i;
1645         qla_tx_fp_t             *fp;
1646         struct mbuf             *mp;
1647         qla_host_t              *ha;
1648
1649         ha = (qla_host_t *)ifp->if_softc;
1650
1651         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1652
1653         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1654
1655                 fp = &ha->tx_fp[i];
1656
1657                 if (fp == NULL)
1658                         continue;
1659
1660                 if (fp->tx_br) {
1661                         mtx_lock(&fp->tx_mtx);
1662
1663                         while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
1664                                 m_freem(mp);
1665                         }
1666                         mtx_unlock(&fp->tx_mtx);
1667                 }
1668         }
1669         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1670
1671         return;
1672 }
1673
1674 static void
1675 qla_stop(qla_host_t *ha)
1676 {
1677         struct ifnet *ifp = ha->ifp;
1678         device_t        dev;
1679         int i = 0;
1680
1681         ql_sp_log(ha, 13, 0, 0, 0, 0, 0, 0);
1682
1683         dev = ha->pci_dev;
1684
1685         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
1686         ha->qla_watchdog_pause = 1;
1687
1688         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1689                 qla_tx_fp_t *fp;
1690
1691                 fp = &ha->tx_fp[i];
1692
1693                 if (fp == NULL)
1694                         continue;
1695
1696                 if (fp->tx_br != NULL) {
1697                         mtx_lock(&fp->tx_mtx);
1698                         mtx_unlock(&fp->tx_mtx);
1699                 }
1700         }
1701
1702         while (!ha->qla_watchdog_paused)
1703                 qla_mdelay(__func__, 1);
1704
1705         ha->qla_interface_up = 0;
1706
1707         qla_drain_fp_taskqueues(ha);
1708
1709         ql_del_hw_if(ha);
1710
1711         qla_free_xmt_bufs(ha);
1712         qla_free_rcv_bufs(ha);
1713
1714         return;
1715 }
1716
1717 /*
1718  * Buffer Management Functions for Transmit and Receive Rings
1719  */
1720 static int
1721 qla_alloc_xmt_bufs(qla_host_t *ha)
1722 {
1723         int ret = 0;
1724         uint32_t i, j;
1725         qla_tx_buf_t *txb;
1726
1727         if (bus_dma_tag_create(NULL,    /* parent */
1728                 1, 0,    /* alignment, bounds */
1729                 BUS_SPACE_MAXADDR,       /* lowaddr */
1730                 BUS_SPACE_MAXADDR,       /* highaddr */
1731                 NULL, NULL,      /* filter, filterarg */
1732                 QLA_MAX_TSO_FRAME_SIZE,     /* maxsize */
1733                 QLA_MAX_SEGMENTS,        /* nsegments */
1734                 PAGE_SIZE,        /* maxsegsize */
1735                 BUS_DMA_ALLOCNOW,        /* flags */
1736                 NULL,    /* lockfunc */
1737                 NULL,    /* lockfuncarg */
1738                 &ha->tx_tag)) {
1739                 device_printf(ha->pci_dev, "%s: tx_tag alloc failed\n",
1740                         __func__);
1741                 return (ENOMEM);
1742         }
1743
1744         for (i = 0; i < ha->hw.num_tx_rings; i++) {
1745                 bzero((void *)ha->tx_ring[i].tx_buf,
1746                         (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1747         }
1748
1749         for (j = 0; j < ha->hw.num_tx_rings; j++) {
1750                 for (i = 0; i < NUM_TX_DESCRIPTORS; i++) {
1751
1752                         txb = &ha->tx_ring[j].tx_buf[i];
1753
1754                         if ((ret = bus_dmamap_create(ha->tx_tag,
1755                                         BUS_DMA_NOWAIT, &txb->map))) {
1756
1757                                 ha->err_tx_dmamap_create++;
1758                                 device_printf(ha->pci_dev,
1759                                         "%s: bus_dmamap_create failed[%d]\n",
1760                                         __func__, ret);
1761
1762                                 qla_free_xmt_bufs(ha);
1763
1764                                 return (ret);
1765                         }
1766                 }
1767         }
1768
1769         return 0;
1770 }
1771
1772 /*
1773  * Release mbuf after it sent on the wire
1774  */
1775 static void
1776 qla_clear_tx_buf(qla_host_t *ha, qla_tx_buf_t *txb)
1777 {
1778         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1779
1780         if (txb->m_head) {
1781                 bus_dmamap_sync(ha->tx_tag, txb->map,
1782                         BUS_DMASYNC_POSTWRITE);
1783
1784                 bus_dmamap_unload(ha->tx_tag, txb->map);
1785
1786                 m_freem(txb->m_head);
1787                 txb->m_head = NULL;
1788
1789                 bus_dmamap_destroy(ha->tx_tag, txb->map);
1790                 txb->map = NULL;
1791         }
1792
1793         if (txb->map) {
1794                 bus_dmamap_unload(ha->tx_tag, txb->map);
1795                 bus_dmamap_destroy(ha->tx_tag, txb->map);
1796                 txb->map = NULL;
1797         }
1798
1799         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1800 }
1801
1802 static void
1803 qla_free_xmt_bufs(qla_host_t *ha)
1804 {
1805         int             i, j;
1806
1807         for (j = 0; j < ha->hw.num_tx_rings; j++) {
1808                 for (i = 0; i < NUM_TX_DESCRIPTORS; i++)
1809                         qla_clear_tx_buf(ha, &ha->tx_ring[j].tx_buf[i]);
1810         }
1811
1812         if (ha->tx_tag != NULL) {
1813                 bus_dma_tag_destroy(ha->tx_tag);
1814                 ha->tx_tag = NULL;
1815         }
1816
1817         for (i = 0; i < ha->hw.num_tx_rings; i++) {
1818                 bzero((void *)ha->tx_ring[i].tx_buf,
1819                         (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1820         }
1821         return;
1822 }
1823
1824
1825 static int
1826 qla_alloc_rcv_std(qla_host_t *ha)
1827 {
1828         int             i, j, k, r, ret = 0;
1829         qla_rx_buf_t    *rxb;
1830         qla_rx_ring_t   *rx_ring;
1831
1832         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1833
1834                 rx_ring = &ha->rx_ring[r];
1835
1836                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1837
1838                         rxb = &rx_ring->rx_buf[i];
1839
1840                         ret = bus_dmamap_create(ha->rx_tag, BUS_DMA_NOWAIT,
1841                                         &rxb->map);
1842
1843                         if (ret) {
1844                                 device_printf(ha->pci_dev,
1845                                         "%s: dmamap[%d, %d] failed\n",
1846                                         __func__, r, i);
1847
1848                                 for (k = 0; k < r; k++) {
1849                                         for (j = 0; j < NUM_RX_DESCRIPTORS;
1850                                                 j++) {
1851                                                 rxb = &ha->rx_ring[k].rx_buf[j];
1852                                                 bus_dmamap_destroy(ha->rx_tag,
1853                                                         rxb->map);
1854                                         }
1855                                 }
1856
1857                                 for (j = 0; j < i; j++) {
1858                                         bus_dmamap_destroy(ha->rx_tag,
1859                                                 rx_ring->rx_buf[j].map);
1860                                 }
1861                                 goto qla_alloc_rcv_std_err;
1862                         }
1863                 }
1864         }
1865
1866         qla_init_hw_rcv_descriptors(ha);
1867
1868
1869         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1870
1871                 rx_ring = &ha->rx_ring[r];
1872
1873                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1874                         rxb = &rx_ring->rx_buf[i];
1875                         rxb->handle = i;
1876                         if (!(ret = ql_get_mbuf(ha, rxb, NULL))) {
1877                                 /*
1878                                  * set the physical address in the
1879                                  * corresponding descriptor entry in the
1880                                  * receive ring/queue for the hba
1881                                  */
1882                                 qla_set_hw_rcv_desc(ha, r, i, rxb->handle,
1883                                         rxb->paddr,
1884                                         (rxb->m_head)->m_pkthdr.len);
1885                         } else {
1886                                 device_printf(ha->pci_dev,
1887                                         "%s: ql_get_mbuf [%d, %d] failed\n",
1888                                         __func__, r, i);
1889                                 bus_dmamap_destroy(ha->rx_tag, rxb->map);
1890                                 goto qla_alloc_rcv_std_err;
1891                         }
1892                 }
1893         }
1894         return 0;
1895
1896 qla_alloc_rcv_std_err:
1897         return (-1);
1898 }
1899
1900 static void
1901 qla_free_rcv_std(qla_host_t *ha)
1902 {
1903         int             i, r;
1904         qla_rx_buf_t    *rxb;
1905
1906         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1907                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1908                         rxb = &ha->rx_ring[r].rx_buf[i];
1909                         if (rxb->m_head != NULL) {
1910                                 bus_dmamap_unload(ha->rx_tag, rxb->map);
1911                                 bus_dmamap_destroy(ha->rx_tag, rxb->map);
1912                                 m_freem(rxb->m_head);
1913                                 rxb->m_head = NULL;
1914                         }
1915                 }
1916         }
1917         return;
1918 }
1919
1920 static int
1921 qla_alloc_rcv_bufs(qla_host_t *ha)
1922 {
1923         int             i, ret = 0;
1924
1925         if (bus_dma_tag_create(NULL,    /* parent */
1926                         1, 0,    /* alignment, bounds */
1927                         BUS_SPACE_MAXADDR,       /* lowaddr */
1928                         BUS_SPACE_MAXADDR,       /* highaddr */
1929                         NULL, NULL,      /* filter, filterarg */
1930                         MJUM9BYTES,     /* maxsize */
1931                         1,        /* nsegments */
1932                         MJUM9BYTES,        /* maxsegsize */
1933                         BUS_DMA_ALLOCNOW,        /* flags */
1934                         NULL,    /* lockfunc */
1935                         NULL,    /* lockfuncarg */
1936                         &ha->rx_tag)) {
1937
1938                 device_printf(ha->pci_dev, "%s: rx_tag alloc failed\n",
1939                         __func__);
1940
1941                 return (ENOMEM);
1942         }
1943
1944         bzero((void *)ha->rx_ring, (sizeof(qla_rx_ring_t) * MAX_RDS_RINGS));
1945
1946         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1947                 ha->hw.sds[i].sdsr_next = 0;
1948                 ha->hw.sds[i].rxb_free = NULL;
1949                 ha->hw.sds[i].rx_free = 0;
1950         }
1951
1952         ret = qla_alloc_rcv_std(ha);
1953
1954         return (ret);
1955 }
1956
1957 static void
1958 qla_free_rcv_bufs(qla_host_t *ha)
1959 {
1960         int             i;
1961
1962         qla_free_rcv_std(ha);
1963
1964         if (ha->rx_tag != NULL) {
1965                 bus_dma_tag_destroy(ha->rx_tag);
1966                 ha->rx_tag = NULL;
1967         }
1968
1969         bzero((void *)ha->rx_ring, (sizeof(qla_rx_ring_t) * MAX_RDS_RINGS));
1970
1971         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1972                 ha->hw.sds[i].sdsr_next = 0;
1973                 ha->hw.sds[i].rxb_free = NULL;
1974                 ha->hw.sds[i].rx_free = 0;
1975         }
1976
1977         return;
1978 }
1979
1980 int
1981 ql_get_mbuf(qla_host_t *ha, qla_rx_buf_t *rxb, struct mbuf *nmp)
1982 {
1983         register struct mbuf *mp = nmp;
1984         struct ifnet            *ifp;
1985         int                     ret = 0;
1986         uint32_t                offset;
1987         bus_dma_segment_t       segs[1];
1988         int                     nsegs, mbuf_size;
1989
1990         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1991
1992         ifp = ha->ifp;
1993
1994         if (ha->hw.enable_9kb)
1995                 mbuf_size = MJUM9BYTES;
1996         else
1997                 mbuf_size = MCLBYTES;
1998
1999         if (mp == NULL) {
2000
2001                 if (QL_ERR_INJECT(ha, INJCT_M_GETCL_M_GETJCL_FAILURE))
2002                         return(-1);
2003
2004                 if (ha->hw.enable_9kb)
2005                         mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, mbuf_size);
2006                 else
2007                         mp = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
2008
2009                 if (mp == NULL) {
2010                         ha->err_m_getcl++;
2011                         ret = ENOBUFS;
2012                         device_printf(ha->pci_dev,
2013                                         "%s: m_getcl failed\n", __func__);
2014                         goto exit_ql_get_mbuf;
2015                 }
2016                 mp->m_len = mp->m_pkthdr.len = mbuf_size;
2017         } else {
2018                 mp->m_len = mp->m_pkthdr.len = mbuf_size;
2019                 mp->m_data = mp->m_ext.ext_buf;
2020                 mp->m_next = NULL;
2021         }
2022
2023         offset = (uint32_t)((unsigned long long)mp->m_data & 0x7ULL);
2024         if (offset) {
2025                 offset = 8 - offset;
2026                 m_adj(mp, offset);
2027         }
2028
2029         /*
2030          * Using memory from the mbuf cluster pool, invoke the bus_dma
2031          * machinery to arrange the memory mapping.
2032          */
2033         ret = bus_dmamap_load_mbuf_sg(ha->rx_tag, rxb->map,
2034                         mp, segs, &nsegs, BUS_DMA_NOWAIT);
2035         rxb->paddr = segs[0].ds_addr;
2036
2037         if (ret || !rxb->paddr || (nsegs != 1)) {
2038                 m_free(mp);
2039                 rxb->m_head = NULL;
2040                 device_printf(ha->pci_dev,
2041                         "%s: bus_dmamap_load failed[%d, 0x%016llx, %d]\n",
2042                         __func__, ret, (long long unsigned int)rxb->paddr,
2043                         nsegs);
2044                 ret = -1;
2045                 goto exit_ql_get_mbuf;
2046         }
2047         rxb->m_head = mp;
2048         bus_dmamap_sync(ha->rx_tag, rxb->map, BUS_DMASYNC_PREREAD);
2049
2050 exit_ql_get_mbuf:
2051         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = 0x%08x\n", __func__, ret));
2052         return (ret);
2053 }
2054
2055
2056 static void
2057 qla_get_peer(qla_host_t *ha)
2058 {
2059         device_t *peers;
2060         int count, i, slot;
2061         int my_slot = pci_get_slot(ha->pci_dev);
2062
2063         if (device_get_children(device_get_parent(ha->pci_dev), &peers, &count))
2064                 return;
2065
2066         for (i = 0; i < count; i++) {
2067                 slot = pci_get_slot(peers[i]);
2068
2069                 if ((slot >= 0) && (slot == my_slot) &&
2070                         (pci_get_device(peers[i]) ==
2071                                 pci_get_device(ha->pci_dev))) {
2072                         if (ha->pci_dev != peers[i])
2073                                 ha->peer_dev = peers[i];
2074                 }
2075         }
2076 }
2077
2078 static void
2079 qla_send_msg_to_peer(qla_host_t *ha, uint32_t msg_to_peer)
2080 {
2081         qla_host_t *ha_peer;
2082
2083         if (ha->peer_dev) {
2084                 if ((ha_peer = device_get_softc(ha->peer_dev)) != NULL) {
2085
2086                         ha_peer->msg_from_peer = msg_to_peer;
2087                 }
2088         }
2089 }
2090
2091 void
2092 qla_set_error_recovery(qla_host_t *ha)
2093 {
2094         struct ifnet *ifp = ha->ifp;
2095
2096         if (!cold && ha->enable_error_recovery) {
2097                 if (ifp)
2098                         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
2099                 ha->qla_initiate_recovery = 1;
2100         } else
2101                 ha->offline = 1;
2102         return;
2103 }
2104
2105 static void
2106 qla_error_recovery(void *context, int pending)
2107 {
2108         qla_host_t *ha = context;
2109         uint32_t msecs_100 = 400;
2110         struct ifnet *ifp = ha->ifp;
2111         int i = 0;
2112
2113         device_printf(ha->pci_dev, "%s: enter\n", __func__);
2114         ha->hw.imd_compl = 1;
2115
2116         taskqueue_drain_all(ha->stats_tq);
2117         taskqueue_drain_all(ha->async_event_tq);
2118
2119         if (QLA_LOCK(ha, __func__, -1, 0) != 0)
2120                 return;
2121
2122         device_printf(ha->pci_dev, "%s: ts_usecs = %ld start\n",
2123                 __func__, qla_get_usec_timestamp());
2124
2125         if (ha->qla_interface_up) {
2126
2127                 qla_mdelay(__func__, 300);
2128
2129                 //ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
2130
2131                 for (i = 0; i < ha->hw.num_sds_rings; i++) {
2132                         qla_tx_fp_t *fp;
2133
2134                         fp = &ha->tx_fp[i];
2135
2136                         if (fp == NULL)
2137                                 continue;
2138
2139                         if (fp->tx_br != NULL) {
2140                                 mtx_lock(&fp->tx_mtx);
2141                                 mtx_unlock(&fp->tx_mtx);
2142                         }
2143                 }
2144         }
2145
2146         qla_drain_fp_taskqueues(ha);
2147
2148         if ((ha->pci_func & 0x1) == 0) {
2149
2150                 if (!ha->msg_from_peer) {
2151                         qla_send_msg_to_peer(ha, QL_PEER_MSG_RESET);
2152
2153                         while ((ha->msg_from_peer != QL_PEER_MSG_ACK) &&
2154                                 msecs_100--)
2155                                 qla_mdelay(__func__, 100);
2156                 }
2157
2158                 ha->msg_from_peer = 0;
2159
2160                 if (ha->enable_minidump)
2161                         ql_minidump(ha);
2162
2163                 if (ha->enable_driverstate_dump)
2164                         ql_capture_drvr_state(ha);
2165
2166                 if (ql_init_hw(ha)) {
2167                         device_printf(ha->pci_dev,
2168                                 "%s: ts_usecs = %ld exit: ql_init_hw failed\n",
2169                                 __func__, qla_get_usec_timestamp());
2170                         ha->offline = 1;
2171                         goto qla_error_recovery_exit;
2172                 }
2173
2174                 if (ha->qla_interface_up) {
2175                         qla_free_xmt_bufs(ha);
2176                         qla_free_rcv_bufs(ha);
2177                 }
2178
2179                 if (!QL_ERR_INJECT(ha, INJCT_PEER_PORT_FAILURE_ERR_RECOVERY))
2180                         qla_send_msg_to_peer(ha, QL_PEER_MSG_ACK);
2181
2182         } else {
2183                 if (ha->msg_from_peer == QL_PEER_MSG_RESET) {
2184
2185                         ha->msg_from_peer = 0;
2186
2187                         if (!QL_ERR_INJECT(ha, INJCT_PEER_PORT_FAILURE_ERR_RECOVERY))
2188                                 qla_send_msg_to_peer(ha, QL_PEER_MSG_ACK);
2189                 } else {
2190                         qla_send_msg_to_peer(ha, QL_PEER_MSG_RESET);
2191                 }
2192
2193                 while ((ha->msg_from_peer != QL_PEER_MSG_ACK)  && msecs_100--)
2194                         qla_mdelay(__func__, 100);
2195                 ha->msg_from_peer = 0;
2196
2197                 if (ha->enable_driverstate_dump)
2198                         ql_capture_drvr_state(ha);
2199
2200                 if (msecs_100 == 0) {
2201                         device_printf(ha->pci_dev,
2202                                 "%s: ts_usecs = %ld exit: QL_PEER_MSG_ACK not received\n",
2203                                 __func__, qla_get_usec_timestamp());
2204                         ha->offline = 1;
2205                         goto qla_error_recovery_exit;
2206                 }
2207
2208                 if (ql_init_hw(ha)) {
2209                         device_printf(ha->pci_dev,
2210                                 "%s: ts_usecs = %ld exit: ql_init_hw failed\n",
2211                                 __func__, qla_get_usec_timestamp());
2212                         ha->offline = 1;
2213                         goto qla_error_recovery_exit;
2214                 }
2215
2216                 if (ha->qla_interface_up) {
2217                         qla_free_xmt_bufs(ha);
2218                         qla_free_rcv_bufs(ha);
2219                 }
2220         }
2221
2222         qla_mdelay(__func__, ha->ms_delay_after_init);
2223
2224         *((uint32_t *)&ha->hw.flags) = 0;
2225         ha->qla_initiate_recovery = 0;
2226
2227         if (ha->qla_interface_up) {
2228
2229                 if (qla_alloc_xmt_bufs(ha) != 0) {
2230                         ha->offline = 1;
2231                         goto qla_error_recovery_exit;
2232                 }
2233
2234                 qla_confirm_9kb_enable(ha);
2235
2236                 if (qla_alloc_rcv_bufs(ha) != 0) {
2237                         ha->offline = 1;
2238                         goto qla_error_recovery_exit;
2239                 }
2240
2241                 ha->stop_rcv = 0;
2242
2243                 if (ql_init_hw_if(ha) == 0) {
2244                         ifp = ha->ifp;
2245                         ifp->if_drv_flags |= IFF_DRV_RUNNING;
2246                         ha->qla_watchdog_pause = 0;
2247                         ql_update_link_state(ha);
2248                 } else {
2249                         ha->offline = 1;
2250
2251                         if (ha->hw.sp_log_stop_events &
2252                                 Q8_SP_LOG_STOP_IF_START_FAILURE)
2253                                 ha->hw.sp_log_stop = -1;
2254                 }
2255         } else {
2256                 ha->qla_watchdog_pause = 0;
2257         }
2258
2259 qla_error_recovery_exit:
2260
2261         if (ha->offline ) {
2262                 device_printf(ha->pci_dev, "%s: ts_usecs = %ld port offline\n",
2263                         __func__, qla_get_usec_timestamp());
2264                 if (ha->hw.sp_log_stop_events &
2265                         Q8_SP_LOG_STOP_ERR_RECOVERY_FAILURE)
2266                         ha->hw.sp_log_stop = -1;
2267         }
2268
2269
2270         QLA_UNLOCK(ha, __func__);
2271
2272         if (!ha->offline)
2273                 callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
2274                         qla_watchdog, ha);
2275
2276         device_printf(ha->pci_dev,
2277                 "%s: ts_usecs = %ld exit\n",
2278                 __func__, qla_get_usec_timestamp());
2279         return;
2280 }
2281
2282 static void
2283 qla_async_event(void *context, int pending)
2284 {
2285         qla_host_t *ha = context;
2286
2287         if (QLA_LOCK(ha, __func__, -1, 0) != 0)
2288                 return;
2289
2290         if (ha->async_event) {
2291                 ha->async_event = 0;
2292                 qla_hw_async_event(ha);
2293         }
2294
2295         QLA_UNLOCK(ha, __func__);
2296
2297         return;
2298 }
2299
2300 static void
2301 qla_stats(void *context, int pending)
2302 {
2303         qla_host_t *ha;
2304
2305         ha = context;
2306
2307         ql_get_stats(ha);
2308
2309         return;
2310 }
2311