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_stats(SYSCTL_HANDLER_ARGS);
  74 static int qla_sysctl_get_link_status(SYSCTL_HANDLER_ARGS);
  75 static void qla_release(qla_host_t *ha);
  76 static void qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs,
  77                 int error);
  78 static void qla_stop(qla_host_t *ha);
  79 static void qla_get_peer(qla_host_t *ha);
  80 static void qla_error_recovery(void *context, int pending);
  81 static void qla_async_event(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_PROC(device_get_sysctl_ctx(dev),
 172                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 173                 OID_AUTO, "stats", CTLTYPE_INT | CTLFLAG_RW,
 174                 (void *)ha, 0,
 175                 qla_sysctl_get_stats, "I", "Statistics");
 176
 177         SYSCTL_ADD_STRING(device_get_sysctl_ctx(dev),
 178                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 179                 OID_AUTO, "fw_version", CTLFLAG_RD,
 180                 ha->fw_ver_str, 0, "firmware version");
 181
 182         SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
 183                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 184                 OID_AUTO, "link_status", CTLTYPE_INT | CTLFLAG_RW,
 185                 (void *)ha, 0,
 186                 qla_sysctl_get_link_status, "I", "Link Status");
 187
 188         ha->dbg_level = 0;
 189         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 190                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 191                 OID_AUTO, "debug", CTLFLAG_RW,
 192                 &ha->dbg_level, ha->dbg_level, "Debug Level");
 193
 194         ha->std_replenish = QL_STD_REPLENISH_THRES;
 195         SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
 196                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 197                 OID_AUTO, "std_replenish", CTLFLAG_RW,
 198                 &ha->std_replenish, ha->std_replenish,
 199                 "Threshold for Replenishing Standard Frames");
 200
 201         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 202                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 203                 OID_AUTO, "ipv4_lro",
 204                 CTLFLAG_RD, &ha->ipv4_lro,
 205                 "number of ipv4 lro completions");
 206
 207         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 208                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 209                 OID_AUTO, "ipv6_lro",
 210                 CTLFLAG_RD, &ha->ipv6_lro,
 211                 "number of ipv6 lro completions");
 212
 213         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 214                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 215                 OID_AUTO, "tx_tso_frames",
 216                 CTLFLAG_RD, &ha->tx_tso_frames,
 217                 "number of Tx TSO Frames");
 218
 219         SYSCTL_ADD_QUAD(device_get_sysctl_ctx(dev),
 220                 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
 221                 OID_AUTO, "hw_vlan_tx_frames",
 222                 CTLFLAG_RD, &ha->hw_vlan_tx_frames,
 223                 "number of Tx VLAN Frames");
 224
 225         return;
 226 }
 227
 228 static void
 229 qla_watchdog(void *arg)
 230 {
 231         qla_host_t *ha = arg;
 232         qla_hw_t *hw;
 233         struct ifnet *ifp;
 234         uint32_t i;
 235
 236         hw = &ha->hw;
 237         ifp = ha->ifp;
 238
 239         if (ha->flags.qla_watchdog_exit) {
 240                 ha->qla_watchdog_exited = 1;
 241                 return;
 242         }
 243         ha->qla_watchdog_exited = 0;
 244
 245         if (!ha->flags.qla_watchdog_pause) {
 246                 if (ql_hw_check_health(ha) || ha->qla_initiate_recovery ||
 247                         (ha->msg_from_peer == QL_PEER_MSG_RESET)) {
 248                         ha->qla_watchdog_paused = 1;
 249                         ha->flags.qla_watchdog_pause = 1;
 250                         ha->qla_initiate_recovery = 0;
 251                         ha->err_inject = 0;
 252                         device_printf(ha->pci_dev,
 253                                 "%s: taskqueue_enqueue(err_task) \n", __func__);
 254                         taskqueue_enqueue(ha->err_tq, &ha->err_task);
 255                 } else if (ha->flags.qla_interface_up) {
 256
 257                         if (ha->async_event) {
 258                                 ha->async_event = 0;
 259                                 taskqueue_enqueue(ha->async_event_tq,
 260                                         &ha->async_event_task);
 261                         }
 262
 263                         for (i = 0; i < ha->hw.num_sds_rings; i++) {
 264                                 qla_tx_fp_t *fp = &ha->tx_fp[i];
 265
 266                                 if (fp->fp_taskqueue != NULL)
 267                                         taskqueue_enqueue(fp->fp_taskqueue,
 268                                                 &fp->fp_task);
 269                         }
 270
 271                         ha->qla_watchdog_paused = 0;
 272                 } else {
 273                         ha->qla_watchdog_paused = 0;
 274                 }
 275         } else {
 276                 ha->qla_watchdog_paused = 1;
 277         }
 278
 279         ha->watchdog_ticks = ha->watchdog_ticks++ % 1000;
 280         callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
 281                 qla_watchdog, ha);
 282 }
 283
 284 /*
 285  * Name:        qla_pci_attach
 286  * Function:    attaches the device to the operating system
 287  */
 288 static int
 289 qla_pci_attach(device_t dev)
 290 {
 291         qla_host_t *ha = NULL;
 292         uint32_t rsrc_len;
 293         int i;
 294         uint32_t num_rcvq = 0;
 295
 296         if ((ha = device_get_softc(dev)) == NULL) {
 297                 device_printf(dev, "cannot get softc\n");
 298                 return (ENOMEM);
 299         }
 300
 301         memset(ha, 0, sizeof (qla_host_t));
 302
 303         if (pci_get_device(dev) != PCI_PRODUCT_QLOGIC_ISP8030) {
 304                 device_printf(dev, "device is not ISP8030\n");
 305                 return (ENXIO);
 306         }
 307
 308         ha->pci_func = pci_get_function(dev) & 0x1;
 309
 310         ha->pci_dev = dev;
 311
 312         pci_enable_busmaster(dev);
 313
 314         ha->reg_rid = PCIR_BAR(0);
 315         ha->pci_reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &ha->reg_rid,
 316                                 RF_ACTIVE);
 317
 318         if (ha->pci_reg == NULL) {
 319                 device_printf(dev, "unable to map any ports\n");
 320                 goto qla_pci_attach_err;
 321         }
 322
 323         rsrc_len = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
 324                                         ha->reg_rid);
 325
 326         mtx_init(&ha->hw_lock, "qla83xx_hw_lock", MTX_NETWORK_LOCK, MTX_DEF);
 327
 328         qla_add_sysctls(ha);
 329         ql_hw_add_sysctls(ha);
 330
 331         ha->flags.lock_init = 1;
 332
 333         ha->reg_rid1 = PCIR_BAR(2);
 334         ha->pci_reg1 = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
 335                         &ha->reg_rid1, RF_ACTIVE);
 336
 337         ha->msix_count = pci_msix_count(dev);
 338
 339         if (ha->msix_count < (ha->hw.num_sds_rings + 1)) {
 340                 device_printf(dev, "%s: msix_count[%d] not enough\n", __func__,
 341                         ha->msix_count);
 342                 goto qla_pci_attach_err;
 343         }
 344
 345         QL_DPRINT2(ha, (dev, "%s: ha %p pci_func 0x%x rsrc_count 0x%08x"
 346                 " msix_count 0x%x pci_reg %p pci_reg1 %p\n", __func__, ha,
 347                 ha->pci_func, rsrc_len, ha->msix_count, ha->pci_reg,
 348                 ha->pci_reg1));
 349
 350         /* initialize hardware */
 351         if (ql_init_hw(ha)) {
 352                 device_printf(dev, "%s: ql_init_hw failed\n", __func__);
 353                 goto qla_pci_attach_err;
 354         }
 355
 356         device_printf(dev, "%s: firmware[%d.%d.%d.%d]\n", __func__,
 357                 ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
 358                 ha->fw_ver_build);
 359         snprintf(ha->fw_ver_str, sizeof(ha->fw_ver_str), "%d.%d.%d.%d",
 360                         ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
 361                         ha->fw_ver_build);
 362
 363         if (qla_get_nic_partition(ha, NULL, &num_rcvq)) {
 364                 device_printf(dev, "%s: qla_get_nic_partition failed\n",
 365                         __func__);
 366                 goto qla_pci_attach_err;
 367         }
 368         device_printf(dev, "%s: ha %p pci_func 0x%x rsrc_count 0x%08x"
 369                 " msix_count 0x%x pci_reg %p pci_reg1 %p num_rcvq = %d\n",
 370                 __func__, ha, ha->pci_func, rsrc_len, ha->msix_count,
 371                 ha->pci_reg, ha->pci_reg1, num_rcvq);
 372
 373
 374 #ifdef QL_ENABLE_ISCSI_TLV
 375         if ((ha->msix_count  < 64) || (num_rcvq != 32)) {
 376                 ha->hw.num_sds_rings = 15;
 377                 ha->hw.num_tx_rings = ha->hw.num_sds_rings * 2;
 378         }
 379 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
 380         ha->hw.num_rds_rings = ha->hw.num_sds_rings;
 381
 382         ha->msix_count = ha->hw.num_sds_rings + 1;
 383
 384         if (pci_alloc_msix(dev, &ha->msix_count)) {
 385                 device_printf(dev, "%s: pci_alloc_msi[%d] failed\n", __func__,
 386                         ha->msix_count);
 387                 ha->msix_count = 0;
 388                 goto qla_pci_attach_err;
 389         }
 390
 391         ha->mbx_irq_rid = 1;
 392         ha->mbx_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
 393                                 &ha->mbx_irq_rid,
 394                                 (RF_ACTIVE | RF_SHAREABLE));
 395         if (ha->mbx_irq == NULL) {
 396                 device_printf(dev, "could not allocate mbx interrupt\n");
 397                 goto qla_pci_attach_err;
 398         }
 399         if (bus_setup_intr(dev, ha->mbx_irq, (INTR_TYPE_NET | INTR_MPSAFE),
 400                 NULL, ql_mbx_isr, ha, &ha->mbx_handle)) {
 401                 device_printf(dev, "could not setup mbx interrupt\n");
 402                 goto qla_pci_attach_err;
 403         }
 404
 405         for (i = 0; i < ha->hw.num_sds_rings; i++) {
 406                 ha->irq_vec[i].sds_idx = i;
 407                 ha->irq_vec[i].ha = ha;
 408                 ha->irq_vec[i].irq_rid = 2 + i;
 409
 410                 ha->irq_vec[i].irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
 411                                 &ha->irq_vec[i].irq_rid,
 412                                 (RF_ACTIVE | RF_SHAREABLE));
 413
 414                 if (ha->irq_vec[i].irq == NULL) {
 415                         device_printf(dev, "could not allocate interrupt\n");
 416                         goto qla_pci_attach_err;
 417                 }
 418                 if (bus_setup_intr(dev, ha->irq_vec[i].irq,
 419                         (INTR_TYPE_NET | INTR_MPSAFE),
 420                         NULL, ql_isr, &ha->irq_vec[i],
 421                         &ha->irq_vec[i].handle)) {
 422                         device_printf(dev, "could not setup interrupt\n");
 423                         goto qla_pci_attach_err;
 424                 }
 425
 426                 ha->tx_fp[i].ha = ha;
 427                 ha->tx_fp[i].txr_idx = i;
 428
 429                 if (qla_alloc_tx_br(ha, &ha->tx_fp[i])) {
 430                         device_printf(dev, "%s: could not allocate tx_br[%d]\n",
 431                                 __func__, i);
 432                         goto qla_pci_attach_err;
 433                 }
 434         }
 435
 436         if (qla_create_fp_taskqueues(ha) != 0)
 437                 goto qla_pci_attach_err;
 438
 439         printf("%s: mp__ncpus %d sds %d rds %d msi-x %d\n", __func__, mp_ncpus,
 440                 ha->hw.num_sds_rings, ha->hw.num_rds_rings, ha->msix_count);
 441
 442         ql_read_mac_addr(ha);
 443
 444         /* allocate parent dma tag */
 445         if (qla_alloc_parent_dma_tag(ha)) {
 446                 device_printf(dev, "%s: qla_alloc_parent_dma_tag failed\n",
 447                         __func__);
 448                 goto qla_pci_attach_err;
 449         }
 450
 451         /* alloc all dma buffers */
 452         if (ql_alloc_dma(ha)) {
 453                 device_printf(dev, "%s: ql_alloc_dma failed\n", __func__);
 454                 goto qla_pci_attach_err;
 455         }
 456         qla_get_peer(ha);
 457
 458         if (ql_minidump_init(ha) != 0) {
 459                 device_printf(dev, "%s: ql_minidump_init failed\n", __func__);
 460                 goto qla_pci_attach_err;
 461         }
 462         /* create the o.s ethernet interface */
 463         qla_init_ifnet(dev, ha);
 464
 465         ha->flags.qla_watchdog_active = 1;
 466         ha->flags.qla_watchdog_pause = 0;
 467
 468         callout_init(&ha->tx_callout, TRUE);
 469         ha->flags.qla_callout_init = 1;
 470
 471         /* create ioctl device interface */
 472         if (ql_make_cdev(ha)) {
 473                 device_printf(dev, "%s: ql_make_cdev failed\n", __func__);
 474                 goto qla_pci_attach_err;
 475         }
 476
 477         callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
 478                 qla_watchdog, ha);
 479
 480         TASK_INIT(&ha->err_task, 0, qla_error_recovery, ha);
 481         ha->err_tq = taskqueue_create("qla_errq", M_NOWAIT,
 482                         taskqueue_thread_enqueue, &ha->err_tq);
 483         taskqueue_start_threads(&ha->err_tq, 1, PI_NET, "%s errq",
 484                 device_get_nameunit(ha->pci_dev));
 485
 486         TASK_INIT(&ha->async_event_task, 0, qla_async_event, ha);
 487         ha->async_event_tq = taskqueue_create("qla_asyncq", M_NOWAIT,
 488                         taskqueue_thread_enqueue, &ha->async_event_tq);
 489         taskqueue_start_threads(&ha->async_event_tq, 1, PI_NET, "%s asyncq",
 490                 device_get_nameunit(ha->pci_dev));
 491
 492         QL_DPRINT2(ha, (dev, "%s: exit 0\n", __func__));
 493         return (0);
 494
 495 qla_pci_attach_err:
 496
 497         qla_release(ha);
 498
 499         QL_DPRINT2(ha, (dev, "%s: exit ENXIO\n", __func__));
 500         return (ENXIO);
 501 }
 502
 503 /*
 504  * Name:        qla_pci_detach
 505  * Function:    Unhooks the device from the operating system
 506  */
 507 static int
 508 qla_pci_detach(device_t dev)
 509 {
 510         qla_host_t *ha = NULL;
 511         struct ifnet *ifp;
 512
 513         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 514
 515         if ((ha = device_get_softc(dev)) == NULL) {
 516                 device_printf(dev, "cannot get softc\n");
 517                 return (ENOMEM);
 518         }
 519
 520         ifp = ha->ifp;
 521
 522         (void)QLA_LOCK(ha, __func__, 0);
 523         qla_stop(ha);
 524         QLA_UNLOCK(ha, __func__);
 525
 526         qla_release(ha);
 527
 528         QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
 529
 530         return (0);
 531 }
 532
 533 /*
 534  * SYSCTL Related Callbacks
 535  */
 536 static int
 537 qla_sysctl_get_stats(SYSCTL_HANDLER_ARGS)
 538 {
 539         int err, ret = 0;
 540         qla_host_t *ha;
 541
 542         err = sysctl_handle_int(oidp, &ret, 0, req);
 543
 544         if (err || !req->newptr)
 545                 return (err);
 546
 547         if (ret == 1) {
 548                 ha = (qla_host_t *)arg1;
 549                 ql_get_stats(ha);
 550         }
 551         return (err);
 552 }
 553 static int
 554 qla_sysctl_get_link_status(SYSCTL_HANDLER_ARGS)
 555 {
 556         int err, ret = 0;
 557         qla_host_t *ha;
 558
 559         err = sysctl_handle_int(oidp, &ret, 0, req);
 560
 561         if (err || !req->newptr)
 562                 return (err);
 563
 564         if (ret == 1) {
 565                 ha = (qla_host_t *)arg1;
 566                 ql_hw_link_status(ha);
 567         }
 568         return (err);
 569 }
 570
 571 /*
 572  * Name:        qla_release
 573  * Function:    Releases the resources allocated for the device
 574  */
 575 static void
 576 qla_release(qla_host_t *ha)
 577 {
 578         device_t dev;
 579         int i;
 580
 581         dev = ha->pci_dev;
 582
 583         if (ha->async_event_tq) {
 584                 taskqueue_drain(ha->async_event_tq, &ha->async_event_task);
 585                 taskqueue_free(ha->async_event_tq);
 586         }
 587
 588         if (ha->err_tq) {
 589                 taskqueue_drain(ha->err_tq, &ha->err_task);
 590                 taskqueue_free(ha->err_tq);
 591         }
 592
 593         ql_del_cdev(ha);
 594
 595         if (ha->flags.qla_watchdog_active) {
 596                 ha->flags.qla_watchdog_exit = 1;
 597
 598                 while (ha->qla_watchdog_exited == 0)
 599                         qla_mdelay(__func__, 1);
 600         }
 601
 602         if (ha->flags.qla_callout_init)
 603                 callout_stop(&ha->tx_callout);
 604
 605         if (ha->ifp != NULL)
 606                 ether_ifdetach(ha->ifp);
 607
 608         ql_free_dma(ha);
 609         qla_free_parent_dma_tag(ha);
 610
 611         if (ha->mbx_handle)
 612                 (void)bus_teardown_intr(dev, ha->mbx_irq, ha->mbx_handle);
 613
 614         if (ha->mbx_irq)
 615                 (void) bus_release_resource(dev, SYS_RES_IRQ, ha->mbx_irq_rid,
 616                                 ha->mbx_irq);
 617
 618         for (i = 0; i < ha->hw.num_sds_rings; i++) {
 619
 620                 if (ha->irq_vec[i].handle) {
 621                         (void)bus_teardown_intr(dev, ha->irq_vec[i].irq,
 622                                         ha->irq_vec[i].handle);
 623                 }
 624
 625                 if (ha->irq_vec[i].irq) {
 626                         (void)bus_release_resource(dev, SYS_RES_IRQ,
 627                                 ha->irq_vec[i].irq_rid,
 628                                 ha->irq_vec[i].irq);
 629                 }
 630
 631                 qla_free_tx_br(ha, &ha->tx_fp[i]);
 632         }
 633         qla_destroy_fp_taskqueues(ha);
 634
 635         if (ha->msix_count)
 636                 pci_release_msi(dev);
 637
 638         if (ha->flags.lock_init) {
 639                 mtx_destroy(&ha->hw_lock);
 640         }
 641
 642         if (ha->pci_reg)
 643                 (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid,
 644                                 ha->pci_reg);
 645
 646         if (ha->pci_reg1)
 647                 (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid1,
 648                                 ha->pci_reg1);
 649 }
 650
 651 /*
 652  * DMA Related Functions
 653  */
 654
 655 static void
 656 qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
 657 {
 658         *((bus_addr_t *)arg) = 0;
 659
 660         if (error) {
 661                 printf("%s: bus_dmamap_load failed (%d)\n", __func__, error);
 662                 return;
 663         }
 664
 665         *((bus_addr_t *)arg) = segs[0].ds_addr;
 666
 667         return;
 668 }
 669
 670 int
 671 ql_alloc_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
 672 {
 673         int             ret = 0;
 674         device_t        dev;
 675         bus_addr_t      b_addr;
 676
 677         dev = ha->pci_dev;
 678
 679         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 680
 681         ret = bus_dma_tag_create(
 682                         ha->parent_tag,/* parent */
 683                         dma_buf->alignment,
 684                         ((bus_size_t)(1ULL << 32)),/* boundary */
 685                         BUS_SPACE_MAXADDR,      /* lowaddr */
 686                         BUS_SPACE_MAXADDR,      /* highaddr */
 687                         NULL, NULL,             /* filter, filterarg */
 688                         dma_buf->size,          /* maxsize */
 689                         1,                      /* nsegments */
 690                         dma_buf->size,          /* maxsegsize */
 691                         0,                      /* flags */
 692                         NULL, NULL,             /* lockfunc, lockarg */
 693                         &dma_buf->dma_tag);
 694
 695         if (ret) {
 696                 device_printf(dev, "%s: could not create dma tag\n", __func__);
 697                 goto ql_alloc_dmabuf_exit;
 698         }
 699         ret = bus_dmamem_alloc(dma_buf->dma_tag,
 700                         (void **)&dma_buf->dma_b,
 701                         (BUS_DMA_ZERO | BUS_DMA_COHERENT | BUS_DMA_NOWAIT),
 702                         &dma_buf->dma_map);
 703         if (ret) {
 704                 bus_dma_tag_destroy(dma_buf->dma_tag);
 705                 device_printf(dev, "%s: bus_dmamem_alloc failed\n", __func__);
 706                 goto ql_alloc_dmabuf_exit;
 707         }
 708
 709         ret = bus_dmamap_load(dma_buf->dma_tag,
 710                         dma_buf->dma_map,
 711                         dma_buf->dma_b,
 712                         dma_buf->size,
 713                         qla_dmamap_callback,
 714                         &b_addr, BUS_DMA_NOWAIT);
 715
 716         if (ret || !b_addr) {
 717                 bus_dma_tag_destroy(dma_buf->dma_tag);
 718                 bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b,
 719                         dma_buf->dma_map);
 720                 ret = -1;
 721                 goto ql_alloc_dmabuf_exit;
 722         }
 723
 724         dma_buf->dma_addr = b_addr;
 725
 726 ql_alloc_dmabuf_exit:
 727         QL_DPRINT2(ha, (dev, "%s: exit ret 0x%08x tag %p map %p b %p sz 0x%x\n",
 728                 __func__, ret, (void *)dma_buf->dma_tag,
 729                 (void *)dma_buf->dma_map, (void *)dma_buf->dma_b,
 730                 dma_buf->size));
 731
 732         return ret;
 733 }
 734
 735 void
 736 ql_free_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
 737 {
 738         bus_dmamap_unload(dma_buf->dma_tag, dma_buf->dma_map);
 739         bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b, dma_buf->dma_map);
 740         bus_dma_tag_destroy(dma_buf->dma_tag);
 741 }
 742
 743 static int
 744 qla_alloc_parent_dma_tag(qla_host_t *ha)
 745 {
 746         int             ret;
 747         device_t        dev;
 748
 749         dev = ha->pci_dev;
 750
 751         /*
 752          * Allocate parent DMA Tag
 753          */
 754         ret = bus_dma_tag_create(
 755                         bus_get_dma_tag(dev),   /* parent */
 756                         1,((bus_size_t)(1ULL << 32)),/* alignment, boundary */
 757                         BUS_SPACE_MAXADDR,      /* lowaddr */
 758                         BUS_SPACE_MAXADDR,      /* highaddr */
 759                         NULL, NULL,             /* filter, filterarg */
 760                         BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
 761                         0,                      /* nsegments */
 762                         BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
 763                         0,                      /* flags */
 764                         NULL, NULL,             /* lockfunc, lockarg */
 765                         &ha->parent_tag);
 766
 767         if (ret) {
 768                 device_printf(dev, "%s: could not create parent dma tag\n",
 769                         __func__);
 770                 return (-1);
 771         }
 772
 773         ha->flags.parent_tag = 1;
 774
 775         return (0);
 776 }
 777
 778 static void
 779 qla_free_parent_dma_tag(qla_host_t *ha)
 780 {
 781         if (ha->flags.parent_tag) {
 782                 bus_dma_tag_destroy(ha->parent_tag);
 783                 ha->flags.parent_tag = 0;
 784         }
 785 }
 786
 787 /*
 788  * Name: qla_init_ifnet
 789  * Function: Creates the Network Device Interface and Registers it with the O.S
 790  */
 791
 792 static void
 793 qla_init_ifnet(device_t dev, qla_host_t *ha)
 794 {
 795         struct ifnet *ifp;
 796
 797         QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
 798
 799         ifp = ha->ifp = if_alloc(IFT_ETHER);
 800
 801         if (ifp == NULL)
 802                 panic("%s: cannot if_alloc()\n", device_get_nameunit(dev));
 803
 804         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
 805
 806 #if __FreeBSD_version >= 1000000
 807         if_initbaudrate(ifp, IF_Gbps(10));
 808         ifp->if_capabilities = IFCAP_LINKSTATE;
 809 #else
 810         ifp->if_mtu = ETHERMTU;
 811         ifp->if_baudrate = (1 * 1000 * 1000 *1000);
 812
 813 #endif /* #if __FreeBSD_version >= 1000000 */
 814
 815         ifp->if_init = qla_init;
 816         ifp->if_softc = ha;
 817         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
 818         ifp->if_ioctl = qla_ioctl;
 819
 820         ifp->if_transmit = qla_transmit;
 821         ifp->if_qflush = qla_qflush;
 822
 823         IFQ_SET_MAXLEN(&ifp->if_snd, qla_get_ifq_snd_maxlen(ha));
 824         ifp->if_snd.ifq_drv_maxlen = qla_get_ifq_snd_maxlen(ha);
 825         IFQ_SET_READY(&ifp->if_snd);
 826
 827         ha->max_frame_size = ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
 828
 829         ether_ifattach(ifp, qla_get_mac_addr(ha));
 830
 831         ifp->if_capabilities |= IFCAP_HWCSUM |
 832                                 IFCAP_TSO4 |
 833                                 IFCAP_JUMBO_MTU |
 834                                 IFCAP_VLAN_HWTAGGING |
 835                                 IFCAP_VLAN_MTU |
 836                                 IFCAP_VLAN_HWTSO |
 837                                 IFCAP_LRO;
 838
 839         ifp->if_capenable = ifp->if_capabilities;
 840
 841         ifp->if_data.ifi_hdrlen = sizeof(struct ether_vlan_header);
 842
 843         ifmedia_init(&ha->media, IFM_IMASK, qla_media_change, qla_media_status);
 844
 845         ifmedia_add(&ha->media, (IFM_ETHER | qla_get_optics(ha) | IFM_FDX), 0,
 846                 NULL);
 847         ifmedia_add(&ha->media, (IFM_ETHER | IFM_AUTO), 0, NULL);
 848
 849         ifmedia_set(&ha->media, (IFM_ETHER | IFM_AUTO));
 850
 851         QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
 852
 853         return;
 854 }
 855
 856 static void
 857 qla_init_locked(qla_host_t *ha)
 858 {
 859         struct ifnet *ifp = ha->ifp;
 860
 861         qla_stop(ha);
 862
 863         if (qla_alloc_xmt_bufs(ha) != 0)
 864                 return;
 865
 866         qla_confirm_9kb_enable(ha);
 867
 868         if (qla_alloc_rcv_bufs(ha) != 0)
 869                 return;
 870
 871         bcopy(IF_LLADDR(ha->ifp), ha->hw.mac_addr, ETHER_ADDR_LEN);
 872
 873         ifp->if_hwassist = CSUM_TCP | CSUM_UDP | CSUM_TSO;
 874
 875         ha->flags.stop_rcv = 0;
 876         if (ql_init_hw_if(ha) == 0) {
 877                 ifp = ha->ifp;
 878                 ifp->if_drv_flags |= IFF_DRV_RUNNING;
 879                 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 880                 ha->flags.qla_watchdog_pause = 0;
 881                 ha->hw_vlan_tx_frames = 0;
 882                 ha->tx_tso_frames = 0;
 883                 ha->flags.qla_interface_up = 1;
 884         }
 885
 886         return;
 887 }
 888
 889 static void
 890 qla_init(void *arg)
 891 {
 892         qla_host_t *ha;
 893
 894         ha = (qla_host_t *)arg;
 895
 896         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
 897
 898         (void)QLA_LOCK(ha, __func__, 0);
 899         qla_init_locked(ha);
 900         QLA_UNLOCK(ha, __func__);
 901
 902         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
 903 }
 904
 905 static int
 906 qla_set_multi(qla_host_t *ha, uint32_t add_multi)
 907 {
 908         uint8_t mta[Q8_MAX_NUM_MULTICAST_ADDRS * Q8_MAC_ADDR_LEN];
 909         struct ifmultiaddr *ifma;
 910         int mcnt = 0;
 911         struct ifnet *ifp = ha->ifp;
 912         int ret = 0;
 913
 914         if_maddr_rlock(ifp);
 915
 916         TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
 917
 918                 if (ifma->ifma_addr->sa_family != AF_LINK)
 919                         continue;
 920
 921                 if (mcnt == Q8_MAX_NUM_MULTICAST_ADDRS)
 922                         break;
 923
 924                 bcopy(LLADDR((struct sockaddr_dl *) ifma->ifma_addr),
 925                         &mta[mcnt * Q8_MAC_ADDR_LEN], Q8_MAC_ADDR_LEN);
 926
 927                 mcnt++;
 928         }
 929
 930         if_maddr_runlock(ifp);
 931
 932         //if (QLA_LOCK(ha, __func__, 1) == 0) {
 933         //      ret = ql_hw_set_multi(ha, mta, mcnt, add_multi);
 934         //      QLA_UNLOCK(ha, __func__);
 935         //}
 936         QLA_LOCK(ha, __func__, 1);
 937         ret = ql_hw_set_multi(ha, mta, mcnt, add_multi);
 938         QLA_UNLOCK(ha, __func__);
 939
 940         return (ret);
 941 }
 942
 943 static int
 944 qla_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
 945 {
 946         int ret = 0;
 947         struct ifreq *ifr = (struct ifreq *)data;
 948         struct ifaddr *ifa = (struct ifaddr *)data;
 949         qla_host_t *ha;
 950
 951         ha = (qla_host_t *)ifp->if_softc;
 952
 953         switch (cmd) {
 954         case SIOCSIFADDR:
 955                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFADDR (0x%lx)\n",
 956                         __func__, cmd));
 957
 958                 if (ifa->ifa_addr->sa_family == AF_INET) {
 959                         ifp->if_flags |= IFF_UP;
 960                         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
 961                                 (void)QLA_LOCK(ha, __func__, 0);
 962                                 qla_init_locked(ha);
 963                                 QLA_UNLOCK(ha, __func__);
 964                         }
 965                         QL_DPRINT4(ha, (ha->pci_dev,
 966                                 "%s: SIOCSIFADDR (0x%lx) ipv4 [0x%08x]\n",
 967                                 __func__, cmd,
 968                                 ntohl(IA_SIN(ifa)->sin_addr.s_addr)));
 969
 970                         arp_ifinit(ifp, ifa);
 971                 } else {
 972                         ether_ioctl(ifp, cmd, data);
 973                 }
 974                 break;
 975
 976         case SIOCSIFMTU:
 977                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFMTU (0x%lx)\n",
 978                         __func__, cmd));
 979
 980                 if (ifr->ifr_mtu > QLA_MAX_MTU) {
 981                         ret = EINVAL;
 982                 } else {
 983                         (void) QLA_LOCK(ha, __func__, 0);
 984                         ifp->if_mtu = ifr->ifr_mtu;
 985                         ha->max_frame_size =
 986                                 ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
 987                         if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
 988                                 ret = ql_set_max_mtu(ha, ha->max_frame_size,
 989                                         ha->hw.rcv_cntxt_id);
 990                         }
 991
 992                         if (ifp->if_mtu > ETHERMTU)
 993                                 ha->std_replenish = QL_JUMBO_REPLENISH_THRES;
 994                         else
 995                                 ha->std_replenish = QL_STD_REPLENISH_THRES;
 996
 997
 998                         QLA_UNLOCK(ha, __func__);
 999
