Logo Search packages:      
Sourcecode: linux version File versions  Download package

lpfc_sli.c

/*******************************************************************
 * This file is part of the Emulex Linux Device Driver for         *
 * Fibre Channel Host Bus Adapters.                                *
 * Copyright (C) 2004-2007 Emulex.  All rights reserved.           *
 * EMULEX and SLI are trademarks of Emulex.                        *
 * www.emulex.com                                                  *
 * Portions Copyright (C) 2004-2005 Christoph Hellwig              *
 *                                                                 *
 * This program is free software; you can redistribute it and/or   *
 * modify it under the terms of version 2 of the GNU General       *
 * Public License as published by the Free Software Foundation.    *
 * This program is distributed in the hope that it will be useful. *
 * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
 * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
 * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
 * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
 * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
 * more details, a copy of which can be found in the file COPYING  *
 * included with this package.                                     *
 *******************************************************************/

#include <linux/blkdev.h>
#include <linux/pci.h>
#include <linux/interrupt.h>
#include <linux/delay.h>

#include <scsi/scsi.h>
#include <scsi/scsi_cmnd.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_host.h>
#include <scsi/scsi_transport_fc.h>

#include "lpfc_hw.h"
#include "lpfc_sli.h"
#include "lpfc_disc.h"
#include "lpfc_scsi.h"
#include "lpfc.h"
#include "lpfc_crtn.h"
#include "lpfc_logmsg.h"
#include "lpfc_compat.h"
#include "lpfc_debugfs.h"

/*
 * Define macro to log: Mailbox command x%x cannot issue Data
 * This allows multiple uses of lpfc_msgBlk0311
 * w/o perturbing log msg utility.
 */
#define LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag) \
                  lpfc_printf_log(phba, \
                        KERN_INFO, \
                        LOG_MBOX | LOG_SLI, \
                        "(%d):0311 Mailbox command x%x cannot " \
                        "issue Data: x%x x%x x%x\n", \
                        pmbox->vport ? pmbox->vport->vpi : 0, \
                        pmbox->mb.mbxCommand,         \
                        phba->pport->port_state,      \
                        psli->sli_flag,   \
                        flag)


/* There are only four IOCB completion types. */
typedef enum _lpfc_iocb_type {
      LPFC_UNKNOWN_IOCB,
      LPFC_UNSOL_IOCB,
      LPFC_SOL_IOCB,
      LPFC_ABORT_IOCB
} lpfc_iocb_type;

            /* SLI-2/SLI-3 provide different sized iocbs.  Given a pointer
             * to the start of the ring, and the slot number of the
             * desired iocb entry, calc a pointer to that entry.
             */
static inline IOCB_t *
lpfc_cmd_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      return (IOCB_t *) (((char *) pring->cmdringaddr) +
                     pring->cmdidx * phba->iocb_cmd_size);
}

static inline IOCB_t *
lpfc_resp_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      return (IOCB_t *) (((char *) pring->rspringaddr) +
                     pring->rspidx * phba->iocb_rsp_size);
}

static struct lpfc_iocbq *
__lpfc_sli_get_iocbq(struct lpfc_hba *phba)
{
      struct list_head *lpfc_iocb_list = &phba->lpfc_iocb_list;
      struct lpfc_iocbq * iocbq = NULL;

      list_remove_head(lpfc_iocb_list, iocbq, struct lpfc_iocbq, list);
      return iocbq;
}

struct lpfc_iocbq *
lpfc_sli_get_iocbq(struct lpfc_hba *phba)
{
      struct lpfc_iocbq * iocbq = NULL;
      unsigned long iflags;

      spin_lock_irqsave(&phba->hbalock, iflags);
      iocbq = __lpfc_sli_get_iocbq(phba);
      spin_unlock_irqrestore(&phba->hbalock, iflags);
      return iocbq;
}

void
__lpfc_sli_release_iocbq(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
{
      size_t start_clean = offsetof(struct lpfc_iocbq, iocb);

      /*
       * Clean all volatile data fields, preserve iotag and node struct.
       */
      memset((char*)iocbq + start_clean, 0, sizeof(*iocbq) - start_clean);
      list_add_tail(&iocbq->list, &phba->lpfc_iocb_list);
}

void
lpfc_sli_release_iocbq(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
{
      unsigned long iflags;

      /*
       * Clean all volatile data fields, preserve iotag and node struct.
       */
      spin_lock_irqsave(&phba->hbalock, iflags);
      __lpfc_sli_release_iocbq(phba, iocbq);
      spin_unlock_irqrestore(&phba->hbalock, iflags);
}

/*
 * Translate the iocb command to an iocb command type used to decide the final
 * disposition of each completed IOCB.
 */
static lpfc_iocb_type
lpfc_sli_iocb_cmd_type(uint8_t iocb_cmnd)
{
      lpfc_iocb_type type = LPFC_UNKNOWN_IOCB;

      if (iocb_cmnd > CMD_MAX_IOCB_CMD)
            return 0;

      switch (iocb_cmnd) {
      case CMD_XMIT_SEQUENCE_CR:
      case CMD_XMIT_SEQUENCE_CX:
      case CMD_XMIT_BCAST_CN:
      case CMD_XMIT_BCAST_CX:
      case CMD_ELS_REQUEST_CR:
      case CMD_ELS_REQUEST_CX:
      case CMD_CREATE_XRI_CR:
      case CMD_CREATE_XRI_CX:
      case CMD_GET_RPI_CN:
      case CMD_XMIT_ELS_RSP_CX:
      case CMD_GET_RPI_CR:
      case CMD_FCP_IWRITE_CR:
      case CMD_FCP_IWRITE_CX:
      case CMD_FCP_IREAD_CR:
      case CMD_FCP_IREAD_CX:
      case CMD_FCP_ICMND_CR:
      case CMD_FCP_ICMND_CX:
      case CMD_FCP_TSEND_CX:
      case CMD_FCP_TRSP_CX:
      case CMD_FCP_TRECEIVE_CX:
      case CMD_FCP_AUTO_TRSP_CX:
      case CMD_ADAPTER_MSG:
      case CMD_ADAPTER_DUMP:
      case CMD_XMIT_SEQUENCE64_CR:
      case CMD_XMIT_SEQUENCE64_CX:
      case CMD_XMIT_BCAST64_CN:
      case CMD_XMIT_BCAST64_CX:
      case CMD_ELS_REQUEST64_CR:
      case CMD_ELS_REQUEST64_CX:
      case CMD_FCP_IWRITE64_CR:
      case CMD_FCP_IWRITE64_CX:
      case CMD_FCP_IREAD64_CR:
      case CMD_FCP_IREAD64_CX:
      case CMD_FCP_ICMND64_CR:
      case CMD_FCP_ICMND64_CX:
      case CMD_FCP_TSEND64_CX:
      case CMD_FCP_TRSP64_CX:
      case CMD_FCP_TRECEIVE64_CX:
      case CMD_GEN_REQUEST64_CR:
      case CMD_GEN_REQUEST64_CX:
      case CMD_XMIT_ELS_RSP64_CX:
            type = LPFC_SOL_IOCB;
            break;
      case CMD_ABORT_XRI_CN:
      case CMD_ABORT_XRI_CX:
      case CMD_CLOSE_XRI_CN:
      case CMD_CLOSE_XRI_CX:
      case CMD_XRI_ABORTED_CX:
      case CMD_ABORT_MXRI64_CN:
            type = LPFC_ABORT_IOCB;
            break;
      case CMD_RCV_SEQUENCE_CX:
      case CMD_RCV_ELS_REQ_CX:
      case CMD_RCV_SEQUENCE64_CX:
      case CMD_RCV_ELS_REQ64_CX:
      case CMD_IOCB_RCV_SEQ64_CX:
      case CMD_IOCB_RCV_ELS64_CX:
      case CMD_IOCB_RCV_CONT64_CX:
            type = LPFC_UNSOL_IOCB;
            break;
      default:
            type = LPFC_UNKNOWN_IOCB;
            break;
      }

      return type;
}

static int
lpfc_sli_ring_map(struct lpfc_hba *phba)
{
      struct lpfc_sli *psli = &phba->sli;
      LPFC_MBOXQ_t *pmb;
      MAILBOX_t *pmbox;
      int i, rc, ret = 0;

      pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
      if (!pmb)
            return -ENOMEM;
      pmbox = &pmb->mb;
      phba->link_state = LPFC_INIT_MBX_CMDS;
      for (i = 0; i < psli->num_rings; i++) {
            lpfc_config_ring(phba, i, pmb);
            rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
            if (rc != MBX_SUCCESS) {
                  lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                              "0446 Adapter failed to init (%d), "
                              "mbxCmd x%x CFG_RING, mbxStatus x%x, "
                              "ring %d\n",
                              rc, pmbox->mbxCommand,
                              pmbox->mbxStatus, i);
                  phba->link_state = LPFC_HBA_ERROR;
                  ret = -ENXIO;
                  break;
            }
      }
      mempool_free(pmb, phba->mbox_mem_pool);
      return ret;
}

static int
lpfc_sli_ringtxcmpl_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                  struct lpfc_iocbq *piocb)
{
      list_add_tail(&piocb->list, &pring->txcmplq);
      pring->txcmplq_cnt++;
      if ((unlikely(pring->ringno == LPFC_ELS_RING)) &&
         (piocb->iocb.ulpCommand != CMD_ABORT_XRI_CN) &&
         (piocb->iocb.ulpCommand != CMD_CLOSE_XRI_CN)) {
            if (!piocb->vport)
                  BUG();
            else
                  mod_timer(&piocb->vport->els_tmofunc,
                          jiffies + HZ * (phba->fc_ratov << 1));
      }


      return 0;
}

static struct lpfc_iocbq *
lpfc_sli_ringtx_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      struct lpfc_iocbq *cmd_iocb;

      list_remove_head((&pring->txq), cmd_iocb, struct lpfc_iocbq, list);
      if (cmd_iocb != NULL)
            pring->txq_cnt--;
      return cmd_iocb;
}

static IOCB_t *
lpfc_sli_next_iocb_slot (struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
            &phba->slim2p->mbx.us.s2.port[pring->ringno];
      uint32_t  max_cmd_idx = pring->numCiocb;

      if ((pring->next_cmdidx == pring->cmdidx) &&
         (++pring->next_cmdidx >= max_cmd_idx))
            pring->next_cmdidx = 0;

      if (unlikely(pring->local_getidx == pring->next_cmdidx)) {

            pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);

            if (unlikely(pring->local_getidx >= max_cmd_idx)) {
                  lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                              "0315 Ring %d issue: portCmdGet %d "
                              "is bigger then cmd ring %d\n",
                              pring->ringno,
                              pring->local_getidx, max_cmd_idx);

                  phba->link_state = LPFC_HBA_ERROR;
                  /*
                   * All error attention handlers are posted to
                   * worker thread
                   */
                  phba->work_ha |= HA_ERATT;
                  phba->work_hs = HS_FFER3;

                  /* hbalock should already be held */
                  if (phba->work_wait)
                        lpfc_worker_wake_up(phba);

                  return NULL;
            }

            if (pring->local_getidx == pring->next_cmdidx)
                  return NULL;
      }

      return lpfc_cmd_iocb(phba, pring);
}

uint16_t
lpfc_sli_next_iotag(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
{
      struct lpfc_iocbq **new_arr;
      struct lpfc_iocbq **old_arr;
      size_t new_len;
      struct lpfc_sli *psli = &phba->sli;
      uint16_t iotag;

      spin_lock_irq(&phba->hbalock);
      iotag = psli->last_iotag;
      if(++iotag < psli->iocbq_lookup_len) {
            psli->last_iotag = iotag;
            psli->iocbq_lookup[iotag] = iocbq;
            spin_unlock_irq(&phba->hbalock);
            iocbq->iotag = iotag;
            return iotag;
      } else if (psli->iocbq_lookup_len < (0xffff
                                 - LPFC_IOCBQ_LOOKUP_INCREMENT)) {
            new_len = psli->iocbq_lookup_len + LPFC_IOCBQ_LOOKUP_INCREMENT;
            spin_unlock_irq(&phba->hbalock);
            new_arr = kzalloc(new_len * sizeof (struct lpfc_iocbq *),
                          GFP_KERNEL);
            if (new_arr) {
                  spin_lock_irq(&phba->hbalock);
                  old_arr = psli->iocbq_lookup;
                  if (new_len <= psli->iocbq_lookup_len) {
                        /* highly unprobable case */
                        kfree(new_arr);
                        iotag = psli->last_iotag;
                        if(++iotag < psli->iocbq_lookup_len) {
                              psli->last_iotag = iotag;
                              psli->iocbq_lookup[iotag] = iocbq;
                              spin_unlock_irq(&phba->hbalock);
                              iocbq->iotag = iotag;
                              return iotag;
                        }
                        spin_unlock_irq(&phba->hbalock);
                        return 0;
                  }
                  if (psli->iocbq_lookup)
                        memcpy(new_arr, old_arr,
                               ((psli->last_iotag  + 1) *
                              sizeof (struct lpfc_iocbq *)));
                  psli->iocbq_lookup = new_arr;
                  psli->iocbq_lookup_len = new_len;
                  psli->last_iotag = iotag;
                  psli->iocbq_lookup[iotag] = iocbq;
                  spin_unlock_irq(&phba->hbalock);
                  iocbq->iotag = iotag;
                  kfree(old_arr);
                  return iotag;
            }
      } else
            spin_unlock_irq(&phba->hbalock);

      lpfc_printf_log(phba, KERN_ERR,LOG_SLI,
                  "0318 Failed to allocate IOTAG.last IOTAG is %d\n",
                  psli->last_iotag);

      return 0;
}

static void
lpfc_sli_submit_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
            IOCB_t *iocb, struct lpfc_iocbq *nextiocb)
{
      /*
       * Set up an iotag
       */
      nextiocb->iocb.ulpIoTag = (nextiocb->iocb_cmpl) ? nextiocb->iotag : 0;

      if (pring->ringno == LPFC_ELS_RING) {
            lpfc_debugfs_slow_ring_trc(phba,
                  "IOCB cmd ring:   wd4:x%08x wd6:x%08x wd7:x%08x",
                  *(((uint32_t *) &nextiocb->iocb) + 4),
                  *(((uint32_t *) &nextiocb->iocb) + 6),
                  *(((uint32_t *) &nextiocb->iocb) + 7));
      }

      /*
       * Issue iocb command to adapter
       */
      lpfc_sli_pcimem_bcopy(&nextiocb->iocb, iocb, phba->iocb_cmd_size);
      wmb();
      pring->stats.iocb_cmd++;

      /*
       * If there is no completion routine to call, we can release the
       * IOCB buffer back right now. For IOCBs, like QUE_RING_BUF,
       * that have no rsp ring completion, iocb_cmpl MUST be NULL.
       */
      if (nextiocb->iocb_cmpl)
            lpfc_sli_ringtxcmpl_put(phba, pring, nextiocb);
      else
            __lpfc_sli_release_iocbq(phba, nextiocb);

      /*
       * Let the HBA know what IOCB slot will be the next one the
       * driver will put a command into.
       */
      pring->cmdidx = pring->next_cmdidx;
      writel(pring->cmdidx, &phba->host_gp[pring->ringno].cmdPutInx);
}

static void
lpfc_sli_update_full_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      int ringno = pring->ringno;

      pring->flag |= LPFC_CALL_RING_AVAILABLE;

      wmb();

      /*
       * Set ring 'ringno' to SET R0CE_REQ in Chip Att register.
       * The HBA will tell us when an IOCB entry is available.
       */
      writel((CA_R0ATT|CA_R0CE_REQ) << (ringno*4), phba->CAregaddr);
      readl(phba->CAregaddr); /* flush */

      pring->stats.iocb_cmd_full++;
}

static void
lpfc_sli_update_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      int ringno = pring->ringno;

      /*
       * Tell the HBA that there is work to do in this ring.
       */
      wmb();
      writel(CA_R0ATT << (ringno * 4), phba->CAregaddr);
      readl(phba->CAregaddr); /* flush */
}

static void
lpfc_sli_resume_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      IOCB_t *iocb;
      struct lpfc_iocbq *nextiocb;

      /*
       * Check to see if:
       *  (a) there is anything on the txq to send
       *  (b) link is up
       *  (c) link attention events can be processed (fcp ring only)
       *  (d) IOCB processing is not blocked by the outstanding mbox command.
       */
      if (pring->txq_cnt &&
          lpfc_is_link_up(phba) &&
          (pring->ringno != phba->sli.fcp_ring ||
           phba->sli.sli_flag & LPFC_PROCESS_LA) &&
          !(pring->flag & LPFC_STOP_IOCB_MBX)) {

            while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) &&
                   (nextiocb = lpfc_sli_ringtx_get(phba, pring)))
                  lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb);

            if (iocb)
                  lpfc_sli_update_ring(phba, pring);
            else
                  lpfc_sli_update_full_ring(phba, pring);
      }

      return;
}

/* lpfc_sli_turn_on_ring is only called by lpfc_sli_handle_mb_event below */
static void
lpfc_sli_turn_on_ring(struct lpfc_hba *phba, int ringno)
{
      struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[ringno] :
            &phba->slim2p->mbx.us.s2.port[ringno];
      unsigned long iflags;

      /* If the ring is active, flag it */
      spin_lock_irqsave(&phba->hbalock, iflags);
      if (phba->sli.ring[ringno].cmdringaddr) {
            if (phba->sli.ring[ringno].flag & LPFC_STOP_IOCB_MBX) {
                  phba->sli.ring[ringno].flag &= ~LPFC_STOP_IOCB_MBX;
                  /*
                   * Force update of the local copy of cmdGetInx
                   */
                  phba->sli.ring[ringno].local_getidx
                        = le32_to_cpu(pgp->cmdGetInx);
                  lpfc_sli_resume_iocb(phba, &phba->sli.ring[ringno]);
            }
      }
      spin_unlock_irqrestore(&phba->hbalock, iflags);
}

