sys/dev/qlxgbe/ql_os.c

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