1000                         if (ret)
1001                                 ret = EINVAL;
1002                 }
1003
1004                 break;
1005
1006         case SIOCSIFFLAGS:
1007                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFFLAGS (0x%lx)\n",
1008                         __func__, cmd));
1009
1010                 (void)QLA_LOCK(ha, __func__, 0);
1011
1012                 if (ifp->if_flags & IFF_UP) {
1013                         if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1014                                 if ((ifp->if_flags ^ ha->if_flags) &
1015                                         IFF_PROMISC) {
1016                                         ret = ql_set_promisc(ha);
1017                                 } else if ((ifp->if_flags ^ ha->if_flags) &
1018                                         IFF_ALLMULTI) {
1019                                         ret = ql_set_allmulti(ha);
1020                                 }
1021                         } else {
1022                                 qla_init_locked(ha);
1023                                 ha->max_frame_size = ifp->if_mtu +
1024                                         ETHER_HDR_LEN + ETHER_CRC_LEN;
1025                                 ret = ql_set_max_mtu(ha, ha->max_frame_size,
1026                                         ha->hw.rcv_cntxt_id);
1027                         }
1028                 } else {
1029                         if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1030                                 qla_stop(ha);
1031                         ha->if_flags = ifp->if_flags;
1032                 }
1033
1034                 QLA_UNLOCK(ha, __func__);
1035                 break;
1036
1037         case SIOCADDMULTI:
1038                 QL_DPRINT4(ha, (ha->pci_dev,
1039                         "%s: %s (0x%lx)\n", __func__, "SIOCADDMULTI", cmd));
1040
1041                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1042                         if (qla_set_multi(ha, 1))
1043                                 ret = EINVAL;
1044                 }
1045                 break;
1046
1047         case SIOCDELMULTI:
1048                 QL_DPRINT4(ha, (ha->pci_dev,
1049                         "%s: %s (0x%lx)\n", __func__, "SIOCDELMULTI", cmd));
1050
1051                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1052                         if (qla_set_multi(ha, 0))
1053                                 ret = EINVAL;
1054                 }
1055                 break;
1056
1057         case SIOCSIFMEDIA:
1058         case SIOCGIFMEDIA:
1059                 QL_DPRINT4(ha, (ha->pci_dev,
1060                         "%s: SIOCSIFMEDIA/SIOCGIFMEDIA (0x%lx)\n",
1061                         __func__, cmd));
1062                 ret = ifmedia_ioctl(ifp, ifr, &ha->media, cmd);
1063                 break;
1064
1065         case SIOCSIFCAP:
1066         {
1067                 int mask = ifr->ifr_reqcap ^ ifp->if_capenable;
1068
1069                 QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFCAP (0x%lx)\n",
1070                         __func__, cmd));
1071
1072                 if (mask & IFCAP_HWCSUM)
1073                         ifp->if_capenable ^= IFCAP_HWCSUM;
1074                 if (mask & IFCAP_TSO4)
1075                         ifp->if_capenable ^= IFCAP_TSO4;
1076                 if (mask & IFCAP_VLAN_HWTAGGING)
1077                         ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING;
1078                 if (mask & IFCAP_VLAN_HWTSO)
1079                         ifp->if_capenable ^= IFCAP_VLAN_HWTSO;
1080                 if (mask & IFCAP_LRO)
1081                         ifp->if_capenable ^= IFCAP_LRO;
1082
1083                 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1084                         qla_init(ha);
1085
1086                 VLAN_CAPABILITIES(ifp);
1087                 break;
1088         }
1089
1090         default:
1091                 QL_DPRINT4(ha, (ha->pci_dev, "%s: default (0x%lx)\n",
1092                         __func__, cmd));
1093                 ret = ether_ioctl(ifp, cmd, data);
1094                 break;
1095         }
1096
1097         return (ret);
1098 }
1099
1100 static int
1101 qla_media_change(struct ifnet *ifp)
1102 {
1103         qla_host_t *ha;
1104         struct ifmedia *ifm;
1105         int ret = 0;
1106
1107         ha = (qla_host_t *)ifp->if_softc;
1108
1109         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1110
1111         ifm = &ha->media;
1112
1113         if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
1114                 ret = EINVAL;
1115
1116         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1117
1118         return (ret);
1119 }
1120
1121 static void
1122 qla_media_status(struct ifnet *ifp, struct ifmediareq *ifmr)
1123 {
1124         qla_host_t *ha;
1125
1126         ha = (qla_host_t *)ifp->if_softc;
1127
1128         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1129
1130         ifmr->ifm_status = IFM_AVALID;
1131         ifmr->ifm_active = IFM_ETHER;
1132
1133         ql_update_link_state(ha);
1134         if (ha->hw.link_up) {
1135                 ifmr->ifm_status |= IFM_ACTIVE;
1136                 ifmr->ifm_active |= (IFM_FDX | qla_get_optics(ha));
1137         }
1138
1139         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit (%s)\n", __func__,\
1140                 (ha->hw.link_up ? "link_up" : "link_down")));
1141
1142         return;
1143 }
1144
1145
1146 static int
1147 qla_send(qla_host_t *ha, struct mbuf **m_headp, uint32_t txr_idx,
1148         uint32_t iscsi_pdu)
1149 {
1150         bus_dma_segment_t       segs[QLA_MAX_SEGMENTS];
1151         bus_dmamap_t            map;
1152         int                     nsegs;
1153         int                     ret = -1;
1154         uint32_t                tx_idx;
1155         struct mbuf             *m_head = *m_headp;
1156
1157         QL_DPRINT8(ha, (ha->pci_dev, "%s: enter\n", __func__));
1158
1159         if (m_head->m_flags & M_FLOWID) {
1160 #ifdef QL_ENABLE_ISCSI_TLV
1161                 if (qla_iscsi_pdu(ha, m_head) == 0) {
1162                         iscsi_pdu = 1;
1163                         txr_idx = m_head->m_pkthdr.flowid &
1164                                         ((ha->hw.num_tx_rings >> 1) - 1);
1165                 } else {
1166                         txr_idx = m_head->m_pkthdr.flowid &
1167                                         (ha->hw.num_tx_rings - 1);
1168                 }
1169 #else
1170                 txr_idx = m_head->m_pkthdr.flowid & (ha->hw.num_tx_rings - 1);
1171 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
1172         }
1173
1174
1175         tx_idx = ha->hw.tx_cntxt[txr_idx].txr_next;
1176         map = ha->tx_ring[txr_idx].tx_buf[tx_idx].map;
1177
1178         ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head, segs, &nsegs,
1179                         BUS_DMA_NOWAIT);
1180
1181         if (ret == EFBIG) {
1182
1183                 struct mbuf *m;
1184
1185                 QL_DPRINT8(ha, (ha->pci_dev, "%s: EFBIG [%d]\n", __func__,
1186                         m_head->m_pkthdr.len));
1187
1188                 m = m_defrag(m_head, M_NOWAIT);
1189                 if (m == NULL) {
1190                         ha->err_tx_defrag++;
1191                         m_freem(m_head);
1192                         *m_headp = NULL;
1193                         device_printf(ha->pci_dev,
1194                                 "%s: m_defrag() = NULL [%d]\n",
1195                                 __func__, ret);
1196                         return (ENOBUFS);
1197                 }
1198                 m_head = m;
1199                 *m_headp = m_head;
1200
1201                 if ((ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head,
1202                                         segs, &nsegs, BUS_DMA_NOWAIT))) {
1203
1204                         ha->err_tx_dmamap_load++;
1205
1206                         device_printf(ha->pci_dev,
1207                                 "%s: bus_dmamap_load_mbuf_sg failed0[%d, %d]\n",
1208                                 __func__, ret, m_head->m_pkthdr.len);
1209
1210                         if (ret != ENOMEM) {
1211                                 m_freem(m_head);
1212                                 *m_headp = NULL;
1213                         }
1214                         return (ret);
1215                 }
1216
1217         } else if (ret) {
1218
1219                 ha->err_tx_dmamap_load++;
1220
1221                 device_printf(ha->pci_dev,
1222                         "%s: bus_dmamap_load_mbuf_sg failed1[%d, %d]\n",
1223                         __func__, ret, m_head->m_pkthdr.len);
1224
1225                 if (ret != ENOMEM) {
1226                         m_freem(m_head);
1227                         *m_headp = NULL;
1228                 }
1229                 return (ret);
1230         }
1231
1232         QL_ASSERT(ha, (nsegs != 0), ("qla_send: empty packet"));
1233
1234         bus_dmamap_sync(ha->tx_tag, map, BUS_DMASYNC_PREWRITE);
1235
1236         if (!(ret = ql_hw_send(ha, segs, nsegs, tx_idx, m_head, txr_idx,
1237                                 iscsi_pdu))) {
1238                 ha->tx_ring[txr_idx].count++;
1239                 ha->tx_ring[txr_idx].tx_buf[tx_idx].m_head = m_head;
1240         } else {
1241                 if (ret == EINVAL) {
1242                         if (m_head)
1243                                 m_freem(m_head);
1244                         *m_headp = NULL;
1245                 }
1246         }
1247
1248         QL_DPRINT8(ha, (ha->pci_dev, "%s: exit\n", __func__));
1249         return (ret);
1250 }
1251
1252 static int
1253 qla_alloc_tx_br(qla_host_t *ha, qla_tx_fp_t *fp)
1254 {
1255         snprintf(fp->tx_mtx_name, sizeof(fp->tx_mtx_name),
1256                 "qla%d_fp%d_tx_mq_lock", ha->pci_func, fp->txr_idx);
1257
1258         mtx_init(&fp->tx_mtx, fp->tx_mtx_name, NULL, MTX_DEF);
1259
1260         fp->tx_br = buf_ring_alloc(NUM_TX_DESCRIPTORS, M_DEVBUF,
1261                                    M_NOWAIT, &fp->tx_mtx);
1262         if (fp->tx_br == NULL) {
1263             QL_DPRINT1(ha, (ha->pci_dev, "buf_ring_alloc failed for "
1264                 " fp[%d, %d]\n", ha->pci_func, fp->txr_idx));
1265             return (-ENOMEM);
1266         }
1267         return 0;
1268 }
1269
1270 static void
1271 qla_free_tx_br(qla_host_t *ha, qla_tx_fp_t *fp)
1272 {
1273         struct mbuf *mp;
1274         struct ifnet *ifp = ha->ifp;
1275
1276         if (mtx_initialized(&fp->tx_mtx)) {
1277
1278                 if (fp->tx_br != NULL) {
1279
1280                         mtx_lock(&fp->tx_mtx);
1281
1282                         while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
1283                                 m_freem(mp);
1284                         }
1285
1286                         mtx_unlock(&fp->tx_mtx);
1287
1288                         buf_ring_free(fp->tx_br, M_DEVBUF);
1289                         fp->tx_br = NULL;
1290                 }
1291                 mtx_destroy(&fp->tx_mtx);
1292         }
1293         return;
1294 }
1295
1296 static void
1297 qla_fp_taskqueue(void *context, int pending)
1298 {
1299         qla_tx_fp_t *fp;
1300         qla_host_t *ha;
1301         struct ifnet *ifp;
1302         struct mbuf  *mp;
1303         int ret = 0;
1304         uint32_t txr_idx;
1305         uint32_t iscsi_pdu = 0;
1306         uint32_t rx_pkts_left;
1307
1308         fp = context;
1309
1310         if (fp == NULL)
1311                 return;
1312
1313         ha = (qla_host_t *)fp->ha;
1314
1315         ifp = ha->ifp;
1316
1317         txr_idx = fp->txr_idx;
1318
1319         mtx_lock(&fp->tx_mtx);
1320
1321         if (((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
1322                 IFF_DRV_RUNNING) || (!ha->hw.link_up)) {
1323                 mtx_unlock(&fp->tx_mtx);
1324                 goto qla_fp_taskqueue_exit;
1325         }
1326
1327         rx_pkts_left = ql_rcv_isr(ha, fp->txr_idx, 64);
1328
1329 #ifdef QL_ENABLE_ISCSI_TLV
1330         ql_hw_tx_done_locked(ha, fp->txr_idx);
1331         ql_hw_tx_done_locked(ha, (fp->txr_idx + (ha->hw.num_tx_rings >> 1)));
1332         txr_idx = txr_idx + (ha->hw.num_tx_rings >> 1);
1333 #else
1334         ql_hw_tx_done_locked(ha, fp->txr_idx);
1335 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
1336
1337         mp = drbr_peek(ifp, fp->tx_br);
1338
1339         while (mp != NULL) {
1340
1341                 if (M_HASHTYPE_GET(mp) != M_HASHTYPE_NONE) {
1342 #ifdef QL_ENABLE_ISCSI_TLV
1343                         if (ql_iscsi_pdu(ha, mp) == 0) {
1344                                 iscsi_pdu = 1;
1345                         }
1346 #endif /* #ifdef QL_ENABLE_ISCSI_TLV */
1347                 }
1348
1349                 ret = qla_send(ha, &mp, txr_idx, iscsi_pdu);
1350
1351                 if (ret) {
1352                         if (mp != NULL)
1353                                 drbr_putback(ifp, fp->tx_br, mp);
1354                         else {
1355                                 drbr_advance(ifp, fp->tx_br);
1356                         }
1357
1358                         mtx_unlock(&fp->tx_mtx);
1359
1360                         goto qla_fp_taskqueue_exit0;
1361                 } else {
1362                         drbr_advance(ifp, fp->tx_br);
1363                 }
1364
1365                 mp = drbr_peek(ifp, fp->tx_br);
1366         }
1367
1368         mtx_unlock(&fp->tx_mtx);
1369
1370 qla_fp_taskqueue_exit0:
1371
1372         if (rx_pkts_left || ((mp != NULL) && ret)) {
1373                 taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
1374         } else {
1375                 if (!ha->flags.stop_rcv) {
1376                         QL_ENABLE_INTERRUPTS(ha, fp->txr_idx);
1377                 }
1378         }
1379
1380 qla_fp_taskqueue_exit:
1381
1382         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
1383         return;
1384 }
1385
1386 static int
1387 qla_create_fp_taskqueues(qla_host_t *ha)
1388 {
1389         int     i;
1390         uint8_t tq_name[32];
1391
1392         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1393
1394                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1395
1396                 bzero(tq_name, sizeof (tq_name));
1397                 snprintf(tq_name, sizeof (tq_name), "ql_fp_tq_%d", i);
1398
1399                 TASK_INIT(&fp->fp_task, 0, qla_fp_taskqueue, fp);
1400
1401                 fp->fp_taskqueue = taskqueue_create_fast(tq_name, M_NOWAIT,
1402                                         taskqueue_thread_enqueue,
1403                                         &fp->fp_taskqueue);
1404
1405                 if (fp->fp_taskqueue == NULL)
1406                         return (-1);
1407
1408                 taskqueue_start_threads(&fp->fp_taskqueue, 1, PI_NET, "%s",
1409                         tq_name);
1410
1411                 QL_DPRINT1(ha, (ha->pci_dev, "%s: %p\n", __func__,
1412                         fp->fp_taskqueue));
1413         }
1414
1415         return (0);
1416 }
1417
1418 static void
1419 qla_destroy_fp_taskqueues(qla_host_t *ha)
1420 {
1421         int     i;
1422
1423         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1424
1425                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1426
1427                 if (fp->fp_taskqueue != NULL) {
1428                         taskqueue_drain(fp->fp_taskqueue, &fp->fp_task);
1429                         taskqueue_free(fp->fp_taskqueue);
1430                         fp->fp_taskqueue = NULL;
1431                 }
1432         }
1433         return;
1434 }
1435
1436 static void
1437 qla_drain_fp_taskqueues(qla_host_t *ha)
1438 {
1439         int     i;
1440
1441         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1442                 qla_tx_fp_t *fp = &ha->tx_fp[i];
1443
1444                 if (fp->fp_taskqueue != NULL) {
1445                         taskqueue_drain(fp->fp_taskqueue, &fp->fp_task);
1446                 }
1447         }
1448         return;
1449 }
1450
1451 static int
1452 qla_transmit(struct ifnet *ifp, struct mbuf  *mp)
1453 {
1454         qla_host_t *ha = (qla_host_t *)ifp->if_softc;
1455         qla_tx_fp_t *fp;
1456         int rss_id = 0;
1457         int ret = 0;
1458
1459         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1460
1461 #if __FreeBSD_version >= 1100000
1462         if (M_HASHTYPE_GET(mp) != M_HASHTYPE_NONE)
1463 #else
1464         if (mp->m_flags & M_FLOWID)
1465 #endif
1466                 rss_id = (mp->m_pkthdr.flowid & Q8_RSS_IND_TBL_MAX_IDX) %
1467                                         ha->hw.num_sds_rings;
1468         fp = &ha->tx_fp[rss_id];
1469
1470         if (fp->tx_br == NULL) {
1471                 ret = EINVAL;
1472                 goto qla_transmit_exit;
1473         }
1474
1475         if (mp != NULL) {
1476                 ret = drbr_enqueue(ifp, fp->tx_br, mp);
1477         }
1478
1479         if (fp->fp_taskqueue != NULL)
1480                 taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
1481
1482         ret = 0;
1483
1484 qla_transmit_exit:
1485
1486         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
1487         return ret;
1488 }
1489
1490 static void
1491 qla_qflush(struct ifnet *ifp)
1492 {
1493         int                     i;
1494         qla_tx_fp_t             *fp;
1495         struct mbuf             *mp;
1496         qla_host_t              *ha;
1497
1498         ha = (qla_host_t *)ifp->if_softc;
1499
1500         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1501
1502         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1503
1504                 fp = &ha->tx_fp[i];
1505
1506                 if (fp == NULL)
1507                         continue;
1508
1509                 if (fp->tx_br) {
1510                         mtx_lock(&fp->tx_mtx);
1511
1512                         while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
1513                                 m_freem(mp);
1514                         }
1515                         mtx_unlock(&fp->tx_mtx);
1516                 }
1517         }
1518         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1519
1520         return;
1521 }
1522
1523 static void
1524 qla_stop(qla_host_t *ha)
1525 {
1526         struct ifnet *ifp = ha->ifp;
1527         device_t        dev;
1528         int i = 0;
1529
1530         dev = ha->pci_dev;
1531
1532         ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE | IFF_DRV_RUNNING);
1533
1534         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1535                 qla_tx_fp_t *fp;
1536
1537                 fp = &ha->tx_fp[i];
1538
1539                 if (fp == NULL)
1540                         continue;
1541
1542                 if (fp->tx_br != NULL) {
1543                         mtx_lock(&fp->tx_mtx);
1544                         mtx_unlock(&fp->tx_mtx);
1545                 }
1546         }
1547
1548         ha->flags.qla_watchdog_pause = 1;
1549
1550         while (!ha->qla_watchdog_paused)
1551                 qla_mdelay(__func__, 1);
1552
1553         ha->flags.qla_interface_up = 0;
1554
1555         qla_drain_fp_taskqueues(ha);
1556
1557         ql_hw_stop_rcv(ha);
1558
1559         ql_del_hw_if(ha);
1560
1561         qla_free_xmt_bufs(ha);
1562         qla_free_rcv_bufs(ha);
1563
1564         return;
1565 }
1566
1567 /*
1568  * Buffer Management Functions for Transmit and Receive Rings
1569  */
1570 static int
1571 qla_alloc_xmt_bufs(qla_host_t *ha)
1572 {
1573         int ret = 0;
1574         uint32_t i, j;
1575         qla_tx_buf_t *txb;
1576
1577         if (bus_dma_tag_create(NULL,    /* parent */
1578                 1, 0,    /* alignment, bounds */
1579                 BUS_SPACE_MAXADDR,       /* lowaddr */
1580                 BUS_SPACE_MAXADDR,       /* highaddr */
1581                 NULL, NULL,      /* filter, filterarg */
1582                 QLA_MAX_TSO_FRAME_SIZE,     /* maxsize */
1583                 QLA_MAX_SEGMENTS,        /* nsegments */
1584                 PAGE_SIZE,        /* maxsegsize */
1585                 BUS_DMA_ALLOCNOW,        /* flags */
1586                 NULL,    /* lockfunc */
1587                 NULL,    /* lockfuncarg */
1588                 &ha->tx_tag)) {
1589                 device_printf(ha->pci_dev, "%s: tx_tag alloc failed\n",
1590                         __func__);
1591                 return (ENOMEM);
1592         }
1593
1594         for (i = 0; i < ha->hw.num_tx_rings; i++) {
1595                 bzero((void *)ha->tx_ring[i].tx_buf,
1596                         (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1597         }
1598
1599         for (j = 0; j < ha->hw.num_tx_rings; j++) {
1600                 for (i = 0; i < NUM_TX_DESCRIPTORS; i++) {
1601
1602                         txb = &ha->tx_ring[j].tx_buf[i];
1603
1604                         if ((ret = bus_dmamap_create(ha->tx_tag,
1605                                         BUS_DMA_NOWAIT, &txb->map))) {
1606
1607                                 ha->err_tx_dmamap_create++;
1608                                 device_printf(ha->pci_dev,
1609                                         "%s: bus_dmamap_create failed[%d]\n",
1610                                         __func__, ret);
1611
1612                                 qla_free_xmt_bufs(ha);
1613
1614                                 return (ret);
1615                         }
1616                 }
1617         }
1618
1619         return 0;
1620 }
1621
1622 /*
1623  * Release mbuf after it sent on the wire
1624  */
1625 static void
1626 qla_clear_tx_buf(qla_host_t *ha, qla_tx_buf_t *txb)
1627 {
1628         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1629
1630         if (txb->m_head && txb->map) {
1631
1632                 bus_dmamap_unload(ha->tx_tag, txb->map);
1633
1634                 m_freem(txb->m_head);
1635                 txb->m_head = NULL;
1636         }
1637
1638         if (txb->map)
1639                 bus_dmamap_destroy(ha->tx_tag, txb->map);
1640
1641         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1642 }
1643
1644 static void
1645 qla_free_xmt_bufs(qla_host_t *ha)
1646 {
1647         int             i, j;
1648
1649         for (j = 0; j < ha->hw.num_tx_rings; j++) {
1650                 for (i = 0; i < NUM_TX_DESCRIPTORS; i++)
1651                         qla_clear_tx_buf(ha, &ha->tx_ring[j].tx_buf[i]);
1652         }
1653
1654         if (ha->tx_tag != NULL) {
1655                 bus_dma_tag_destroy(ha->tx_tag);
1656                 ha->tx_tag = NULL;
1657         }
1658
1659         for (i = 0; i < ha->hw.num_tx_rings; i++) {
1660                 bzero((void *)ha->tx_ring[i].tx_buf,
1661                         (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1662         }
1663         return;
1664 }
1665
1666
1667 static int
1668 qla_alloc_rcv_std(qla_host_t *ha)
1669 {
1670         int             i, j, k, r, ret = 0;
1671         qla_rx_buf_t    *rxb;
1672         qla_rx_ring_t   *rx_ring;
1673
1674         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1675
1676                 rx_ring = &ha->rx_ring[r];
1677
1678                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1679
1680                         rxb = &rx_ring->rx_buf[i];
1681
1682                         ret = bus_dmamap_create(ha->rx_tag, BUS_DMA_NOWAIT,
1683                                         &rxb->map);
1684
1685                         if (ret) {
1686                                 device_printf(ha->pci_dev,
1687                                         "%s: dmamap[%d, %d] failed\n",
1688                                         __func__, r, i);
1689
1690                                 for (k = 0; k < r; k++) {
1691                                         for (j = 0; j < NUM_RX_DESCRIPTORS;
1692                                                 j++) {
1693                                                 rxb = &ha->rx_ring[k].rx_buf[j];
1694                                                 bus_dmamap_destroy(ha->rx_tag,
1695                                                         rxb->map);
1696                                         }
1697                                 }
1698
1699                                 for (j = 0; j < i; j++) {
1700                                         bus_dmamap_destroy(ha->rx_tag,
1701                                                 rx_ring->rx_buf[j].map);
1702                                 }
1703                                 goto qla_alloc_rcv_std_err;
1704                         }
1705                 }
1706         }
1707
1708         qla_init_hw_rcv_descriptors(ha);
1709
1710
1711         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1712
1713                 rx_ring = &ha->rx_ring[r];
1714
1715                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1716                         rxb = &rx_ring->rx_buf[i];
1717                         rxb->handle = i;
1718                         if (!(ret = ql_get_mbuf(ha, rxb, NULL))) {
1719                                 /*
1720                                  * set the physical address in the
1721                                  * corresponding descriptor entry in the
1722                                  * receive ring/queue for the hba
1723                                  */
1724                                 qla_set_hw_rcv_desc(ha, r, i, rxb->handle,
1725                                         rxb->paddr,
1726                                         (rxb->m_head)->m_pkthdr.len);
1727                         } else {
1728                                 device_printf(ha->pci_dev,
1729                                         "%s: ql_get_mbuf [%d, %d] failed\n",
1730                                         __func__, r, i);
1731                                 bus_dmamap_destroy(ha->rx_tag, rxb->map);
1732                                 goto qla_alloc_rcv_std_err;
1733                         }
1734                 }
1735         }
1736         return 0;
1737
1738 qla_alloc_rcv_std_err:
1739         return (-1);
1740 }
1741
1742 static void
1743 qla_free_rcv_std(qla_host_t *ha)
1744 {
1745         int             i, r;
1746         qla_rx_buf_t    *rxb;
1747
1748         for (r = 0; r < ha->hw.num_rds_rings; r++) {
1749                 for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1750                         rxb = &ha->rx_ring[r].rx_buf[i];
1751                         if (rxb->m_head != NULL) {
1752                                 bus_dmamap_unload(ha->rx_tag, rxb->map);
1753                                 bus_dmamap_destroy(ha->rx_tag, rxb->map);
1754                                 m_freem(rxb->m_head);
1755                                 rxb->m_head = NULL;
1756                         }
1757                 }
1758         }
1759         return;
1760 }
1761
1762 static int
1763 qla_alloc_rcv_bufs(qla_host_t *ha)
1764 {
1765         int             i, ret = 0;
1766
1767         if (bus_dma_tag_create(NULL,    /* parent */
1768                         1, 0,    /* alignment, bounds */
1769                         BUS_SPACE_MAXADDR,       /* lowaddr */
1770                         BUS_SPACE_MAXADDR,       /* highaddr */
1771                         NULL, NULL,      /* filter, filterarg */
1772                         MJUM9BYTES,     /* maxsize */
1773                         1,        /* nsegments */
1774                         MJUM9BYTES,        /* maxsegsize */
1775                         BUS_DMA_ALLOCNOW,        /* flags */
1776                         NULL,    /* lockfunc */
1777                         NULL,    /* lockfuncarg */
1778                         &ha->rx_tag)) {
1779
1780                 device_printf(ha->pci_dev, "%s: rx_tag alloc failed\n",
1781                         __func__);
1782
1783                 return (ENOMEM);
1784         }
1785
1786         bzero((void *)ha->rx_ring, (sizeof(qla_rx_ring_t) * MAX_RDS_RINGS));
1787
1788         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1789                 ha->hw.sds[i].sdsr_next = 0;
1790                 ha->hw.sds[i].rxb_free = NULL;
1791                 ha->hw.sds[i].rx_free = 0;
1792         }
1793
1794         ret = qla_alloc_rcv_std(ha);
1795
1796         return (ret);
1797 }
1798
1799 static void
1800 qla_free_rcv_bufs(qla_host_t *ha)
1801 {
1802         int             i;
1803
1804         qla_free_rcv_std(ha);
1805
1806         if (ha->rx_tag != NULL) {
1807                 bus_dma_tag_destroy(ha->rx_tag);
1808                 ha->rx_tag = NULL;
1809         }
1810
1811         bzero((void *)ha->rx_ring, (sizeof(qla_rx_ring_t) * MAX_RDS_RINGS));
1812
1813         for (i = 0; i < ha->hw.num_sds_rings; i++) {
1814                 ha->hw.sds[i].sdsr_next = 0;
1815                 ha->hw.sds[i].rxb_free = NULL;
1816                 ha->hw.sds[i].rx_free = 0;
1817         }
1818
1819         return;
1820 }
1821
1822 int
1823 ql_get_mbuf(qla_host_t *ha, qla_rx_buf_t *rxb, struct mbuf *nmp)
1824 {
1825         register struct mbuf *mp = nmp;
1826         struct ifnet            *ifp;
1827         int                     ret = 0;
1828         uint32_t                offset;
1829         bus_dma_segment_t       segs[1];
1830         int                     nsegs, mbuf_size;
1831
1832         QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1833
1834         ifp = ha->ifp;
1835
1836         if (ha->hw.enable_9kb)
1837                 mbuf_size = MJUM9BYTES;
1838         else
1839                 mbuf_size = MCLBYTES;
1840
1841         if (mp == NULL) {
1842
1843                 if (QL_ERR_INJECT(ha, INJCT_M_GETCL_M_GETJCL_FAILURE))
1844                         return(-1);
1845
1846                 if (ha->hw.enable_9kb)
1847                         mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, mbuf_size);
1848                 else
1849                         mp = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1850
1851                 if (mp == NULL) {
1852                         ha->err_m_getcl++;
1853                         ret = ENOBUFS;
1854                         device_printf(ha->pci_dev,
1855                                         "%s: m_getcl failed\n", __func__);
1856                         goto exit_ql_get_mbuf;
1857                 }
1858                 mp->m_len = mp->m_pkthdr.len = mbuf_size;
1859         } else {
1860                 mp->m_len = mp->m_pkthdr.len = mbuf_size;
1861                 mp->m_data = mp->m_ext.ext_buf;
1862                 mp->m_next = NULL;
1863         }
1864
1865         offset = (uint32_t)((unsigned long long)mp->m_data & 0x7ULL);
1866         if (offset) {
1867                 offset = 8 - offset;
1868                 m_adj(mp, offset);
1869         }
1870
1871         /*
1872          * Using memory from the mbuf cluster pool, invoke the bus_dma
1873          * machinery to arrange the memory mapping.
1874          */
1875         ret = bus_dmamap_load_mbuf_sg(ha->rx_tag, rxb->map,
1876                         mp, segs, &nsegs, BUS_DMA_NOWAIT);
1877         rxb->paddr = segs[0].ds_addr;
1878
1879         if (ret || !rxb->paddr || (nsegs != 1)) {
1880                 m_free(mp);
1881                 rxb->m_head = NULL;
1882                 device_printf(ha->pci_dev,
1883                         "%s: bus_dmamap_load failed[%d, 0x%016llx, %d]\n",
1884                         __func__, ret, (long long unsigned int)rxb->paddr,
1885                         nsegs);
1886                 ret = -1;
1887                 goto exit_ql_get_mbuf;
1888         }
1889         rxb->m_head = mp;
1890         bus_dmamap_sync(ha->rx_tag, rxb->map, BUS_DMASYNC_PREREAD);
1891
1892 exit_ql_get_mbuf:
1893         QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = 0x%08x\n", __func__, ret));
1894         return (ret);
1895 }
1896
1897
1898 static void
1899 qla_get_peer(qla_host_t *ha)
1900 {
1901         device_t *peers;
1902         int count, i, slot;
1903         int my_slot = pci_get_slot(ha->pci_dev);
1904
1905         if (device_get_children(device_get_parent(ha->pci_dev), &peers, &count))
1906                 return;
1907
1908         for (i = 0; i < count; i++) {
1909                 slot = pci_get_slot(peers[i]);
1910
1911                 if ((slot >= 0) && (slot == my_slot) &&
1912                         (pci_get_device(peers[i]) ==
1913                                 pci_get_device(ha->pci_dev))) {
1914                         if (ha->pci_dev != peers[i])
1915                                 ha->peer_dev = peers[i];
1916                 }
1917         }
1918 }
1919
1920 static void
1921 qla_send_msg_to_peer(qla_host_t *ha, uint32_t msg_to_peer)
1922 {
1923         qla_host_t *ha_peer;
1924
1925         if (ha->peer_dev) {
1926                 if ((ha_peer = device_get_softc(ha->peer_dev)) != NULL) {
1927
1928                         ha_peer->msg_from_peer = msg_to_peer;
1929                 }
1930         }
1931 }
1932
1933 static void
1934 qla_error_recovery(void *context, int pending)
1935 {
1936         qla_host_t *ha = context;
1937         uint32_t msecs_100 = 100;
1938         struct ifnet *ifp = ha->ifp;
1939         int i = 0;
1940
1941         (void)QLA_LOCK(ha, __func__, 0);
1942
1943         if (ha->flags.qla_interface_up) {
1944
1945                 ha->hw.imd_compl = 1;
1946                 qla_mdelay(__func__, 300);
1947
1948                 ql_hw_stop_rcv(ha);
1949
1950                 ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE | IFF_DRV_RUNNING);
1951
1952                 for (i = 0; i < ha->hw.num_sds_rings; i++) {
1953                         qla_tx_fp_t *fp;
1954
1955                         fp = &ha->tx_fp[i];
1956
1957                         if (fp == NULL)
1958                                 continue;
1959
1960                         if (fp->tx_br != NULL) {
1961                                 mtx_lock(&fp->tx_mtx);
1962                                 mtx_unlock(&fp->tx_mtx);
1963                         }
1964                 }
1965         }
1966
1967         QLA_UNLOCK(ha, __func__);
1968
1969         if ((ha->pci_func & 0x1) == 0) {
1970
1971                 if (!ha->msg_from_peer) {
1972                         qla_send_msg_to_peer(ha, QL_PEER_MSG_RESET);
1973
1974                         while ((ha->msg_from_peer != QL_PEER_MSG_ACK) &&
1975                                 msecs_100--)
1976                                 qla_mdelay(__func__, 100);
1977                 }
1978
1979                 ha->msg_from_peer = 0;
1980
1981                 (void)QLA_LOCK(ha, __func__, 0);
1982                 ql_minidump(ha);
1983                 QLA_UNLOCK(ha, __func__);
1984
1985                 (void) ql_init_hw(ha);
1986
1987                 (void)QLA_LOCK(ha, __func__, 0);
1988                 if (ha->flags.qla_interface_up) {
1989                 qla_free_xmt_bufs(ha);
1990                 qla_free_rcv_bufs(ha);
1991                 }
1992                 QLA_UNLOCK(ha, __func__);
1993
1994                 qla_send_msg_to_peer(ha, QL_PEER_MSG_ACK);
1995
1996         } else {
1997                 if (ha->msg_from_peer == QL_PEER_MSG_RESET) {
1998
1999                         ha->msg_from_peer = 0;
2000
2001                         qla_send_msg_to_peer(ha, QL_PEER_MSG_ACK);
2002                 } else {
2003                         qla_send_msg_to_peer(ha, QL_PEER_MSG_RESET);
2004                 }
2005
2006                 while ((ha->msg_from_peer != QL_PEER_MSG_ACK)  && msecs_100--)
2007                         qla_mdelay(__func__, 100);
2008                 ha->msg_from_peer = 0;
2009
2010                 (void) ql_init_hw(ha);
2011
2012                 (void)QLA_LOCK(ha, __func__, 0);
2013                 if (ha->flags.qla_interface_up) {
2014                 qla_free_xmt_bufs(ha);
2015                 qla_free_rcv_bufs(ha);
2016         }
2017                 QLA_UNLOCK(ha, __func__);
2018         }
2019
2020         (void)QLA_LOCK(ha, __func__, 0);
2021
2022         if (ha->flags.qla_interface_up) {
2023         if (qla_alloc_xmt_bufs(ha) != 0) {
2024                 QLA_UNLOCK(ha, __func__);
2025                 return;
2026         }
2027         qla_confirm_9kb_enable(ha);
2028
2029         if (qla_alloc_rcv_bufs(ha) != 0) {
2030                 QLA_UNLOCK(ha, __func__);
2031                 return;
2032         }
2033
2034         ha->flags.stop_rcv = 0;
2035         if (ql_init_hw_if(ha) == 0) {
2036                 ifp = ha->ifp;
2037                 ifp->if_drv_flags |= IFF_DRV_RUNNING;
2038                 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
2039                 ha->flags.qla_watchdog_pause = 0;
2040         }
2041         } else
2042                 ha->flags.qla_watchdog_pause = 0;
2043
2044         QLA_UNLOCK(ha, __func__);
2045 }
2046
2047 static void
2048 qla_async_event(void *context, int pending)
2049 {
2050         qla_host_t *ha = context;
2051
2052         (void)QLA_LOCK(ha, __func__, 0);
2053         qla_hw_async_event(ha);
2054         QLA_UNLOCK(ha, __func__);
2055 }
2056