struct lpfc_hbq_entry *
lpfc_sli_next_hbq_slot(struct lpfc_hba *phba, uint32_t hbqno)
{
      struct hbq_s *hbqp = &phba->hbqs[hbqno];

      if (hbqp->next_hbqPutIdx == hbqp->hbqPutIdx &&
          ++hbqp->next_hbqPutIdx >= hbqp->entry_count)
            hbqp->next_hbqPutIdx = 0;

      if (unlikely(hbqp->local_hbqGetIdx == hbqp->next_hbqPutIdx)) {
            uint32_t raw_index = phba->hbq_get[hbqno];
            uint32_t getidx = le32_to_cpu(raw_index);

            hbqp->local_hbqGetIdx = getidx;

            if (unlikely(hbqp->local_hbqGetIdx >= hbqp->entry_count)) {
                  lpfc_printf_log(phba, KERN_ERR,
                              LOG_SLI | LOG_VPORT,
                              "1802 HBQ %d: local_hbqGetIdx "
                              "%u is > than hbqp->entry_count %u\n",
                              hbqno, hbqp->local_hbqGetIdx,
                              hbqp->entry_count);

                  phba->link_state = LPFC_HBA_ERROR;
                  return NULL;
            }

            if (hbqp->local_hbqGetIdx == hbqp->next_hbqPutIdx)
                  return NULL;
      }

      return (struct lpfc_hbq_entry *) phba->hbqs[hbqno].hbq_virt +
                  hbqp->hbqPutIdx;
}

void
lpfc_sli_hbqbuf_free_all(struct lpfc_hba *phba)
{
      struct lpfc_dmabuf *dmabuf, *next_dmabuf;
      struct hbq_dmabuf *hbq_buf;
      int i, hbq_count;

      hbq_count = lpfc_sli_hbq_count();
      /* Return all memory used by all HBQs */
      for (i = 0; i < hbq_count; ++i) {
            list_for_each_entry_safe(dmabuf, next_dmabuf,
                        &phba->hbqs[i].hbq_buffer_list, list) {
                  hbq_buf = container_of(dmabuf, struct hbq_dmabuf, dbuf);
                  list_del(&hbq_buf->dbuf.list);
                  (phba->hbqs[i].hbq_free_buffer)(phba, hbq_buf);
            }
      }
}

static struct lpfc_hbq_entry *
lpfc_sli_hbq_to_firmware(struct lpfc_hba *phba, uint32_t hbqno,
                   struct hbq_dmabuf *hbq_buf)
{
      struct lpfc_hbq_entry *hbqe;
      dma_addr_t physaddr = hbq_buf->dbuf.phys;

      /* Get next HBQ entry slot to use */
      hbqe = lpfc_sli_next_hbq_slot(phba, hbqno);
      if (hbqe) {
            struct hbq_s *hbqp = &phba->hbqs[hbqno];

            hbqe->bde.addrHigh = le32_to_cpu(putPaddrHigh(physaddr));
            hbqe->bde.addrLow  = le32_to_cpu(putPaddrLow(physaddr));
            hbqe->bde.tus.f.bdeSize = hbq_buf->size;
            hbqe->bde.tus.f.bdeFlags = 0;
            hbqe->bde.tus.w = le32_to_cpu(hbqe->bde.tus.w);
            hbqe->buffer_tag = le32_to_cpu(hbq_buf->tag);
                        /* Sync SLIM */
            hbqp->hbqPutIdx = hbqp->next_hbqPutIdx;
            writel(hbqp->hbqPutIdx, phba->hbq_put + hbqno);
                        /* flush */
            readl(phba->hbq_put + hbqno);
            list_add_tail(&hbq_buf->dbuf.list, &hbqp->hbq_buffer_list);
      }
      return hbqe;
}

static struct lpfc_hbq_init lpfc_els_hbq = {
      .rn = 1,
      .entry_count = 200,
      .mask_count = 0,
      .profile = 0,
      .ring_mask = (1 << LPFC_ELS_RING),
      .buffer_count = 0,
      .init_count = 20,
      .add_count = 5,
};

static struct lpfc_hbq_init lpfc_extra_hbq = {
      .rn = 1,
      .entry_count = 200,
      .mask_count = 0,
      .profile = 0,
      .ring_mask = (1 << LPFC_EXTRA_RING),
      .buffer_count = 0,
      .init_count = 0,
      .add_count = 5,
};

struct lpfc_hbq_init *lpfc_hbq_defs[] = {
      &lpfc_els_hbq,
      &lpfc_extra_hbq,
};

static int
lpfc_sli_hbqbuf_fill_hbqs(struct lpfc_hba *phba, uint32_t hbqno, uint32_t count)
{
      uint32_t i, start, end;
      struct hbq_dmabuf *hbq_buffer;

      if (!phba->hbqs[hbqno].hbq_alloc_buffer) {
            return 0;
      }

      start = lpfc_hbq_defs[hbqno]->buffer_count;
      end = count + lpfc_hbq_defs[hbqno]->buffer_count;
      if (end > lpfc_hbq_defs[hbqno]->entry_count) {
            end = lpfc_hbq_defs[hbqno]->entry_count;
      }

      /* Populate HBQ entries */
      for (i = start; i < end; i++) {
            hbq_buffer = (phba->hbqs[hbqno].hbq_alloc_buffer)(phba);
            if (!hbq_buffer)
                  return 1;
            hbq_buffer->tag = (i | (hbqno << 16));
            if (lpfc_sli_hbq_to_firmware(phba, hbqno, hbq_buffer))
                  lpfc_hbq_defs[hbqno]->buffer_count++;
            else
                  (phba->hbqs[hbqno].hbq_free_buffer)(phba, hbq_buffer);
      }
      return 0;
}

int
lpfc_sli_hbqbuf_add_hbqs(struct lpfc_hba *phba, uint32_t qno)
{
      return(lpfc_sli_hbqbuf_fill_hbqs(phba, qno,
                               lpfc_hbq_defs[qno]->add_count));
}

int
lpfc_sli_hbqbuf_init_hbqs(struct lpfc_hba *phba, uint32_t qno)
{
      return(lpfc_sli_hbqbuf_fill_hbqs(phba, qno,
                               lpfc_hbq_defs[qno]->init_count));
}

struct hbq_dmabuf *
lpfc_sli_hbqbuf_find(struct lpfc_hba *phba, uint32_t tag)
{
      struct lpfc_dmabuf *d_buf;
      struct hbq_dmabuf *hbq_buf;
      uint32_t hbqno;

      hbqno = tag >> 16;
      if (hbqno >= LPFC_MAX_HBQS)
            return NULL;

      list_for_each_entry(d_buf, &phba->hbqs[hbqno].hbq_buffer_list, list) {
            hbq_buf = container_of(d_buf, struct hbq_dmabuf, dbuf);
            if (hbq_buf->tag == tag) {
                  return hbq_buf;
            }
      }
      lpfc_printf_log(phba, KERN_ERR, LOG_SLI | LOG_VPORT,
                  "1803 Bad hbq tag. Data: x%x x%x\n",
                  tag, lpfc_hbq_defs[tag >> 16]->buffer_count);
      return NULL;
}

void
lpfc_sli_free_hbq(struct lpfc_hba *phba, struct hbq_dmabuf *hbq_buffer)
{
      uint32_t hbqno;

      if (hbq_buffer) {
            hbqno = hbq_buffer->tag >> 16;
            if (!lpfc_sli_hbq_to_firmware(phba, hbqno, hbq_buffer)) {
                  (phba->hbqs[hbqno].hbq_free_buffer)(phba, hbq_buffer);
            }
      }
}

static int
lpfc_sli_chk_mbx_command(uint8_t mbxCommand)
{
      uint8_t ret;

      switch (mbxCommand) {
      case MBX_LOAD_SM:
      case MBX_READ_NV:
      case MBX_WRITE_NV:
      case MBX_RUN_BIU_DIAG:
      case MBX_INIT_LINK:
      case MBX_DOWN_LINK:
      case MBX_CONFIG_LINK:
      case MBX_CONFIG_RING:
      case MBX_RESET_RING:
      case MBX_READ_CONFIG:
      case MBX_READ_RCONFIG:
      case MBX_READ_SPARM:
      case MBX_READ_STATUS:
      case MBX_READ_RPI:
      case MBX_READ_XRI:
      case MBX_READ_REV:
      case MBX_READ_LNK_STAT:
      case MBX_REG_LOGIN:
      case MBX_UNREG_LOGIN:
      case MBX_READ_LA:
      case MBX_CLEAR_LA:
      case MBX_DUMP_MEMORY:
      case MBX_DUMP_CONTEXT:
      case MBX_RUN_DIAGS:
      case MBX_RESTART:
      case MBX_UPDATE_CFG:
      case MBX_DOWN_LOAD:
      case MBX_DEL_LD_ENTRY:
      case MBX_RUN_PROGRAM:
      case MBX_SET_MASK:
      case MBX_SET_SLIM:
      case MBX_UNREG_D_ID:
      case MBX_KILL_BOARD:
      case MBX_CONFIG_FARP:
      case MBX_BEACON:
      case MBX_LOAD_AREA:
      case MBX_RUN_BIU_DIAG64:
      case MBX_CONFIG_PORT:
      case MBX_READ_SPARM64:
      case MBX_READ_RPI64:
      case MBX_REG_LOGIN64:
      case MBX_READ_LA64:
      case MBX_FLASH_WR_ULA:
      case MBX_SET_DEBUG:
      case MBX_LOAD_EXP_ROM:
      case MBX_REG_VPI:
      case MBX_UNREG_VPI:
      case MBX_HEARTBEAT:
            ret = mbxCommand;
            break;
      default:
            ret = MBX_SHUTDOWN;
            break;
      }
      return ret;
}
static void
lpfc_sli_wake_mbox_wait(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
{
      wait_queue_head_t *pdone_q;
      unsigned long drvr_flag;

      /*
       * If pdone_q is empty, the driver thread gave up waiting and
       * continued running.
       */
      pmboxq->mbox_flag |= LPFC_MBX_WAKE;
      spin_lock_irqsave(&phba->hbalock, drvr_flag);
      pdone_q = (wait_queue_head_t *) pmboxq->context1;
      if (pdone_q)
            wake_up_interruptible(pdone_q);
      spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
      return;
}

void
lpfc_sli_def_mbox_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
{
      struct lpfc_dmabuf *mp;
      uint16_t rpi;
      int rc;

      mp = (struct lpfc_dmabuf *) (pmb->context1);

      if (mp) {
            lpfc_mbuf_free(phba, mp->virt, mp->phys);
            kfree(mp);
      }

      /*
       * If a REG_LOGIN succeeded  after node is destroyed or node
       * is in re-discovery driver need to cleanup the RPI.
       */
      if (!(phba->pport->load_flag & FC_UNLOADING) &&
          pmb->mb.mbxCommand == MBX_REG_LOGIN64 &&
          !pmb->mb.mbxStatus) {

            rpi = pmb->mb.un.varWords[0];
            lpfc_unreg_login(phba, pmb->mb.un.varRegLogin.vpi, rpi, pmb);
            pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
            rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
            if (rc != MBX_NOT_FINISHED)
                  return;
      }

      mempool_free(pmb, phba->mbox_mem_pool);
      return;
}

int
lpfc_sli_handle_mb_event(struct lpfc_hba *phba)
{
      MAILBOX_t *pmbox;
      LPFC_MBOXQ_t *pmb;
      int rc;
      LIST_HEAD(cmplq);

      phba->sli.slistat.mbox_event++;

      /* Get all completed mailboxe buffers into the cmplq */
      spin_lock_irq(&phba->hbalock);
      list_splice_init(&phba->sli.mboxq_cmpl, &cmplq);
      spin_unlock_irq(&phba->hbalock);

      /* Get a Mailbox buffer to setup mailbox commands for callback */
      do {
            list_remove_head(&cmplq, pmb, LPFC_MBOXQ_t, list);
            if (pmb == NULL)
                  break;

            pmbox = &pmb->mb;

            if (pmbox->mbxCommand != MBX_HEARTBEAT) {
                  if (pmb->vport) {
                        lpfc_debugfs_disc_trc(pmb->vport,
                              LPFC_DISC_TRC_MBOX_VPORT,
                              "MBOX cmpl vport: cmd:x%x mb:x%x x%x",
                              (uint32_t)pmbox->mbxCommand,
                              pmbox->un.varWords[0],
                              pmbox->un.varWords[1]);
                  }
                  else {
                        lpfc_debugfs_disc_trc(phba->pport,
                              LPFC_DISC_TRC_MBOX,
                              "MBOX cmpl:       cmd:x%x mb:x%x x%x",
                              (uint32_t)pmbox->mbxCommand,
                              pmbox->un.varWords[0],
                              pmbox->un.varWords[1]);
                  }
            }

            /*
             * It is a fatal error if unknown mbox command completion.
             */
            if (lpfc_sli_chk_mbx_command(pmbox->mbxCommand) ==
                MBX_SHUTDOWN) {
                  /* Unknow mailbox command compl */
                  lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
                              "(%d):0323 Unknown Mailbox command "
                              "%x Cmpl\n",
                              pmb->vport ? pmb->vport->vpi : 0,
                              pmbox->mbxCommand);
                  phba->link_state = LPFC_HBA_ERROR;
                  phba->work_hs = HS_FFER3;
                  lpfc_handle_eratt(phba);
                  continue;
            }

            if (pmbox->mbxStatus) {
                  phba->sli.slistat.mbox_stat_err++;
                  if (pmbox->mbxStatus == MBXERR_NO_RESOURCES) {
                        /* Mbox cmd cmpl error - RETRYing */
                        lpfc_printf_log(phba, KERN_INFO,
                                    LOG_MBOX | LOG_SLI,
                                    "(%d):0305 Mbox cmd cmpl "
                                    "error - RETRYing Data: x%x "
                                    "x%x x%x x%x\n",
                                    pmb->vport ? pmb->vport->vpi :0,
                                    pmbox->mbxCommand,
                                    pmbox->mbxStatus,
                                    pmbox->un.varWords[0],
                                    pmb->vport->port_state);
                        pmbox->mbxStatus = 0;
                        pmbox->mbxOwner = OWN_HOST;
                        spin_lock_irq(&phba->hbalock);
                        phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
                        spin_unlock_irq(&phba->hbalock);
                        rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
                        if (rc == MBX_SUCCESS)
                              continue;
                  }
            }

            /* Mailbox cmd <cmd> Cmpl <cmpl> */
            lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
                        "(%d):0307 Mailbox cmd x%x Cmpl x%p "
                        "Data: x%x x%x x%x x%x x%x x%x x%x x%x x%x\n",
                        pmb->vport ? pmb->vport->vpi : 0,
                        pmbox->mbxCommand,
                        pmb->mbox_cmpl,
                        *((uint32_t *) pmbox),
                        pmbox->un.varWords[0],
                        pmbox->un.varWords[1],
                        pmbox->un.varWords[2],
                        pmbox->un.varWords[3],
                        pmbox->un.varWords[4],
                        pmbox->un.varWords[5],
                        pmbox->un.varWords[6],
                        pmbox->un.varWords[7]);

            if (pmb->mbox_cmpl)
                  pmb->mbox_cmpl(phba,pmb);
      } while (1);
      return 0;
}

static struct lpfc_dmabuf *
lpfc_sli_replace_hbqbuff(struct lpfc_hba *phba, uint32_t tag)
{
      struct hbq_dmabuf *hbq_entry, *new_hbq_entry;
      uint32_t hbqno;
      void *virt;       /* virtual address ptr */
      dma_addr_t phys;  /* mapped address */

      hbq_entry = lpfc_sli_hbqbuf_find(phba, tag);
      if (hbq_entry == NULL)
            return NULL;
      list_del(&hbq_entry->dbuf.list);

      hbqno = tag >> 16;
      new_hbq_entry = (phba->hbqs[hbqno].hbq_alloc_buffer)(phba);
      if (new_hbq_entry == NULL)
            return &hbq_entry->dbuf;
      new_hbq_entry->tag = -1;
      phys = new_hbq_entry->dbuf.phys;
      virt = new_hbq_entry->dbuf.virt;
      new_hbq_entry->dbuf.phys = hbq_entry->dbuf.phys;
      new_hbq_entry->dbuf.virt = hbq_entry->dbuf.virt;
      hbq_entry->dbuf.phys = phys;
      hbq_entry->dbuf.virt = virt;
      lpfc_sli_free_hbq(phba, hbq_entry);
      return &new_hbq_entry->dbuf;
}

static int
lpfc_sli_process_unsol_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                      struct lpfc_iocbq *saveq)
{
      IOCB_t           * irsp;
      WORD5            * w5p;
      uint32_t           Rctl, Type;
      uint32_t           match, i;

      match = 0;
      irsp = &(saveq->iocb);
      if ((irsp->ulpCommand == CMD_RCV_ELS_REQ64_CX)
          || (irsp->ulpCommand == CMD_RCV_ELS_REQ_CX)
          || (irsp->ulpCommand == CMD_IOCB_RCV_ELS64_CX)
          || (irsp->ulpCommand == CMD_IOCB_RCV_CONT64_CX)) {
            Rctl = FC_ELS_REQ;
            Type = FC_ELS_DATA;
      } else {
            w5p =
                (WORD5 *) & (saveq->iocb.un.
                         ulpWord[5]);
            Rctl = w5p->hcsw.Rctl;
            Type = w5p->hcsw.Type;

            /* Firmware Workaround */
            if ((Rctl == 0) && (pring->ringno == LPFC_ELS_RING) &&
                  (irsp->ulpCommand == CMD_RCV_SEQUENCE64_CX ||
                   irsp->ulpCommand == CMD_IOCB_RCV_SEQ64_CX)) {
                  Rctl = FC_ELS_REQ;
                  Type = FC_ELS_DATA;
                  w5p->hcsw.Rctl = Rctl;
                  w5p->hcsw.Type = Type;
            }
      }

      if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
            if (irsp->ulpBdeCount != 0)
                  saveq->context2 = lpfc_sli_replace_hbqbuff(phba,
                                    irsp->un.ulpWord[3]);
            if (irsp->ulpBdeCount == 2)
                  saveq->context3 = lpfc_sli_replace_hbqbuff(phba,
                                    irsp->unsli3.sli3Words[7]);
      }

      /* unSolicited Responses */
      if (pring->prt[0].profile) {
            if (pring->prt[0].lpfc_sli_rcv_unsol_event)
                  (pring->prt[0].lpfc_sli_rcv_unsol_event) (phba, pring,
                                                      saveq);
            match = 1;
      } else {
            /* We must search, based on rctl / type
               for the right routine */
            for (i = 0; i < pring->num_mask;
                 i++) {
                  if ((pring->prt[i].rctl ==
                       Rctl)
                      && (pring->prt[i].
                        type == Type)) {
                        if (pring->prt[i].lpfc_sli_rcv_unsol_event)
                              (pring->prt[i].lpfc_sli_rcv_unsol_event)
                                          (phba, pring, saveq);
                        match = 1;
                        break;
                  }
            }
      }
      if (match == 0) {
            /* Unexpected Rctl / Type received */
            /* Ring <ringno> handler: unexpected
               Rctl <Rctl> Type <Type> received */
            lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
                        "0313 Ring %d handler: unexpected Rctl x%x "
                        "Type x%x received\n",
                        pring->ringno, Rctl, Type);
      }
      return 1;
}

static struct lpfc_iocbq *
lpfc_sli_iocbq_lookup(struct lpfc_hba *phba,
                  struct lpfc_sli_ring *pring,
                  struct lpfc_iocbq *prspiocb)
{
      struct lpfc_iocbq *cmd_iocb = NULL;
      uint16_t iotag;

      iotag = prspiocb->iocb.ulpIoTag;

      if (iotag != 0 && iotag <= phba->sli.last_iotag) {
            cmd_iocb = phba->sli.iocbq_lookup[iotag];
            list_del_init(&cmd_iocb->list);
            pring->txcmplq_cnt--;
            return cmd_iocb;
      }

      lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                  "0317 iotag x%x is out off "
                  "range: max iotag x%x wd0 x%x\n",
                  iotag, phba->sli.last_iotag,
                  *(((uint32_t *) &prspiocb->iocb) + 7));
      return NULL;
}

static int
lpfc_sli_process_sol_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                    struct lpfc_iocbq *saveq)
{
      struct lpfc_iocbq *cmdiocbp;
      int rc = 1;
      unsigned long iflag;

      /* Based on the iotag field, get the cmd IOCB from the txcmplq */
      spin_lock_irqsave(&phba->hbalock, iflag);
      cmdiocbp = lpfc_sli_iocbq_lookup(phba, pring, saveq);
      spin_unlock_irqrestore(&phba->hbalock, iflag);

      if (cmdiocbp) {
            if (cmdiocbp->iocb_cmpl) {
                  /*
                   * Post all ELS completions to the worker thread.
                   * All other are passed to the completion callback.
                   */
                  if (pring->ringno == LPFC_ELS_RING) {
                        if (cmdiocbp->iocb_flag & LPFC_DRIVER_ABORTED) {
                              cmdiocbp->iocb_flag &=
                                    ~LPFC_DRIVER_ABORTED;
                              saveq->iocb.ulpStatus =
                                    IOSTAT_LOCAL_REJECT;
                              saveq->iocb.un.ulpWord[4] =
                                    IOERR_SLI_ABORTED;
                        }
                  }
                  (cmdiocbp->iocb_cmpl) (phba, cmdiocbp, saveq);
            } else
                  lpfc_sli_release_iocbq(phba, cmdiocbp);
      } else {
            /*
             * Unknown initiating command based on the response iotag.
             * This could be the case on the ELS ring because of
             * lpfc_els_abort().
             */
            if (pring->ringno != LPFC_ELS_RING) {
                  /*
                   * Ring <ringno> handler: unexpected completion IoTag
                   * <IoTag>
                   */
                  lpfc_printf_vlog(cmdiocbp->vport, KERN_WARNING, LOG_SLI,
                               "0322 Ring %d handler: "
                               "unexpected completion IoTag x%x "
                               "Data: x%x x%x x%x x%x\n",
                               pring->ringno,
                               saveq->iocb.ulpIoTag,
                               saveq->iocb.ulpStatus,
                               saveq->iocb.un.ulpWord[4],
                               saveq->iocb.ulpCommand,
                               saveq->iocb.ulpContext);
            }
      }

      return rc;
}

static void
lpfc_sli_rsp_pointers_error(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
            &phba->slim2p->mbx.us.s2.port[pring->ringno];
      /*
       * Ring <ringno> handler: portRspPut <portRspPut> is bigger then
       * rsp ring <portRspMax>
       */
      lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                  "0312 Ring %d handler: portRspPut %d "
                  "is bigger then rsp ring %d\n",
                  pring->ringno, le32_to_cpu(pgp->rspPutInx),
                  pring->numRiocb);

      phba->link_state = LPFC_HBA_ERROR;

      /*
       * All error attention handlers are posted to
       * worker thread
       */
      phba->work_ha |= HA_ERATT;
      phba->work_hs = HS_FFER3;

      /* hbalock should already be held */
      if (phba->work_wait)
            lpfc_worker_wake_up(phba);

      return;
}

void lpfc_sli_poll_fcp_ring(struct lpfc_hba *phba)
{
      struct lpfc_sli      *psli  = &phba->sli;
      struct lpfc_sli_ring *pring = &psli->ring[LPFC_FCP_RING];
      IOCB_t *irsp = NULL;
      IOCB_t *entry = NULL;
      struct lpfc_iocbq *cmdiocbq = NULL;
      struct lpfc_iocbq rspiocbq;
      struct lpfc_pgp *pgp;
      uint32_t status;
      uint32_t portRspPut, portRspMax;
      int type;
      uint32_t rsp_cmpl = 0;
      uint32_t ha_copy;
      unsigned long iflags;

      pring->stats.iocb_event++;

      pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
            &phba->slim2p->mbx.us.s2.port[pring->ringno];


      /*
       * The next available response entry should never exceed the maximum
       * entries.  If it does, treat it as an adapter hardware error.
       */
      portRspMax = pring->numRiocb;
      portRspPut = le32_to_cpu(pgp->rspPutInx);
      if (unlikely(portRspPut >= portRspMax)) {
            lpfc_sli_rsp_pointers_error(phba, pring);
            return;
      }

      rmb();
      while (pring->rspidx != portRspPut) {
            entry = lpfc_resp_iocb(phba, pring);
            if (++pring->rspidx >= portRspMax)
                  pring->rspidx = 0;

            lpfc_sli_pcimem_bcopy((uint32_t *) entry,
                              (uint32_t *) &rspiocbq.iocb,
                              phba->iocb_rsp_size);
            irsp = &rspiocbq.iocb;
            type = lpfc_sli_iocb_cmd_type(irsp->ulpCommand & CMD_IOCB_MASK);
            pring->stats.iocb_rsp++;
            rsp_cmpl++;

            if (unlikely(irsp->ulpStatus)) {
                  /* Rsp ring <ringno> error: IOCB */
                  lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
                              "0326 Rsp Ring %d error: IOCB Data: "
                              "x%x x%x x%x x%x x%x x%x x%x x%x\n",
                              pring->ringno,
                              irsp->un.ulpWord[0],
                              irsp->un.ulpWord[1],
                              irsp->un.ulpWord[2],
                              irsp->un.ulpWord[3],
                              irsp->un.ulpWord[4],
                              irsp->un.ulpWord[5],
                              *(((uint32_t *) irsp) + 6),
                              *(((uint32_t *) irsp) + 7));
            }

            switch (type) {
            case LPFC_ABORT_IOCB:
            case LPFC_SOL_IOCB:
                  /*
                   * Idle exchange closed via ABTS from port.  No iocb
                   * resources need to be recovered.
                   */
                  if (unlikely(irsp->ulpCommand == CMD_XRI_ABORTED_CX)) {
                        lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                                    "0314 IOCB cmd 0x%x "
                                    "processed. Skipping "
                                    "completion",
                                    irsp->ulpCommand);
                        break;
                  }

                  spin_lock_irqsave(&phba->hbalock, iflags);
                  cmdiocbq = lpfc_sli_iocbq_lookup(phba, pring,
                                           &rspiocbq);
                  spin_unlock_irqrestore(&phba->hbalock, iflags);
                  if ((cmdiocbq) && (cmdiocbq->iocb_cmpl)) {
                        (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
                                          &rspiocbq);
                  }
                  break;
            default:
                  if (irsp->ulpCommand == CMD_ADAPTER_MSG) {
                        char adaptermsg[LPFC_MAX_ADPTMSG];
                        memset(adaptermsg, 0, LPFC_MAX_ADPTMSG);
                        memcpy(&adaptermsg[0], (uint8_t *) irsp,
                               MAX_MSG_DATA);
                        dev_warn(&((phba->pcidev)->dev),
                               "lpfc%d: %s\n",
                               phba->brd_no, adaptermsg);
                  } else {
                        /* Unknown IOCB command */
                        lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                                    "0321 Unknown IOCB command "
                                    "Data: x%x, x%x x%x x%x x%x\n",
                                    type, irsp->ulpCommand,
                                    irsp->ulpStatus,
                                    irsp->ulpIoTag,
                                    irsp->ulpContext);
                  }
                  break;
            }

            /*
             * The response IOCB has been processed.  Update the ring
             * pointer in SLIM.  If the port response put pointer has not
             * been updated, sync the pgp->rspPutInx and fetch the new port
             * response put pointer.
             */
            writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);

            if (pring->rspidx == portRspPut)
                  portRspPut = le32_to_cpu(pgp->rspPutInx);
      }

      ha_copy = readl(phba->HAregaddr);
      ha_copy >>= (LPFC_FCP_RING * 4);

      if ((rsp_cmpl > 0) && (ha_copy & HA_R0RE_REQ)) {
            spin_lock_irqsave(&phba->hbalock, iflags);
            pring->stats.iocb_rsp_full++;
            status = ((CA_R0ATT | CA_R0RE_RSP) << (LPFC_FCP_RING * 4));
            writel(status, phba->CAregaddr);
            readl(phba->CAregaddr);
            spin_unlock_irqrestore(&phba->hbalock, iflags);
      }
      if ((ha_copy & HA_R0CE_RSP) &&
          (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
            spin_lock_irqsave(&phba->hbalock, iflags);
            pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
            pring->stats.iocb_cmd_empty++;

            /* Force update of the local copy of cmdGetInx */
            pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
            lpfc_sli_resume_iocb(phba, pring);

            if ((pring->lpfc_sli_cmd_available))
                  (pring->lpfc_sli_cmd_available) (phba, pring);

            spin_unlock_irqrestore(&phba->hbalock, iflags);
      }

      return;
}

/*
 * This routine presumes LPFC_FCP_RING handling and doesn't bother
 * to check it explicitly.
 */
static int
lpfc_sli_handle_fast_ring_event(struct lpfc_hba *phba,
                        struct lpfc_sli_ring *pring, uint32_t mask)
{
      struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
            &phba->slim2p->mbx.us.s2.port[pring->ringno];
      IOCB_t *irsp = NULL;
      IOCB_t *entry = NULL;
      struct lpfc_iocbq *cmdiocbq = NULL;
      struct lpfc_iocbq rspiocbq;
      uint32_t status;
      uint32_t portRspPut, portRspMax;
      int rc = 1;
      lpfc_iocb_type type;
      unsigned long iflag;
      uint32_t rsp_cmpl = 0;

      spin_lock_irqsave(&phba->hbalock, iflag);
      pring->stats.iocb_event++;

      /*
       * The next available response entry should never exceed the maximum
       * entries.  If it does, treat it as an adapter hardware error.
       */
      portRspMax = pring->numRiocb;
      portRspPut = le32_to_cpu(pgp->rspPutInx);
      if (unlikely(portRspPut >= portRspMax)) {
            lpfc_sli_rsp_pointers_error(phba, pring);
            spin_unlock_irqrestore(&phba->hbalock, iflag);
            return 1;
      }

      rmb();
      while (pring->rspidx != portRspPut) {
            /*
             * Fetch an entry off the ring and copy it into a local data
             * structure.  The copy involves a byte-swap since the
             * network byte order and pci byte orders are different.
             */
            entry = lpfc_resp_iocb(phba, pring);
            phba->last_completion_time = jiffies;

            if (++pring->rspidx >= portRspMax)
                  pring->rspidx = 0;

            lpfc_sli_pcimem_bcopy((uint32_t *) entry,
                              (uint32_t *) &rspiocbq.iocb,
                              phba->iocb_rsp_size);
            INIT_LIST_HEAD(&(rspiocbq.list));
            irsp = &rspiocbq.iocb;

            type = lpfc_sli_iocb_cmd_type(irsp->ulpCommand & CMD_IOCB_MASK);
            pring->stats.iocb_rsp++;
            rsp_cmpl++;

            if (unlikely(irsp->ulpStatus)) {
                  /*
                   * If resource errors reported from HBA, reduce
                   * queuedepths of the SCSI device.
                   */
                  if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
                        (irsp->un.ulpWord[4] == IOERR_NO_RESOURCES)) {
                        spin_unlock_irqrestore(&phba->hbalock, iflag);
                        lpfc_adjust_queue_depth(phba);
                        spin_lock_irqsave(&phba->hbalock, iflag);
                  }

                  /* Rsp ring <ringno> error: IOCB */
                  lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
                              "0336 Rsp Ring %d error: IOCB Data: "
                              "x%x x%x x%x x%x x%x x%x x%x x%x\n",
                              pring->ringno,
                              irsp->un.ulpWord[0],
                              irsp->un.ulpWord[1],
                              irsp->un.ulpWord[2],
                              irsp->un.ulpWord[3],
                              irsp->un.ulpWord[4],
                              irsp->un.ulpWord[5],
                              *(((uint32_t *) irsp) + 6),
                              *(((uint32_t *) irsp) + 7));
            }

            switch (type) {
            case LPFC_ABORT_IOCB:
            case LPFC_SOL_IOCB:
                  /*
                   * Idle exchange closed via ABTS from port.  No iocb
                   * resources need to be recovered.
                   */
                  if (unlikely(irsp->ulpCommand == CMD_XRI_ABORTED_CX)) {
                        lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                                    "0333 IOCB cmd 0x%x"
                                    " processed. Skipping"
                                    " completion\n",
                                    irsp->ulpCommand);
                        break;
                  }

                  cmdiocbq = lpfc_sli_iocbq_lookup(phba, pring,
                                           &rspiocbq);
                  if ((cmdiocbq) && (cmdiocbq->iocb_cmpl)) {
                        if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
                              (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
                                                &rspiocbq);
                        } else {
                              spin_unlock_irqrestore(&phba->hbalock,
                                                 iflag);
                              (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
                                                &rspiocbq);
                              spin_lock_irqsave(&phba->hbalock,
                                            iflag);
                        }
                  }
                  break;
            case LPFC_UNSOL_IOCB:
                  spin_unlock_irqrestore(&phba->hbalock, iflag);
                  lpfc_sli_process_unsol_iocb(phba, pring, &rspiocbq);
                  spin_lock_irqsave(&phba->hbalock, iflag);
                  break;
            default:
                  if (irsp->ulpCommand == CMD_ADAPTER_MSG) {
                        char adaptermsg[LPFC_MAX_ADPTMSG];
                        memset(adaptermsg, 0, LPFC_MAX_ADPTMSG);
                        memcpy(&adaptermsg[0], (uint8_t *) irsp,
                               MAX_MSG_DATA);
                        dev_warn(&((phba->pcidev)->dev),
                               "lpfc%d: %s\n",
                               phba->brd_no, adaptermsg);
                  } else {
                        /* Unknown IOCB command */
                        lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                                    "0334 Unknown IOCB command "
                                    "Data: x%x, x%x x%x x%x x%x\n",
                                    type, irsp->ulpCommand,
                                    irsp->ulpStatus,
                                    irsp->ulpIoTag,
                                    irsp->ulpContext);
                  }
                  break;
            }

            /*
             * The response IOCB has been processed.  Update the ring
             * pointer in SLIM.  If the port response put pointer has not
             * been updated, sync the pgp->rspPutInx and fetch the new port
             * response put pointer.
             */
            writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);

            if (pring->rspidx == portRspPut)
                  portRspPut = le32_to_cpu(pgp->rspPutInx);
      }

      if ((rsp_cmpl > 0) && (mask & HA_R0RE_REQ)) {
            pring->stats.iocb_rsp_full++;
            status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4));
            writel(status, phba->CAregaddr);
            readl(phba->CAregaddr);
      }
      if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
            pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
            pring->stats.iocb_cmd_empty++;

            /* Force update of the local copy of cmdGetInx */
            pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
            lpfc_sli_resume_iocb(phba, pring);

            if ((pring->lpfc_sli_cmd_available))
                  (pring->lpfc_sli_cmd_available) (phba, pring);

      }

      spin_unlock_irqrestore(&phba->hbalock, iflag);
      return rc;
}

int
lpfc_sli_handle_slow_ring_event(struct lpfc_hba *phba,
                        struct lpfc_sli_ring *pring, uint32_t mask)
{
      struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
            &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
            &phba->slim2p->mbx.us.s2.port[pring->ringno];
      IOCB_t *entry;
      IOCB_t *irsp = NULL;
      struct lpfc_iocbq *rspiocbp = NULL;
      struct lpfc_iocbq *next_iocb;
      struct lpfc_iocbq *cmdiocbp;
      struct lpfc_iocbq *saveq;
      uint8_t iocb_cmd_type;
      lpfc_iocb_type type;
      uint32_t status, free_saveq;
      uint32_t portRspPut, portRspMax;
      int rc = 1;
      unsigned long iflag;

      spin_lock_irqsave(&phba->hbalock, iflag);
      pring->stats.iocb_event++;

      /*
       * The next available response entry should never exceed the maximum
       * entries.  If it does, treat it as an adapter hardware error.
       */
      portRspMax = pring->numRiocb;
      portRspPut = le32_to_cpu(pgp->rspPutInx);
      if (portRspPut >= portRspMax) {
            /*
             * Ring <ringno> handler: portRspPut <portRspPut> is bigger then
             * rsp ring <portRspMax>
             */
            lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                        "0303 Ring %d handler: portRspPut %d "
                        "is bigger then rsp ring %d\n",
                        pring->ringno, portRspPut, portRspMax);

            phba->link_state = LPFC_HBA_ERROR;
            spin_unlock_irqrestore(&phba->hbalock, iflag);

            phba->work_hs = HS_FFER3;
            lpfc_handle_eratt(phba);

            return 1;
      }

      rmb();
      while (pring->rspidx != portRspPut) {
            /*
             * Build a completion list and call the appropriate handler.
             * The process is to get the next available response iocb, get
             * a free iocb from the list, copy the response data into the
             * free iocb, insert to the continuation list, and update the
             * next response index to slim.  This process makes response
             * iocb's in the ring available to DMA as fast as possible but
             * pays a penalty for a copy operation.  Since the iocb is
             * only 32 bytes, this penalty is considered small relative to
             * the PCI reads for register values and a slim write.  When
             * the ulpLe field is set, the entire Command has been
             * received.
             */
            entry = lpfc_resp_iocb(phba, pring);

            phba->last_completion_time = jiffies;
            rspiocbp = __lpfc_sli_get_iocbq(phba);
            if (rspiocbp == NULL) {
                  printk(KERN_ERR "%s: out of buffers! Failing "
                         "completion.\n", __FUNCTION__);
                  break;
            }

            lpfc_sli_pcimem_bcopy(entry, &rspiocbp->iocb,
                              phba->iocb_rsp_size);
            irsp = &rspiocbp->iocb;

            if (++pring->rspidx >= portRspMax)
                  pring->rspidx = 0;

            if (pring->ringno == LPFC_ELS_RING) {
                  lpfc_debugfs_slow_ring_trc(phba,
                  "IOCB rsp ring:   wd4:x%08x wd6:x%08x wd7:x%08x",
                        *(((uint32_t *) irsp) + 4),
                        *(((uint32_t *) irsp) + 6),
                        *(((uint32_t *) irsp) + 7));
            }

            writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);

            if (list_empty(&(pring->iocb_continueq))) {
                  list_add(&rspiocbp->list, &(pring->iocb_continueq));
            } else {
                  list_add_tail(&rspiocbp->list,
                              &(pring->iocb_continueq));
            }

            pring->iocb_continueq_cnt++;
            if (irsp->ulpLe) {
                  /*
                   * By default, the driver expects to free all resources
                   * associated with this iocb completion.
                   */
                  free_saveq = 1;
                  saveq = list_get_first(&pring->iocb_continueq,
                                     struct lpfc_iocbq, list);
                  irsp = &(saveq->iocb);
                  list_del_init(&pring->iocb_continueq);
                  pring->iocb_continueq_cnt = 0;

                  pring->stats.iocb_rsp++;

                  /*
                   * If resource errors reported from HBA, reduce
                   * queuedepths of the SCSI device.
                   */
                  if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
                       (irsp->un.ulpWord[4] == IOERR_NO_RESOURCES)) {
                        spin_unlock_irqrestore(&phba->hbalock, iflag);
                        lpfc_adjust_queue_depth(phba);
                        spin_lock_irqsave(&phba->hbalock, iflag);
                  }

                  if (irsp->ulpStatus) {
                        /* Rsp ring <ringno> error: IOCB */
                        lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
                                    "0328 Rsp Ring %d error: "
                                    "IOCB Data: "
                                    "x%x x%x x%x x%x "
                                    "x%x x%x x%x x%x "
                                    "x%x x%x x%x x%x "
                                    "x%x x%x x%x x%x\n",
                                    pring->ringno,
                                    irsp->un.ulpWord[0],
                                    irsp->un.ulpWord[1],
                                    irsp->un.ulpWord[2],
                                    irsp->un.ulpWord[3],
                                    irsp->un.ulpWord[4],
                                    irsp->un.ulpWord[5],
                                    *(((uint32_t *) irsp) + 6),
                                    *(((uint32_t *) irsp) + 7),
                                    *(((uint32_t *) irsp) + 8),
                                    *(((uint32_t *) irsp) + 9),
                                    *(((uint32_t *) irsp) + 10),
                                    *(((uint32_t *) irsp) + 11),
                                    *(((uint32_t *) irsp) + 12),
                                    *(((uint32_t *) irsp) + 13),
                                    *(((uint32_t *) irsp) + 14),
                                    *(((uint32_t *) irsp) + 15));
                  }

                  /*
                   * Fetch the IOCB command type and call the correct
                   * completion routine.  Solicited and Unsolicited
                   * IOCBs on the ELS ring get freed back to the
                   * lpfc_iocb_list by the discovery kernel thread.
                   */
                  iocb_cmd_type = irsp->ulpCommand & CMD_IOCB_MASK;
                  type = lpfc_sli_iocb_cmd_type(iocb_cmd_type);
                  if (type == LPFC_SOL_IOCB) {
                        spin_unlock_irqrestore(&phba->hbalock,
                                           iflag);
                        rc = lpfc_sli_process_sol_iocb(phba, pring,
                                                 saveq);
                        spin_lock_irqsave(&phba->hbalock, iflag);
                  } else if (type == LPFC_UNSOL_IOCB) {
                        spin_unlock_irqrestore(&phba->hbalock,
                                           iflag);
                        rc = lpfc_sli_process_unsol_iocb(phba, pring,
                                                 saveq);
                        spin_lock_irqsave(&phba->hbalock, iflag);
                  } else if (type == LPFC_ABORT_IOCB) {
                        if ((irsp->ulpCommand != CMD_XRI_ABORTED_CX) &&
                            ((cmdiocbp =
                              lpfc_sli_iocbq_lookup(phba, pring,
                                              saveq)))) {
                              /* Call the specified completion
                                 routine */
                              if (cmdiocbp->iocb_cmpl) {
                                    spin_unlock_irqrestore(
                                           &phba->hbalock,
                                           iflag);
                                    (cmdiocbp->iocb_cmpl) (phba,
                                               cmdiocbp, saveq);
                                    spin_lock_irqsave(
                                            &phba->hbalock,
                                            iflag);
                              } else
                                    __lpfc_sli_release_iocbq(phba,
                                                      cmdiocbp);
                        }
                  } else if (type == LPFC_UNKNOWN_IOCB) {
                        if (irsp->ulpCommand == CMD_ADAPTER_MSG) {

                              char adaptermsg[LPFC_MAX_ADPTMSG];

                              memset(adaptermsg, 0,
                                     LPFC_MAX_ADPTMSG);
                              memcpy(&adaptermsg[0], (uint8_t *) irsp,
                                     MAX_MSG_DATA);
                              dev_warn(&((phba->pcidev)->dev),
                                     "lpfc%d: %s\n",
                                     phba->brd_no, adaptermsg);
                        } else {
                              /* Unknown IOCB command */
                              lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                                          "0335 Unknown IOCB "
                                          "command Data: x%x "
                                          "x%x x%x x%x\n",
                                          irsp->ulpCommand,
                                          irsp->ulpStatus,
                                          irsp->ulpIoTag,
                                          irsp->ulpContext);
                        }
                  }

                  if (free_saveq) {
                        list_for_each_entry_safe(rspiocbp, next_iocb,
                                           &saveq->list, list) {
                              list_del(&rspiocbp->list);
                              __lpfc_sli_release_iocbq(phba,
                                                 rspiocbp);
                        }
                        __lpfc_sli_release_iocbq(phba, saveq);
                  }
                  rspiocbp = NULL;
            }

            /*
             * If the port response put pointer has not been updated, sync
             * the pgp->rspPutInx in the MAILBOX_tand fetch the new port
             * response put pointer.
             */
            if (pring->rspidx == portRspPut) {
                  portRspPut = le32_to_cpu(pgp->rspPutInx);
            }
      } /* while (pring->rspidx != portRspPut) */

      if ((rspiocbp != NULL) && (mask & HA_R0RE_REQ)) {
            /* At least one response entry has been freed */
            pring->stats.iocb_rsp_full++;
            /* SET RxRE_RSP in Chip Att register */
            status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4));
            writel(status, phba->CAregaddr);
            readl(phba->CAregaddr); /* flush */
      }
      if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
            pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
            pring->stats.iocb_cmd_empty++;

            /* Force update of the local copy of cmdGetInx */
            pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
            lpfc_sli_resume_iocb(phba, pring);

            if ((pring->lpfc_sli_cmd_available))
                  (pring->lpfc_sli_cmd_available) (phba, pring);

      }

      spin_unlock_irqrestore(&phba->hbalock, iflag);
      return rc;
}

void
lpfc_sli_abort_iocb_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
{
      LIST_HEAD(completions);
      struct lpfc_iocbq *iocb, *next_iocb;
      IOCB_t *cmd = NULL;

      if (pring->ringno == LPFC_ELS_RING) {
            lpfc_fabric_abort_hba(phba);
      }

      /* Error everything on txq and txcmplq
       * First do the txq.
       */
      spin_lock_irq(&phba->hbalock);
      list_splice_init(&pring->txq, &completions);
      pring->txq_cnt = 0;

      /* Next issue ABTS for everything on the txcmplq */
      list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list)
            lpfc_sli_issue_abort_iotag(phba, pring, iocb);

      spin_unlock_irq(&phba->hbalock);

      while (!list_empty(&completions)) {
            iocb = list_get_first(&completions, struct lpfc_iocbq, list);
            cmd = &iocb->iocb;
            list_del_init(&iocb->list);

            if (!iocb->iocb_cmpl)
                  lpfc_sli_release_iocbq(phba, iocb);
            else {
                  cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
                  cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
                  (iocb->iocb_cmpl) (phba, iocb, iocb);
            }
      }
}

int
lpfc_sli_brdready(struct lpfc_hba *phba, uint32_t mask)
{
      uint32_t status;
      int i = 0;
      int retval = 0;

      /* Read the HBA Host Status Register */
      status = readl(phba->HSregaddr);

      /*
       * Check status register every 100ms for 5 retries, then every
       * 500ms for 5, then every 2.5 sec for 5, then reset board and
       * every 2.5 sec for 4.
       * Break our of the loop if errors occurred during init.
       */
      while (((status & mask) != mask) &&
             !(status & HS_FFERM) &&
             i++ < 20) {

            if (i <= 5)
                  msleep(10);
            else if (i <= 10)
                  msleep(500);
            else
                  msleep(2500);

            if (i == 15) {
                        /* Do post */
                  phba->pport->port_state = LPFC_VPORT_UNKNOWN;
                  lpfc_sli_brdrestart(phba);
            }
            /* Read the HBA Host Status Register */
            status = readl(phba->HSregaddr);
      }

      /* Check to see if any errors occurred during init */
      if ((status & HS_FFERM) || (i >= 20)) {
            phba->link_state = LPFC_HBA_ERROR;
            retval = 1;
      }

      return retval;
}

#define BARRIER_TEST_PATTERN (0xdeadbeef)

void lpfc_reset_barrier(struct lpfc_hba *phba)
{
      uint32_t __iomem *resp_buf;
      uint32_t __iomem *mbox_buf;
      volatile uint32_t mbox;
      uint32_t hc_copy;
      int  i;
      uint8_t hdrtype;

      pci_read_config_byte(phba->pcidev, PCI_HEADER_TYPE, &hdrtype);
      if (hdrtype != 0x80 ||
          (FC_JEDEC_ID(phba->vpd.rev.biuRev) != HELIOS_JEDEC_ID &&
           FC_JEDEC_ID(phba->vpd.rev.biuRev) != THOR_JEDEC_ID))
            return;

      /*
       * Tell the other part of the chip to suspend temporarily all
       * its DMA activity.
       */
      resp_buf = phba->MBslimaddr;

      /* Disable the error attention */
      hc_copy = readl(phba->HCregaddr);
      writel((hc_copy & ~HC_ERINT_ENA), phba->HCregaddr);
      readl(phba->HCregaddr); /* flush */
      phba->link_flag |= LS_IGNORE_ERATT;

      if (readl(phba->HAregaddr) & HA_ERATT) {
            /* Clear Chip error bit */
            writel(HA_ERATT, phba->HAregaddr);
            phba->pport->stopped = 1;
      }

      mbox = 0;
      ((MAILBOX_t *)&mbox)->mbxCommand = MBX_KILL_BOARD;
      ((MAILBOX_t *)&mbox)->mbxOwner = OWN_CHIP;

      writel(BARRIER_TEST_PATTERN, (resp_buf + 1));
      mbox_buf = phba->MBslimaddr;
      writel(mbox, mbox_buf);

      for (i = 0;
           readl(resp_buf + 1) != ~(BARRIER_TEST_PATTERN) && i < 50; i++)
            mdelay(1);

      if (readl(resp_buf + 1) != ~(BARRIER_TEST_PATTERN)) {
            if (phba->sli.sli_flag & LPFC_SLI2_ACTIVE ||
                phba->pport->stopped)
                  goto restore_hc;
            else
                  goto clear_errat;
      }

      ((MAILBOX_t *)&mbox)->mbxOwner = OWN_HOST;
      for (i = 0; readl(resp_buf) != mbox &&  i < 500; i++)
            mdelay(1);

clear_errat:

      while (!(readl(phba->HAregaddr) & HA_ERATT) && ++i < 500)
            mdelay(1);

      if (readl(phba->HAregaddr) & HA_ERATT) {
            writel(HA_ERATT, phba->HAregaddr);
            phba->pport->stopped = 1;
      }

restore_hc:
      phba->link_flag &= ~LS_IGNORE_ERATT;
      writel(hc_copy, phba->HCregaddr);
      readl(phba->HCregaddr); /* flush */
}

int
lpfc_sli_brdkill(struct lpfc_hba *phba)
{
      struct lpfc_sli *psli;
      LPFC_MBOXQ_t *pmb;
      uint32_t status;
      uint32_t ha_copy;
      int retval;
      int i = 0;

      psli = &phba->sli;

      /* Kill HBA */
      lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                  "0329 Kill HBA Data: x%x x%x\n",
                  phba->pport->port_state, psli->sli_flag);

      if ((pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool,
                                      GFP_KERNEL)) == 0)
            return 1;

      /* Disable the error attention */
      spin_lock_irq(&phba->hbalock);
      status = readl(phba->HCregaddr);
      status &= ~HC_ERINT_ENA;
      writel(status, phba->HCregaddr);
      readl(phba->HCregaddr); /* flush */
      phba->link_flag |= LS_IGNORE_ERATT;
      spin_unlock_irq(&phba->hbalock);

      lpfc_kill_board(phba, pmb);
      pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
      retval = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);

      if (retval != MBX_SUCCESS) {
            if (retval != MBX_BUSY)
                  mempool_free(pmb, phba->mbox_mem_pool);
            spin_lock_irq(&phba->hbalock);
            phba->link_flag &= ~LS_IGNORE_ERATT;
            spin_unlock_irq(&phba->hbalock);
            return 1;
      }

      psli->sli_flag &= ~LPFC_SLI2_ACTIVE;

      mempool_free(pmb, phba->mbox_mem_pool);

      /* There is no completion for a KILL_BOARD mbox cmd. Check for an error
       * attention every 100ms for 3 seconds. If we don't get ERATT after
       * 3 seconds we still set HBA_ERROR state because the status of the
       * board is now undefined.
       */
      ha_copy = readl(phba->HAregaddr);

      while ((i++ < 30) && !(ha_copy & HA_ERATT)) {
            mdelay(100);
            ha_copy = readl(phba->HAregaddr);
      }

      del_timer_sync(&psli->mbox_tmo);
      if (ha_copy & HA_ERATT) {
            writel(HA_ERATT, phba->HAregaddr);
            phba->pport->stopped = 1;
      }
      spin_lock_irq(&phba->hbalock);
      psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
      phba->link_flag &= ~LS_IGNORE_ERATT;
      spin_unlock_irq(&phba->hbalock);

      psli->mbox_active = NULL;
      lpfc_hba_down_post(phba);
      phba->link_state = LPFC_HBA_ERROR;

      return ha_copy & HA_ERATT ? 0 : 1;
}

int
lpfc_sli_brdreset(struct lpfc_hba *phba)
{
      struct lpfc_sli *psli;
      struct lpfc_sli_ring *pring;
      uint16_t cfg_value;
      int i;

      psli = &phba->sli;

      /* Reset HBA */
      lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                  "0325 Reset HBA Data: x%x x%x\n",
                  phba->pport->port_state, psli->sli_flag);

      /* perform board reset */
      phba->fc_eventTag = 0;
      phba->pport->fc_myDID = 0;
      phba->pport->fc_prevDID = 0;

      /* Turn off parity checking and serr during the physical reset */
      pci_read_config_word(phba->pcidev, PCI_COMMAND, &cfg_value);
      pci_write_config_word(phba->pcidev, PCI_COMMAND,
                        (cfg_value &
                         ~(PCI_COMMAND_PARITY | PCI_COMMAND_SERR)));

      psli->sli_flag &= ~(LPFC_SLI2_ACTIVE | LPFC_PROCESS_LA);
      /* Now toggle INITFF bit in the Host Control Register */
      writel(HC_INITFF, phba->HCregaddr);
      mdelay(1);
      readl(phba->HCregaddr); /* flush */
      writel(0, phba->HCregaddr);
      readl(phba->HCregaddr); /* flush */

      /* Restore PCI cmd register */
      pci_write_config_word(phba->pcidev, PCI_COMMAND, cfg_value);

      /* Initialize relevant SLI info */
      for (i = 0; i < psli->num_rings; i++) {
            pring = &psli->ring[i];
            pring->flag = 0;
            pring->rspidx = 0;
            pring->next_cmdidx  = 0;
            pring->local_getidx = 0;
            pring->cmdidx = 0;
            pring->missbufcnt = 0;
      }

      phba->link_state = LPFC_WARM_START;
      return 0;
}

int
lpfc_sli_brdrestart(struct lpfc_hba *phba)
{
      MAILBOX_t *mb;
      struct lpfc_sli *psli;
      uint16_t skip_post;
      volatile uint32_t word0;
      void __iomem *to_slim;

      spin_lock_irq(&phba->hbalock);

      psli = &phba->sli;

      /* Restart HBA */
      lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                  "0337 Restart HBA Data: x%x x%x\n",
                  phba->pport->port_state, psli->sli_flag);

      word0 = 0;
      mb = (MAILBOX_t *) &word0;
      mb->mbxCommand = MBX_RESTART;
      mb->mbxHc = 1;

      lpfc_reset_barrier(phba);

      to_slim = phba->MBslimaddr;
      writel(*(uint32_t *) mb, to_slim);
      readl(to_slim); /* flush */

      /* Only skip post after fc_ffinit is completed */
      if (phba->pport->port_state) {
            skip_post = 1;
            word0 = 1;  /* This is really setting up word1 */
      } else {
            skip_post = 0;
            word0 = 0;  /* This is really setting up word1 */
      }
      to_slim = phba->MBslimaddr + sizeof (uint32_t);
      writel(*(uint32_t *) mb, to_slim);
      readl(to_slim); /* flush */

      lpfc_sli_brdreset(phba);
      phba->pport->stopped = 0;
      phba->link_state = LPFC_INIT_START;

      spin_unlock_irq(&phba->hbalock);

      memset(&psli->lnk_stat_offsets, 0, sizeof(psli->lnk_stat_offsets));
      psli->stats_start = get_seconds();

      if (skip_post)
            mdelay(100);
      else
            mdelay(2000);

      lpfc_hba_down_post(phba);

      return 0;
}

static int
lpfc_sli_chipset_init(struct lpfc_hba *phba)
{
      uint32_t status, i = 0;

      /* Read the HBA Host Status Register */
      status = readl(phba->HSregaddr);

      /* Check status register to see what current state is */
      i = 0;
      while ((status & (HS_FFRDY | HS_MBRDY)) != (HS_FFRDY | HS_MBRDY)) {

            /* Check every 100ms for 5 retries, then every 500ms for 5, then
             * every 2.5 sec for 5, then reset board and every 2.5 sec for
             * 4.
             */
            if (i++ >= 20) {
                  /* Adapter failed to init, timeout, status reg
                     <status> */
                  lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                              "0436 Adapter failed to init, "
                              "timeout, status reg x%x\n", status);
                  phba->link_state = LPFC_HBA_ERROR;
                  return -ETIMEDOUT;
            }

            /* Check to see if any errors occurred during init */
            if (status & HS_FFERM) {
                  /* ERROR: During chipset initialization */
                  /* Adapter failed to init, chipset, status reg
                     <status> */
                  lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                              "0437 Adapter failed to init, "
                              "chipset, status reg x%x\n", status);
                  phba->link_state = LPFC_HBA_ERROR;
                  return -EIO;
            }

            if (i <= 5) {
                  msleep(10);
            } else if (i <= 10) {
                  msleep(500);
            } else {
                  msleep(2500);
            }

            if (i == 15) {
                        /* Do post */
                  phba->pport->port_state = LPFC_VPORT_UNKNOWN;
                  lpfc_sli_brdrestart(phba);
            }
            /* Read the HBA Host Status Register */
            status = readl(phba->HSregaddr);
      }

      /* Check to see if any errors occurred during init */
      if (status & HS_FFERM) {
            /* ERROR: During chipset initialization */
            /* Adapter failed to init, chipset, status reg <status> */
            lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                        "0438 Adapter failed to init, chipset, "
                        "status reg x%x\n", status);
            phba->link_state = LPFC_HBA_ERROR;
            return -EIO;
      }

      /* Clear all interrupt enable conditions */
      writel(0, phba->HCregaddr);
      readl(phba->HCregaddr); /* flush */

      /* setup host attn register */
      writel(0xffffffff, phba->HAregaddr);
      readl(phba->HAregaddr); /* flush */
      return 0;
}

int
lpfc_sli_hbq_count(void)
{
      return ARRAY_SIZE(lpfc_hbq_defs);
}

static int
lpfc_sli_hbq_entry_count(void)
{
      int  hbq_count = lpfc_sli_hbq_count();
      int  count = 0;
      int  i;

      for (i = 0; i < hbq_count; ++i)
            count += lpfc_hbq_defs[i]->entry_count;
      return count;
}

int
lpfc_sli_hbq_size(void)
{
      return lpfc_sli_hbq_entry_count() * sizeof(struct lpfc_hbq_entry);
}

static int
lpfc_sli_hbq_setup(struct lpfc_hba *phba)
{
      int  hbq_count = lpfc_sli_hbq_count();
      LPFC_MBOXQ_t *pmb;
      MAILBOX_t *pmbox;
      uint32_t hbqno;
      uint32_t hbq_entry_index;

                        /* Get a Mailbox buffer to setup mailbox
                         * commands for HBA initialization
                         */
      pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);

      if (!pmb)
            return -ENOMEM;

      pmbox = &pmb->mb;

      /* Initialize the struct lpfc_sli_hbq structure for each hbq */
      phba->link_state = LPFC_INIT_MBX_CMDS;

      hbq_entry_index = 0;
      for (hbqno = 0; hbqno < hbq_count; ++hbqno) {
            phba->hbqs[hbqno].next_hbqPutIdx = 0;
            phba->hbqs[hbqno].hbqPutIdx      = 0;
            phba->hbqs[hbqno].local_hbqGetIdx   = 0;
            phba->hbqs[hbqno].entry_count =
                  lpfc_hbq_defs[hbqno]->entry_count;
            lpfc_config_hbq(phba, hbqno, lpfc_hbq_defs[hbqno],
                  hbq_entry_index, pmb);
            hbq_entry_index += phba->hbqs[hbqno].entry_count;

            if (lpfc_sli_issue_mbox(phba, pmb, MBX_POLL) != MBX_SUCCESS) {
                  /* Adapter failed to init, mbxCmd <cmd> CFG_RING,
                     mbxStatus <status>, ring <num> */

                  lpfc_printf_log(phba, KERN_ERR,
                              LOG_SLI | LOG_VPORT,
                              "1805 Adapter failed to init. "
                              "Data: x%x x%x x%x\n",
                              pmbox->mbxCommand,
                              pmbox->mbxStatus, hbqno);

                  phba->link_state = LPFC_HBA_ERROR;
                  mempool_free(pmb, phba->mbox_mem_pool);
                  return ENXIO;
            }
      }
      phba->hbq_count = hbq_count;

      mempool_free(pmb, phba->mbox_mem_pool);

      /* Initially populate or replenish the HBQs */
      for (hbqno = 0; hbqno < hbq_count; ++hbqno) {
            if (lpfc_sli_hbqbuf_init_hbqs(phba, hbqno))
                  return -ENOMEM;
      }
      return 0;
}

static int
lpfc_do_config_port(struct lpfc_hba *phba, int sli_mode)
{
      LPFC_MBOXQ_t *pmb;
      uint32_t resetcount = 0, rc = 0, done = 0;

      pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
      if (!pmb) {
            phba->link_state = LPFC_HBA_ERROR;
            return -ENOMEM;
      }

      phba->sli_rev = sli_mode;
      while (resetcount < 2 && !done) {
            spin_lock_irq(&phba->hbalock);
            phba->sli.sli_flag |= LPFC_SLI_MBOX_ACTIVE;
            spin_unlock_irq(&phba->hbalock);
            phba->pport->port_state = LPFC_VPORT_UNKNOWN;
            lpfc_sli_brdrestart(phba);
            msleep(2500);
            rc = lpfc_sli_chipset_init(phba);
            if (rc)
                  break;

            spin_lock_irq(&phba->hbalock);
            phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
            spin_unlock_irq(&phba->hbalock);
            resetcount++;

            /* Call pre CONFIG_PORT mailbox command initialization.  A
             * value of 0 means the call was successful.  Any other
             * nonzero value is a failure, but if ERESTART is returned,
             * the driver may reset the HBA and try again.
             */
            rc = lpfc_config_port_prep(phba);
            if (rc == -ERESTART) {
                  phba->link_state = LPFC_LINK_UNKNOWN;
                  continue;
            } else if (rc) {
                  break;
            }

            phba->link_state = LPFC_INIT_MBX_CMDS;
            lpfc_config_port(phba, pmb);
            rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
            if (rc != MBX_SUCCESS) {
                  lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                        "0442 Adapter failed to init, mbxCmd x%x "
                        "CONFIG_PORT, mbxStatus x%x Data: x%x\n",
                        pmb->mb.mbxCommand, pmb->mb.mbxStatus, 0);
                  spin_lock_irq(&phba->hbalock);
                  phba->sli.sli_flag &= ~LPFC_SLI2_ACTIVE;
                  spin_unlock_irq(&phba->hbalock);
                  rc = -ENXIO;
            } else {
                  done = 1;
                  phba->max_vpi = (phba->max_vpi &&
                               pmb->mb.un.varCfgPort.gmv) != 0
                        ? pmb->mb.un.varCfgPort.max_vpi
                        : 0;
            }
      }

      if (!done) {
            rc = -EINVAL;
            goto do_prep_failed;
      }

      if ((pmb->mb.un.varCfgPort.sli_mode == 3) &&
            (!pmb->mb.un.varCfgPort.cMA)) {
            rc = -ENXIO;
            goto do_prep_failed;
      }
      return rc;

do_prep_failed:
      mempool_free(pmb, phba->mbox_mem_pool);
      return rc;
}

int
lpfc_sli_hba_setup(struct lpfc_hba *phba)
{
      uint32_t rc;
      int  mode = 3;

      switch (lpfc_sli_mode) {
      case 2:
            if (phba->cfg_enable_npiv) {
                  lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
                        "1824 NPIV enabled: Override lpfc_sli_mode "
                        "parameter (%d) to auto (0).\n",
                        lpfc_sli_mode);
                  break;
            }
            mode = 2;
            break;
      case 0:
      case 3:
            break;
      default:
            lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
                        "1819 Unrecognized lpfc_sli_mode "
                        "parameter: %d.\n", lpfc_sli_mode);

            break;
      }

      rc = lpfc_do_config_port(phba, mode);
      if (rc && lpfc_sli_mode == 3)
            lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
                        "1820 Unable to select SLI-3.  "
                        "Not supported by adapter.\n");
      if (rc && mode != 2)
            rc = lpfc_do_config_port(phba, 2);
      if (rc)
            goto lpfc_sli_hba_setup_error;

      if (phba->sli_rev == 3) {
            phba->iocb_cmd_size = SLI3_IOCB_CMD_SIZE;
            phba->iocb_rsp_size = SLI3_IOCB_RSP_SIZE;
            phba->sli3_options |= LPFC_SLI3_ENABLED;
            phba->sli3_options |= LPFC_SLI3_HBQ_ENABLED;

      } else {
            phba->iocb_cmd_size = SLI2_IOCB_CMD_SIZE;
            phba->iocb_rsp_size = SLI2_IOCB_RSP_SIZE;
            phba->sli3_options = 0;
      }

      lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
                  "0444 Firmware in SLI %x mode. Max_vpi %d\n",
                  phba->sli_rev, phba->max_vpi);
      rc = lpfc_sli_ring_map(phba);

      if (rc)
            goto lpfc_sli_hba_setup_error;

                        /* Init HBQs */

      if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
            rc = lpfc_sli_hbq_setup(phba);
            if (rc)
                  goto lpfc_sli_hba_setup_error;
      }

      phba->sli.sli_flag |= LPFC_PROCESS_LA;

      rc = lpfc_config_port_post(phba);
      if (rc)
            goto lpfc_sli_hba_setup_error;

      return rc;

lpfc_sli_hba_setup_error:
      phba->link_state = LPFC_HBA_ERROR;
      lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
                  "0445 Firmware initialization failed\n");
      return rc;
}

/*! lpfc_mbox_timeout
 *
 * \pre
 * \post
 * \param hba Pointer to per struct lpfc_hba structure
 * \param l1  Pointer to the driver's mailbox queue.
 * \return
 *   void
 *
 * \b Description:
 *
 * This routine handles mailbox timeout events at timer interrupt context.
 */
void
lpfc_mbox_timeout(unsigned long ptr)
{
      struct lpfc_hba  *phba = (struct lpfc_hba *) ptr;
      unsigned long iflag;
      uint32_t tmo_posted;

      spin_lock_irqsave(&phba->pport->work_port_lock, iflag);
      tmo_posted = phba->pport->work_port_events & WORKER_MBOX_TMO;
      if (!tmo_posted)
            phba->pport->work_port_events |= WORKER_MBOX_TMO;
      spin_unlock_irqrestore(&phba->pport->work_port_lock, iflag);

      if (!tmo_posted) {
            spin_lock_irqsave(&phba->hbalock, iflag);
            if (phba->work_wait)
                  lpfc_worker_wake_up(phba);
            spin_unlock_irqrestore(&phba->hbalock, iflag);
      }
}

void
lpfc_mbox_timeout_handler(struct lpfc_hba *phba)
{
      LPFC_MBOXQ_t *pmbox = phba->sli.mbox_active;
      MAILBOX_t *mb = &pmbox->mb;
      struct lpfc_sli *psli = &phba->sli;
      struct lpfc_sli_ring *pring;

      if (!(phba->pport->work_port_events & WORKER_MBOX_TMO)) {
            return;
      }

      /* Mbox cmd <mbxCommand> timeout */
      lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
                  "0310 Mailbox command x%x timeout Data: x%x x%x x%p\n",
                  mb->mbxCommand,
                  phba->pport->port_state,
                  phba->sli.sli_flag,
                  phba->sli.mbox_active);

      /* Setting state unknown so lpfc_sli_abort_iocb_ring
       * would get IOCB_ERROR from lpfc_sli_issue_iocb, allowing
       * it to fail all oustanding SCSI IO.
       */
      spin_lock_irq(&phba->pport->work_port_lock);
      phba->pport->work_port_events &= ~WORKER_MBOX_TMO;
      spin_unlock_irq(&phba->pport->work_port_lock);
      spin_lock_irq(&phba->hbalock);
      phba->link_state = LPFC_LINK_UNKNOWN;
      phba->pport->fc_flag |= FC_ESTABLISH_LINK;
      psli->sli_flag &= ~LPFC_SLI2_ACTIVE;
      spin_unlock_irq(&phba->hbalock);

      pring = &psli->ring[psli->fcp_ring];
      lpfc_sli_abort_iocb_ring(phba, pring);

      lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
                  "0316 Resetting board due to mailbox timeout\n");
      /*
       * lpfc_offline calls lpfc_sli_hba_down which will clean up
       * on oustanding mailbox commands.
       */
      lpfc_offline_prep(phba);
      lpfc_offline(phba);
      lpfc_sli_brdrestart(phba);
      if (lpfc_online(phba) == 0)         /* Initialize the HBA */
            mod_timer(&phba->fc_estabtmo, jiffies + HZ * 60);
      lpfc_unblock_mgmt_io(phba);
      return;
}

int
lpfc_sli_issue_mbox(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmbox, uint32_t flag)
{
      MAILBOX_t *mb;
      struct lpfc_sli *psli = &phba->sli;
      uint32_t status, evtctr;
      uint32_t ha_copy;
      int i;
      unsigned long drvr_flag = 0;
      volatile uint32_t word0, ldata;
      void __iomem *to_slim;

      if (pmbox->mbox_cmpl && pmbox->mbox_cmpl != lpfc_sli_def_mbox_cmpl &&
            pmbox->mbox_cmpl != lpfc_sli_wake_mbox_wait) {
            if(!pmbox->vport) {
                  lpfc_printf_log(phba, KERN_ERR,
                              LOG_MBOX | LOG_VPORT,
                              "1806 Mbox x%x failed. No vport\n",
                              pmbox->mb.mbxCommand);
                  dump_stack();
                  return MBXERR_ERROR;
            }
      }


      /* If the PCI channel is in offline state, do not post mbox. */
      if (unlikely(pci_channel_offline(phba->pcidev)))
            return MBX_NOT_FINISHED;

      spin_lock_irqsave(&phba->hbalock, drvr_flag);
      psli = &phba->sli;


      mb = &pmbox->mb;
      status = MBX_SUCCESS;

      if (phba->link_state == LPFC_HBA_ERROR) {
            spin_unlock_irqrestore(&phba->hbalock, drvr_flag);

            /* Mbox command <mbxCommand> cannot issue */
            LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag)
            return MBX_NOT_FINISHED;
      }

      if (mb->mbxCommand != MBX_KILL_BOARD && flag & MBX_NOWAIT &&
          !(readl(phba->HCregaddr) & HC_MBINT_ENA)) {
            spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
            LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag)
            return MBX_NOT_FINISHED;
      }

      if (psli->sli_flag & LPFC_SLI_MBOX_ACTIVE) {
            /* Polling for a mbox command when another one is already active
             * is not allowed in SLI. Also, the driver must have established
             * SLI2 mode to queue and process multiple mbox commands.
             */

            if (flag & MBX_POLL) {
                  spin_unlock_irqrestore(&phba->hbalock, drvr_flag);

                  /* Mbox command <mbxCommand> cannot issue */
                  LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
                  return MBX_NOT_FINISHED;
            }

            if (!(psli->sli_flag & LPFC_SLI2_ACTIVE)) {
                  spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
                  /* Mbox command <mbxCommand> cannot issue */
                  LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
                  return MBX_NOT_FINISHED;
            }

            /* Handle STOP IOCB processing flag. This is only meaningful
             * if we are not polling for mbox completion.
             */
            if (flag & MBX_STOP_IOCB) {
                  flag &= ~MBX_STOP_IOCB;
                  /* Now flag each ring */
                  for (i = 0; i < psli->num_rings; i++) {
                        /* If the ring is active, flag it */
                        if (psli->ring[i].cmdringaddr) {
                              psli->ring[i].flag |=
                                  LPFC_STOP_IOCB_MBX;
                        }
                  }
            }

            /* Another mailbox command is still being processed, queue this
             * command to be processed later.
             */
            lpfc_mbox_put(phba, pmbox);

            /* Mbox cmd issue - BUSY */
            lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
                        "(%d):0308 Mbox cmd issue - BUSY Data: "
                        "x%x x%x x%x x%x\n",
                        pmbox->vport ? pmbox->vport->vpi : 0xffffff,
                        mb->mbxCommand, phba->pport->port_state,
                        psli->sli_flag, flag);

            psli->slistat.mbox_busy++;
            spin_unlock_irqrestore(&phba->hbalock, drvr_flag);

            if (pmbox->vport) {
                  lpfc_debugfs_disc_trc(pmbox->vport,
                        LPFC_DISC_TRC_MBOX_VPORT,
                        "MBOX Bsy vport:  cmd:x%x mb:x%x x%x",
                        (uint32_t)mb->mbxCommand,
                        mb->un.varWords[0], mb->un.varWords[1]);
            }
            else {
                  lpfc_debugfs_disc_trc(phba->pport,
                        LPFC_DISC_TRC_MBOX,
                        "MBOX Bsy:        cmd:x%x mb:x%x x%x",
                        (uint32_t)mb->mbxCommand,
                        mb->un.varWords[0], mb->un.varWords[1]);
            }

            return MBX_BUSY;
      }

      /* Handle STOP IOCB processing flag. This is only meaningful
       * if we are not polling for mbox completion.
       */
      if (flag & MBX_STOP_IOCB) {
            flag &= ~MBX_STOP_IOCB;
            if (flag == MBX_NOWAIT) {
                  /* Now flag each ring */
                  for (i = 0; i < psli->num_rings; i++) {
                        /* If the ring is active, flag it */
                        if (psli->ring[i].cmdringaddr) {
                              psli->ring[i].flag |=
                                  LPFC_STOP_IOCB_MBX;
                        }
                  }
            }
      }

      psli->sli_flag |= LPFC_SLI_MBOX_ACTIVE;

      /* If we are not polling, we MUST be in SLI2 mode */
      if (flag != MBX_POLL) {
            if (!(psli->sli_flag & LPFC_SLI2_ACTIVE) &&
                (mb->mbxCommand != MBX_KILL_BOARD)) {
                  psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
                  spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
                  /* Mbox command <mbxCommand> cannot issue */
                  LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
                  return MBX_NOT_FINISHED;
            }
            /* timeout active mbox command */
            mod_timer(&psli->mbox_tmo, (jiffies +
                         (HZ * lpfc_mbox_tmo_val(phba, mb->mbxCommand))));
      }

      /* Mailbox cmd <cmd> issue */
      lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
                  "(%d):0309 Mailbox cmd x%x issue Data: x%x x%x "
                  "x%x\n",
                  pmbox->vport ? pmbox->vport->vpi : 0,
                  mb->mbxCommand, phba->pport->port_state,
                  psli->sli_flag, flag);

      if (mb->mbxCommand != MBX_HEARTBEAT) {
            if (pmbox->vport) {
                  lpfc_debugfs_disc_trc(pmbox->vport,
                        LPFC_DISC_TRC_MBOX_VPORT,
                        "MBOX Send vport: cmd:x%x mb:x%x x%x",
                        (uint32_t)mb->mbxCommand,
                        mb->un.varWords[0], mb->un.varWords[1]);
            }
            else {
                  lpfc_debugfs_disc_trc(phba->pport,
                        LPFC_DISC_TRC_MBOX,
                        "MBOX Send:       cmd:x%x mb:x%x x%x",
                        (uint32_t)mb->mbxCommand,
                        mb->un.varWords[0], mb->un.varWords[1]);
            }
      }

      psli->slistat.mbox_cmd++;
      evtctr = psli->slistat.mbox_event;

      /* next set own bit for the adapter and copy over command word */
      mb->mbxOwner = OWN_CHIP;

      if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
            /* First copy command data to host SLIM area */
            lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx, MAILBOX_CMD_SIZE);
      } else {
            if (mb->mbxCommand == MBX_CONFIG_PORT) {
                  /* copy command data into host mbox for cmpl */
                  lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx,
                                    MAILBOX_CMD_SIZE);
            }

            /* First copy mbox command data to HBA SLIM, skip past first
               word */
            to_slim = phba->MBslimaddr + sizeof (uint32_t);
            lpfc_memcpy_to_slim(to_slim, &mb->un.varWords[0],
                      MAILBOX_CMD_SIZE - sizeof (uint32_t));

            /* Next copy over first word, with mbxOwner set */
            ldata = *((volatile uint32_t *)mb);
            to_slim = phba->MBslimaddr;
            writel(ldata, to_slim);
            readl(to_slim); /* flush */

            if (mb->mbxCommand == MBX_CONFIG_PORT) {
                  /* switch over to host mailbox */
                  psli->sli_flag |= LPFC_SLI2_ACTIVE;
            }
      }

      wmb();
      /* interrupt board to doit right away */
      writel(CA_MBATT, phba->CAregaddr);
      readl(phba->CAregaddr); /* flush */

      switch (flag) {
      case MBX_NOWAIT:
            /* Don't wait for it to finish, just return */
            psli->mbox_active = pmbox;
            break;

      case MBX_POLL:
            psli->mbox_active = NULL;
            if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
                  /* First read mbox status word */
                  word0 = *((volatile uint32_t *)&phba->slim2p->mbx);
                  word0 = le32_to_cpu(word0);
            } else {
                  /* First read mbox status word */
                  word0 = readl(phba->MBslimaddr);
            }

            /* Read the HBA Host Attention Register */
            ha_copy = readl(phba->HAregaddr);

            i = lpfc_mbox_tmo_val(phba, mb->mbxCommand);
            i *= 1000; /* Convert to ms */

            /* Wait for command to complete */
            while (((word0 & OWN_CHIP) == OWN_CHIP) ||
                   (!(ha_copy & HA_MBATT) &&
                  (phba->link_state > LPFC_WARM_START))) {
                  if (i-- <= 0) {
                        psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
                        spin_unlock_irqrestore(&phba->hbalock,
                                           drvr_flag);
                        return MBX_NOT_FINISHED;
                  }

                  /* Check if we took a mbox interrupt while we were
                     polling */
                  if (((word0 & OWN_CHIP) != OWN_CHIP)
                      && (evtctr != psli->slistat.mbox_event))
                        break;

                  spin_unlock_irqrestore(&phba->hbalock,
                                     drvr_flag);

                  msleep(1);

                  spin_lock_irqsave(&phba->hbalock, drvr_flag);

                  if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
                        /* First copy command data */
                        word0 = *((volatile uint32_t *)
                                    &phba->slim2p->mbx);
                        word0 = le32_to_cpu(word0);
                        if (mb->mbxCommand == MBX_CONFIG_PORT) {
                              MAILBOX_t *slimmb;
                              volatile uint32_t slimword0;
                              /* Check real SLIM for any errors */
                              slimword0 = readl(phba->MBslimaddr);
                              slimmb = (MAILBOX_t *) & slimword0;
                              if (((slimword0 & OWN_CHIP) != OWN_CHIP)
                                  && slimmb->mbxStatus) {
                                    psli->sli_flag &=
                                        ~LPFC_SLI2_ACTIVE;
                                    word0 = slimword0;
                              }
                        }
                  } else {
                        /* First copy command data */
                        word0 = readl(phba->MBslimaddr);
                  }
                  /* Read the HBA Host Attention Register */
                  ha_copy = readl(phba->HAregaddr);
            }

            if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
                  /* copy results back to user */
                  lpfc_sli_pcimem_bcopy(&phba->slim2p->mbx, mb,
                                    MAILBOX_CMD_SIZE);
            } else {
                  /* First copy command data */
                  lpfc_memcpy_from_slim(mb, phba->MBslimaddr,
                                          MAILBOX_CMD_SIZE);
                  if ((mb->mbxCommand == MBX_DUMP_MEMORY) &&
                        pmbox->context2) {
                        lpfc_memcpy_from_slim((void *)pmbox->context2,
                              phba->MBslimaddr + DMP_RSP_OFFSET,
                                          mb->un.varDmp.word_cnt);
                  }
            }

            writel(HA_MBATT, phba->HAregaddr);
            readl(phba->HAregaddr); /* flush */

            psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
            status = mb->mbxStatus;
      }

      spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
      return status;
}

/*
 * Caller needs to hold lock.
 */
static void
__lpfc_sli_ringtx_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                struct lpfc_iocbq *piocb)
{
      /* Insert the caller's iocb in the txq tail for later processing. */
      list_add_tail(&piocb->list, &pring->txq);
      pring->txq_cnt++;
}

static struct lpfc_iocbq *
lpfc_sli_next_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
               struct lpfc_iocbq **piocb)
{
      struct lpfc_iocbq * nextiocb;

      nextiocb = lpfc_sli_ringtx_get(phba, pring);
      if (!nextiocb) {
            nextiocb = *piocb;
            *piocb = NULL;
      }

      return nextiocb;
}

/*
 * Lockless version of lpfc_sli_issue_iocb.
 */
int
__lpfc_sli_issue_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                struct lpfc_iocbq *piocb, uint32_t flag)
{
      struct lpfc_iocbq *nextiocb;
      IOCB_t *iocb;

      if (piocb->iocb_cmpl && (!piocb->vport) &&
         (piocb->iocb.ulpCommand != CMD_ABORT_XRI_CN) &&
         (piocb->iocb.ulpCommand != CMD_CLOSE_XRI_CN)) {
            lpfc_printf_log(phba, KERN_ERR,
                        LOG_SLI | LOG_VPORT,
                        "1807 IOCB x%x failed. No vport\n",
                        piocb->iocb.ulpCommand);
            dump_stack();
            return IOCB_ERROR;
      }


      /* If the PCI channel is in offline state, do not post iocbs. */
      if (unlikely(pci_channel_offline(phba->pcidev)))
            return IOCB_ERROR;

      /*
       * We should never get an IOCB if we are in a < LINK_DOWN state
       */
      if (unlikely(phba->link_state < LPFC_LINK_DOWN))
            return IOCB_ERROR;

      /*
       * Check to see if we are blocking IOCB processing because of a
       * outstanding mbox command.
       */
      if (unlikely(pring->flag & LPFC_STOP_IOCB_MBX))
            goto iocb_busy;

      if (unlikely(phba->link_state == LPFC_LINK_DOWN)) {
            /*
             * Only CREATE_XRI, CLOSE_XRI, and QUE_RING_BUF
             * can be issued if the link is not up.
             */
            switch (piocb->iocb.ulpCommand) {
            case CMD_QUE_RING_BUF_CN:
            case CMD_QUE_RING_BUF64_CN:
                  /*
                   * For IOCBs, like QUE_RING_BUF, that have no rsp ring
                   * completion, iocb_cmpl MUST be 0.
                   */
                  if (piocb->iocb_cmpl)
                        piocb->iocb_cmpl = NULL;
                  /*FALLTHROUGH*/
            case CMD_CREATE_XRI_CR:
            case CMD_CLOSE_XRI_CN:
            case CMD_CLOSE_XRI_CX:
                  break;
            default:
                  goto iocb_busy;
            }

      /*
       * For FCP commands, we must be in a state where we can process link
       * attention events.
       */
      } else if (unlikely(pring->ringno == phba->sli.fcp_ring &&
                      !(phba->sli.sli_flag & LPFC_PROCESS_LA))) {
            goto iocb_busy;
      }

      while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) &&
             (nextiocb = lpfc_sli_next_iocb(phba, pring, &piocb)))
            lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb);

      if (iocb)
            lpfc_sli_update_ring(phba, pring);
      else
            lpfc_sli_update_full_ring(phba, pring);

      if (!piocb)
            return IOCB_SUCCESS;

      goto out_busy;

 iocb_busy:
      pring->stats.iocb_cmd_delay++;

 out_busy:

      if (!(flag & SLI_IOCB_RET_IOCB)) {
            __lpfc_sli_ringtx_put(phba, pring, piocb);
            return IOCB_SUCCESS;
      }

      return IOCB_BUSY;
}


int
lpfc_sli_issue_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                struct lpfc_iocbq *piocb, uint32_t flag)
{
      unsigned long iflags;
      int rc;

      spin_lock_irqsave(&phba->hbalock, iflags);
      rc = __lpfc_sli_issue_iocb(phba, pring, piocb, flag);
      spin_unlock_irqrestore(&phba->hbalock, iflags);

      return rc;
}

static int
lpfc_extra_ring_setup( struct lpfc_hba *phba)
{
      struct lpfc_sli *psli;
      struct lpfc_sli_ring *pring;

      psli = &phba->sli;

      /* Adjust cmd/rsp ring iocb entries more evenly */

      /* Take some away from the FCP ring */
      pring = &psli->ring[psli->fcp_ring];
      pring->numCiocb -= SLI2_IOCB_CMD_R1XTRA_ENTRIES;
      pring->numRiocb -= SLI2_IOCB_RSP_R1XTRA_ENTRIES;
      pring->numCiocb -= SLI2_IOCB_CMD_R3XTRA_ENTRIES;
      pring->numRiocb -= SLI2_IOCB_RSP_R3XTRA_ENTRIES;

      /* and give them to the extra ring */
      pring = &psli->ring[psli->extra_ring];

      pring->numCiocb += SLI2_IOCB_CMD_R1XTRA_ENTRIES;
      pring->numRiocb += SLI2_IOCB_RSP_R1XTRA_ENTRIES;
      pring->numCiocb += SLI2_IOCB_CMD_R3XTRA_ENTRIES;
      pring->numRiocb += SLI2_IOCB_RSP_R3XTRA_ENTRIES;

      /* Setup default profile for this ring */
      pring->iotag_max = 4096;
      pring->num_mask = 1;
      pring->prt[0].profile = 0;      /* Mask 0 */
      pring->prt[0].rctl = phba->cfg_multi_ring_rctl;
      pring->prt[0].type = phba->cfg_multi_ring_type;
      pring->prt[0].lpfc_sli_rcv_unsol_event = NULL;
      return 0;
}

int
lpfc_sli_setup(struct lpfc_hba *phba)
{
      int i, totiocbsize = 0;
      struct lpfc_sli *psli = &phba->sli;
      struct lpfc_sli_ring *pring;

      psli->num_rings = MAX_CONFIGURED_RINGS;
      psli->sli_flag = 0;
      psli->fcp_ring = LPFC_FCP_RING;
      psli->next_ring = LPFC_FCP_NEXT_RING;
      psli->extra_ring = LPFC_EXTRA_RING;

      psli->iocbq_lookup = NULL;
      psli->iocbq_lookup_len = 0;
      psli->last_iotag = 0;

      for (i = 0; i < psli->num_rings; i++) {
            pring = &psli->ring[i];
            switch (i) {
            case LPFC_FCP_RING:     /* ring 0 - FCP */
                  /* numCiocb and numRiocb are used in config_port */
                  pring->numCiocb = SLI2_IOCB_CMD_R0_ENTRIES;
                  pring->numRiocb = SLI2_IOCB_RSP_R0_ENTRIES;
                  pring->numCiocb += SLI2_IOCB_CMD_R1XTRA_ENTRIES;
                  pring->numRiocb += SLI2_IOCB_RSP_R1XTRA_ENTRIES;
                  pring->numCiocb += SLI2_IOCB_CMD_R3XTRA_ENTRIES;
                  pring->numRiocb += SLI2_IOCB_RSP_R3XTRA_ENTRIES;
                  pring->sizeCiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_CMD_SIZE :
                                          SLI2_IOCB_CMD_SIZE;
                  pring->sizeRiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_RSP_SIZE :
                                          SLI2_IOCB_RSP_SIZE;
                  pring->iotag_ctr = 0;
                  pring->iotag_max =
                      (phba->cfg_hba_queue_depth * 2);
                  pring->fast_iotag = pring->iotag_max;
                  pring->num_mask = 0;
                  break;
            case LPFC_EXTRA_RING:   /* ring 1 - EXTRA */
                  /* numCiocb and numRiocb are used in config_port */
                  pring->numCiocb = SLI2_IOCB_CMD_R1_ENTRIES;
                  pring->numRiocb = SLI2_IOCB_RSP_R1_ENTRIES;
                  pring->sizeCiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_CMD_SIZE :
                                          SLI2_IOCB_CMD_SIZE;
                  pring->sizeRiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_RSP_SIZE :
                                          SLI2_IOCB_RSP_SIZE;
                  pring->iotag_max = phba->cfg_hba_queue_depth;
                  pring->num_mask = 0;
                  break;
            case LPFC_ELS_RING:     /* ring 2 - ELS / CT */
                  /* numCiocb and numRiocb are used in config_port */
                  pring->numCiocb = SLI2_IOCB_CMD_R2_ENTRIES;
                  pring->numRiocb = SLI2_IOCB_RSP_R2_ENTRIES;
                  pring->sizeCiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_CMD_SIZE :
                                          SLI2_IOCB_CMD_SIZE;
                  pring->sizeRiocb = (phba->sli_rev == 3) ?
                                          SLI3_IOCB_RSP_SIZE :
                                          SLI2_IOCB_RSP_SIZE;
                  pring->fast_iotag = 0;
                  pring->iotag_ctr = 0;
                  pring->iotag_max = 4096;
                  pring->num_mask = 4;
                  pring->prt[0].profile = 0;    /* Mask 0 */
                  pring->prt[0].rctl = FC_ELS_REQ;
                  pring->prt[0].type = FC_ELS_DATA;
                  pring->prt[0].lpfc_sli_rcv_unsol_event =
                      lpfc_els_unsol_event;
                  pring->prt[1].profile = 0;    /* Mask 1 */
                  pring->prt[1].rctl = FC_ELS_RSP;
                  pring->prt[1].type = FC_ELS_DATA;
                  pring->prt[1].lpfc_sli_rcv_unsol_event =
                      lpfc_els_unsol_event;
                  pring->prt[2].profile = 0;    /* Mask 2 */
                  /* NameServer Inquiry */
                  pring->prt[2].rctl = FC_UNSOL_CTL;
                  /* NameServer */
                  pring->prt[2].type = FC_COMMON_TRANSPORT_ULP;
                  pring->prt[2].lpfc_sli_rcv_unsol_event =
                      lpfc_ct_unsol_event;
                  pring->prt[3].profile = 0;    /* Mask 3 */
                  /* NameServer response */
                  pring->prt[3].rctl = FC_SOL_CTL;
                  /* NameServer */
                  pring->prt[3].type = FC_COMMON_TRANSPORT_ULP;
                  pring->prt[3].lpfc_sli_rcv_unsol_event =
                      lpfc_ct_unsol_event;
                  break;
            }
            totiocbsize += (pring->numCiocb * pring->sizeCiocb) +
                        (pring->numRiocb * pring->sizeRiocb);
      }
      if (totiocbsize > MAX_SLIM_IOCB_SIZE) {
            /* Too many cmd / rsp ring entries in SLI2 SLIM */
            printk(KERN_ERR "%d:0462 Too many cmd / rsp ring entries in "
                   "SLI2 SLIM Data: x%x x%lx\n",
                   phba->brd_no, totiocbsize,
                   (unsigned long) MAX_SLIM_IOCB_SIZE);
      }
      if (phba->cfg_multi_ring_support == 2)
            lpfc_extra_ring_setup(phba);

      return 0;
}

int
lpfc_sli_queue_setup(struct lpfc_hba *phba)
{
      struct lpfc_sli *psli;
      struct lpfc_sli_ring *pring;
      int i;

      psli = &phba->sli;
      spin_lock_irq(&phba->hbalock);
      INIT_LIST_HEAD(&psli->mboxq);
      INIT_LIST_HEAD(&psli->mboxq_cmpl);
      /* Initialize list headers for txq and txcmplq as double linked lists */
      for (i = 0; i < psli->num_rings; i++) {
            pring = &psli->ring[i];
            pring->ringno = i;
            pring->next_cmdidx  = 0;
            pring->local_getidx = 0;
            pring->cmdidx = 0;
            INIT_LIST_HEAD(&pring->txq);
            INIT_LIST_HEAD(&pring->txcmplq);
            INIT_LIST_HEAD(&pring->iocb_continueq);
            INIT_LIST_HEAD(&pring->postbufq);
      }
      spin_unlock_irq(&phba->hbalock);
      return 1;
}

int
lpfc_sli_host_down(struct lpfc_vport *vport)
{
      LIST_HEAD(completions);
      struct lpfc_hba *phba = vport->phba;
      struct lpfc_sli *psli = &phba->sli;
      struct lpfc_sli_ring *pring;
      struct lpfc_iocbq *iocb, *next_iocb;
      int i;
      unsigned long flags = 0;
      uint16_t prev_pring_flag;

      lpfc_cleanup_discovery_resources(vport);

      spin_lock_irqsave(&phba->hbalock, flags);
      for (i = 0; i < psli->num_rings; i++) {
            pring = &psli->ring[i];
            prev_pring_flag = pring->flag;
            if (pring->ringno == LPFC_ELS_RING) /* Only slow rings */
                  pring->flag |= LPFC_DEFERRED_RING_EVENT;
            /*
             * Error everything on the txq since these iocbs have not been
             * given to the FW yet.
             */
            list_for_each_entry_safe(iocb, next_iocb, &pring->txq, list) {
                  if (iocb->vport != vport)
                        continue;
                  list_move_tail(&iocb->list, &completions);
                  pring->txq_cnt--;
            }

            /* Next issue ABTS for everything on the txcmplq */
            list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq,
                                                      list) {
                  if (iocb->vport != vport)
                        continue;
                  lpfc_sli_issue_abort_iotag(phba, pring, iocb);
            }

            pring->flag = prev_pring_flag;
      }

      spin_unlock_irqrestore(&phba->hbalock, flags);

      while (!list_empty(&completions)) {
            list_remove_head(&completions, iocb, struct lpfc_iocbq, list);

            if (!iocb->iocb_cmpl)
                  lpfc_sli_release_iocbq(phba, iocb);
            else {
                  iocb->iocb.ulpStatus = IOSTAT_LOCAL_REJECT;
                  iocb->iocb.un.ulpWord[4] = IOERR_SLI_DOWN;
                  (iocb->iocb_cmpl) (phba, iocb, iocb);
            }
      }
      return 1;
}

int
lpfc_sli_hba_down(struct lpfc_hba *phba)
{
      LIST_HEAD(completions);
      struct lpfc_sli *psli = &phba->sli;
      struct lpfc_sli_ring *pring;
      LPFC_MBOXQ_t *pmb;
      struct lpfc_iocbq *iocb;
      IOCB_t *cmd = NULL;
      int i;
      unsigned long flags = 0;

      lpfc_hba_down_prep(phba);

      lpfc_fabric_abort_hba(phba);

      spin_lock_irqsave(&phba->hbalock, flags);
      for (i = 0; i < psli->num_rings; i++) {
            pring = &psli->ring[i];
            if (pring->ringno == LPFC_ELS_RING) /* Only slow rings */
                  pring->flag |= LPFC_DEFERRED_RING_EVENT;

            /*
             * Error everything on the txq since these iocbs have not been
             * given to the FW yet.
             */
            list_splice_init(&pring->txq, &completions);
            pring->txq_cnt = 0;

      }
      spin_unlock_irqrestore(&phba->hbalock, flags);

      while (!list_empty(&completions)) {
            list_remove_head(&completions, iocb, struct lpfc_iocbq, list);
            cmd = &iocb->iocb;

            if (!iocb->iocb_cmpl)
                  lpfc_sli_release_iocbq(phba, iocb);
            else {
                  cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
                  cmd->un.ulpWord[4] = IOERR_SLI_DOWN;
                  (iocb->iocb_cmpl) (phba, iocb, iocb);
            }
      }

      /* Return any active mbox cmds */
      del_timer_sync(&psli->mbox_tmo);
      spin_lock_irqsave(&phba->hbalock, flags);

      spin_lock(&phba->pport->work_port_lock);
      phba->pport->work_port_events &= ~WORKER_MBOX_TMO;
      spin_unlock(&phba->pport->work_port_lock);

      if (psli->mbox_active) {
            list_add_tail(&psli->mbox_active->list, &completions);
            psli->mbox_active = NULL;
            psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
      }

      /* Return any pending or completed mbox cmds */
      list_splice_init(&phba->sli.mboxq, &completions);
      list_splice_init(&phba->sli.mboxq_cmpl, &completions);
      INIT_LIST_HEAD(&psli->mboxq);
      INIT_LIST_HEAD(&psli->mboxq_cmpl);

      spin_unlock_irqrestore(&phba->hbalock, flags);

      while (!list_empty(&completions)) {
            list_remove_head(&completions, pmb, LPFC_MBOXQ_t, list);
            pmb->mb.mbxStatus = MBX_NOT_FINISHED;
            if (pmb->mbox_cmpl) {
                  pmb->mbox_cmpl(phba,pmb);
            }
      }
      return 1;
}

void
lpfc_sli_pcimem_bcopy(void *srcp, void *destp, uint32_t cnt)
{
      uint32_t *src = srcp;
      uint32_t *dest = destp;
      uint32_t ldata;
      int i;

      for (i = 0; i < (int)cnt; i += sizeof (uint32_t)) {
            ldata = *src;
            ldata = le32_to_cpu(ldata);
            *dest = ldata;
            src++;
            dest++;
      }
}

int
lpfc_sli_ringpostbuf_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                   struct lpfc_dmabuf *mp)
{
      /* Stick struct lpfc_dmabuf at end of postbufq so driver can look it up
         later */
      spin_lock_irq(&phba->hbalock);
      list_add_tail(&mp->list, &pring->postbufq);
      pring->postbufq_cnt++;
      spin_unlock_irq(&phba->hbalock);
      return 0;
}


struct lpfc_dmabuf *
lpfc_sli_ringpostbuf_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                   dma_addr_t phys)
{
      struct lpfc_dmabuf *mp, *next_mp;
      struct list_head *slp = &pring->postbufq;

      /* Search postbufq, from the begining, looking for a match on phys */
      spin_lock_irq(&phba->hbalock);
      list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) {
            if (mp->phys == phys) {
                  list_del_init(&mp->list);
                  pring->postbufq_cnt--;
                  spin_unlock_irq(&phba->hbalock);
                  return mp;
            }
      }

      spin_unlock_irq(&phba->hbalock);
      lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
                  "0410 Cannot find virtual addr for mapped buf on "
                  "ring %d Data x%llx x%p x%p x%x\n",
                  pring->ringno, (unsigned long long)phys,
                  slp->next, slp->prev, pring->postbufq_cnt);
      return NULL;
}

static void
lpfc_sli_abort_els_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
                  struct lpfc_iocbq *rspiocb)
{
      IOCB_t *irsp = &rspiocb->iocb;
      uint16_t abort_iotag, abort_context;
      struct lpfc_iocbq *abort_iocb;
      struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];

      abort_iocb = NULL;

      if (irsp->ulpStatus) {
            abort_context = cmdiocb->iocb.un.acxri.abortContextTag;
            abort_iotag = cmdiocb->iocb.un.acxri.abortIoTag;

            spin_lock_irq(&phba->hbalock);
            if (abort_iotag != 0 && abort_iotag <= phba->sli.last_iotag)
                  abort_iocb = phba->sli.iocbq_lookup[abort_iotag];

            lpfc_printf_log(phba, KERN_INFO, LOG_ELS | LOG_SLI,
                        "0327 Cannot abort els iocb %p "
                        "with tag %x context %x, abort status %x, "
                        "abort code %x\n",
                        abort_iocb, abort_iotag, abort_context,
                        irsp->ulpStatus, irsp->un.ulpWord[4]);

            /*
             * make sure we have the right iocbq before taking it
             * off the txcmplq and try to call completion routine.
             */
            if (!abort_iocb ||
                abort_iocb->iocb.ulpContext != abort_context ||
                (abort_iocb->iocb_flag & LPFC_DRIVER_ABORTED) == 0)
                  spin_unlock_irq(&phba->hbalock);
            else {
                  list_del_init(&abort_iocb->list);
                  pring->txcmplq_cnt--;
                  spin_unlock_irq(&phba->hbalock);

                  abort_iocb->iocb_flag &= ~LPFC_DRIVER_ABORTED;
                  abort_iocb->iocb.ulpStatus = IOSTAT_LOCAL_REJECT;
                  abort_iocb->iocb.un.ulpWord[4] = IOERR_SLI_ABORTED;
                  (abort_iocb->iocb_cmpl)(phba, abort_iocb, abort_iocb);
            }
      }

      lpfc_sli_release_iocbq(phba, cmdiocb);
      return;
}

static void
lpfc_ignore_els_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
                 struct lpfc_iocbq *rspiocb)
{
      IOCB_t *irsp = &rspiocb->iocb;

      /* ELS cmd tag <ulpIoTag> completes */
      lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
                  "0133 Ignoring ELS cmd tag x%x completion Data: "
                  "x%x x%x x%x\n",
                  irsp->ulpIoTag, irsp->ulpStatus,
                  irsp->un.ulpWord[4], irsp->ulpTimeout);
      if (cmdiocb->iocb.ulpCommand == CMD_GEN_REQUEST64_CR)
            lpfc_ct_free_iocb(phba, cmdiocb);
      else
            lpfc_els_free_iocb(phba, cmdiocb);
      return;
}

int
lpfc_sli_issue_abort_iotag(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
                     struct lpfc_iocbq *cmdiocb)
{
      struct lpfc_vport *vport = cmdiocb->vport;
      struct lpfc_iocbq *abtsiocbp;
      IOCB_t *icmd = NULL;
      IOCB_t *iabt = NULL;
      int retval = IOCB_ERROR;

      /*
       * There are certain command types we don't want to abort.  And we
       * don't want to abort commands that are already in the process of
       * being aborted.
       */
      icmd = &cmdiocb->iocb;
      if (icmd->ulpCommand == CMD_ABORT_XRI_CN ||
          icmd->ulpCommand == CMD_CLOSE_XRI_CN ||
          (cmdiocb->iocb_flag & LPFC_DRIVER_ABORTED) != 0)
            return 0;

      /* If we're unloading, don't abort iocb on the ELS ring, but change the
       * callback so that nothing happens when it finishes.
       */
      if ((vport->load_flag & FC_UNLOADING) &&
          (pring->ringno == LPFC_ELS_RING)) {
            if (cmdiocb->iocb_flag & LPFC_IO_FABRIC)
                  cmdiocb->fabric_iocb_cmpl = lpfc_ignore_els_cmpl;
            else
                  cmdiocb->iocb_cmpl = lpfc_ignore_els_cmpl;
            goto abort_iotag_exit;
      }

      /* issue ABTS for this IOCB based on iotag */
      abtsiocbp = __lpfc_sli_get_iocbq(phba);
      if (abtsiocbp == NULL)
            return 0;

      /* This signals the response to set the correct status
       * before calling the completion handler.
       */
      cmdiocb->iocb_flag |= LPFC_DRIVER_ABORTED;

      iabt = &abtsiocbp->iocb;
      iabt->un.acxri.abortType = ABORT_TYPE_ABTS;
      iabt->un.acxri.abortContextTag = icmd->ulpContext;
      iabt->un.acxri.abortIoTag = icmd->ulpIoTag;
      iabt->ulpLe = 1;
      iabt->ulpClass = icmd->ulpClass;

      if (phba->link_state >= LPFC_LINK_UP)
            iabt->ulpCommand = CMD_ABORT_XRI_CN;
      else
            iabt->ulpCommand = CMD_CLOSE_XRI_CN;

      abtsiocbp->iocb_cmpl = lpfc_sli_abort_els_cmpl;

      lpfc_printf_vlog(vport, KERN_INFO, LOG_SLI,
                   "0339 Abort xri x%x, original iotag x%x, "
                   "abort cmd iotag x%x\n",
                   iabt->un.acxri.abortContextTag,
                   iabt->un.acxri.abortIoTag, abtsiocbp->iotag);
      retval = __lpfc_sli_issue_iocb(phba, pring, abtsiocbp, 0);

abort_iotag_exit:
      /*
       * Caller to this routine should check for IOCB_ERROR
       * and handle it properly.  This routine no longer removes
       * iocb off txcmplq and call compl in case of IOCB_ERROR.
       */
      return retval;
}

static int
lpfc_sli_validate_fcp_iocb(struct lpfc_iocbq *iocbq, struct lpfc_vport *vport,
                     uint16_t tgt_id, uint64_t lun_id,
                     lpfc_ctx_cmd ctx_cmd)
{
      struct lpfc_scsi_buf *lpfc_cmd;
      struct scsi_cmnd *cmnd;
      int rc = 1;

      if (!(iocbq->iocb_flag &  LPFC_IO_FCP))
            return rc;

      if (iocbq->vport != vport)
            return rc;

      lpfc_cmd = container_of(iocbq, struct lpfc_scsi_buf, cur_iocbq);
      cmnd = lpfc_cmd->pCmd;

      if (cmnd == NULL)
            return rc;

      switch (ctx_cmd) {
      case LPFC_CTX_LUN:
            if ((cmnd->device->id == tgt_id) &&
                (cmnd->device->lun == lun_id))
                  rc = 0;
            break;
      case LPFC_CTX_TGT:
            if (cmnd->device->id == tgt_id)
                  rc = 0;
            break;
      case LPFC_CTX_HOST:
            rc = 0;
            break;
      default:
            printk(KERN_ERR "%s: Unknown context cmd type, value %d\n",
                  __FUNCTION__, ctx_cmd);
            break;
      }

      return rc;
}

int
lpfc_sli_sum_iocb(struct lpfc_vport *vport, uint16_t tgt_id, uint64_t lun_id,
              lpfc_ctx_cmd ctx_cmd)
{
      struct lpfc_hba *phba = vport->phba;
      struct lpfc_iocbq *iocbq;
      int sum, i;

      for (i = 1, sum = 0; i <= phba->sli.last_iotag; i++) {
            iocbq = phba->sli.iocbq_lookup[i];

            if (lpfc_sli_validate_fcp_iocb (iocbq, vport, tgt_id, lun_id,
                                    ctx_cmd) == 0)
                  sum++;
      }

      return sum;
}

void
lpfc_sli_abort_fcp_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
                  struct lpfc_iocbq *rspiocb)
{
      lpfc_sli_release_iocbq(phba, cmdiocb);
      return;
}

int
lpfc_sli_abort_iocb(struct lpfc_vport *vport, struct lpfc_sli_ring *pring,
                uint16_t tgt_id, uint64_t lun_id, lpfc_ctx_cmd abort_cmd)
{
      struct lpfc_hba *phba = vport->phba;
      struct lpfc_iocbq *iocbq;
      struct lpfc_iocbq *abtsiocb;
      IOCB_t *cmd = NULL;
      int errcnt = 0, ret_val = 0;
      int i;

      for (i = 1; i <= phba->sli.last_iotag; i++) {
            iocbq = phba->sli.iocbq_lookup[i];

            if (lpfc_sli_validate_fcp_iocb(iocbq, vport, tgt_id, lun_id,
                                     abort_cmd) != 0)
                  continue;

            /* issue ABTS for this IOCB based on iotag */
            abtsiocb = lpfc_sli_get_iocbq(phba);
            if (abtsiocb == NULL) {
                  errcnt++;
                  continue;
            }

            cmd = &iocbq->iocb;
            abtsiocb->iocb.un.acxri.abortType = ABORT_TYPE_ABTS;
            abtsiocb->iocb.un.acxri.abortContextTag = cmd->ulpContext;
            abtsiocb->iocb.un.acxri.abortIoTag = cmd->ulpIoTag;
            abtsiocb->iocb.ulpLe = 1;
            abtsiocb->iocb.ulpClass = cmd->ulpClass;
            abtsiocb->vport = phba->pport;

            if (lpfc_is_link_up(phba))
                  abtsiocb->iocb.ulpCommand = CMD_ABORT_XRI_CN;
            else
                  abtsiocb->iocb.ulpCommand = CMD_CLOSE_XRI_CN;

            /* Setup callback routine and issue the command. */
            abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl;
            ret_val = lpfc_sli_issue_iocb(phba, pring, abtsiocb, 0);
            if (ret_val == IOCB_ERROR) {
                  lpfc_sli_release_iocbq(phba, abtsiocb);
                  errcnt++;
                  continue;
            }
      }

      return errcnt;
}

static void
lpfc_sli_wake_iocb_wait(struct lpfc_hba *phba,
                  struct lpfc_iocbq *cmdiocbq,
                  struct lpfc_iocbq *rspiocbq)
{
      wait_queue_head_t *pdone_q;
      unsigned long iflags;

      spin_lock_irqsave(&phba->hbalock, iflags);
      cmdiocbq->iocb_flag |= LPFC_IO_WAKE;
      if (cmdiocbq->context2 && rspiocbq)
            memcpy(&((struct lpfc_iocbq *)cmdiocbq->context2)->iocb,
                   &rspiocbq->iocb, sizeof(IOCB_t));

      pdone_q = cmdiocbq->context_un.wait_queue;
      if (pdone_q)
            wake_up(pdone_q);
      spin_unlock_irqrestore(&phba->hbalock, iflags);
      return;
}

/*
 * Issue the caller's iocb and wait for its completion, but no longer than the
 * caller's timeout.  Note that iocb_flags is cleared before the
 * lpfc_sli_issue_call since the wake routine sets a unique value and by
 * definition this is a wait function.
 */

int
lpfc_sli_issue_iocb_wait(struct lpfc_hba *phba,
                   struct lpfc_sli_ring *pring,
                   struct lpfc_iocbq *piocb,
                   struct lpfc_iocbq *prspiocbq,
                   uint32_t timeout)
{
      DECLARE_WAIT_QUEUE_HEAD_ONSTACK(done_q);
      long timeleft, timeout_req = 0;
      int retval = IOCB_SUCCESS;
      uint32_t creg_val;

      /*
       * If the caller has provided a response iocbq buffer, then context2
       * is NULL or its an error.
       */
      if (prspiocbq) {
            if (piocb->context2)
                  return IOCB_ERROR;
            piocb->context2 = prspiocbq;
      }

      piocb->iocb_cmpl = lpfc_sli_wake_iocb_wait;
      piocb->context_un.wait_queue = &done_q;
      piocb->iocb_flag &= ~LPFC_IO_WAKE;

      if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
            creg_val = readl(phba->HCregaddr);
            creg_val |= (HC_R0INT_ENA << LPFC_FCP_RING);
            writel(creg_val, phba->HCregaddr);
            readl(phba->HCregaddr); /* flush */
      }

      retval = lpfc_sli_issue_iocb(phba, pring, piocb, 0);
      if (retval == IOCB_SUCCESS) {
            timeout_req = timeout * HZ;
            timeleft = wait_event_timeout(done_q,
                        piocb->iocb_flag & LPFC_IO_WAKE,
                        timeout_req);

            if (piocb->iocb_flag & LPFC_IO_WAKE) {
                  lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                              "0331 IOCB wake signaled\n");
            } else if (timeleft == 0) {
                  lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                              "0338 IOCB wait timeout error - no "
                              "wake response Data x%x\n", timeout);
                  retval = IOCB_TIMEDOUT;
            } else {
                  lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
                              "0330 IOCB wake NOT set, "
                              "Data x%x x%lx\n",
                              timeout, (timeleft / jiffies));
                  retval = IOCB_TIMEDOUT;
            }
      } else {
            lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
                        ":0332 IOCB wait issue failed, Data x%x\n",
                        retval);
            retval = IOCB_ERROR;
      }

      if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
            creg_val = readl(phba->HCregaddr);
            creg_val &= ~(HC_R0INT_ENA << LPFC_FCP_RING);
            writel(creg_val, phba->HCregaddr);
            readl(phba->HCregaddr); /* flush */
      }

      if (prspiocbq)
            piocb->context2 = NULL;

      piocb->context_un.wait_queue = NULL;
      piocb->iocb_cmpl = NULL;
      return retval;
}

int
lpfc_sli_issue_mbox_wait(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq,
                   uint32_t timeout)
{
      DECLARE_WAIT_QUEUE_HEAD_ONSTACK(done_q);
      int retval;
      unsigned long flag;

      /* The caller must leave context1 empty. */
      if (pmboxq->context1 != 0)
            return MBX_NOT_FINISHED;

      /* setup wake call as IOCB callback */
      pmboxq->mbox_cmpl = lpfc_sli_wake_mbox_wait;
      /* setup context field to pass wait_queue pointer to wake function  */
      pmboxq->context1 = &done_q;

      /* now issue the command */
      retval = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);

      if (retval == MBX_BUSY || retval == MBX_SUCCESS) {
            wait_event_interruptible_timeout(done_q,
                        pmboxq->mbox_flag & LPFC_MBX_WAKE,
                        timeout * HZ);

            spin_lock_irqsave(&phba->hbalock, flag);
            pmboxq->context1 = NULL;
            /*
             * if LPFC_MBX_WAKE flag is set the mailbox is completed
             * else do not free the resources.
             */
            if (pmboxq->mbox_flag & LPFC_MBX_WAKE)
                  retval = MBX_SUCCESS;
            else {
                  retval = MBX_TIMEOUT;
                  pmboxq->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
            }
            spin_unlock_irqrestore(&phba->hbalock, flag);
      }

      return retval;
}

int
lpfc_sli_flush_mbox_queue(struct lpfc_hba * phba)
{
      struct lpfc_vport *vport = phba->pport;
      int i = 0;
      uint32_t ha_copy;

      while (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE && !vport->stopped) {
            if (i++ > LPFC_MBOX_TMO * 1000)
                  return 1;

            /*
             * Call lpfc_sli_handle_mb_event only if a mailbox cmd
             * did finish. This way we won't get the misleading
             * "Stray Mailbox Interrupt" message.
             */
            spin_lock_irq(&phba->hbalock);
            ha_copy = phba->work_ha;
            phba->work_ha &= ~HA_MBATT;
            spin_unlock_irq(&phba->hbalock);

            if (ha_copy & HA_MBATT)
                  if (lpfc_sli_handle_mb_event(phba) == 0)
                        i = 0;

            msleep(1);
      }

      return (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE) ? 1 : 0;
}

irqreturn_t
lpfc_intr_handler(int irq, void *dev_id)
{
      struct lpfc_hba  *phba;
      uint32_t ha_copy;
      uint32_t work_ha_copy;
      unsigned long status;
      int i;
      uint32_t control;

      MAILBOX_t *mbox, *pmbox;
      struct lpfc_vport *vport;
      struct lpfc_nodelist *ndlp;
      struct lpfc_dmabuf *mp;
      LPFC_MBOXQ_t *pmb;
      int rc;

      /*
       * Get the driver's phba structure from the dev_id and
       * assume the HBA is not interrupting.
       */
      phba = (struct lpfc_hba *) dev_id;

      if (unlikely(!phba))
            return IRQ_NONE;

      /* If the pci channel is offline, ignore all the interrupts. */
      if (unlikely(pci_channel_offline(phba->pcidev)))
            return IRQ_NONE;

      phba->sli.slistat.sli_intr++;

      /*
       * Call the HBA to see if it is interrupting.  If not, don't claim
       * the interrupt
       */

      /* Ignore all interrupts during initialization. */
      if (unlikely(phba->link_state < LPFC_LINK_DOWN))
            return IRQ_NONE;

      /*
       * Read host attention register to determine interrupt source
       * Clear Attention Sources, except Error Attention (to
       * preserve status) and Link Attention
       */
      spin_lock(&phba->hbalock);
      ha_copy = readl(phba->HAregaddr);
      /* If somebody is waiting to handle an eratt don't process it
       * here.  The brdkill function will do this.
       */
      if (phba->link_flag & LS_IGNORE_ERATT)
            ha_copy &= ~HA_ERATT;
      writel((ha_copy & ~(HA_LATT | HA_ERATT)), phba->HAregaddr);
      readl(phba->HAregaddr); /* flush */
      spin_unlock(&phba->hbalock);

      if (unlikely(!ha_copy))
            return IRQ_NONE;

      work_ha_copy = ha_copy & phba->work_ha_mask;

      if (unlikely(work_ha_copy)) {
            if (work_ha_copy & HA_LATT) {
                  if (phba->sli.sli_flag & LPFC_PROCESS_LA) {
                        /*
                         * Turn off Link Attention interrupts
                         * until CLEAR_LA done
                         */
                        spin_lock(&phba->hbalock);
                        phba->sli.sli_flag &= ~LPFC_PROCESS_LA;
                        control = readl(phba->HCregaddr);
                        control &= ~HC_LAINT_ENA;
                        writel(control, phba->HCregaddr);
                        readl(phba->HCregaddr); /* flush */
                        spin_unlock(&phba->hbalock);
                  }
                  else
                        work_ha_copy &= ~HA_LATT;
            }

            if (work_ha_copy & ~(HA_ERATT|HA_MBATT|HA_LATT)) {
                  /*
                   * Turn off Slow Rings interrupts, LPFC_ELS_RING is
                   * the only slow ring.
                   */
                  status = (work_ha_copy &
                        (HA_RXMASK  << (4*LPFC_ELS_RING)));
                  status >>= (4*LPFC_ELS_RING);
                  if (status & HA_RXMASK) {
                        spin_lock(&phba->hbalock);
                        control = readl(phba->HCregaddr);

                        lpfc_debugfs_slow_ring_trc(phba,
                        "ISR slow ring:   ctl:x%x stat:x%x isrcnt:x%x",
                        control, status,
                        (uint32_t)phba->sli.slistat.sli_intr);

                        if (control & (HC_R0INT_ENA << LPFC_ELS_RING)) {
                              lpfc_debugfs_slow_ring_trc(phba,
                                    "ISR Disable ring:"
                                    "pwork:x%x hawork:x%x wait:x%x",
                                    phba->work_ha, work_ha_copy,
                                    (uint32_t)((unsigned long)
                                    phba->work_wait));

                              control &=
                                  ~(HC_R0INT_ENA << LPFC_ELS_RING);
                              writel(control, phba->HCregaddr);
                              readl(phba->HCregaddr); /* flush */
                        }
                        else {
                              lpfc_debugfs_slow_ring_trc(phba,
                                    "ISR slow ring:   pwork:"
                                    "x%x hawork:x%x wait:x%x",
                                    phba->work_ha, work_ha_copy,
                                    (uint32_t)((unsigned long)
                                    phba->work_wait));
                        }
                        spin_unlock(&phba->hbalock);
                  }
            }

            if (work_ha_copy & HA_ERATT) {
                  phba->link_state = LPFC_HBA_ERROR;
                  /*
                   * There was a link/board error.  Read the
                   * status register to retrieve the error event
                   * and process it.
                   */
                  phba->sli.slistat.err_attn_event++;
                  /* Save status info */
                  phba->work_hs = readl(phba->HSregaddr);
                  phba->work_status[0] = readl(phba->MBslimaddr + 0xa8);
                  phba->work_status[1] = readl(phba->MBslimaddr + 0xac);

                  /* Clear Chip error bit */
                  writel(HA_ERATT, phba->HAregaddr);
                  readl(phba->HAregaddr); /* flush */
                  phba->pport->stopped = 1;
            }

            if ((work_ha_copy & HA_MBATT) &&
                (phba->sli.mbox_active)) {
                  pmb = phba->sli.mbox_active;
                  pmbox = &pmb->mb;
                  mbox = &phba->slim2p->mbx;
                  vport = pmb->vport;

                  /* First check out the status word */
                  lpfc_sli_pcimem_bcopy(mbox, pmbox, sizeof(uint32_t));
                  if (pmbox->mbxOwner != OWN_HOST) {
                        /*
                         * Stray Mailbox Interrupt, mbxCommand <cmd>
                         * mbxStatus <status>
                         */
                        lpfc_printf_log(phba, KERN_WARNING, LOG_MBOX |
                                    LOG_SLI,
                                    "(%d):0304 Stray Mailbox "
                                    "Interrupt mbxCommand x%x "
                                    "mbxStatus x%x\n",
                                    (vport ? vport->vpi : 0),
                                    pmbox->mbxCommand,
                                    pmbox->mbxStatus);
                  }
                  phba->last_completion_time = jiffies;
                  del_timer_sync(&phba->sli.mbox_tmo);

                  phba->sli.mbox_active = NULL;
                  if (pmb->mbox_cmpl) {
                        lpfc_sli_pcimem_bcopy(mbox, pmbox,
                                          MAILBOX_CMD_SIZE);
                  }
                  if (pmb->mbox_flag & LPFC_MBX_IMED_UNREG) {
                        pmb->mbox_flag &= ~LPFC_MBX_IMED_UNREG;

                        lpfc_debugfs_disc_trc(vport,
                              LPFC_DISC_TRC_MBOX_VPORT,
                              "MBOX dflt rpi: : status:x%x rpi:x%x",
                              (uint32_t)pmbox->mbxStatus,
                              pmbox->un.varWords[0], 0);

                        if ( !pmbox->mbxStatus) {
                              mp = (struct lpfc_dmabuf *)
                                    (pmb->context1);
                              ndlp = (struct lpfc_nodelist *)
                                    pmb->context2;

                              /* Reg_LOGIN of dflt RPI was successful.
                               * new lets get rid of the RPI using the
                               * same mbox buffer.
                               */
                              lpfc_unreg_login(phba, vport->vpi,
                                    pmbox->un.varWords[0], pmb);
                              pmb->mbox_cmpl = lpfc_mbx_cmpl_dflt_rpi;
                              pmb->context1 = mp;
                              pmb->context2 = ndlp;
                              pmb->vport = vport;
                              spin_lock(&phba->hbalock);
                              phba->sli.sli_flag &=
                                    ~LPFC_SLI_MBOX_ACTIVE;
                              spin_unlock(&phba->hbalock);
                              goto send_current_mbox;
                        }
                  }
                  spin_lock(&phba->pport->work_port_lock);
                  phba->pport->work_port_events &= ~WORKER_MBOX_TMO;
                  spin_unlock(&phba->pport->work_port_lock);
                  lpfc_mbox_cmpl_put(phba, pmb);
            }
            if ((work_ha_copy & HA_MBATT) &&
                (phba->sli.mbox_active == NULL)) {
send_next_mbox:
                  spin_lock(&phba->hbalock);
                  phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
                  pmb = lpfc_mbox_get(phba);
                  spin_unlock(&phba->hbalock);
send_current_mbox:
                  /* Process next mailbox command if there is one */
                  if (pmb != NULL) {
                        rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
                        if (rc == MBX_NOT_FINISHED) {
                              pmb->mb.mbxStatus = MBX_NOT_FINISHED;
                              lpfc_mbox_cmpl_put(phba, pmb);
                              goto send_next_mbox;
                        }
                  } else {
                        /* Turn on IOCB processing */
                        for (i = 0; i < phba->sli.num_rings; i++)
                              lpfc_sli_turn_on_ring(phba, i);
                  }

            }

            spin_lock(&phba->hbalock);
            phba->work_ha |= work_ha_copy;
            if (phba->work_wait)
                  lpfc_worker_wake_up(phba);
            spin_unlock(&phba->hbalock);
      }

      ha_copy &= ~(phba->work_ha_mask);

      /*
       * Process all events on FCP ring.  Take the optimized path for
       * FCP IO.  Any other IO is slow path and is handled by
       * the worker thread.
       */
      status = (ha_copy & (HA_RXMASK  << (4*LPFC_FCP_RING)));
      status >>= (4*LPFC_FCP_RING);
      if (status & HA_RXMASK)
            lpfc_sli_handle_fast_ring_event(phba,
                                    &phba->sli.ring[LPFC_FCP_RING],
                                    status);

      if (phba->cfg_multi_ring_support == 2) {
            /*
             * Process all events on extra ring.  Take the optimized path
             * for extra ring IO.  Any other IO is slow path and is handled
             * by the worker thread.
             */
            status = (ha_copy & (HA_RXMASK  << (4*LPFC_EXTRA_RING)));
            status >>= (4*LPFC_EXTRA_RING);
            if (status & HA_RXMASK) {
                  lpfc_sli_handle_fast_ring_event(phba,
                              &phba->sli.ring[LPFC_EXTRA_RING],
                              status);
            }
      }
      return IRQ_HANDLED;

} /* lpfc_intr_handler */

Generated by  Doxygen 1.6.0   Back to index