git.oblomov.eu Git - linux-2.6/blob - drivers/scsi/lpfc/lpfc_sli.c

   1 /*******************************************************************
   2  * This file is part of the Emulex Linux Device Driver for         *
   3  * Fibre Channel Host Bus Adapters.                                *
   4  * Copyright (C) 2004-2007 Emulex.  All rights reserved.           *
   5  * EMULEX and SLI are trademarks of Emulex.                        *
   6  * www.emulex.com                                                  *
   7  * Portions Copyright (C) 2004-2005 Christoph Hellwig              *
   8  *                                                                 *
   9  * This program is free software; you can redistribute it and/or   *
  10  * modify it under the terms of version 2 of the GNU General       *
  11  * Public License as published by the Free Software Foundation.    *
  12  * This program is distributed in the hope that it will be useful. *
  13  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
  14  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
  15  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
  16  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
  17  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
  18  * more details, a copy of which can be found in the file COPYING  *
  19  * included with this package.                                     *
  20  *******************************************************************/
  21
  22 #include <linux/blkdev.h>
  23 #include <linux/pci.h>
  24 #include <linux/interrupt.h>
  25 #include <linux/delay.h>
  26
  27 #include <scsi/scsi.h>
  28 #include <scsi/scsi_cmnd.h>
  29 #include <scsi/scsi_device.h>
  30 #include <scsi/scsi_host.h>
  31 #include <scsi/scsi_transport_fc.h>
  32
  33 #include "lpfc_hw.h"
  34 #include "lpfc_sli.h"
  35 #include "lpfc_disc.h"
  36 #include "lpfc_scsi.h"
  37 #include "lpfc.h"
  38 #include "lpfc_crtn.h"
  39 #include "lpfc_logmsg.h"
  40 #include "lpfc_compat.h"
  41 #include "lpfc_debugfs.h"
  42
  43 /*
  44  * Define macro to log: Mailbox command x%x cannot issue Data
  45  * This allows multiple uses of lpfc_msgBlk0311
  46  * w/o perturbing log msg utility.
  47  */
  48 #define LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag) \
  49                         lpfc_printf_log(phba, \
  50                                 KERN_INFO, \
  51                                 LOG_MBOX | LOG_SLI, \
  52                                 "(%d):0311 Mailbox command x%x cannot " \
  53                                 "issue Data: x%x x%x x%x\n", \
  54                                 pmbox->vport ? pmbox->vport->vpi : 0, \
  55                                 pmbox->mb.mbxCommand,           \
  56                                 phba->pport->port_state,        \
  57                                 psli->sli_flag, \
  58                                 flag)
  59
  60
  61 /* There are only four IOCB completion types. */
  62 typedef enum _lpfc_iocb_type {
  63         LPFC_UNKNOWN_IOCB,
  64         LPFC_UNSOL_IOCB,
  65         LPFC_SOL_IOCB,
  66         LPFC_ABORT_IOCB
  67 } lpfc_iocb_type;
  68
  69                 /* SLI-2/SLI-3 provide different sized iocbs.  Given a pointer
  70                  * to the start of the ring, and the slot number of the
  71                  * desired iocb entry, calc a pointer to that entry.
  72                  */
  73 static inline IOCB_t *
  74 lpfc_cmd_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
  75 {
  76         return (IOCB_t *) (((char *) pring->cmdringaddr) +
  77                            pring->cmdidx * phba->iocb_cmd_size);
  78 }
  79
  80 static inline IOCB_t *
  81 lpfc_resp_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
  82 {
  83         return (IOCB_t *) (((char *) pring->rspringaddr) +
  84                            pring->rspidx * phba->iocb_rsp_size);
  85 }
  86
  87 static struct lpfc_iocbq *
  88 __lpfc_sli_get_iocbq(struct lpfc_hba *phba)
  89 {
  90         struct list_head *lpfc_iocb_list = &phba->lpfc_iocb_list;
  91         struct lpfc_iocbq * iocbq = NULL;
  92
  93         list_remove_head(lpfc_iocb_list, iocbq, struct lpfc_iocbq, list);
  94         return iocbq;
  95 }
  96
  97 struct lpfc_iocbq *
  98 lpfc_sli_get_iocbq(struct lpfc_hba *phba)
  99 {
 100         struct lpfc_iocbq * iocbq = NULL;
 101         unsigned long iflags;
 102
 103         spin_lock_irqsave(&phba->hbalock, iflags);
 104         iocbq = __lpfc_sli_get_iocbq(phba);
 105         spin_unlock_irqrestore(&phba->hbalock, iflags);
 106         return iocbq;
 107 }
 108
 109 static void
 110 __lpfc_sli_release_iocbq(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
 111 {
 112         size_t start_clean = offsetof(struct lpfc_iocbq, iocb);
 113
 114         /*
 115          * Clean all volatile data fields, preserve iotag and node struct.
 116          */
 117         memset((char*)iocbq + start_clean, 0, sizeof(*iocbq) - start_clean);
 118         list_add_tail(&iocbq->list, &phba->lpfc_iocb_list);
 119 }
 120
 121 void
 122 lpfc_sli_release_iocbq(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
 123 {
 124         unsigned long iflags;
 125
 126         /*
 127          * Clean all volatile data fields, preserve iotag and node struct.
 128          */
 129         spin_lock_irqsave(&phba->hbalock, iflags);
 130         __lpfc_sli_release_iocbq(phba, iocbq);
 131         spin_unlock_irqrestore(&phba->hbalock, iflags);
 132 }
 133
 134 /*
 135  * Translate the iocb command to an iocb command type used to decide the final
 136  * disposition of each completed IOCB.
 137  */
 138 static lpfc_iocb_type
 139 lpfc_sli_iocb_cmd_type(uint8_t iocb_cmnd)
 140 {
 141         lpfc_iocb_type type = LPFC_UNKNOWN_IOCB;
 142
 143         if (iocb_cmnd > CMD_MAX_IOCB_CMD)
 144                 return 0;
 145
 146         switch (iocb_cmnd) {
 147         case CMD_XMIT_SEQUENCE_CR:
 148         case CMD_XMIT_SEQUENCE_CX:
 149         case CMD_XMIT_BCAST_CN:
 150         case CMD_XMIT_BCAST_CX:
 151         case CMD_ELS_REQUEST_CR:
 152         case CMD_ELS_REQUEST_CX:
 153         case CMD_CREATE_XRI_CR:
 154         case CMD_CREATE_XRI_CX:
 155         case CMD_GET_RPI_CN:
 156         case CMD_XMIT_ELS_RSP_CX:
 157         case CMD_GET_RPI_CR:
 158         case CMD_FCP_IWRITE_CR:
 159         case CMD_FCP_IWRITE_CX:
 160         case CMD_FCP_IREAD_CR:
 161         case CMD_FCP_IREAD_CX:
 162         case CMD_FCP_ICMND_CR:
 163         case CMD_FCP_ICMND_CX:
 164         case CMD_FCP_TSEND_CX:
 165         case CMD_FCP_TRSP_CX:
 166         case CMD_FCP_TRECEIVE_CX:
 167         case CMD_FCP_AUTO_TRSP_CX:
 168         case CMD_ADAPTER_MSG:
 169         case CMD_ADAPTER_DUMP:
 170         case CMD_XMIT_SEQUENCE64_CR:
 171         case CMD_XMIT_SEQUENCE64_CX:
 172         case CMD_XMIT_BCAST64_CN:
 173         case CMD_XMIT_BCAST64_CX:
 174         case CMD_ELS_REQUEST64_CR:
 175         case CMD_ELS_REQUEST64_CX:
 176         case CMD_FCP_IWRITE64_CR:
 177         case CMD_FCP_IWRITE64_CX:
 178         case CMD_FCP_IREAD64_CR:
 179         case CMD_FCP_IREAD64_CX:
 180         case CMD_FCP_ICMND64_CR:
 181         case CMD_FCP_ICMND64_CX:
 182         case CMD_FCP_TSEND64_CX:
 183         case CMD_FCP_TRSP64_CX:
 184         case CMD_FCP_TRECEIVE64_CX:
 185         case CMD_GEN_REQUEST64_CR:
 186         case CMD_GEN_REQUEST64_CX:
 187         case CMD_XMIT_ELS_RSP64_CX:
 188                 type = LPFC_SOL_IOCB;
 189                 break;
 190         case CMD_ABORT_XRI_CN:
 191         case CMD_ABORT_XRI_CX:
 192         case CMD_CLOSE_XRI_CN:
 193         case CMD_CLOSE_XRI_CX:
 194         case CMD_XRI_ABORTED_CX:
 195         case CMD_ABORT_MXRI64_CN:
 196                 type = LPFC_ABORT_IOCB;
 197                 break;
 198         case CMD_RCV_SEQUENCE_CX:
 199         case CMD_RCV_ELS_REQ_CX:
 200         case CMD_RCV_SEQUENCE64_CX:
 201         case CMD_RCV_ELS_REQ64_CX:
 202         case CMD_ASYNC_STATUS:
 203         case CMD_IOCB_RCV_SEQ64_CX:
 204         case CMD_IOCB_RCV_ELS64_CX:
 205         case CMD_IOCB_RCV_CONT64_CX:
 206                 type = LPFC_UNSOL_IOCB;
 207                 break;
 208         default:
 209                 type = LPFC_UNKNOWN_IOCB;
 210                 break;
 211         }
 212
 213         return type;
 214 }
 215
 216 static int
 217 lpfc_sli_ring_map(struct lpfc_hba *phba)
 218 {
 219         struct lpfc_sli *psli = &phba->sli;
 220         LPFC_MBOXQ_t *pmb;
 221         MAILBOX_t *pmbox;
 222         int i, rc, ret = 0;
 223
 224         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 225         if (!pmb)
 226                 return -ENOMEM;
 227         pmbox = &pmb->mb;
 228         phba->link_state = LPFC_INIT_MBX_CMDS;
 229         for (i = 0; i < psli->num_rings; i++) {
 230                 lpfc_config_ring(phba, i, pmb);
 231                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
 232                 if (rc != MBX_SUCCESS) {
 233                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 234                                         "0446 Adapter failed to init (%d), "
 235                                         "mbxCmd x%x CFG_RING, mbxStatus x%x, "
 236                                         "ring %d\n",
 237                                         rc, pmbox->mbxCommand,
 238                                         pmbox->mbxStatus, i);
 239                         phba->link_state = LPFC_HBA_ERROR;
 240                         ret = -ENXIO;
 241                         break;
 242                 }
 243         }
 244         mempool_free(pmb, phba->mbox_mem_pool);
 245         return ret;
 246 }
 247
 248 static int
 249 lpfc_sli_ringtxcmpl_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
 250                         struct lpfc_iocbq *piocb)
 251 {
 252         list_add_tail(&piocb->list, &pring->txcmplq);
 253         pring->txcmplq_cnt++;
 254         if ((unlikely(pring->ringno == LPFC_ELS_RING)) &&
 255            (piocb->iocb.ulpCommand != CMD_ABORT_XRI_CN) &&
 256            (piocb->iocb.ulpCommand != CMD_CLOSE_XRI_CN)) {
 257                 if (!piocb->vport)
 258                         BUG();
 259                 else
 260                         mod_timer(&piocb->vport->els_tmofunc,
 261                                   jiffies + HZ * (phba->fc_ratov << 1));
 262         }
 263
 264
 265         return 0;
 266 }
 267
 268 static struct lpfc_iocbq *
 269 lpfc_sli_ringtx_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
 270 {
 271         struct lpfc_iocbq *cmd_iocb;
 272
 273         list_remove_head((&pring->txq), cmd_iocb, struct lpfc_iocbq, list);
 274         if (cmd_iocb != NULL)
 275                 pring->txq_cnt--;
 276         return cmd_iocb;
 277 }
 278
 279 static IOCB_t *
 280 lpfc_sli_next_iocb_slot (struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
 281 {
 282         struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
 283                 &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
 284                 &phba->slim2p->mbx.us.s2.port[pring->ringno];
 285         uint32_t  max_cmd_idx = pring->numCiocb;
 286
 287         if ((pring->next_cmdidx == pring->cmdidx) &&
 288            (++pring->next_cmdidx >= max_cmd_idx))
 289                 pring->next_cmdidx = 0;
 290
 291         if (unlikely(pring->local_getidx == pring->next_cmdidx)) {
 292
 293                 pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
 294
 295                 if (unlikely(pring->local_getidx >= max_cmd_idx)) {
 296                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
 297                                         "0315 Ring %d issue: portCmdGet %d "
 298                                         "is bigger then cmd ring %d\n",
 299                                         pring->ringno,
 300                                         pring->local_getidx, max_cmd_idx);
 301
 302                         phba->link_state = LPFC_HBA_ERROR;
 303                         /*
 304                          * All error attention handlers are posted to
 305                          * worker thread
 306                          */
 307                         phba->work_ha |= HA_ERATT;
 308                         phba->work_hs = HS_FFER3;
 309
 310                         /* hbalock should already be held */
 311                         if (phba->work_wait)
 312                                 lpfc_worker_wake_up(phba);
 313
 314                         return NULL;
 315                 }
 316
 317                 if (pring->local_getidx == pring->next_cmdidx)
 318                         return NULL;
 319         }
 320
 321         return lpfc_cmd_iocb(phba, pring);
 322 }
 323
 324 uint16_t
 325 lpfc_sli_next_iotag(struct lpfc_hba *phba, struct lpfc_iocbq *iocbq)
 326 {
 327         struct lpfc_iocbq **new_arr;
 328         struct lpfc_iocbq **old_arr;
 329         size_t new_len;
 330         struct lpfc_sli *psli = &phba->sli;
 331         uint16_t iotag;
 332
 333         spin_lock_irq(&phba->hbalock);
 334         iotag = psli->last_iotag;
 335         if(++iotag < psli->iocbq_lookup_len) {
 336                 psli->last_iotag = iotag;
 337                 psli->iocbq_lookup[iotag] = iocbq;
 338                 spin_unlock_irq(&phba->hbalock);
 339                 iocbq->iotag = iotag;
 340                 return iotag;
 341         } else if (psli->iocbq_lookup_len < (0xffff
 342                                            - LPFC_IOCBQ_LOOKUP_INCREMENT)) {
 343                 new_len = psli->iocbq_lookup_len + LPFC_IOCBQ_LOOKUP_INCREMENT;
 344                 spin_unlock_irq(&phba->hbalock);
 345                 new_arr = kzalloc(new_len * sizeof (struct lpfc_iocbq *),
 346                                   GFP_KERNEL);
 347                 if (new_arr) {
 348                         spin_lock_irq(&phba->hbalock);
 349                         old_arr = psli->iocbq_lookup;
 350                         if (new_len <= psli->iocbq_lookup_len) {
 351                                 /* highly unprobable case */
 352                                 kfree(new_arr);
 353                                 iotag = psli->last_iotag;
 354                                 if(++iotag < psli->iocbq_lookup_len) {
 355                                         psli->last_iotag = iotag;
 356                                         psli->iocbq_lookup[iotag] = iocbq;
 357                                         spin_unlock_irq(&phba->hbalock);
 358                                         iocbq->iotag = iotag;
 359                                         return iotag;
 360                                 }
 361                                 spin_unlock_irq(&phba->hbalock);
 362                                 return 0;
 363                         }
 364                         if (psli->iocbq_lookup)
 365                                 memcpy(new_arr, old_arr,
 366                                        ((psli->last_iotag  + 1) *
 367                                         sizeof (struct lpfc_iocbq *)));
 368                         psli->iocbq_lookup = new_arr;
 369                         psli->iocbq_lookup_len = new_len;
 370                         psli->last_iotag = iotag;
 371                         psli->iocbq_lookup[iotag] = iocbq;
 372                         spin_unlock_irq(&phba->hbalock);
 373                         iocbq->iotag = iotag;
 374                         kfree(old_arr);
 375                         return iotag;
 376                 }
 377         } else
 378                 spin_unlock_irq(&phba->hbalock);
 379
 380         lpfc_printf_log(phba, KERN_ERR,LOG_SLI,
 381                         "0318 Failed to allocate IOTAG.last IOTAG is %d\n",
 382                         psli->last_iotag);
 383
 384         return 0;
 385 }
 386
 387 static void
 388 lpfc_sli_submit_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
 389                 IOCB_t *iocb, struct lpfc_iocbq *nextiocb)
 390 {
 391         /*
 392          * Set up an iotag
 393          */
 394         nextiocb->iocb.ulpIoTag = (nextiocb->iocb_cmpl) ? nextiocb->iotag : 0;
 395
 396         if (pring->ringno == LPFC_ELS_RING) {
 397                 lpfc_debugfs_slow_ring_trc(phba,
 398                         "IOCB cmd ring:   wd4:x%08x wd6:x%08x wd7:x%08x",
 399                         *(((uint32_t *) &nextiocb->iocb) + 4),
 400                         *(((uint32_t *) &nextiocb->iocb) + 6),
 401                         *(((uint32_t *) &nextiocb->iocb) + 7));
 402         }
 403
 404         /*
 405          * Issue iocb command to adapter
 406          */
 407         lpfc_sli_pcimem_bcopy(&nextiocb->iocb, iocb, phba->iocb_cmd_size);
 408         wmb();
 409         pring->stats.iocb_cmd++;
 410
 411         /*
 412          * If there is no completion routine to call, we can release the
 413          * IOCB buffer back right now. For IOCBs, like QUE_RING_BUF,
 414          * that have no rsp ring completion, iocb_cmpl MUST be NULL.
 415          */
 416         if (nextiocb->iocb_cmpl)
 417                 lpfc_sli_ringtxcmpl_put(phba, pring, nextiocb);
 418         else
 419                 __lpfc_sli_release_iocbq(phba, nextiocb);
 420
 421         /*
 422          * Let the HBA know what IOCB slot will be the next one the
 423          * driver will put a command into.
 424          */
 425         pring->cmdidx = pring->next_cmdidx;
 426         writel(pring->cmdidx, &phba->host_gp[pring->ringno].cmdPutInx);
 427 }
 428
 429 static void
 430 lpfc_sli_update_full_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
 431 {
 432         int ringno = pring->ringno;
 433
 434         pring->flag |= LPFC_CALL_RING_AVAILABLE;
 435
 436         wmb();
 437
 438         /*
 439          * Set ring 'ringno' to SET R0CE_REQ in Chip Att register.
 440          * The HBA will tell us when an IOCB entry is available.
 441          */
 442         writel((CA_R0ATT|CA_R0CE_REQ) << (ringno*4), phba->CAregaddr);
 443         readl(phba->CAregaddr); /* flush */
 444
 445         pring->stats.iocb_cmd_full++;
 446 }
 447
 448 static void
 449 lpfc_sli_update_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
 450 {
 451         int ringno = pring->ringno;
 452
 453         /*
 454          * Tell the HBA that there is work to do in this ring.
 455          */
 456         wmb();
 457         writel(CA_R0ATT << (ringno * 4), phba->CAregaddr);
 458         readl(phba->CAregaddr); /* flush */
 459 }
 460
 461 static void
 462 lpfc_sli_resume_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
 463 {
 464         IOCB_t *iocb;
 465         struct lpfc_iocbq *nextiocb;
 466
 467         /*
 468          * Check to see if:
 469          *  (a) there is anything on the txq to send
 470          *  (b) link is up
 471          *  (c) link attention events can be processed (fcp ring only)
 472          *  (d) IOCB processing is not blocked by the outstanding mbox command.
 473          */
 474         if (pring->txq_cnt &&
 475             lpfc_is_link_up(phba) &&
 476             (pring->ringno != phba->sli.fcp_ring ||
 477              phba->sli.sli_flag & LPFC_PROCESS_LA)) {
 478
 479                 while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) &&
 480                        (nextiocb = lpfc_sli_ringtx_get(phba, pring)))
 481                         lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb);
 482
 483                 if (iocb)
 484                         lpfc_sli_update_ring(phba, pring);
 485                 else
 486                         lpfc_sli_update_full_ring(phba, pring);
 487         }
 488
 489         return;
 490 }
 491
 492 static struct lpfc_hbq_entry *
 493 lpfc_sli_next_hbq_slot(struct lpfc_hba *phba, uint32_t hbqno)
 494 {
 495         struct hbq_s *hbqp = &phba->hbqs[hbqno];
 496
 497         if (hbqp->next_hbqPutIdx == hbqp->hbqPutIdx &&
 498             ++hbqp->next_hbqPutIdx >= hbqp->entry_count)
 499                 hbqp->next_hbqPutIdx = 0;
 500
 501         if (unlikely(hbqp->local_hbqGetIdx == hbqp->next_hbqPutIdx)) {
 502                 uint32_t raw_index = phba->hbq_get[hbqno];
 503                 uint32_t getidx = le32_to_cpu(raw_index);
 504
 505                 hbqp->local_hbqGetIdx = getidx;
 506
 507                 if (unlikely(hbqp->local_hbqGetIdx >= hbqp->entry_count)) {
 508                         lpfc_printf_log(phba, KERN_ERR,
 509                                         LOG_SLI | LOG_VPORT,
 510                                         "1802 HBQ %d: local_hbqGetIdx "
 511                                         "%u is > than hbqp->entry_count %u\n",
 512                                         hbqno, hbqp->local_hbqGetIdx,
 513                                         hbqp->entry_count);
 514
 515                         phba->link_state = LPFC_HBA_ERROR;
 516                         return NULL;
 517                 }
 518
 519                 if (hbqp->local_hbqGetIdx == hbqp->next_hbqPutIdx)
 520                         return NULL;
 521         }
 522
 523         return (struct lpfc_hbq_entry *) phba->hbqs[hbqno].hbq_virt +
 524                         hbqp->hbqPutIdx;
 525 }
 526
 527 void
 528 lpfc_sli_hbqbuf_free_all(struct lpfc_hba *phba)
 529 {
 530         struct lpfc_dmabuf *dmabuf, *next_dmabuf;
 531         struct hbq_dmabuf *hbq_buf;
 532         int i, hbq_count;
 533
 534         hbq_count = lpfc_sli_hbq_count();
 535         /* Return all memory used by all HBQs */
 536         for (i = 0; i < hbq_count; ++i) {
 537                 list_for_each_entry_safe(dmabuf, next_dmabuf,
 538                                 &phba->hbqs[i].hbq_buffer_list, list) {
 539                         hbq_buf = container_of(dmabuf, struct hbq_dmabuf, dbuf);
 540                         list_del(&hbq_buf->dbuf.list);
 541                         (phba->hbqs[i].hbq_free_buffer)(phba, hbq_buf);
 542                 }
 543                 phba->hbqs[i].buffer_count = 0;
 544         }
 545 }
 546
 547 static struct lpfc_hbq_entry *
 548 lpfc_sli_hbq_to_firmware(struct lpfc_hba *phba, uint32_t hbqno,
 549                          struct hbq_dmabuf *hbq_buf)
 550 {
 551         struct lpfc_hbq_entry *hbqe;
 552         dma_addr_t physaddr = hbq_buf->dbuf.phys;
 553
 554         /* Get next HBQ entry slot to use */
 555         hbqe = lpfc_sli_next_hbq_slot(phba, hbqno);
 556         if (hbqe) {
 557                 struct hbq_s *hbqp = &phba->hbqs[hbqno];
 558
 559                 hbqe->bde.addrHigh = le32_to_cpu(putPaddrHigh(physaddr));
 560                 hbqe->bde.addrLow  = le32_to_cpu(putPaddrLow(physaddr));
 561                 hbqe->bde.tus.f.bdeSize = hbq_buf->size;
 562                 hbqe->bde.tus.f.bdeFlags = 0;
 563                 hbqe->bde.tus.w = le32_to_cpu(hbqe->bde.tus.w);
 564                 hbqe->buffer_tag = le32_to_cpu(hbq_buf->tag);
 565                                 /* Sync SLIM */
 566                 hbqp->hbqPutIdx = hbqp->next_hbqPutIdx;
 567                 writel(hbqp->hbqPutIdx, phba->hbq_put + hbqno);
 568                                 /* flush */
 569                 readl(phba->hbq_put + hbqno);
 570                 list_add_tail(&hbq_buf->dbuf.list, &hbqp->hbq_buffer_list);
 571         }
 572         return hbqe;
 573 }
 574
 575 static struct lpfc_hbq_init lpfc_els_hbq = {
 576         .rn = 1,
 577         .entry_count = 200,
 578         .mask_count = 0,
 579         .profile = 0,
 580         .ring_mask = (1 << LPFC_ELS_RING),
 581         .buffer_count = 0,
 582         .init_count = 20,
 583         .add_count = 5,
 584 };
 585
 586 static struct lpfc_hbq_init lpfc_extra_hbq = {
 587         .rn = 1,
 588         .entry_count = 200,
 589         .mask_count = 0,
 590         .profile = 0,
 591         .ring_mask = (1 << LPFC_EXTRA_RING),
 592         .buffer_count = 0,
 593         .init_count = 0,
 594         .add_count = 5,
 595 };
 596
 597 struct lpfc_hbq_init *lpfc_hbq_defs[] = {
 598         &lpfc_els_hbq,
 599         &lpfc_extra_hbq,
 600 };
 601
 602 static int
 603 lpfc_sli_hbqbuf_fill_hbqs(struct lpfc_hba *phba, uint32_t hbqno, uint32_t count)
 604 {
 605         uint32_t i, start, end;
 606         struct hbq_dmabuf *hbq_buffer;
 607
 608         if (!phba->hbqs[hbqno].hbq_alloc_buffer) {
 609                 return 0;
 610         }
 611
 612         start = phba->hbqs[hbqno].buffer_count;
 613         end = count + start;
 614         if (end > lpfc_hbq_defs[hbqno]->entry_count) {
 615                 end = lpfc_hbq_defs[hbqno]->entry_count;
 616         }
 617
 618         /* Populate HBQ entries */
 619         for (i = start; i < end; i++) {
 620                 hbq_buffer = (phba->hbqs[hbqno].hbq_alloc_buffer)(phba);
 621                 if (!hbq_buffer)
 622                         return 1;
 623                 hbq_buffer->tag = (i | (hbqno << 16));
 624                 if (lpfc_sli_hbq_to_firmware(phba, hbqno, hbq_buffer))
 625                         phba->hbqs[hbqno].buffer_count++;
 626                 else
 627                         (phba->hbqs[hbqno].hbq_free_buffer)(phba, hbq_buffer);
 628         }
 629         return 0;
 630 }
 631
 632 int
 633 lpfc_sli_hbqbuf_add_hbqs(struct lpfc_hba *phba, uint32_t qno)
 634 {
 635         return(lpfc_sli_hbqbuf_fill_hbqs(phba, qno,
 636                                          lpfc_hbq_defs[qno]->add_count));
 637 }
 638
 639 static int
 640 lpfc_sli_hbqbuf_init_hbqs(struct lpfc_hba *phba, uint32_t qno)
 641 {
 642         return(lpfc_sli_hbqbuf_fill_hbqs(phba, qno,
 643                                          lpfc_hbq_defs[qno]->init_count));
 644 }
 645
 646 static struct hbq_dmabuf *
 647 lpfc_sli_hbqbuf_find(struct lpfc_hba *phba, uint32_t tag)
 648 {
 649         struct lpfc_dmabuf *d_buf;
 650         struct hbq_dmabuf *hbq_buf;
 651         uint32_t hbqno;
 652
 653         hbqno = tag >> 16;
 654         if (hbqno >= LPFC_MAX_HBQS)
 655                 return NULL;
 656
 657         list_for_each_entry(d_buf, &phba->hbqs[hbqno].hbq_buffer_list, list) {
 658                 hbq_buf = container_of(d_buf, struct hbq_dmabuf, dbuf);
 659                 if (hbq_buf->tag == tag) {
 660                         return hbq_buf;
 661                 }
 662         }
 663         lpfc_printf_log(phba, KERN_ERR, LOG_SLI | LOG_VPORT,
 664                         "1803 Bad hbq tag. Data: x%x x%x\n",
 665                         tag, phba->hbqs[tag >> 16].buffer_count);
 666         return NULL;
 667 }
 668
 669 void
 670 lpfc_sli_free_hbq(struct lpfc_hba *phba, struct hbq_dmabuf *hbq_buffer)
 671 {
 672         uint32_t hbqno;
 673
 674         if (hbq_buffer) {
 675                 hbqno = hbq_buffer->tag >> 16;
 676                 if (!lpfc_sli_hbq_to_firmware(phba, hbqno, hbq_buffer)) {
 677                         (phba->hbqs[hbqno].hbq_free_buffer)(phba, hbq_buffer);
 678                 }
 679         }
 680 }
 681
 682 static int
 683 lpfc_sli_chk_mbx_command(uint8_t mbxCommand)
 684 {
 685         uint8_t ret;
 686
 687         switch (mbxCommand) {
 688         case MBX_LOAD_SM:
 689         case MBX_READ_NV:
 690         case MBX_WRITE_NV:
 691         case MBX_WRITE_VPARMS:
 692         case MBX_RUN_BIU_DIAG:
 693         case MBX_INIT_LINK:
 694         case MBX_DOWN_LINK:
 695         case MBX_CONFIG_LINK:
 696         case MBX_CONFIG_RING:
 697         case MBX_RESET_RING:
 698         case MBX_READ_CONFIG:
 699         case MBX_READ_RCONFIG:
 700         case MBX_READ_SPARM:
 701         case MBX_READ_STATUS:
 702         case MBX_READ_RPI:
 703         case MBX_READ_XRI:
 704         case MBX_READ_REV:
 705         case MBX_READ_LNK_STAT:
 706         case MBX_REG_LOGIN:
 707         case MBX_UNREG_LOGIN:
 708         case MBX_READ_LA:
 709         case MBX_CLEAR_LA:
 710         case MBX_DUMP_MEMORY:
 711         case MBX_DUMP_CONTEXT:
 712         case MBX_RUN_DIAGS:
 713         case MBX_RESTART:
 714         case MBX_UPDATE_CFG:
 715         case MBX_DOWN_LOAD:
 716         case MBX_DEL_LD_ENTRY:
 717         case MBX_RUN_PROGRAM:
 718         case MBX_SET_MASK:
 719         case MBX_SET_VARIABLE:
 720         case MBX_UNREG_D_ID:
 721         case MBX_KILL_BOARD:
 722         case MBX_CONFIG_FARP:
 723         case MBX_BEACON:
 724         case MBX_LOAD_AREA:
 725         case MBX_RUN_BIU_DIAG64:
 726         case MBX_CONFIG_PORT:
 727         case MBX_READ_SPARM64:
 728         case MBX_READ_RPI64:
 729         case MBX_REG_LOGIN64:
 730         case MBX_READ_LA64:
 731         case MBX_WRITE_WWN:
 732         case MBX_SET_DEBUG:
 733         case MBX_LOAD_EXP_ROM:
 734         case MBX_ASYNCEVT_ENABLE:
 735         case MBX_REG_VPI:
 736         case MBX_UNREG_VPI:
 737         case MBX_HEARTBEAT:
 738                 ret = mbxCommand;
 739                 break;
 740         default:
 741                 ret = MBX_SHUTDOWN;
 742                 break;
 743         }
 744         return ret;
 745 }
 746 static void
 747 lpfc_sli_wake_mbox_wait(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
 748 {
 749         wait_queue_head_t *pdone_q;
 750         unsigned long drvr_flag;
 751
 752         /*
 753          * If pdone_q is empty, the driver thread gave up waiting and
 754          * continued running.
 755          */
 756         pmboxq->mbox_flag |= LPFC_MBX_WAKE;
 757         spin_lock_irqsave(&phba->hbalock, drvr_flag);
 758         pdone_q = (wait_queue_head_t *) pmboxq->context1;
 759         if (pdone_q)
 760                 wake_up_interruptible(pdone_q);
 761         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
 762         return;
 763 }
 764
 765 void
 766 lpfc_sli_def_mbox_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)
 767 {
 768         struct lpfc_dmabuf *mp;
 769         uint16_t rpi;
 770         int rc;
 771
 772         mp = (struct lpfc_dmabuf *) (pmb->context1);
 773
 774         if (mp) {
 775                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
 776                 kfree(mp);
 777         }
 778
 779         /*
 780          * If a REG_LOGIN succeeded  after node is destroyed or node
 781          * is in re-discovery driver need to cleanup the RPI.
 782          */
 783         if (!(phba->pport->load_flag & FC_UNLOADING) &&
 784             pmb->mb.mbxCommand == MBX_REG_LOGIN64 &&
 785             !pmb->mb.mbxStatus) {
 786
 787                 rpi = pmb->mb.un.varWords[0];
 788                 lpfc_unreg_login(phba, pmb->mb.un.varRegLogin.vpi, rpi, pmb);
 789                 pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 790                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
 791                 if (rc != MBX_NOT_FINISHED)
 792                         return;
 793         }
 794
 795         mempool_free(pmb, phba->mbox_mem_pool);
 796         return;
 797 }
 798
 799 int
 800 lpfc_sli_handle_mb_event(struct lpfc_hba *phba)
 801 {
 802         MAILBOX_t *pmbox;
 803         LPFC_MBOXQ_t *pmb;
 804         int rc;
 805         LIST_HEAD(cmplq);
 806
 807         phba->sli.slistat.mbox_event++;
 808
 809         /* Get all completed mailboxe buffers into the cmplq */
 810         spin_lock_irq(&phba->hbalock);
 811         list_splice_init(&phba->sli.mboxq_cmpl, &cmplq);
 812         spin_unlock_irq(&phba->hbalock);
 813
 814         /* Get a Mailbox buffer to setup mailbox commands for callback */
 815         do {
 816                 list_remove_head(&cmplq, pmb, LPFC_MBOXQ_t, list);
 817                 if (pmb == NULL)
 818                         break;
 819
 820                 pmbox = &pmb->mb;
 821
 822                 if (pmbox->mbxCommand != MBX_HEARTBEAT) {
 823                         if (pmb->vport) {
 824                                 lpfc_debugfs_disc_trc(pmb->vport,
 825                                         LPFC_DISC_TRC_MBOX_VPORT,
 826                                         "MBOX cmpl vport: cmd:x%x mb:x%x x%x",
 827                                         (uint32_t)pmbox->mbxCommand,
 828                                         pmbox->un.varWords[0],
 829                                         pmbox->un.varWords[1]);
 830                         }
 831                         else {
 832                                 lpfc_debugfs_disc_trc(phba->pport,
 833                                         LPFC_DISC_TRC_MBOX,
 834                                         "MBOX cmpl:       cmd:x%x mb:x%x x%x",
 835                                         (uint32_t)pmbox->mbxCommand,
 836                                         pmbox->un.varWords[0],
 837                                         pmbox->un.varWords[1]);
 838                         }
 839                 }
 840
 841                 /*
 842                  * It is a fatal error if unknown mbox command completion.
 843                  */
 844                 if (lpfc_sli_chk_mbx_command(pmbox->mbxCommand) ==
 845                     MBX_SHUTDOWN) {
 846                         /* Unknow mailbox command compl */
 847                         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
 848                                         "(%d):0323 Unknown Mailbox command "
 849                                         "%x Cmpl\n",
 850                                         pmb->vport ? pmb->vport->vpi : 0,
 851                                         pmbox->mbxCommand);
 852                         phba->link_state = LPFC_HBA_ERROR;
 853                         phba->work_hs = HS_FFER3;
 854                         lpfc_handle_eratt(phba);
 855                         continue;
 856                 }
 857
 858                 if (pmbox->mbxStatus) {
 859                         phba->sli.slistat.mbox_stat_err++;
 860                         if (pmbox->mbxStatus == MBXERR_NO_RESOURCES) {
 861                                 /* Mbox cmd cmpl error - RETRYing */
 862                                 lpfc_printf_log(phba, KERN_INFO,
 863                                                 LOG_MBOX | LOG_SLI,
 864                                                 "(%d):0305 Mbox cmd cmpl "
 865                                                 "error - RETRYing Data: x%x "
 866                                                 "x%x x%x x%x\n",
 867                                                 pmb->vport ? pmb->vport->vpi :0,
 868                                                 pmbox->mbxCommand,
 869                                                 pmbox->mbxStatus,
 870                                                 pmbox->un.varWords[0],
 871                                                 pmb->vport->port_state);
 872                                 pmbox->mbxStatus = 0;
 873                                 pmbox->mbxOwner = OWN_HOST;
 874                                 spin_lock_irq(&phba->hbalock);
 875                                 phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
 876                                 spin_unlock_irq(&phba->hbalock);
 877                                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
 878                                 if (rc == MBX_SUCCESS)
 879                                         continue;
 880                         }
 881                 }
 882
 883                 /* Mailbox cmd <cmd> Cmpl <cmpl> */
 884                 lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
 885                                 "(%d):0307 Mailbox cmd x%x Cmpl x%p "
 886                                 "Data: x%x x%x x%x x%x x%x x%x x%x x%x x%x\n",
 887                                 pmb->vport ? pmb->vport->vpi : 0,
 888                                 pmbox->mbxCommand,
 889                                 pmb->mbox_cmpl,
 890                                 *((uint32_t *) pmbox),
 891                                 pmbox->un.varWords[0],
 892                                 pmbox->un.varWords[1],
 893                                 pmbox->un.varWords[2],
 894                                 pmbox->un.varWords[3],
 895                                 pmbox->un.varWords[4],
 896                                 pmbox->un.varWords[5],
 897                                 pmbox->un.varWords[6],
 898                                 pmbox->un.varWords[7]);
 899
 900                 if (pmb->mbox_cmpl)
 901                         pmb->mbox_cmpl(phba,pmb);
 902         } while (1);
 903         return 0;
 904 }
 905
 906 static struct lpfc_dmabuf *
 907 lpfc_sli_replace_hbqbuff(struct lpfc_hba *phba, uint32_t tag)
 908 {
 909         struct hbq_dmabuf *hbq_entry, *new_hbq_entry;
 910         uint32_t hbqno;
 911         void *virt;             /* virtual address ptr */
 912         dma_addr_t phys;        /* mapped address */
 913
 914         hbq_entry = lpfc_sli_hbqbuf_find(phba, tag);
 915         if (hbq_entry == NULL)
 916                 return NULL;
 917         list_del(&hbq_entry->dbuf.list);
 918
 919         hbqno = tag >> 16;
 920         new_hbq_entry = (phba->hbqs[hbqno].hbq_alloc_buffer)(phba);
 921         if (new_hbq_entry == NULL)
 922                 return &hbq_entry->dbuf;
 923         new_hbq_entry->tag = -1;
 924         phys = new_hbq_entry->dbuf.phys;
 925         virt = new_hbq_entry->dbuf.virt;
 926         new_hbq_entry->dbuf.phys = hbq_entry->dbuf.phys;
 927         new_hbq_entry->dbuf.virt = hbq_entry->dbuf.virt;
 928         hbq_entry->dbuf.phys = phys;
 929         hbq_entry->dbuf.virt = virt;
 930         lpfc_sli_free_hbq(phba, hbq_entry);
 931         return &new_hbq_entry->dbuf;
 932 }
 933
 934 static struct lpfc_dmabuf *
 935 lpfc_sli_get_buff(struct lpfc_hba *phba,
 936                         struct lpfc_sli_ring *pring,
 937                         uint32_t tag)
 938 {
 939         if (tag & QUE_BUFTAG_BIT)
 940                 return lpfc_sli_ring_taggedbuf_get(phba, pring, tag);
 941         else
 942                 return lpfc_sli_replace_hbqbuff(phba, tag);
 943 }
 944
 945 static int
 946 lpfc_sli_process_unsol_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
 947                             struct lpfc_iocbq *saveq)
 948 {
 949         IOCB_t           * irsp;
 950         WORD5            * w5p;
 951         uint32_t           Rctl, Type;
 952         uint32_t           match, i;
 953         struct lpfc_iocbq *iocbq;
 954
 955         match = 0;
 956         irsp = &(saveq->iocb);
 957
 958         if (irsp->ulpStatus == IOSTAT_NEED_BUFFER)
 959                 return 1;
 960         if (irsp->ulpCommand == CMD_ASYNC_STATUS) {
 961                 if (pring->lpfc_sli_rcv_async_status)
 962                         pring->lpfc_sli_rcv_async_status(phba, pring, saveq);
 963                 else
 964                         lpfc_printf_log(phba,
 965                                         KERN_WARNING,
 966                                         LOG_SLI,
 967                                         "0316 Ring %d handler: unexpected "
 968                                         "ASYNC_STATUS iocb received evt_code "
 969                                         "0x%x\n",
 970                                         pring->ringno,
 971                                         irsp->un.asyncstat.evt_code);
 972                 return 1;
 973         }
 974
 975         if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
 976                 if (irsp->ulpBdeCount != 0) {
 977                         saveq->context2 = lpfc_sli_get_buff(phba, pring,
 978                                                 irsp->un.ulpWord[3]);
 979                         if (!saveq->context2)
 980                                 lpfc_printf_log(phba,
 981                                         KERN_ERR,
 982                                         LOG_SLI,
 983                                         "0341 Ring %d Cannot find buffer for "
 984                                         "an unsolicited iocb. tag 0x%x\n",
 985                                         pring->ringno,
 986                                         irsp->un.ulpWord[3]);
 987                 }
 988                 if (irsp->ulpBdeCount == 2) {
 989                         saveq->context3 = lpfc_sli_get_buff(phba, pring,
 990                                                 irsp->unsli3.sli3Words[7]);
 991                         if (!saveq->context3)
 992                                 lpfc_printf_log(phba,
 993                                         KERN_ERR,
 994                                         LOG_SLI,
 995                                         "0342 Ring %d Cannot find buffer for an"
 996                                         " unsolicited iocb. tag 0x%x\n",
 997                                         pring->ringno,
 998                                         irsp->unsli3.sli3Words[7]);
 999                 }
1000                 list_for_each_entry(iocbq, &saveq->list, list) {
1001                         irsp = &(iocbq->iocb);
1002                         if (irsp->ulpBdeCount != 0) {
1003                                 iocbq->context2 = lpfc_sli_get_buff(phba, pring,
1004                                                         irsp->un.ulpWord[3]);
1005                                 if (!iocbq->context2)
1006                                         lpfc_printf_log(phba,
1007                                                 KERN_ERR,
1008                                                 LOG_SLI,
1009                                                 "0343 Ring %d Cannot find "
1010                                                 "buffer for an unsolicited iocb"
1011                                                 ". tag 0x%x\n", pring->ringno,
1012                                                 irsp->un.ulpWord[3]);
1013                         }
1014                         if (irsp->ulpBdeCount == 2) {
1015                                 iocbq->context3 = lpfc_sli_get_buff(phba, pring,
1016                                                 irsp->unsli3.sli3Words[7]);
1017                                 if (!iocbq->context3)
1018                                         lpfc_printf_log(phba,
1019                                                 KERN_ERR,
1020                                                 LOG_SLI,
1021                                                 "0344 Ring %d Cannot find "
1022                                                 "buffer for an unsolicited "
1023                                                 "iocb. tag 0x%x\n",
1024                                                 pring->ringno,
1025                                                 irsp->unsli3.sli3Words[7]);
1026                         }
1027                 }
1028         }
1029         if (irsp->ulpBdeCount != 0 &&
1030             (irsp->ulpCommand == CMD_IOCB_RCV_CONT64_CX ||
1031              irsp->ulpStatus == IOSTAT_INTERMED_RSP)) {
1032                 int found = 0;
1033
1034                 /* search continue save q for same XRI */
1035                 list_for_each_entry(iocbq, &pring->iocb_continue_saveq, clist) {
1036                         if (iocbq->iocb.ulpContext == saveq->iocb.ulpContext) {
1037                                 list_add_tail(&saveq->list, &iocbq->list);
1038                                 found = 1;
1039                                 break;
1040                         }
1041                 }
1042                 if (!found)
1043                         list_add_tail(&saveq->clist,
1044                                       &pring->iocb_continue_saveq);
1045                 if (saveq->iocb.ulpStatus != IOSTAT_INTERMED_RSP) {
1046                         list_del_init(&iocbq->clist);
1047                         saveq = iocbq;
1048                         irsp = &(saveq->iocb);
1049                 } else
1050                         return 0;
1051         }
1052         if ((irsp->ulpCommand == CMD_RCV_ELS_REQ64_CX) ||
1053             (irsp->ulpCommand == CMD_RCV_ELS_REQ_CX) ||
1054             (irsp->ulpCommand == CMD_IOCB_RCV_ELS64_CX)) {
1055                 Rctl = FC_ELS_REQ;
1056                 Type = FC_ELS_DATA;
1057         } else {
1058                 w5p = (WORD5 *)&(saveq->iocb.un.ulpWord[5]);
1059                 Rctl = w5p->hcsw.Rctl;
1060                 Type = w5p->hcsw.Type;
1061
1062                 /* Firmware Workaround */
1063                 if ((Rctl == 0) && (pring->ringno == LPFC_ELS_RING) &&
1064                         (irsp->ulpCommand == CMD_RCV_SEQUENCE64_CX ||
1065                          irsp->ulpCommand == CMD_IOCB_RCV_SEQ64_CX)) {
1066                         Rctl = FC_ELS_REQ;
1067                         Type = FC_ELS_DATA;
1068                         w5p->hcsw.Rctl = Rctl;
1069                         w5p->hcsw.Type = Type;
1070                 }
1071         }
1072
1073         /* unSolicited Responses */
1074         if (pring->prt[0].profile) {
1075                 if (pring->prt[0].lpfc_sli_rcv_unsol_event)
1076                         (pring->prt[0].lpfc_sli_rcv_unsol_event) (phba, pring,
1077                                                                         saveq);
1078                 match = 1;
1079         } else {
1080                 /* We must search, based on rctl / type
1081                    for the right routine */
1082                 for (i = 0; i < pring->num_mask; i++) {
1083                         if ((pring->prt[i].rctl == Rctl)
1084                             && (pring->prt[i].type == Type)) {
1085                                 if (pring->prt[i].lpfc_sli_rcv_unsol_event)
1086                                         (pring->prt[i].lpfc_sli_rcv_unsol_event)
1087                                                         (phba, pring, saveq);
1088                                 match = 1;
1089                                 break;
1090                         }
1091                 }
1092         }
1093         if (match == 0) {
1094                 /* Unexpected Rctl / Type received */
1095                 /* Ring <ringno> handler: unexpected
1096                    Rctl <Rctl> Type <Type> received */
1097                 lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
1098                                 "0313 Ring %d handler: unexpected Rctl x%x "
1099                                 "Type x%x received\n",
1100                                 pring->ringno, Rctl, Type);
1101         }
1102         return 1;
1103 }
1104
1105 static struct lpfc_iocbq *
1106 lpfc_sli_iocbq_lookup(struct lpfc_hba *phba,
1107                       struct lpfc_sli_ring *pring,
1108                       struct lpfc_iocbq *prspiocb)
1109 {
1110         struct lpfc_iocbq *cmd_iocb = NULL;
1111         uint16_t iotag;
1112
1113         iotag = prspiocb->iocb.ulpIoTag;
1114
1115         if (iotag != 0 && iotag <= phba->sli.last_iotag) {
1116                 cmd_iocb = phba->sli.iocbq_lookup[iotag];
1117                 list_del_init(&cmd_iocb->list);
1118                 pring->txcmplq_cnt--;
1119                 return cmd_iocb;
1120         }
1121
1122         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1123                         "0317 iotag x%x is out off "
1124                         "range: max iotag x%x wd0 x%x\n",
1125                         iotag, phba->sli.last_iotag,
1126                         *(((uint32_t *) &prspiocb->iocb) + 7));
1127         return NULL;
1128 }
1129
1130 static int
1131 lpfc_sli_process_sol_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
1132                           struct lpfc_iocbq *saveq)
1133 {
1134         struct lpfc_iocbq *cmdiocbp;
1135         int rc = 1;
1136         unsigned long iflag;
1137
1138         /* Based on the iotag field, get the cmd IOCB from the txcmplq */
1139         spin_lock_irqsave(&phba->hbalock, iflag);
1140         cmdiocbp = lpfc_sli_iocbq_lookup(phba, pring, saveq);
1141         spin_unlock_irqrestore(&phba->hbalock, iflag);
1142
1143         if (cmdiocbp) {
1144                 if (cmdiocbp->iocb_cmpl) {
1145                         /*
1146                          * Post all ELS completions to the worker thread.
1147                          * All other are passed to the completion callback.
1148                          */
1149                         if (pring->ringno == LPFC_ELS_RING) {
1150                                 if (cmdiocbp->iocb_flag & LPFC_DRIVER_ABORTED) {
1151                                         cmdiocbp->iocb_flag &=
1152                                                 ~LPFC_DRIVER_ABORTED;
1153                                         saveq->iocb.ulpStatus =
1154                                                 IOSTAT_LOCAL_REJECT;
1155                                         saveq->iocb.un.ulpWord[4] =
1156                                                 IOERR_SLI_ABORTED;
1157
1158                                         /* Firmware could still be in progress
1159                                          * of DMAing payload, so don't free data
1160                                          * buffer till after a hbeat.
1161                                          */
1162                                         saveq->iocb_flag |= LPFC_DELAY_MEM_FREE;
1163                                 }
1164                         }
1165                         (cmdiocbp->iocb_cmpl) (phba, cmdiocbp, saveq);
1166                 } else
1167                         lpfc_sli_release_iocbq(phba, cmdiocbp);
1168         } else {
1169                 /*
1170                  * Unknown initiating command based on the response iotag.
1171                  * This could be the case on the ELS ring because of
1172                  * lpfc_els_abort().
1173                  */
1174                 if (pring->ringno != LPFC_ELS_RING) {
1175                         /*
1176                          * Ring <ringno> handler: unexpected completion IoTag
1177                          * <IoTag>
1178                          */
1179                         lpfc_printf_vlog(cmdiocbp->vport, KERN_WARNING, LOG_SLI,
1180                                          "0322 Ring %d handler: "
1181                                          "unexpected completion IoTag x%x "
1182                                          "Data: x%x x%x x%x x%x\n",
1183                                          pring->ringno,
1184                                          saveq->iocb.ulpIoTag,
1185                                          saveq->iocb.ulpStatus,
1186                                          saveq->iocb.un.ulpWord[4],
1187                                          saveq->iocb.ulpCommand,
1188                                          saveq->iocb.ulpContext);
1189                 }
1190         }
1191
1192         return rc;
1193 }
1194
1195 static void
1196 lpfc_sli_rsp_pointers_error(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
1197 {
1198         struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
1199                 &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
1200                 &phba->slim2p->mbx.us.s2.port[pring->ringno];
1201         /*
1202          * Ring <ringno> handler: portRspPut <portRspPut> is bigger then
1203          * rsp ring <portRspMax>
1204          */
1205         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1206                         "0312 Ring %d handler: portRspPut %d "
1207                         "is bigger then rsp ring %d\n",
1208                         pring->ringno, le32_to_cpu(pgp->rspPutInx),
1209                         pring->numRiocb);
1210
1211         phba->link_state = LPFC_HBA_ERROR;
1212
1213         /*
1214          * All error attention handlers are posted to
1215          * worker thread
1216          */
1217         phba->work_ha |= HA_ERATT;
1218         phba->work_hs = HS_FFER3;
1219
1220         /* hbalock should already be held */
1221         if (phba->work_wait)
1222                 lpfc_worker_wake_up(phba);
1223
1224         return;
1225 }
1226
1227 void lpfc_sli_poll_fcp_ring(struct lpfc_hba *phba)
1228 {
1229         struct lpfc_sli      *psli  = &phba->sli;
1230         struct lpfc_sli_ring *pring = &psli->ring[LPFC_FCP_RING];
1231         IOCB_t *irsp = NULL;
1232         IOCB_t *entry = NULL;
1233         struct lpfc_iocbq *cmdiocbq = NULL;
1234         struct lpfc_iocbq rspiocbq;
1235         struct lpfc_pgp *pgp;
1236         uint32_t status;
1237         uint32_t portRspPut, portRspMax;
1238         int type;
1239         uint32_t rsp_cmpl = 0;
1240         uint32_t ha_copy;
1241         unsigned long iflags;
1242
1243         pring->stats.iocb_event++;
1244
1245         pgp = (phba->sli_rev == 3) ?
1246                 &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
1247                 &phba->slim2p->mbx.us.s2.port[pring->ringno];
1248
1249
1250         /*
1251          * The next available response entry should never exceed the maximum
1252          * entries.  If it does, treat it as an adapter hardware error.
1253          */
1254         portRspMax = pring->numRiocb;
1255         portRspPut = le32_to_cpu(pgp->rspPutInx);
1256         if (unlikely(portRspPut >= portRspMax)) {
1257                 lpfc_sli_rsp_pointers_error(phba, pring);
1258                 return;
1259         }
1260
1261         rmb();
1262         while (pring->rspidx != portRspPut) {
1263                 entry = lpfc_resp_iocb(phba, pring);
1264                 if (++pring->rspidx >= portRspMax)
1265                         pring->rspidx = 0;
1266
1267                 lpfc_sli_pcimem_bcopy((uint32_t *) entry,
1268                                       (uint32_t *) &rspiocbq.iocb,
1269                                       phba->iocb_rsp_size);
1270                 irsp = &rspiocbq.iocb;
1271                 type = lpfc_sli_iocb_cmd_type(irsp->ulpCommand & CMD_IOCB_MASK);
1272                 pring->stats.iocb_rsp++;
1273                 rsp_cmpl++;
1274
1275                 if (unlikely(irsp->ulpStatus)) {
1276                         /* Rsp ring <ringno> error: IOCB */
1277                         lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
1278                                         "0326 Rsp Ring %d error: IOCB Data: "
1279                                         "x%x x%x x%x x%x x%x x%x x%x x%x\n",
1280                                         pring->ringno,
1281                                         irsp->un.ulpWord[0],
1282                                         irsp->un.ulpWord[1],
1283                                         irsp->un.ulpWord[2],
1284                                         irsp->un.ulpWord[3],
1285                                         irsp->un.ulpWord[4],
1286                                         irsp->un.ulpWord[5],
1287                                         *(((uint32_t *) irsp) + 6),
1288                                         *(((uint32_t *) irsp) + 7));
1289                 }
1290
1291                 switch (type) {
1292                 case LPFC_ABORT_IOCB:
1293                 case LPFC_SOL_IOCB:
1294                         /*
1295                          * Idle exchange closed via ABTS from port.  No iocb
1296                          * resources need to be recovered.
1297                          */
1298                         if (unlikely(irsp->ulpCommand == CMD_XRI_ABORTED_CX)) {
1299                                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
1300                                                 "0314 IOCB cmd 0x%x "
1301                                                 "processed. Skipping "
1302                                                 "completion",
1303                                                 irsp->ulpCommand);
1304                                 break;
1305                         }
1306
1307                         spin_lock_irqsave(&phba->hbalock, iflags);
1308                         cmdiocbq = lpfc_sli_iocbq_lookup(phba, pring,
1309                                                          &rspiocbq);
1310                         spin_unlock_irqrestore(&phba->hbalock, iflags);
1311                         if ((cmdiocbq) && (cmdiocbq->iocb_cmpl)) {
1312                                 (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
1313                                                       &rspiocbq);
1314                         }
1315                         break;
1316                 default:
1317                         if (irsp->ulpCommand == CMD_ADAPTER_MSG) {
1318                                 char adaptermsg[LPFC_MAX_ADPTMSG];
1319                                 memset(adaptermsg, 0, LPFC_MAX_ADPTMSG);
1320                                 memcpy(&adaptermsg[0], (uint8_t *) irsp,
1321                                        MAX_MSG_DATA);
1322                                 dev_warn(&((phba->pcidev)->dev),
1323                                          "lpfc%d: %s\n",
1324                                          phba->brd_no, adaptermsg);
1325                         } else {
1326                                 /* Unknown IOCB command */
1327                                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1328                                                 "0321 Unknown IOCB command "
1329                                                 "Data: x%x, x%x x%x x%x x%x\n",
1330                                                 type, irsp->ulpCommand,
1331                                                 irsp->ulpStatus,
1332                                                 irsp->ulpIoTag,
1333                                                 irsp->ulpContext);
1334                         }
1335                         break;
1336                 }
1337
1338                 /*
1339                  * The response IOCB has been processed.  Update the ring
1340                  * pointer in SLIM.  If the port response put pointer has not
1341                  * been updated, sync the pgp->rspPutInx and fetch the new port
1342                  * response put pointer.
1343                  */
1344                 writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);
1345
1346                 if (pring->rspidx == portRspPut)
1347                         portRspPut = le32_to_cpu(pgp->rspPutInx);
1348         }
1349
1350         ha_copy = readl(phba->HAregaddr);
1351         ha_copy >>= (LPFC_FCP_RING * 4);
1352
1353         if ((rsp_cmpl > 0) && (ha_copy & HA_R0RE_REQ)) {
1354                 spin_lock_irqsave(&phba->hbalock, iflags);
1355                 pring->stats.iocb_rsp_full++;
1356                 status = ((CA_R0ATT | CA_R0RE_RSP) << (LPFC_FCP_RING * 4));
1357                 writel(status, phba->CAregaddr);
1358                 readl(phba->CAregaddr);
1359                 spin_unlock_irqrestore(&phba->hbalock, iflags);
1360         }
1361         if ((ha_copy & HA_R0CE_RSP) &&
1362             (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
1363                 spin_lock_irqsave(&phba->hbalock, iflags);
1364                 pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
1365                 pring->stats.iocb_cmd_empty++;
1366
1367                 /* Force update of the local copy of cmdGetInx */
1368                 pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
1369                 lpfc_sli_resume_iocb(phba, pring);
1370
1371                 if ((pring->lpfc_sli_cmd_available))
1372                         (pring->lpfc_sli_cmd_available) (phba, pring);
1373
1374                 spin_unlock_irqrestore(&phba->hbalock, iflags);
1375         }
1376
1377         return;
1378 }
1379
1380 /*
1381  * This routine presumes LPFC_FCP_RING handling and doesn't bother
1382  * to check it explicitly.
1383  */
1384 static int
1385 lpfc_sli_handle_fast_ring_event(struct lpfc_hba *phba,
1386                                 struct lpfc_sli_ring *pring, uint32_t mask)
1387 {
1388         struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
1389                 &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
1390                 &phba->slim2p->mbx.us.s2.port[pring->ringno];
1391         IOCB_t *irsp = NULL;
1392         IOCB_t *entry = NULL;
1393         struct lpfc_iocbq *cmdiocbq = NULL;
1394         struct lpfc_iocbq rspiocbq;
1395         uint32_t status;
1396         uint32_t portRspPut, portRspMax;
1397         int rc = 1;
1398         lpfc_iocb_type type;
1399         unsigned long iflag;
1400         uint32_t rsp_cmpl = 0;
1401
1402         spin_lock_irqsave(&phba->hbalock, iflag);
1403         pring->stats.iocb_event++;
1404
1405         /*
1406          * The next available response entry should never exceed the maximum
1407          * entries.  If it does, treat it as an adapter hardware error.
1408          */
1409         portRspMax = pring->numRiocb;
1410         portRspPut = le32_to_cpu(pgp->rspPutInx);
1411         if (unlikely(portRspPut >= portRspMax)) {
1412                 lpfc_sli_rsp_pointers_error(phba, pring);
1413                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1414                 return 1;
1415         }
1416
1417         rmb();
1418         while (pring->rspidx != portRspPut) {
1419                 /*
1420                  * Fetch an entry off the ring and copy it into a local data
1421                  * structure.  The copy involves a byte-swap since the
1422                  * network byte order and pci byte orders are different.
1423                  */
1424                 entry = lpfc_resp_iocb(phba, pring);
1425                 phba->last_completion_time = jiffies;
1426
1427                 if (++pring->rspidx >= portRspMax)
1428                         pring->rspidx = 0;
1429
1430                 lpfc_sli_pcimem_bcopy((uint32_t *) entry,
1431                                       (uint32_t *) &rspiocbq.iocb,
1432                                       phba->iocb_rsp_size);
1433                 INIT_LIST_HEAD(&(rspiocbq.list));
1434                 irsp = &rspiocbq.iocb;
1435
1436                 type = lpfc_sli_iocb_cmd_type(irsp->ulpCommand & CMD_IOCB_MASK);
1437                 pring->stats.iocb_rsp++;
1438                 rsp_cmpl++;
1439
1440                 if (unlikely(irsp->ulpStatus)) {
1441                         /*
1442                          * If resource errors reported from HBA, reduce
1443                          * queuedepths of the SCSI device.
1444                          */
1445                         if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
1446                                 (irsp->un.ulpWord[4] == IOERR_NO_RESOURCES)) {
1447                                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1448                                 lpfc_adjust_queue_depth(phba);
1449                                 spin_lock_irqsave(&phba->hbalock, iflag);
1450                         }
1451
1452                         /* Rsp ring <ringno> error: IOCB */
1453                         lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
1454                                         "0336 Rsp Ring %d error: IOCB Data: "
1455                                         "x%x x%x x%x x%x x%x x%x x%x x%x\n",
1456                                         pring->ringno,
1457                                         irsp->un.ulpWord[0],
1458                                         irsp->un.ulpWord[1],
1459                                         irsp->un.ulpWord[2],
1460                                         irsp->un.ulpWord[3],
1461                                         irsp->un.ulpWord[4],
1462                                         irsp->un.ulpWord[5],
1463                                         *(((uint32_t *) irsp) + 6),
1464                                         *(((uint32_t *) irsp) + 7));
1465                 }
1466
1467                 switch (type) {
1468                 case LPFC_ABORT_IOCB:
1469                 case LPFC_SOL_IOCB:
1470                         /*
1471                          * Idle exchange closed via ABTS from port.  No iocb
1472                          * resources need to be recovered.
1473                          */
1474                         if (unlikely(irsp->ulpCommand == CMD_XRI_ABORTED_CX)) {
1475                                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
1476                                                 "0333 IOCB cmd 0x%x"
1477                                                 " processed. Skipping"
1478                                                 " completion\n",
1479                                                 irsp->ulpCommand);
1480                                 break;
1481                         }
1482
1483                         cmdiocbq = lpfc_sli_iocbq_lookup(phba, pring,
1484                                                          &rspiocbq);
1485                         if ((cmdiocbq) && (cmdiocbq->iocb_cmpl)) {
1486                                 if (phba->cfg_poll & ENABLE_FCP_RING_POLLING) {
1487                                         (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
1488                                                               &rspiocbq);
1489                                 } else {
1490                                         spin_unlock_irqrestore(&phba->hbalock,
1491                                                                iflag);
1492                                         (cmdiocbq->iocb_cmpl)(phba, cmdiocbq,
1493                                                               &rspiocbq);
1494                                         spin_lock_irqsave(&phba->hbalock,
1495                                                           iflag);
1496                                 }
1497                         }
1498                         break;
1499                 case LPFC_UNSOL_IOCB:
1500                         spin_unlock_irqrestore(&phba->hbalock, iflag);
1501                         lpfc_sli_process_unsol_iocb(phba, pring, &rspiocbq);
1502                         spin_lock_irqsave(&phba->hbalock, iflag);
1503                         break;
1504                 default:
1505                         if (irsp->ulpCommand == CMD_ADAPTER_MSG) {
1506                                 char adaptermsg[LPFC_MAX_ADPTMSG];
1507                                 memset(adaptermsg, 0, LPFC_MAX_ADPTMSG);
1508                                 memcpy(&adaptermsg[0], (uint8_t *) irsp,
1509                                        MAX_MSG_DATA);
1510                                 dev_warn(&((phba->pcidev)->dev),
1511                                          "lpfc%d: %s\n",
1512                                          phba->brd_no, adaptermsg);
1513                         } else {
1514                                 /* Unknown IOCB command */
1515                                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1516                                                 "0334 Unknown IOCB command "
1517                                                 "Data: x%x, x%x x%x x%x x%x\n",
1518                                                 type, irsp->ulpCommand,
1519                                                 irsp->ulpStatus,
1520                                                 irsp->ulpIoTag,
1521                                                 irsp->ulpContext);
1522                         }
1523                         break;
1524                 }
1525
1526                 /*
1527                  * The response IOCB has been processed.  Update the ring
1528                  * pointer in SLIM.  If the port response put pointer has not
1529                  * been updated, sync the pgp->rspPutInx and fetch the new port
1530                  * response put pointer.
1531                  */
1532                 writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);
1533
1534                 if (pring->rspidx == portRspPut)
1535                         portRspPut = le32_to_cpu(pgp->rspPutInx);
1536         }
1537
1538         if ((rsp_cmpl > 0) && (mask & HA_R0RE_REQ)) {
1539                 pring->stats.iocb_rsp_full++;
1540                 status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4));
1541                 writel(status, phba->CAregaddr);
1542                 readl(phba->CAregaddr);
1543         }
1544         if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
1545                 pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
1546                 pring->stats.iocb_cmd_empty++;
1547
1548                 /* Force update of the local copy of cmdGetInx */
1549                 pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
1550                 lpfc_sli_resume_iocb(phba, pring);
1551
1552                 if ((pring->lpfc_sli_cmd_available))
1553                         (pring->lpfc_sli_cmd_available) (phba, pring);
1554
1555         }
1556
1557         spin_unlock_irqrestore(&phba->hbalock, iflag);
1558         return rc;
1559 }
1560
1561 int
1562 lpfc_sli_handle_slow_ring_event(struct lpfc_hba *phba,
1563                                 struct lpfc_sli_ring *pring, uint32_t mask)
1564 {
1565         struct lpfc_pgp *pgp = (phba->sli_rev == 3) ?
1566                 &phba->slim2p->mbx.us.s3_pgp.port[pring->ringno] :
1567                 &phba->slim2p->mbx.us.s2.port[pring->ringno];
1568         IOCB_t *entry;
1569         IOCB_t *irsp = NULL;
1570         struct lpfc_iocbq *rspiocbp = NULL;
1571         struct lpfc_iocbq *next_iocb;
1572         struct lpfc_iocbq *cmdiocbp;
1573         struct lpfc_iocbq *saveq;
1574         uint8_t iocb_cmd_type;
1575         lpfc_iocb_type type;
1576         uint32_t status, free_saveq;
1577         uint32_t portRspPut, portRspMax;
1578         int rc = 1;
1579         unsigned long iflag;
1580
1581         spin_lock_irqsave(&phba->hbalock, iflag);
1582         pring->stats.iocb_event++;
1583
1584         /*
1585          * The next available response entry should never exceed the maximum
1586          * entries.  If it does, treat it as an adapter hardware error.
1587          */
1588         portRspMax = pring->numRiocb;
1589         portRspPut = le32_to_cpu(pgp->rspPutInx);
1590         if (portRspPut >= portRspMax) {
1591                 /*
1592                  * Ring <ringno> handler: portRspPut <portRspPut> is bigger then
1593                  * rsp ring <portRspMax>
1594                  */
1595                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1596                                 "0303 Ring %d handler: portRspPut %d "
1597                                 "is bigger then rsp ring %d\n",
1598                                 pring->ringno, portRspPut, portRspMax);
1599
1600                 phba->link_state = LPFC_HBA_ERROR;
1601                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1602
1603                 phba->work_hs = HS_FFER3;
1604                 lpfc_handle_eratt(phba);
1605
1606                 return 1;
1607         }
1608
1609         rmb();
1610         while (pring->rspidx != portRspPut) {
1611                 /*
1612                  * Build a completion list and call the appropriate handler.
1613                  * The process is to get the next available response iocb, get
1614                  * a free iocb from the list, copy the response data into the
1615                  * free iocb, insert to the continuation list, and update the
1616                  * next response index to slim.  This process makes response
1617                  * iocb's in the ring available to DMA as fast as possible but
1618                  * pays a penalty for a copy operation.  Since the iocb is
1619                  * only 32 bytes, this penalty is considered small relative to
1620                  * the PCI reads for register values and a slim write.  When
1621                  * the ulpLe field is set, the entire Command has been
1622                  * received.
1623                  */
1624                 entry = lpfc_resp_iocb(phba, pring);
1625
1626                 phba->last_completion_time = jiffies;
1627                 rspiocbp = __lpfc_sli_get_iocbq(phba);
1628                 if (rspiocbp == NULL) {
1629                         printk(KERN_ERR "%s: out of buffers! Failing "
1630                                "completion.\n", __FUNCTION__);
1631                         break;
1632                 }
1633
1634                 lpfc_sli_pcimem_bcopy(entry, &rspiocbp->iocb,
1635                                       phba->iocb_rsp_size);
1636                 irsp = &rspiocbp->iocb;
1637
1638                 if (++pring->rspidx >= portRspMax)
1639                         pring->rspidx = 0;
1640
1641                 if (pring->ringno == LPFC_ELS_RING) {
1642                         lpfc_debugfs_slow_ring_trc(phba,
1643                         "IOCB rsp ring:   wd4:x%08x wd6:x%08x wd7:x%08x",
1644                                 *(((uint32_t *) irsp) + 4),
1645                                 *(((uint32_t *) irsp) + 6),
1646                                 *(((uint32_t *) irsp) + 7));
1647                 }
1648
1649                 writel(pring->rspidx, &phba->host_gp[pring->ringno].rspGetInx);
1650
1651                 list_add_tail(&rspiocbp->list, &(pring->iocb_continueq));
1652
1653                 pring->iocb_continueq_cnt++;
1654                 if (irsp->ulpLe) {
1655                         /*
1656                          * By default, the driver expects to free all resources
1657                          * associated with this iocb completion.
1658                          */
1659                         free_saveq = 1;
1660                         saveq = list_get_first(&pring->iocb_continueq,
1661                                                struct lpfc_iocbq, list);
1662                         irsp = &(saveq->iocb);
1663                         list_del_init(&pring->iocb_continueq);
1664                         pring->iocb_continueq_cnt = 0;
1665
1666                         pring->stats.iocb_rsp++;
1667
1668                         /*
1669                          * If resource errors reported from HBA, reduce
1670                          * queuedepths of the SCSI device.
1671                          */
1672                         if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
1673                              (irsp->un.ulpWord[4] == IOERR_NO_RESOURCES)) {
1674                                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1675                                 lpfc_adjust_queue_depth(phba);
1676                                 spin_lock_irqsave(&phba->hbalock, iflag);
1677                         }
1678
1679                         if (irsp->ulpStatus) {
1680                                 /* Rsp ring <ringno> error: IOCB */
1681                                 lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
1682                                                 "0328 Rsp Ring %d error: "
1683                                                 "IOCB Data: "
1684                                                 "x%x x%x x%x x%x "
1685                                                 "x%x x%x x%x x%x "
1686                                                 "x%x x%x x%x x%x "
1687                                                 "x%x x%x x%x x%x\n",
1688                                                 pring->ringno,
1689                                                 irsp->un.ulpWord[0],
1690                                                 irsp->un.ulpWord[1],
1691                                                 irsp->un.ulpWord[2],
1692                                                 irsp->un.ulpWord[3],
1693                                                 irsp->un.ulpWord[4],
1694                                                 irsp->un.ulpWord[5],
1695                                                 *(((uint32_t *) irsp) + 6),
1696                                                 *(((uint32_t *) irsp) + 7),
1697                                                 *(((uint32_t *) irsp) + 8),
1698                                                 *(((uint32_t *) irsp) + 9),
1699                                                 *(((uint32_t *) irsp) + 10),
1700                                                 *(((uint32_t *) irsp) + 11),
1701                                                 *(((uint32_t *) irsp) + 12),
1702                                                 *(((uint32_t *) irsp) + 13),
1703                                                 *(((uint32_t *) irsp) + 14),
1704                                                 *(((uint32_t *) irsp) + 15));
1705                         }
1706
1707                         /*
1708                          * Fetch the IOCB command type and call the correct
1709                          * completion routine.  Solicited and Unsolicited
1710                          * IOCBs on the ELS ring get freed back to the
1711                          * lpfc_iocb_list by the discovery kernel thread.
1712                          */
1713                         iocb_cmd_type = irsp->ulpCommand & CMD_IOCB_MASK;
1714                         type = lpfc_sli_iocb_cmd_type(iocb_cmd_type);
1715                         if (type == LPFC_SOL_IOCB) {
1716                                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1717                                 rc = lpfc_sli_process_sol_iocb(phba, pring,
1718                                                                saveq);
1719                                 spin_lock_irqsave(&phba->hbalock, iflag);
1720                         } else if (type == LPFC_UNSOL_IOCB) {
1721                                 spin_unlock_irqrestore(&phba->hbalock, iflag);
1722                                 rc = lpfc_sli_process_unsol_iocb(phba, pring,
1723                                                                  saveq);
1724                                 spin_lock_irqsave(&phba->hbalock, iflag);
1725                                 if (!rc)
1726                                         free_saveq = 0;
1727                         } else if (type == LPFC_ABORT_IOCB) {
1728                                 if ((irsp->ulpCommand != CMD_XRI_ABORTED_CX) &&
1729                                     ((cmdiocbp =
1730                                       lpfc_sli_iocbq_lookup(phba, pring,
1731                                                             saveq)))) {
1732                                         /* Call the specified completion
1733                                            routine */
1734                                         if (cmdiocbp->iocb_cmpl) {
1735                                                 spin_unlock_irqrestore(
1736                                                        &phba->hbalock,
1737                                                        iflag);
1738                                                 (cmdiocbp->iocb_cmpl) (phba,
1739                                                              cmdiocbp, saveq);
1740                                                 spin_lock_irqsave(
1741                                                           &phba->hbalock,
1742                                                           iflag);
1743                                         } else
1744                                                 __lpfc_sli_release_iocbq(phba,
1745                                                                       cmdiocbp);
1746                                 }
1747                         } else if (type == LPFC_UNKNOWN_IOCB) {
1748                                 if (irsp->ulpCommand == CMD_ADAPTER_MSG) {
1749
1750                                         char adaptermsg[LPFC_MAX_ADPTMSG];
1751
1752                                         memset(adaptermsg, 0,
1753                                                LPFC_MAX_ADPTMSG);
1754                                         memcpy(&adaptermsg[0], (uint8_t *) irsp,
1755                                                MAX_MSG_DATA);
1756                                         dev_warn(&((phba->pcidev)->dev),
1757                                                  "lpfc%d: %s\n",
1758                                                  phba->brd_no, adaptermsg);
1759                                 } else {
1760                                         /* Unknown IOCB command */
1761                                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
1762                                                         "0335 Unknown IOCB "
1763                                                         "command Data: x%x "
1764                                                         "x%x x%x x%x\n",
1765                                                         irsp->ulpCommand,
1766                                                         irsp->ulpStatus,
1767                                                         irsp->ulpIoTag,
1768                                                         irsp->ulpContext);
1769                                 }
1770                         }
1771
1772                         if (free_saveq) {
1773                                 list_for_each_entry_safe(rspiocbp, next_iocb,
1774                                                          &saveq->list, list) {
1775                                         list_del(&rspiocbp->list);
1776                                         __lpfc_sli_release_iocbq(phba,
1777                                                                  rspiocbp);
1778                                 }
1779                                 __lpfc_sli_release_iocbq(phba, saveq);
1780                         }
1781                         rspiocbp = NULL;
1782                 }
1783
1784                 /*
1785                  * If the port response put pointer has not been updated, sync
1786                  * the pgp->rspPutInx in the MAILBOX_tand fetch the new port
1787                  * response put pointer.
1788                  */
1789                 if (pring->rspidx == portRspPut) {
1790                         portRspPut = le32_to_cpu(pgp->rspPutInx);
1791                 }
1792         } /* while (pring->rspidx != portRspPut) */
1793
1794         if ((rspiocbp != NULL) && (mask & HA_R0RE_REQ)) {
1795                 /* At least one response entry has been freed */
1796                 pring->stats.iocb_rsp_full++;
1797                 /* SET RxRE_RSP in Chip Att register */
1798                 status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4));
1799                 writel(status, phba->CAregaddr);
1800                 readl(phba->CAregaddr); /* flush */
1801         }
1802         if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) {
1803                 pring->flag &= ~LPFC_CALL_RING_AVAILABLE;
1804                 pring->stats.iocb_cmd_empty++;
1805
1806                 /* Force update of the local copy of cmdGetInx */
1807                 pring->local_getidx = le32_to_cpu(pgp->cmdGetInx);
1808                 lpfc_sli_resume_iocb(phba, pring);
1809
1810                 if ((pring->lpfc_sli_cmd_available))
1811                         (pring->lpfc_sli_cmd_available) (phba, pring);
1812
1813         }
1814
1815         spin_unlock_irqrestore(&phba->hbalock, iflag);
1816         return rc;
1817 }
1818
1819 void
1820 lpfc_sli_abort_iocb_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring)
1821 {
1822         LIST_HEAD(completions);
1823         struct lpfc_iocbq *iocb, *next_iocb;
1824         IOCB_t *cmd = NULL;
1825
1826         if (pring->ringno == LPFC_ELS_RING) {
1827                 lpfc_fabric_abort_hba(phba);
1828         }
1829
1830         /* Error everything on txq and txcmplq
1831          * First do the txq.
1832          */
1833         spin_lock_irq(&phba->hbalock);
1834         list_splice_init(&pring->txq, &completions);
1835         pring->txq_cnt = 0;
1836
1837         /* Next issue ABTS for everything on the txcmplq */
1838         list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list)
1839                 lpfc_sli_issue_abort_iotag(phba, pring, iocb);
1840
1841         spin_unlock_irq(&phba->hbalock);
1842
1843         while (!list_empty(&completions)) {
1844                 iocb = list_get_first(&completions, struct lpfc_iocbq, list);
1845                 cmd = &iocb->iocb;
1846                 list_del_init(&iocb->list);
1847
1848                 if (!iocb->iocb_cmpl)
1849                         lpfc_sli_release_iocbq(phba, iocb);
1850                 else {
1851                         cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
1852                         cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
1853                         (iocb->iocb_cmpl) (phba, iocb, iocb);
1854                 }
1855         }
1856 }
1857
1858 int
1859 lpfc_sli_brdready(struct lpfc_hba *phba, uint32_t mask)
1860 {
1861         uint32_t status;
1862         int i = 0;
1863         int retval = 0;
1864
1865         /* Read the HBA Host Status Register */
1866         status = readl(phba->HSregaddr);
1867
1868         /*
1869          * Check status register every 100ms for 5 retries, then every
1870          * 500ms for 5, then every 2.5 sec for 5, then reset board and
1871          * every 2.5 sec for 4.
1872          * Break our of the loop if errors occurred during init.
1873          */
1874         while (((status & mask) != mask) &&
1875                !(status & HS_FFERM) &&
1876                i++ < 20) {
1877
1878                 if (i <= 5)
1879                         msleep(10);
1880                 else if (i <= 10)
1881                         msleep(500);
1882                 else
1883                         msleep(2500);
1884
1885                 if (i == 15) {
1886                                 /* Do post */
1887                         phba->pport->port_state = LPFC_VPORT_UNKNOWN;
1888                         lpfc_sli_brdrestart(phba);
1889                 }
1890                 /* Read the HBA Host Status Register */
1891                 status = readl(phba->HSregaddr);
1892         }
1893
1894         /* Check to see if any errors occurred during init */
1895         if ((status & HS_FFERM) || (i >= 20)) {
1896                 phba->link_state = LPFC_HBA_ERROR;
1897                 retval = 1;
1898         }
1899
1900         return retval;
1901 }
1902
1903 #define BARRIER_TEST_PATTERN (0xdeadbeef)
1904
1905 void lpfc_reset_barrier(struct lpfc_hba *phba)
1906 {
1907         uint32_t __iomem *resp_buf;
1908         uint32_t __iomem *mbox_buf;
1909         volatile uint32_t mbox;
1910         uint32_t hc_copy;
1911         int  i;
1912         uint8_t hdrtype;
1913
1914         pci_read_config_byte(phba->pcidev, PCI_HEADER_TYPE, &hdrtype);
1915         if (hdrtype != 0x80 ||
1916             (FC_JEDEC_ID(phba->vpd.rev.biuRev) != HELIOS_JEDEC_ID &&
1917              FC_JEDEC_ID(phba->vpd.rev.biuRev) != THOR_JEDEC_ID))
1918                 return;
1919
1920         /*
1921          * Tell the other part of the chip to suspend temporarily all
1922          * its DMA activity.
1923          */
1924         resp_buf = phba->MBslimaddr;
1925
1926         /* Disable the error attention */
1927         hc_copy = readl(phba->HCregaddr);
1928         writel((hc_copy & ~HC_ERINT_ENA), phba->HCregaddr);
1929         readl(phba->HCregaddr); /* flush */
1930         phba->link_flag |= LS_IGNORE_ERATT;
1931
1932         if (readl(phba->HAregaddr) & HA_ERATT) {
1933                 /* Clear Chip error bit */
1934                 writel(HA_ERATT, phba->HAregaddr);
1935                 phba->pport->stopped = 1;
1936         }
1937
1938         mbox = 0;
1939         ((MAILBOX_t *)&mbox)->mbxCommand = MBX_KILL_BOARD;
1940         ((MAILBOX_t *)&mbox)->mbxOwner = OWN_CHIP;
1941
1942         writel(BARRIER_TEST_PATTERN, (resp_buf + 1));
1943         mbox_buf = phba->MBslimaddr;
1944         writel(mbox, mbox_buf);
1945
1946         for (i = 0;
1947              readl(resp_buf + 1) != ~(BARRIER_TEST_PATTERN) && i < 50; i++)
1948                 mdelay(1);
1949
1950         if (readl(resp_buf + 1) != ~(BARRIER_TEST_PATTERN)) {
1951                 if (phba->sli.sli_flag & LPFC_SLI2_ACTIVE ||
1952                     phba->pport->stopped)
1953                         goto restore_hc;
1954                 else
1955                         goto clear_errat;
1956         }
1957
1958         ((MAILBOX_t *)&mbox)->mbxOwner = OWN_HOST;
1959         for (i = 0; readl(resp_buf) != mbox &&  i < 500; i++)
1960                 mdelay(1);
1961
1962 clear_errat:
1963
1964         while (!(readl(phba->HAregaddr) & HA_ERATT) && ++i < 500)
1965                 mdelay(1);
1966
1967         if (readl(phba->HAregaddr) & HA_ERATT) {
1968                 writel(HA_ERATT, phba->HAregaddr);
1969                 phba->pport->stopped = 1;
1970         }
1971
1972 restore_hc:
1973         phba->link_flag &= ~LS_IGNORE_ERATT;
1974         writel(hc_copy, phba->HCregaddr);
1975         readl(phba->HCregaddr); /* flush */
1976 }
1977
1978 int
1979 lpfc_sli_brdkill(struct lpfc_hba *phba)
1980 {
1981         struct lpfc_sli *psli;
1982         LPFC_MBOXQ_t *pmb;
1983         uint32_t status;
1984         uint32_t ha_copy;
1985         int retval;
1986         int i = 0;
1987
1988         psli = &phba->sli;
1989
1990         /* Kill HBA */
1991         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
1992                         "0329 Kill HBA Data: x%x x%x\n",
1993                         phba->pport->port_state, psli->sli_flag);
1994
1995         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
1996         if (!pmb)
1997                 return 1;
1998
1999         /* Disable the error attention */
2000         spin_lock_irq(&phba->hbalock);
2001         status = readl(phba->HCregaddr);
2002         status &= ~HC_ERINT_ENA;
2003         writel(status, phba->HCregaddr);
2004         readl(phba->HCregaddr); /* flush */
2005         phba->link_flag |= LS_IGNORE_ERATT;
2006         spin_unlock_irq(&phba->hbalock);
2007
2008         lpfc_kill_board(phba, pmb);
2009         pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
2010         retval = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
2011
2012         if (retval != MBX_SUCCESS) {
2013                 if (retval != MBX_BUSY)
2014                         mempool_free(pmb, phba->mbox_mem_pool);
2015                 spin_lock_irq(&phba->hbalock);
2016                 phba->link_flag &= ~LS_IGNORE_ERATT;
2017                 spin_unlock_irq(&phba->hbalock);
2018                 return 1;
2019         }
2020
2021         psli->sli_flag &= ~LPFC_SLI2_ACTIVE;
2022
2023         mempool_free(pmb, phba->mbox_mem_pool);
2024
2025         /* There is no completion for a KILL_BOARD mbox cmd. Check for an error
2026          * attention every 100ms for 3 seconds. If we don't get ERATT after
2027          * 3 seconds we still set HBA_ERROR state because the status of the
2028          * board is now undefined.
2029          */
2030         ha_copy = readl(phba->HAregaddr);
2031
2032         while ((i++ < 30) && !(ha_copy & HA_ERATT)) {
2033                 mdelay(100);
2034                 ha_copy = readl(phba->HAregaddr);
2035         }
2036
2037         del_timer_sync(&psli->mbox_tmo);
2038         if (ha_copy & HA_ERATT) {
2039                 writel(HA_ERATT, phba->HAregaddr);
2040                 phba->pport->stopped = 1;
2041         }
2042         spin_lock_irq(&phba->hbalock);
2043         psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
2044         phba->link_flag &= ~LS_IGNORE_ERATT;
2045         spin_unlock_irq(&phba->hbalock);
2046
2047         psli->mbox_active = NULL;
2048         lpfc_hba_down_post(phba);
2049         phba->link_state = LPFC_HBA_ERROR;
2050
2051         return ha_copy & HA_ERATT ? 0 : 1;
2052 }
2053
2054 int
2055 lpfc_sli_brdreset(struct lpfc_hba *phba)
2056 {
2057         struct lpfc_sli *psli;
2058         struct lpfc_sli_ring *pring;
2059         uint16_t cfg_value;
2060         int i;
2061
2062         psli = &phba->sli;
2063
2064         /* Reset HBA */
2065         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2066                         "0325 Reset HBA Data: x%x x%x\n",
2067                         phba->pport->port_state, psli->sli_flag);
2068
2069         /* perform board reset */
2070         phba->fc_eventTag = 0;
2071         phba->pport->fc_myDID = 0;
2072         phba->pport->fc_prevDID = 0;
2073
2074         /* Turn off parity checking and serr during the physical reset */
2075         pci_read_config_word(phba->pcidev, PCI_COMMAND, &cfg_value);
2076         pci_write_config_word(phba->pcidev, PCI_COMMAND,
2077                               (cfg_value &
2078                                ~(PCI_COMMAND_PARITY | PCI_COMMAND_SERR)));
2079
2080         psli->sli_flag &= ~(LPFC_SLI2_ACTIVE | LPFC_PROCESS_LA);
2081         /* Now toggle INITFF bit in the Host Control Register */
2082         writel(HC_INITFF, phba->HCregaddr);
2083         mdelay(1);
2084         readl(phba->HCregaddr); /* flush */
2085         writel(0, phba->HCregaddr);
2086         readl(phba->HCregaddr); /* flush */
2087
2088         /* Restore PCI cmd register */
2089         pci_write_config_word(phba->pcidev, PCI_COMMAND, cfg_value);
2090
2091         /* Initialize relevant SLI info */
2092         for (i = 0; i < psli->num_rings; i++) {
2093                 pring = &psli->ring[i];
2094                 pring->flag = 0;
2095                 pring->rspidx = 0;
2096                 pring->next_cmdidx  = 0;
2097                 pring->local_getidx = 0;
2098                 pring->cmdidx = 0;
2099                 pring->missbufcnt = 0;
2100         }
2101
2102         phba->link_state = LPFC_WARM_START;
2103         return 0;
2104 }
2105
2106 int
2107 lpfc_sli_brdrestart(struct lpfc_hba *phba)
2108 {
2109         MAILBOX_t *mb;
2110         struct lpfc_sli *psli;
2111         uint16_t skip_post;
2112         volatile uint32_t word0;
2113         void __iomem *to_slim;
2114
2115         spin_lock_irq(&phba->hbalock);
2116
2117         psli = &phba->sli;
2118
2119         /* Restart HBA */
2120         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2121                         "0337 Restart HBA Data: x%x x%x\n",
2122                         phba->pport->port_state, psli->sli_flag);
2123
2124         word0 = 0;
2125         mb = (MAILBOX_t *) &word0;
2126         mb->mbxCommand = MBX_RESTART;
2127         mb->mbxHc = 1;
2128
2129         lpfc_reset_barrier(phba);
2130
2131         to_slim = phba->MBslimaddr;
2132         writel(*(uint32_t *) mb, to_slim);
2133         readl(to_slim); /* flush */
2134
2135         /* Only skip post after fc_ffinit is completed */
2136         if (phba->pport->port_state) {
2137                 skip_post = 1;
2138                 word0 = 1;      /* This is really setting up word1 */
2139         } else {
2140                 skip_post = 0;
2141                 word0 = 0;      /* This is really setting up word1 */
2142         }
2143         to_slim = phba->MBslimaddr + sizeof (uint32_t);
2144         writel(*(uint32_t *) mb, to_slim);
2145         readl(to_slim); /* flush */
2146
2147         lpfc_sli_brdreset(phba);
2148         phba->pport->stopped = 0;
2149         phba->link_state = LPFC_INIT_START;
2150
2151         spin_unlock_irq(&phba->hbalock);
2152
2153         memset(&psli->lnk_stat_offsets, 0, sizeof(psli->lnk_stat_offsets));
2154         psli->stats_start = get_seconds();
2155
2156         if (skip_post)
2157                 mdelay(100);
2158         else
2159                 mdelay(2000);
2160
2161         lpfc_hba_down_post(phba);
2162
2163         return 0;
2164 }
2165
2166 static int
2167 lpfc_sli_chipset_init(struct lpfc_hba *phba)
2168 {
2169         uint32_t status, i = 0;
2170
2171         /* Read the HBA Host Status Register */
2172         status = readl(phba->HSregaddr);
2173
2174         /* Check status register to see what current state is */
2175         i = 0;
2176         while ((status & (HS_FFRDY | HS_MBRDY)) != (HS_FFRDY | HS_MBRDY)) {
2177
2178                 /* Check every 100ms for 5 retries, then every 500ms for 5, then
2179                  * every 2.5 sec for 5, then reset board and every 2.5 sec for
2180                  * 4.
2181                  */
2182                 if (i++ >= 20) {
2183                         /* Adapter failed to init, timeout, status reg
2184                            <status> */
2185                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2186                                         "0436 Adapter failed to init, "
2187                                         "timeout, status reg x%x, "
2188                                         "FW Data: A8 x%x AC x%x\n", status,
2189                                         readl(phba->MBslimaddr + 0xa8),
2190                                         readl(phba->MBslimaddr + 0xac));
2191                         phba->link_state = LPFC_HBA_ERROR;
2192                         return -ETIMEDOUT;
2193                 }
2194
2195                 /* Check to see if any errors occurred during init */
2196                 if (status & HS_FFERM) {
2197                         /* ERROR: During chipset initialization */
2198                         /* Adapter failed to init, chipset, status reg
2199                            <status> */
2200                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2201                                         "0437 Adapter failed to init, "
2202                                         "chipset, status reg x%x, "
2203                                         "FW Data: A8 x%x AC x%x\n", status,
2204                                         readl(phba->MBslimaddr + 0xa8),
2205                                         readl(phba->MBslimaddr + 0xac));
2206                         phba->link_state = LPFC_HBA_ERROR;
2207                         return -EIO;
2208                 }
2209
2210                 if (i <= 5) {
2211                         msleep(10);
2212                 } else if (i <= 10) {
2213                         msleep(500);
2214                 } else {
2215                         msleep(2500);
2216                 }
2217
2218                 if (i == 15) {
2219                                 /* Do post */
2220                         phba->pport->port_state = LPFC_VPORT_UNKNOWN;
2221                         lpfc_sli_brdrestart(phba);
2222                 }
2223                 /* Read the HBA Host Status Register */
2224                 status = readl(phba->HSregaddr);
2225         }
2226
2227         /* Check to see if any errors occurred during init */
2228         if (status & HS_FFERM) {
2229                 /* ERROR: During chipset initialization */
2230                 /* Adapter failed to init, chipset, status reg <status> */
2231                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2232                                 "0438 Adapter failed to init, chipset, "
2233                                 "status reg x%x, "
2234                                 "FW Data: A8 x%x AC x%x\n", status,
2235                                 readl(phba->MBslimaddr + 0xa8),
2236                                 readl(phba->MBslimaddr + 0xac));
2237                 phba->link_state = LPFC_HBA_ERROR;
2238                 return -EIO;
2239         }
2240
2241         /* Clear all interrupt enable conditions */
2242         writel(0, phba->HCregaddr);
2243         readl(phba->HCregaddr); /* flush */
2244
2245         /* setup host attn register */
2246         writel(0xffffffff, phba->HAregaddr);
2247         readl(phba->HAregaddr); /* flush */
2248         return 0;
2249 }
2250
2251 int
2252 lpfc_sli_hbq_count(void)
2253 {
2254         return ARRAY_SIZE(lpfc_hbq_defs);
2255 }
2256
2257 static int
2258 lpfc_sli_hbq_entry_count(void)
2259 {
2260         int  hbq_count = lpfc_sli_hbq_count();
2261         int  count = 0;
2262         int  i;
2263
2264         for (i = 0; i < hbq_count; ++i)
2265                 count += lpfc_hbq_defs[i]->entry_count;
2266         return count;
2267 }
2268
2269 int
2270 lpfc_sli_hbq_size(void)
2271 {
2272         return lpfc_sli_hbq_entry_count() * sizeof(struct lpfc_hbq_entry);
2273 }
2274
2275 static int
2276 lpfc_sli_hbq_setup(struct lpfc_hba *phba)
2277 {
2278         int  hbq_count = lpfc_sli_hbq_count();
2279         LPFC_MBOXQ_t *pmb;
2280         MAILBOX_t *pmbox;
2281         uint32_t hbqno;
2282         uint32_t hbq_entry_index;
2283
2284                                 /* Get a Mailbox buffer to setup mailbox
2285                                  * commands for HBA initialization
2286                                  */
2287         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
2288
2289         if (!pmb)
2290                 return -ENOMEM;
2291
2292         pmbox = &pmb->mb;
2293
2294         /* Initialize the struct lpfc_sli_hbq structure for each hbq */
2295         phba->link_state = LPFC_INIT_MBX_CMDS;
2296
2297         hbq_entry_index = 0;
2298         for (hbqno = 0; hbqno < hbq_count; ++hbqno) {
2299                 phba->hbqs[hbqno].next_hbqPutIdx = 0;
2300                 phba->hbqs[hbqno].hbqPutIdx      = 0;
2301                 phba->hbqs[hbqno].local_hbqGetIdx   = 0;
2302                 phba->hbqs[hbqno].entry_count =
2303                         lpfc_hbq_defs[hbqno]->entry_count;
2304                 lpfc_config_hbq(phba, hbqno, lpfc_hbq_defs[hbqno],
2305                         hbq_entry_index, pmb);
2306                 hbq_entry_index += phba->hbqs[hbqno].entry_count;
2307
2308                 if (lpfc_sli_issue_mbox(phba, pmb, MBX_POLL) != MBX_SUCCESS) {
2309                         /* Adapter failed to init, mbxCmd <cmd> CFG_RING,
2310                            mbxStatus <status>, ring <num> */
2311
2312                         lpfc_printf_log(phba, KERN_ERR,
2313                                         LOG_SLI | LOG_VPORT,
2314                                         "1805 Adapter failed to init. "
2315                                         "Data: x%x x%x x%x\n",
2316                                         pmbox->mbxCommand,
2317                                         pmbox->mbxStatus, hbqno);
2318
2319                         phba->link_state = LPFC_HBA_ERROR;
2320                         mempool_free(pmb, phba->mbox_mem_pool);
2321                         return ENXIO;
2322                 }
2323         }
2324         phba->hbq_count = hbq_count;
2325
2326         mempool_free(pmb, phba->mbox_mem_pool);
2327
2328         /* Initially populate or replenish the HBQs */
2329         for (hbqno = 0; hbqno < hbq_count; ++hbqno) {
2330                 if (lpfc_sli_hbqbuf_init_hbqs(phba, hbqno))
2331                         return -ENOMEM;
2332         }
2333         return 0;
2334 }
2335
2336 static int
2337 lpfc_do_config_port(struct lpfc_hba *phba, int sli_mode)
2338 {
2339         LPFC_MBOXQ_t *pmb;
2340         uint32_t resetcount = 0, rc = 0, done = 0;
2341
2342         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
2343         if (!pmb) {
2344                 phba->link_state = LPFC_HBA_ERROR;
2345                 return -ENOMEM;
2346         }
2347
2348         phba->sli_rev = sli_mode;
2349         while (resetcount < 2 && !done) {
2350                 spin_lock_irq(&phba->hbalock);
2351                 phba->sli.sli_flag |= LPFC_SLI_MBOX_ACTIVE;
2352                 spin_unlock_irq(&phba->hbalock);
2353                 phba->pport->port_state = LPFC_VPORT_UNKNOWN;
2354                 lpfc_sli_brdrestart(phba);
2355                 msleep(2500);
2356                 rc = lpfc_sli_chipset_init(phba);
2357                 if (rc)
2358                         break;
2359
2360                 spin_lock_irq(&phba->hbalock);
2361                 phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
2362                 spin_unlock_irq(&phba->hbalock);
2363                 resetcount++;
2364
2365                 /* Call pre CONFIG_PORT mailbox command initialization.  A
2366                  * value of 0 means the call was successful.  Any other
2367                  * nonzero value is a failure, but if ERESTART is returned,
2368                  * the driver may reset the HBA and try again.
2369                  */
2370                 rc = lpfc_config_port_prep(phba);
2371                 if (rc == -ERESTART) {
2372                         phba->link_state = LPFC_LINK_UNKNOWN;
2373                         continue;
2374                 } else if (rc) {
2375                         break;
2376                 }
2377
2378                 phba->link_state = LPFC_INIT_MBX_CMDS;
2379                 lpfc_config_port(phba, pmb);
2380                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
2381                 if (rc != MBX_SUCCESS) {
2382                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2383                                 "0442 Adapter failed to init, mbxCmd x%x "
2384                                 "CONFIG_PORT, mbxStatus x%x Data: x%x\n",
2385                                 pmb->mb.mbxCommand, pmb->mb.mbxStatus, 0);
2386                         spin_lock_irq(&phba->hbalock);
2387                         phba->sli.sli_flag &= ~LPFC_SLI2_ACTIVE;
2388                         spin_unlock_irq(&phba->hbalock);
2389                         rc = -ENXIO;
2390                 } else {
2391                         done = 1;
2392                         phba->max_vpi = (phba->max_vpi &&
2393                                          pmb->mb.un.varCfgPort.gmv) != 0
2394                                 ? pmb->mb.un.varCfgPort.max_vpi
2395                                 : 0;
2396                 }
2397         }
2398
2399         if (!done) {
2400                 rc = -EINVAL;
2401                 goto do_prep_failed;
2402         }
2403
2404         if ((pmb->mb.un.varCfgPort.sli_mode == 3) &&
2405                 (!pmb->mb.un.varCfgPort.cMA)) {
2406                 rc = -ENXIO;
2407                 goto do_prep_failed;
2408         }
2409         return rc;
2410
2411 do_prep_failed:
2412         mempool_free(pmb, phba->mbox_mem_pool);
2413         return rc;
2414 }
2415
2416 int
2417 lpfc_sli_hba_setup(struct lpfc_hba *phba)
2418 {
2419         uint32_t rc;
2420         int  mode = 3;
2421
2422         switch (lpfc_sli_mode) {
2423         case 2:
2424                 if (phba->cfg_enable_npiv) {
2425                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
2426                                 "1824 NPIV enabled: Override lpfc_sli_mode "
2427                                 "parameter (%d) to auto (0).\n",
2428                                 lpfc_sli_mode);
2429                         break;
2430                 }
2431                 mode = 2;
2432                 break;
2433         case 0:
2434         case 3:
2435                 break;
2436         default:
2437                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
2438                                 "1819 Unrecognized lpfc_sli_mode "
2439                                 "parameter: %d.\n", lpfc_sli_mode);
2440
2441                 break;
2442         }
2443
2444         rc = lpfc_do_config_port(phba, mode);
2445         if (rc && lpfc_sli_mode == 3)
2446                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT | LOG_VPORT,
2447                                 "1820 Unable to select SLI-3.  "
2448                                 "Not supported by adapter.\n");
2449         if (rc && mode != 2)
2450                 rc = lpfc_do_config_port(phba, 2);
2451         if (rc)
2452                 goto lpfc_sli_hba_setup_error;
2453
2454         if (phba->sli_rev == 3) {
2455                 phba->iocb_cmd_size = SLI3_IOCB_CMD_SIZE;
2456                 phba->iocb_rsp_size = SLI3_IOCB_RSP_SIZE;
2457                 phba->sli3_options |= LPFC_SLI3_ENABLED;
2458                 phba->sli3_options |= LPFC_SLI3_HBQ_ENABLED;
2459
2460         } else {
2461                 phba->iocb_cmd_size = SLI2_IOCB_CMD_SIZE;
2462                 phba->iocb_rsp_size = SLI2_IOCB_RSP_SIZE;
2463                 phba->sli3_options = 0;
2464         }
2465
2466         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
2467                         "0444 Firmware in SLI %x mode. Max_vpi %d\n",
2468                         phba->sli_rev, phba->max_vpi);
2469         rc = lpfc_sli_ring_map(phba);
2470
2471         if (rc)
2472                 goto lpfc_sli_hba_setup_error;
2473
2474                                 /* Init HBQs */
2475
2476         if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
2477                 rc = lpfc_sli_hbq_setup(phba);
2478                 if (rc)
2479                         goto lpfc_sli_hba_setup_error;
2480         }
2481
2482         phba->sli.sli_flag |= LPFC_PROCESS_LA;
2483
2484         rc = lpfc_config_port_post(phba);
2485         if (rc)
2486                 goto lpfc_sli_hba_setup_error;
2487
2488         return rc;
2489
2490 lpfc_sli_hba_setup_error:
2491         phba->link_state = LPFC_HBA_ERROR;
2492         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
2493                         "0445 Firmware initialization failed\n");
2494         return rc;
2495 }
2496
2497 /*! lpfc_mbox_timeout
2498  *
2499  * \pre
2500  * \post
2501  * \param hba Pointer to per struct lpfc_hba structure
2502  * \param l1  Pointer to the driver's mailbox queue.
2503  * \return
2504  *   void
2505  *
2506  * \b Description:
2507  *
2508  * This routine handles mailbox timeout events at timer interrupt context.
2509  */
2510 void
2511 lpfc_mbox_timeout(unsigned long ptr)
2512 {
2513         struct lpfc_hba  *phba = (struct lpfc_hba *) ptr;
2514         unsigned long iflag;
2515         uint32_t tmo_posted;
2516
2517         spin_lock_irqsave(&phba->pport->work_port_lock, iflag);
2518         tmo_posted = phba->pport->work_port_events & WORKER_MBOX_TMO;
2519         if (!tmo_posted)
2520                 phba->pport->work_port_events |= WORKER_MBOX_TMO;
2521         spin_unlock_irqrestore(&phba->pport->work_port_lock, iflag);
2522
2523         if (!tmo_posted) {
2524                 spin_lock_irqsave(&phba->hbalock, iflag);
2525                 if (phba->work_wait)
2526                         lpfc_worker_wake_up(phba);
2527                 spin_unlock_irqrestore(&phba->hbalock, iflag);
2528         }
2529 }
2530
2531 void
2532 lpfc_mbox_timeout_handler(struct lpfc_hba *phba)
2533 {
2534         LPFC_MBOXQ_t *pmbox = phba->sli.mbox_active;
2535         MAILBOX_t *mb = &pmbox->mb;
2536         struct lpfc_sli *psli = &phba->sli;
2537         struct lpfc_sli_ring *pring;
2538
2539         if (!(phba->pport->work_port_events & WORKER_MBOX_TMO)) {
2540                 return;
2541         }
2542
2543         /* Mbox cmd <mbxCommand> timeout */
2544         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
2545                         "0310 Mailbox command x%x timeout Data: x%x x%x x%p\n",
2546                         mb->mbxCommand,
2547                         phba->pport->port_state,
2548                         phba->sli.sli_flag,
2549                         phba->sli.mbox_active);
2550
2551         /* Setting state unknown so lpfc_sli_abort_iocb_ring
2552          * would get IOCB_ERROR from lpfc_sli_issue_iocb, allowing
2553          * it to fail all oustanding SCSI IO.
2554          */
2555         spin_lock_irq(&phba->pport->work_port_lock);
2556         phba->pport->work_port_events &= ~WORKER_MBOX_TMO;
2557         spin_unlock_irq(&phba->pport->work_port_lock);
2558         spin_lock_irq(&phba->hbalock);
2559         phba->link_state = LPFC_LINK_UNKNOWN;
2560         phba->pport->fc_flag |= FC_ESTABLISH_LINK;
2561         psli->sli_flag &= ~LPFC_SLI2_ACTIVE;
2562         spin_unlock_irq(&phba->hbalock);
2563
2564         pring = &psli->ring[psli->fcp_ring];
2565         lpfc_sli_abort_iocb_ring(phba, pring);
2566
2567         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
2568                         "0345 Resetting board due to mailbox timeout\n");
2569         /*
2570          * lpfc_offline calls lpfc_sli_hba_down which will clean up
2571          * on oustanding mailbox commands.
2572          */
2573         /* If resets are disabled then set error state and return. */
2574         if (!phba->cfg_enable_hba_reset) {
2575                 phba->link_state = LPFC_HBA_ERROR;
2576                 return;
2577         }
2578         lpfc_offline_prep(phba);
2579         lpfc_offline(phba);
2580         lpfc_sli_brdrestart(phba);
2581         if (lpfc_online(phba) == 0)             /* Initialize the HBA */
2582                 mod_timer(&phba->fc_estabtmo, jiffies + HZ * 60);
2583         lpfc_unblock_mgmt_io(phba);
2584         return;
2585 }
2586
2587 int
2588 lpfc_sli_issue_mbox(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmbox, uint32_t flag)
2589 {
2590         MAILBOX_t *mb;
2591         struct lpfc_sli *psli = &phba->sli;
2592         uint32_t status, evtctr;
2593         uint32_t ha_copy;
2594         int i;
2595         unsigned long timeout;
2596         unsigned long drvr_flag = 0;
2597         volatile uint32_t word0, ldata;
2598         void __iomem *to_slim;
2599
2600         if (pmbox->mbox_cmpl && pmbox->mbox_cmpl != lpfc_sli_def_mbox_cmpl &&
2601                 pmbox->mbox_cmpl != lpfc_sli_wake_mbox_wait) {
2602                 if(!pmbox->vport) {
2603                         lpfc_printf_log(phba, KERN_ERR,
2604                                         LOG_MBOX | LOG_VPORT,
2605                                         "1806 Mbox x%x failed. No vport\n",
2606                                         pmbox->mb.mbxCommand);
2607                         dump_stack();
2608                         return MBX_NOT_FINISHED;
2609                 }
2610         }
2611
2612
2613         /* If the PCI channel is in offline state, do not post mbox. */
2614         if (unlikely(pci_channel_offline(phba->pcidev)))
2615                 return MBX_NOT_FINISHED;
2616
2617         spin_lock_irqsave(&phba->hbalock, drvr_flag);
2618         psli = &phba->sli;
2619
2620
2621         mb = &pmbox->mb;
2622         status = MBX_SUCCESS;
2623
2624         if (phba->link_state == LPFC_HBA_ERROR) {
2625                 spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2626
2627                 /* Mbox command <mbxCommand> cannot issue */
2628                 LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag)
2629                 return MBX_NOT_FINISHED;
2630         }
2631
2632         if (mb->mbxCommand != MBX_KILL_BOARD && flag & MBX_NOWAIT &&
2633             !(readl(phba->HCregaddr) & HC_MBINT_ENA)) {
2634                 spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2635                 LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag)
2636                 return MBX_NOT_FINISHED;
2637         }
2638
2639         if (psli->sli_flag & LPFC_SLI_MBOX_ACTIVE) {
2640                 /* Polling for a mbox command when another one is already active
2641                  * is not allowed in SLI. Also, the driver must have established
2642                  * SLI2 mode to queue and process multiple mbox commands.
2643                  */
2644
2645                 if (flag & MBX_POLL) {
2646                         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2647
2648                         /* Mbox command <mbxCommand> cannot issue */
2649                         LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
2650                         return MBX_NOT_FINISHED;
2651                 }
2652
2653                 if (!(psli->sli_flag & LPFC_SLI2_ACTIVE)) {
2654                         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2655                         /* Mbox command <mbxCommand> cannot issue */
2656                         LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
2657                         return MBX_NOT_FINISHED;
2658                 }
2659
2660                 /* Another mailbox command is still being processed, queue this
2661                  * command to be processed later.
2662                  */
2663                 lpfc_mbox_put(phba, pmbox);
2664
2665                 /* Mbox cmd issue - BUSY */
2666                 lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
2667                                 "(%d):0308 Mbox cmd issue - BUSY Data: "
2668                                 "x%x x%x x%x x%x\n",
2669                                 pmbox->vport ? pmbox->vport->vpi : 0xffffff,
2670                                 mb->mbxCommand, phba->pport->port_state,
2671                                 psli->sli_flag, flag);
2672
2673                 psli->slistat.mbox_busy++;
2674                 spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2675
2676                 if (pmbox->vport) {
2677                         lpfc_debugfs_disc_trc(pmbox->vport,
2678                                 LPFC_DISC_TRC_MBOX_VPORT,
2679                                 "MBOX Bsy vport:  cmd:x%x mb:x%x x%x",
2680                                 (uint32_t)mb->mbxCommand,
2681                                 mb->un.varWords[0], mb->un.varWords[1]);
2682                 }
2683                 else {
2684                         lpfc_debugfs_disc_trc(phba->pport,
2685                                 LPFC_DISC_TRC_MBOX,
2686                                 "MBOX Bsy:        cmd:x%x mb:x%x x%x",
2687                                 (uint32_t)mb->mbxCommand,
2688                                 mb->un.varWords[0], mb->un.varWords[1]);
2689                 }
2690
2691                 return MBX_BUSY;
2692         }
2693
2694         psli->sli_flag |= LPFC_SLI_MBOX_ACTIVE;
2695
2696         /* If we are not polling, we MUST be in SLI2 mode */
2697         if (flag != MBX_POLL) {
2698                 if (!(psli->sli_flag & LPFC_SLI2_ACTIVE) &&
2699                     (mb->mbxCommand != MBX_KILL_BOARD)) {
2700                         psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
2701                         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2702                         /* Mbox command <mbxCommand> cannot issue */
2703                         LOG_MBOX_CANNOT_ISSUE_DATA(phba, pmbox, psli, flag);
2704                         return MBX_NOT_FINISHED;
2705                 }
2706                 /* timeout active mbox command */
2707                 mod_timer(&psli->mbox_tmo, (jiffies +
2708                                (HZ * lpfc_mbox_tmo_val(phba, mb->mbxCommand))));
2709         }
2710
2711         /* Mailbox cmd <cmd> issue */
2712         lpfc_printf_log(phba, KERN_INFO, LOG_MBOX | LOG_SLI,
2713                         "(%d):0309 Mailbox cmd x%x issue Data: x%x x%x "
2714                         "x%x\n",
2715                         pmbox->vport ? pmbox->vport->vpi : 0,
2716                         mb->mbxCommand, phba->pport->port_state,
2717                         psli->sli_flag, flag);
2718
2719         if (mb->mbxCommand != MBX_HEARTBEAT) {
2720                 if (pmbox->vport) {
2721                         lpfc_debugfs_disc_trc(pmbox->vport,
2722                                 LPFC_DISC_TRC_MBOX_VPORT,
2723                                 "MBOX Send vport: cmd:x%x mb:x%x x%x",
2724                                 (uint32_t)mb->mbxCommand,
2725                                 mb->un.varWords[0], mb->un.varWords[1]);
2726                 }
2727                 else {
2728                         lpfc_debugfs_disc_trc(phba->pport,
2729                                 LPFC_DISC_TRC_MBOX,
2730                                 "MBOX Send:       cmd:x%x mb:x%x x%x",
2731                                 (uint32_t)mb->mbxCommand,
2732                                 mb->un.varWords[0], mb->un.varWords[1]);
2733                 }
2734         }
2735
2736         psli->slistat.mbox_cmd++;
2737         evtctr = psli->slistat.mbox_event;
2738
2739         /* next set own bit for the adapter and copy over command word */
2740         mb->mbxOwner = OWN_CHIP;
2741
2742         if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
2743                 /* First copy command data to host SLIM area */
2744                 lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx, MAILBOX_CMD_SIZE);
2745         } else {
2746                 if (mb->mbxCommand == MBX_CONFIG_PORT) {
2747                         /* copy command data into host mbox for cmpl */
2748                         lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx,
2749                                               MAILBOX_CMD_SIZE);
2750                 }
2751
2752                 /* First copy mbox command data to HBA SLIM, skip past first
2753                    word */
2754                 to_slim = phba->MBslimaddr + sizeof (uint32_t);
2755                 lpfc_memcpy_to_slim(to_slim, &mb->un.varWords[0],
2756                             MAILBOX_CMD_SIZE - sizeof (uint32_t));
2757
2758                 /* Next copy over first word, with mbxOwner set */
2759                 ldata = *((volatile uint32_t *)mb);
2760                 to_slim = phba->MBslimaddr;
2761                 writel(ldata, to_slim);
2762                 readl(to_slim); /* flush */
2763
2764                 if (mb->mbxCommand == MBX_CONFIG_PORT) {
2765                         /* switch over to host mailbox */
2766                         psli->sli_flag |= LPFC_SLI2_ACTIVE;
2767                 }
2768         }
2769
2770         wmb();
2771
2772         switch (flag) {
2773         case MBX_NOWAIT:
2774                 /* Set up reference to mailbox command */
2775                 psli->mbox_active = pmbox;
2776                 /* Interrupt board to do it */
2777                 writel(CA_MBATT, phba->CAregaddr);
2778                 readl(phba->CAregaddr); /* flush */
2779                 /* Don't wait for it to finish, just return */
2780                 break;
2781
2782         case MBX_POLL:
2783                 /* Set up null reference to mailbox command */
2784                 psli->mbox_active = NULL;
2785                 /* Interrupt board to do it */
2786                 writel(CA_MBATT, phba->CAregaddr);
2787                 readl(phba->CAregaddr); /* flush */
2788
2789                 if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
2790                         /* First read mbox status word */
2791                         word0 = *((volatile uint32_t *)&phba->slim2p->mbx);
2792                         word0 = le32_to_cpu(word0);
2793                 } else {
2794                         /* First read mbox status word */
2795                         word0 = readl(phba->MBslimaddr);
2796                 }
2797
2798                 /* Read the HBA Host Attention Register */
2799                 ha_copy = readl(phba->HAregaddr);
2800                 timeout = msecs_to_jiffies(lpfc_mbox_tmo_val(phba,
2801                                                              mb->mbxCommand) *
2802                                            1000) + jiffies;
2803                 i = 0;
2804                 /* Wait for command to complete */
2805                 while (((word0 & OWN_CHIP) == OWN_CHIP) ||
2806                        (!(ha_copy & HA_MBATT) &&
2807                         (phba->link_state > LPFC_WARM_START))) {
2808                         if (time_after(jiffies, timeout)) {
2809                                 psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
2810                                 spin_unlock_irqrestore(&phba->hbalock,
2811                                                        drvr_flag);
2812                                 return MBX_NOT_FINISHED;
2813                         }
2814
2815                         /* Check if we took a mbox interrupt while we were
2816                            polling */
2817                         if (((word0 & OWN_CHIP) != OWN_CHIP)
2818                             && (evtctr != psli->slistat.mbox_event))
2819                                 break;
2820
2821                         if (i++ > 10) {
2822                                 spin_unlock_irqrestore(&phba->hbalock,
2823                                                        drvr_flag);
2824                                 msleep(1);
2825                                 spin_lock_irqsave(&phba->hbalock, drvr_flag);
2826                         }
2827
2828                         if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
2829                                 /* First copy command data */
2830                                 word0 = *((volatile uint32_t *)
2831                                                 &phba->slim2p->mbx);
2832                                 word0 = le32_to_cpu(word0);
2833                                 if (mb->mbxCommand == MBX_CONFIG_PORT) {
2834                                         MAILBOX_t *slimmb;
2835                                         volatile uint32_t slimword0;
2836                                         /* Check real SLIM for any errors */
2837                                         slimword0 = readl(phba->MBslimaddr);
2838                                         slimmb = (MAILBOX_t *) & slimword0;
2839                                         if (((slimword0 & OWN_CHIP) != OWN_CHIP)
2840                                             && slimmb->mbxStatus) {
2841                                                 psli->sli_flag &=
2842                                                     ~LPFC_SLI2_ACTIVE;
2843                                                 word0 = slimword0;
2844                                         }
2845                                 }
2846                         } else {
2847                                 /* First copy command data */
2848                                 word0 = readl(phba->MBslimaddr);
2849                         }
2850                         /* Read the HBA Host Attention Register */
2851                         ha_copy = readl(phba->HAregaddr);
2852                 }
2853
2854                 if (psli->sli_flag & LPFC_SLI2_ACTIVE) {
2855                         /* copy results back to user */
2856                         lpfc_sli_pcimem_bcopy(&phba->slim2p->mbx, mb,
2857                                               MAILBOX_CMD_SIZE);
2858                 } else {
2859                         /* First copy command data */
2860                         lpfc_memcpy_from_slim(mb, phba->MBslimaddr,
2861                                                         MAILBOX_CMD_SIZE);
2862                         if ((mb->mbxCommand == MBX_DUMP_MEMORY) &&
2863                                 pmbox->context2) {
2864                                 lpfc_memcpy_from_slim((void *)pmbox->context2,
2865                                       phba->MBslimaddr + DMP_RSP_OFFSET,
2866                                                       mb->un.varDmp.word_cnt);
2867                         }
2868                 }
2869
2870                 writel(HA_MBATT, phba->HAregaddr);
2871                 readl(phba->HAregaddr); /* flush */
2872
2873                 psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
2874                 status = mb->mbxStatus;
2875         }
2876
2877         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
2878         return status;
2879 }
2880
2881 /*
2882  * Caller needs to hold lock.
2883  */
2884 static void
2885 __lpfc_sli_ringtx_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
2886                     struct lpfc_iocbq *piocb)
2887 {
2888         /* Insert the caller's iocb in the txq tail for later processing. */
2889         list_add_tail(&piocb->list, &pring->txq);
2890         pring->txq_cnt++;
2891 }
2892
2893 static struct lpfc_iocbq *
2894 lpfc_sli_next_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
2895                    struct lpfc_iocbq **piocb)
2896 {
2897         struct lpfc_iocbq * nextiocb;
2898
2899         nextiocb = lpfc_sli_ringtx_get(phba, pring);
2900         if (!nextiocb) {
2901                 nextiocb = *piocb;
2902                 *piocb = NULL;
2903         }
2904
2905         return nextiocb;
2906 }
2907
2908 /*
2909  * Lockless version of lpfc_sli_issue_iocb.
2910  */
2911 static int
2912 __lpfc_sli_issue_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
2913                     struct lpfc_iocbq *piocb, uint32_t flag)
2914 {
2915         struct lpfc_iocbq *nextiocb;
2916         IOCB_t *iocb;
2917
2918         if (piocb->iocb_cmpl && (!piocb->vport) &&
2919            (piocb->iocb.ulpCommand != CMD_ABORT_XRI_CN) &&
2920            (piocb->iocb.ulpCommand != CMD_CLOSE_XRI_CN)) {
2921                 lpfc_printf_log(phba, KERN_ERR,
2922                                 LOG_SLI | LOG_VPORT,
2923                                 "1807 IOCB x%x failed. No vport\n",
2924                                 piocb->iocb.ulpCommand);
2925                 dump_stack();
2926                 return IOCB_ERROR;
2927         }
2928
2929
2930         /* If the PCI channel is in offline state, do not post iocbs. */
2931         if (unlikely(pci_channel_offline(phba->pcidev)))
2932                 return IOCB_ERROR;
2933
2934         /*
2935          * We should never get an IOCB if we are in a < LINK_DOWN state
2936          */
2937         if (unlikely(phba->link_state < LPFC_LINK_DOWN))
2938                 return IOCB_ERROR;
2939
2940         /*
2941          * Check to see if we are blocking IOCB processing because of a
2942          * outstanding event.
2943          */
2944         if (unlikely(pring->flag & LPFC_STOP_IOCB_EVENT))
2945                 goto iocb_busy;
2946
2947         if (unlikely(phba->link_state == LPFC_LINK_DOWN)) {
2948                 /*
2949                  * Only CREATE_XRI, CLOSE_XRI, and QUE_RING_BUF
2950                  * can be issued if the link is not up.
2951                  */
2952                 switch (piocb->iocb.ulpCommand) {
2953                 case CMD_QUE_RING_BUF_CN:
2954                 case CMD_QUE_RING_BUF64_CN:
2955                         /*
2956                          * For IOCBs, like QUE_RING_BUF, that have no rsp ring
2957                          * completion, iocb_cmpl MUST be 0.
2958                          */
2959                         if (piocb->iocb_cmpl)
2960                                 piocb->iocb_cmpl = NULL;
2961                         /*FALLTHROUGH*/
2962                 case CMD_CREATE_XRI_CR:
2963                 case CMD_CLOSE_XRI_CN:
2964                 case CMD_CLOSE_XRI_CX:
2965                         break;
2966                 default:
2967                         goto iocb_busy;
2968                 }
2969
2970         /*
2971          * For FCP commands, we must be in a state where we can process link
2972          * attention events.
2973          */
2974         } else if (unlikely(pring->ringno == phba->sli.fcp_ring &&
2975                             !(phba->sli.sli_flag & LPFC_PROCESS_LA))) {
2976                 goto iocb_busy;
2977         }
2978
2979         while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) &&
2980                (nextiocb = lpfc_sli_next_iocb(phba, pring, &piocb)))
2981                 lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb);
2982
2983         if (iocb)
2984                 lpfc_sli_update_ring(phba, pring);
2985         else
2986                 lpfc_sli_update_full_ring(phba, pring);
2987
2988         if (!piocb)
2989                 return IOCB_SUCCESS;
2990
2991         goto out_busy;
2992
2993  iocb_busy:
2994         pring->stats.iocb_cmd_delay++;
2995
2996  out_busy:
2997
2998         if (!(flag & SLI_IOCB_RET_IOCB)) {
2999                 __lpfc_sli_ringtx_put(phba, pring, piocb);
3000                 return IOCB_SUCCESS;
3001         }
3002
3003         return IOCB_BUSY;
3004 }
3005
3006
3007 int
3008 lpfc_sli_issue_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3009                     struct lpfc_iocbq *piocb, uint32_t flag)
3010 {
3011         unsigned long iflags;
3012         int rc;
3013
3014         spin_lock_irqsave(&phba->hbalock, iflags);
3015         rc = __lpfc_sli_issue_iocb(phba, pring, piocb, flag);
3016         spin_unlock_irqrestore(&phba->hbalock, iflags);
3017
3018         return rc;
3019 }
3020
3021 static int
3022 lpfc_extra_ring_setup( struct lpfc_hba *phba)
3023 {
3024         struct lpfc_sli *psli;
3025         struct lpfc_sli_ring *pring;
3026
3027         psli = &phba->sli;
3028
3029         /* Adjust cmd/rsp ring iocb entries more evenly */
3030
3031         /* Take some away from the FCP ring */
3032         pring = &psli->ring[psli->fcp_ring];
3033         pring->numCiocb -= SLI2_IOCB_CMD_R1XTRA_ENTRIES;
3034         pring->numRiocb -= SLI2_IOCB_RSP_R1XTRA_ENTRIES;
3035         pring->numCiocb -= SLI2_IOCB_CMD_R3XTRA_ENTRIES;
3036         pring->numRiocb -= SLI2_IOCB_RSP_R3XTRA_ENTRIES;
3037
3038         /* and give them to the extra ring */
3039         pring = &psli->ring[psli->extra_ring];
3040
3041         pring->numCiocb += SLI2_IOCB_CMD_R1XTRA_ENTRIES;
3042         pring->numRiocb += SLI2_IOCB_RSP_R1XTRA_ENTRIES;
3043         pring->numCiocb += SLI2_IOCB_CMD_R3XTRA_ENTRIES;
3044         pring->numRiocb += SLI2_IOCB_RSP_R3XTRA_ENTRIES;
3045
3046         /* Setup default profile for this ring */
3047         pring->iotag_max = 4096;
3048         pring->num_mask = 1;
3049         pring->prt[0].profile = 0;      /* Mask 0 */
3050         pring->prt[0].rctl = phba->cfg_multi_ring_rctl;
3051         pring->prt[0].type = phba->cfg_multi_ring_type;
3052         pring->prt[0].lpfc_sli_rcv_unsol_event = NULL;
3053         return 0;
3054 }
3055
3056 static void
3057 lpfc_sli_async_event_handler(struct lpfc_hba * phba,
3058         struct lpfc_sli_ring * pring, struct lpfc_iocbq * iocbq)
3059 {
3060         IOCB_t *icmd;
3061         uint16_t evt_code;
3062         uint16_t temp;
3063         struct temp_event temp_event_data;
3064         struct Scsi_Host *shost;
3065
3066         icmd = &iocbq->iocb;
3067         evt_code = icmd->un.asyncstat.evt_code;
3068         temp = icmd->ulpContext;
3069
3070         if ((evt_code != ASYNC_TEMP_WARN) &&
3071                 (evt_code != ASYNC_TEMP_SAFE)) {
3072                 lpfc_printf_log(phba,
3073                         KERN_ERR,
3074                         LOG_SLI,
3075                         "0346 Ring %d handler: unexpected ASYNC_STATUS"
3076                         " evt_code 0x%x\n",
3077                         pring->ringno,
3078                         icmd->un.asyncstat.evt_code);
3079                 return;
3080         }
3081         temp_event_data.data = (uint32_t)temp;
3082         temp_event_data.event_type = FC_REG_TEMPERATURE_EVENT;
3083         if (evt_code == ASYNC_TEMP_WARN) {
3084                 temp_event_data.event_code = LPFC_THRESHOLD_TEMP;
3085                 lpfc_printf_log(phba,
3086                                 KERN_ERR,
3087                                 LOG_TEMP,
3088                                 "0347 Adapter is very hot, please take "
3089                                 "corrective action. temperature : %d Celsius\n",
3090                                 temp);
3091         }
3092         if (evt_code == ASYNC_TEMP_SAFE) {
3093                 temp_event_data.event_code = LPFC_NORMAL_TEMP;
3094                 lpfc_printf_log(phba,
3095                                 KERN_ERR,
3096                                 LOG_TEMP,
3097                                 "0340 Adapter temperature is OK now. "
3098                                 "temperature : %d Celsius\n",
3099                                 temp);
3100         }
3101
3102         /* Send temperature change event to applications */
3103         shost = lpfc_shost_from_vport(phba->pport);
3104         fc_host_post_vendor_event(shost, fc_get_event_number(),
3105                 sizeof(temp_event_data), (char *) &temp_event_data,
3106                 SCSI_NL_VID_TYPE_PCI | PCI_VENDOR_ID_EMULEX);
3107
3108 }
3109
3110
3111 int
3112 lpfc_sli_setup(struct lpfc_hba *phba)
3113 {
3114         int i, totiocbsize = 0;
3115         struct lpfc_sli *psli = &phba->sli;
3116         struct lpfc_sli_ring *pring;
3117
3118         psli->num_rings = MAX_CONFIGURED_RINGS;
3119         psli->sli_flag = 0;
3120         psli->fcp_ring = LPFC_FCP_RING;
3121         psli->next_ring = LPFC_FCP_NEXT_RING;
3122         psli->extra_ring = LPFC_EXTRA_RING;
3123
3124         psli->iocbq_lookup = NULL;
3125         psli->iocbq_lookup_len = 0;
3126         psli->last_iotag = 0;
3127
3128         for (i = 0; i < psli->num_rings; i++) {
3129                 pring = &psli->ring[i];
3130                 switch (i) {
3131                 case LPFC_FCP_RING:     /* ring 0 - FCP */
3132                         /* numCiocb and numRiocb are used in config_port */
3133                         pring->numCiocb = SLI2_IOCB_CMD_R0_ENTRIES;
3134                         pring->numRiocb = SLI2_IOCB_RSP_R0_ENTRIES;
3135                         pring->numCiocb += SLI2_IOCB_CMD_R1XTRA_ENTRIES;
3136                         pring->numRiocb += SLI2_IOCB_RSP_R1XTRA_ENTRIES;
3137                         pring->numCiocb += SLI2_IOCB_CMD_R3XTRA_ENTRIES;
3138                         pring->numRiocb += SLI2_IOCB_RSP_R3XTRA_ENTRIES;
3139                         pring->sizeCiocb = (phba->sli_rev == 3) ?
3140                                                         SLI3_IOCB_CMD_SIZE :
3141                                                         SLI2_IOCB_CMD_SIZE;
3142                         pring->sizeRiocb = (phba->sli_rev == 3) ?
3143                                                         SLI3_IOCB_RSP_SIZE :
3144                                                         SLI2_IOCB_RSP_SIZE;
3145                         pring->iotag_ctr = 0;
3146                         pring->iotag_max =
3147                             (phba->cfg_hba_queue_depth * 2);
3148                         pring->fast_iotag = pring->iotag_max;
3149                         pring->num_mask = 0;
3150                         break;
3151                 case LPFC_EXTRA_RING:   /* ring 1 - EXTRA */
3152                         /* numCiocb and numRiocb are used in config_port */
3153                         pring->numCiocb = SLI2_IOCB_CMD_R1_ENTRIES;
3154                         pring->numRiocb = SLI2_IOCB_RSP_R1_ENTRIES;
3155                         pring->sizeCiocb = (phba->sli_rev == 3) ?
3156                                                         SLI3_IOCB_CMD_SIZE :
3157                                                         SLI2_IOCB_CMD_SIZE;
3158                         pring->sizeRiocb = (phba->sli_rev == 3) ?
3159                                                         SLI3_IOCB_RSP_SIZE :
3160                                                         SLI2_IOCB_RSP_SIZE;
3161                         pring->iotag_max = phba->cfg_hba_queue_depth;
3162                         pring->num_mask = 0;
3163                         break;
3164                 case LPFC_ELS_RING:     /* ring 2 - ELS / CT */
3165                         /* numCiocb and numRiocb are used in config_port */
3166                         pring->numCiocb = SLI2_IOCB_CMD_R2_ENTRIES;
3167                         pring->numRiocb = SLI2_IOCB_RSP_R2_ENTRIES;
3168                         pring->sizeCiocb = (phba->sli_rev == 3) ?
3169                                                         SLI3_IOCB_CMD_SIZE :
3170                                                         SLI2_IOCB_CMD_SIZE;
3171                         pring->sizeRiocb = (phba->sli_rev == 3) ?
3172                                                         SLI3_IOCB_RSP_SIZE :
3173                                                         SLI2_IOCB_RSP_SIZE;
3174                         pring->fast_iotag = 0;
3175                         pring->iotag_ctr = 0;
3176                         pring->iotag_max = 4096;
3177                         pring->lpfc_sli_rcv_async_status =
3178                                 lpfc_sli_async_event_handler;
3179                         pring->num_mask = 4;
3180                         pring->prt[0].profile = 0;      /* Mask 0 */
3181                         pring->prt[0].rctl = FC_ELS_REQ;
3182                         pring->prt[0].type = FC_ELS_DATA;
3183                         pring->prt[0].lpfc_sli_rcv_unsol_event =
3184                             lpfc_els_unsol_event;
3185                         pring->prt[1].profile = 0;      /* Mask 1 */
3186                         pring->prt[1].rctl = FC_ELS_RSP;
3187                         pring->prt[1].type = FC_ELS_DATA;
3188                         pring->prt[1].lpfc_sli_rcv_unsol_event =
3189                             lpfc_els_unsol_event;
3190                         pring->prt[2].profile = 0;      /* Mask 2 */
3191                         /* NameServer Inquiry */
3192                         pring->prt[2].rctl = FC_UNSOL_CTL;
3193                         /* NameServer */
3194                         pring->prt[2].type = FC_COMMON_TRANSPORT_ULP;
3195                         pring->prt[2].lpfc_sli_rcv_unsol_event =
3196                             lpfc_ct_unsol_event;
3197                         pring->prt[3].profile = 0;      /* Mask 3 */
3198                         /* NameServer response */
3199                         pring->prt[3].rctl = FC_SOL_CTL;
3200                         /* NameServer */
3201                         pring->prt[3].type = FC_COMMON_TRANSPORT_ULP;
3202                         pring->prt[3].lpfc_sli_rcv_unsol_event =
3203                             lpfc_ct_unsol_event;
3204                         break;
3205                 }
3206                 totiocbsize += (pring->numCiocb * pring->sizeCiocb) +
3207                                 (pring->numRiocb * pring->sizeRiocb);
3208         }
3209         if (totiocbsize > MAX_SLIM_IOCB_SIZE) {
3210                 /* Too many cmd / rsp ring entries in SLI2 SLIM */
3211                 printk(KERN_ERR "%d:0462 Too many cmd / rsp ring entries in "
3212                        "SLI2 SLIM Data: x%x x%lx\n",
3213                        phba->brd_no, totiocbsize,
3214                        (unsigned long) MAX_SLIM_IOCB_SIZE);
3215         }
3216         if (phba->cfg_multi_ring_support == 2)
3217                 lpfc_extra_ring_setup(phba);
3218
3219         return 0;
3220 }
3221
3222 int
3223 lpfc_sli_queue_setup(struct lpfc_hba *phba)
3224 {
3225         struct lpfc_sli *psli;
3226         struct lpfc_sli_ring *pring;
3227         int i;
3228
3229         psli = &phba->sli;
3230         spin_lock_irq(&phba->hbalock);
3231         INIT_LIST_HEAD(&psli->mboxq);
3232         INIT_LIST_HEAD(&psli->mboxq_cmpl);
3233         /* Initialize list headers for txq and txcmplq as double linked lists */
3234         for (i = 0; i < psli->num_rings; i++) {
3235                 pring = &psli->ring[i];
3236                 pring->ringno = i;
3237                 pring->next_cmdidx  = 0;
3238                 pring->local_getidx = 0;
3239                 pring->cmdidx = 0;
3240                 INIT_LIST_HEAD(&pring->txq);
3241                 INIT_LIST_HEAD(&pring->txcmplq);
3242                 INIT_LIST_HEAD(&pring->iocb_continueq);
3243                 INIT_LIST_HEAD(&pring->iocb_continue_saveq);
3244                 INIT_LIST_HEAD(&pring->postbufq);
3245         }
3246         spin_unlock_irq(&phba->hbalock);
3247         return 1;
3248 }
3249
3250 int
3251 lpfc_sli_host_down(struct lpfc_vport *vport)
3252 {
3253         LIST_HEAD(completions);
3254         struct lpfc_hba *phba = vport->phba;
3255         struct lpfc_sli *psli = &phba->sli;
3256         struct lpfc_sli_ring *pring;
3257         struct lpfc_iocbq *iocb, *next_iocb;
3258         int i;
3259         unsigned long flags = 0;
3260         uint16_t prev_pring_flag;
3261
3262         lpfc_cleanup_discovery_resources(vport);
3263
3264         spin_lock_irqsave(&phba->hbalock, flags);
3265         for (i = 0; i < psli->num_rings; i++) {
3266                 pring = &psli->ring[i];
3267                 prev_pring_flag = pring->flag;
3268                 if (pring->ringno == LPFC_ELS_RING) /* Only slow rings */
3269                         pring->flag |= LPFC_DEFERRED_RING_EVENT;
3270                 /*
3271                  * Error everything on the txq since these iocbs have not been
3272                  * given to the FW yet.
3273                  */
3274                 list_for_each_entry_safe(iocb, next_iocb, &pring->txq, list) {
3275                         if (iocb->vport != vport)
3276                                 continue;
3277                         list_move_tail(&iocb->list, &completions);
3278                         pring->txq_cnt--;
3279                 }
3280
3281                 /* Next issue ABTS for everything on the txcmplq */
3282                 list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq,
3283                                                                         list) {
3284                         if (iocb->vport != vport)
3285                                 continue;
3286                         lpfc_sli_issue_abort_iotag(phba, pring, iocb);
3287                 }
3288
3289                 pring->flag = prev_pring_flag;
3290         }
3291
3292         spin_unlock_irqrestore(&phba->hbalock, flags);
3293
3294         while (!list_empty(&completions)) {
3295                 list_remove_head(&completions, iocb, struct lpfc_iocbq, list);
3296
3297                 if (!iocb->iocb_cmpl)
3298                         lpfc_sli_release_iocbq(phba, iocb);
3299                 else {
3300                         iocb->iocb.ulpStatus = IOSTAT_LOCAL_REJECT;
3301                         iocb->iocb.un.ulpWord[4] = IOERR_SLI_DOWN;
3302                         (iocb->iocb_cmpl) (phba, iocb, iocb);
3303                 }
3304         }
3305         return 1;
3306 }
3307
3308 int
3309 lpfc_sli_hba_down(struct lpfc_hba *phba)
3310 {
3311         LIST_HEAD(completions);
3312         struct lpfc_sli *psli = &phba->sli;
3313         struct lpfc_sli_ring *pring;
3314         struct lpfc_dmabuf *buf_ptr;
3315         LPFC_MBOXQ_t *pmb;
3316         struct lpfc_iocbq *iocb;
3317         IOCB_t *cmd = NULL;
3318         int i;
3319         unsigned long flags = 0;
3320
3321         lpfc_hba_down_prep(phba);
3322
3323         lpfc_fabric_abort_hba(phba);
3324
3325         spin_lock_irqsave(&phba->hbalock, flags);
3326         for (i = 0; i < psli->num_rings; i++) {
3327                 pring = &psli->ring[i];
3328                 if (pring->ringno == LPFC_ELS_RING) /* Only slow rings */
3329                         pring->flag |= LPFC_DEFERRED_RING_EVENT;
3330
3331                 /*
3332                  * Error everything on the txq since these iocbs have not been
3333                  * given to the FW yet.
3334                  */
3335                 list_splice_init(&pring->txq, &completions);
3336                 pring->txq_cnt = 0;
3337
3338         }
3339         spin_unlock_irqrestore(&phba->hbalock, flags);
3340
3341         while (!list_empty(&completions)) {
3342                 list_remove_head(&completions, iocb, struct lpfc_iocbq, list);
3343                 cmd = &iocb->iocb;
3344
3345                 if (!iocb->iocb_cmpl)
3346                         lpfc_sli_release_iocbq(phba, iocb);
3347                 else {
3348                         cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
3349                         cmd->un.ulpWord[4] = IOERR_SLI_DOWN;
3350                         (iocb->iocb_cmpl) (phba, iocb, iocb);
3351                 }
3352         }
3353
3354         spin_lock_irqsave(&phba->hbalock, flags);
3355         list_splice_init(&phba->elsbuf, &completions);
3356         phba->elsbuf_cnt = 0;
3357         phba->elsbuf_prev_cnt = 0;
3358         spin_unlock_irqrestore(&phba->hbalock, flags);
3359
3360         while (!list_empty(&completions)) {
3361                 list_remove_head(&completions, buf_ptr,
3362                         struct lpfc_dmabuf, list);
3363                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
3364                 kfree(buf_ptr);
3365         }
3366
3367         /* Return any active mbox cmds */
3368         del_timer_sync(&psli->mbox_tmo);
3369         spin_lock_irqsave(&phba->hbalock, flags);
3370
3371         spin_lock(&phba->pport->work_port_lock);
3372         phba->pport->work_port_events &= ~WORKER_MBOX_TMO;
3373         spin_unlock(&phba->pport->work_port_lock);
3374
3375         if (psli->mbox_active) {
3376                 list_add_tail(&psli->mbox_active->list, &completions);
3377                 psli->mbox_active = NULL;
3378                 psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
3379         }
3380
3381         /* Return any pending or completed mbox cmds */
3382         list_splice_init(&phba->sli.mboxq, &completions);
3383         list_splice_init(&phba->sli.mboxq_cmpl, &completions);
3384         INIT_LIST_HEAD(&psli->mboxq);
3385         INIT_LIST_HEAD(&psli->mboxq_cmpl);
3386
3387         spin_unlock_irqrestore(&phba->hbalock, flags);
3388
3389         while (!list_empty(&completions)) {
3390                 list_remove_head(&completions, pmb, LPFC_MBOXQ_t, list);
3391                 pmb->mb.mbxStatus = MBX_NOT_FINISHED;
3392                 if (pmb->mbox_cmpl) {
3393                         pmb->mbox_cmpl(phba,pmb);
3394                 }
3395         }
3396         return 1;
3397 }
3398
3399 void
3400 lpfc_sli_pcimem_bcopy(void *srcp, void *destp, uint32_t cnt)
3401 {
3402         uint32_t *src = srcp;
3403         uint32_t *dest = destp;
3404         uint32_t ldata;
3405         int i;
3406
3407         for (i = 0; i < (int)cnt; i += sizeof (uint32_t)) {
3408                 ldata = *src;
3409                 ldata = le32_to_cpu(ldata);
3410                 *dest = ldata;
3411                 src++;
3412                 dest++;
3413         }
3414 }
3415
3416 int
3417 lpfc_sli_ringpostbuf_put(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3418                          struct lpfc_dmabuf *mp)
3419 {
3420         /* Stick struct lpfc_dmabuf at end of postbufq so driver can look it up
3421            later */
3422         spin_lock_irq(&phba->hbalock);
3423         list_add_tail(&mp->list, &pring->postbufq);
3424         pring->postbufq_cnt++;
3425         spin_unlock_irq(&phba->hbalock);
3426         return 0;
3427 }
3428
3429 uint32_t
3430 lpfc_sli_get_buffer_tag(struct lpfc_hba *phba)
3431 {
3432         spin_lock_irq(&phba->hbalock);
3433         phba->buffer_tag_count++;
3434         /*
3435          * Always set the QUE_BUFTAG_BIT to distiguish between
3436          * a tag assigned by HBQ.
3437          */
3438         phba->buffer_tag_count |= QUE_BUFTAG_BIT;
3439         spin_unlock_irq(&phba->hbalock);
3440         return phba->buffer_tag_count;
3441 }
3442
3443 struct lpfc_dmabuf *
3444 lpfc_sli_ring_taggedbuf_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3445                         uint32_t tag)
3446 {
3447         struct lpfc_dmabuf *mp, *next_mp;
3448         struct list_head *slp = &pring->postbufq;
3449
3450         /* Search postbufq, from the begining, looking for a match on tag */
3451         spin_lock_irq(&phba->hbalock);
3452         list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) {
3453                 if (mp->buffer_tag == tag) {
3454                         list_del_init(&mp->list);
3455                         pring->postbufq_cnt--;
3456                         spin_unlock_irq(&phba->hbalock);
3457                         return mp;
3458                 }
3459         }
3460
3461         spin_unlock_irq(&phba->hbalock);
3462         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
3463                         "0410 Cannot find virtual addr for buffer tag on "
3464                         "ring %d Data x%lx x%p x%p x%x\n",
3465                         pring->ringno, (unsigned long) tag,
3466                         slp->next, slp->prev, pring->postbufq_cnt);
3467
3468         return NULL;
3469 }
3470
3471 struct lpfc_dmabuf *
3472 lpfc_sli_ringpostbuf_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3473                          dma_addr_t phys)
3474 {
3475         struct lpfc_dmabuf *mp, *next_mp;
3476         struct list_head *slp = &pring->postbufq;
3477
3478         /* Search postbufq, from the begining, looking for a match on phys */
3479         spin_lock_irq(&phba->hbalock);
3480         list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) {
3481                 if (mp->phys == phys) {
3482                         list_del_init(&mp->list);
3483                         pring->postbufq_cnt--;
3484                         spin_unlock_irq(&phba->hbalock);
3485                         return mp;
3486                 }
3487         }
3488
3489         spin_unlock_irq(&phba->hbalock);
3490         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
3491                         "0410 Cannot find virtual addr for mapped buf on "
3492                         "ring %d Data x%llx x%p x%p x%x\n",
3493                         pring->ringno, (unsigned long long)phys,
3494                         slp->next, slp->prev, pring->postbufq_cnt);
3495         return NULL;
3496 }
3497
3498 static void
3499 lpfc_sli_abort_els_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
3500                         struct lpfc_iocbq *rspiocb)
3501 {
3502         IOCB_t *irsp = &rspiocb->iocb;
3503         uint16_t abort_iotag, abort_context;
3504         struct lpfc_iocbq *abort_iocb;
3505         struct lpfc_sli_ring *pring = &phba->sli.ring[LPFC_ELS_RING];
3506
3507         abort_iocb = NULL;
3508
3509         if (irsp->ulpStatus) {
3510                 abort_context = cmdiocb->iocb.un.acxri.abortContextTag;
3511                 abort_iotag = cmdiocb->iocb.un.acxri.abortIoTag;
3512
3513                 spin_lock_irq(&phba->hbalock);
3514                 if (abort_iotag != 0 && abort_iotag <= phba->sli.last_iotag)
3515                         abort_iocb = phba->sli.iocbq_lookup[abort_iotag];
3516
3517                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS | LOG_SLI,
3518                                 "0327 Cannot abort els iocb %p "
3519                                 "with tag %x context %x, abort status %x, "
3520                                 "abort code %x\n",
3521                                 abort_iocb, abort_iotag, abort_context,
3522                                 irsp->ulpStatus, irsp->un.ulpWord[4]);
3523
3524                 /*
3525                  * make sure we have the right iocbq before taking it
3526                  * off the txcmplq and try to call completion routine.
3527                  */
3528                 if (!abort_iocb ||
3529                     abort_iocb->iocb.ulpContext != abort_context ||
3530                     (abort_iocb->iocb_flag & LPFC_DRIVER_ABORTED) == 0)
3531                         spin_unlock_irq(&phba->hbalock);
3532                 else {
3533                         list_del_init(&abort_iocb->list);
3534                         pring->txcmplq_cnt--;
3535                         spin_unlock_irq(&phba->hbalock);
3536
3537                         /* Firmware could still be in progress of DMAing
3538                          * payload, so don't free data buffer till after
3539                          * a hbeat.
3540                          */
3541                         abort_iocb->iocb_flag |= LPFC_DELAY_MEM_FREE;
3542
3543                         abort_iocb->iocb_flag &= ~LPFC_DRIVER_ABORTED;
3544                         abort_iocb->iocb.ulpStatus = IOSTAT_LOCAL_REJECT;
3545                         abort_iocb->iocb.un.ulpWord[4] = IOERR_SLI_ABORTED;
3546                         (abort_iocb->iocb_cmpl)(phba, abort_iocb, abort_iocb);
3547                 }
3548         }
3549
3550         lpfc_sli_release_iocbq(phba, cmdiocb);
3551         return;
3552 }
3553
3554 static void
3555 lpfc_ignore_els_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
3556                      struct lpfc_iocbq *rspiocb)
3557 {
3558         IOCB_t *irsp = &rspiocb->iocb;
3559
3560         /* ELS cmd tag <ulpIoTag> completes */
3561         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3562                         "0133 Ignoring ELS cmd tag x%x completion Data: "
3563                         "x%x x%x x%x\n",
3564                         irsp->ulpIoTag, irsp->ulpStatus,
3565                         irsp->un.ulpWord[4], irsp->ulpTimeout);
3566         if (cmdiocb->iocb.ulpCommand == CMD_GEN_REQUEST64_CR)
3567                 lpfc_ct_free_iocb(phba, cmdiocb);
3568         else
3569                 lpfc_els_free_iocb(phba, cmdiocb);
3570         return;
3571 }
3572
3573 int
3574 lpfc_sli_issue_abort_iotag(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
3575                            struct lpfc_iocbq *cmdiocb)
3576 {
3577         struct lpfc_vport *vport = cmdiocb->vport;
3578         struct lpfc_iocbq *abtsiocbp;
3579         IOCB_t *icmd = NULL;
3580         IOCB_t *iabt = NULL;
3581         int retval = IOCB_ERROR;
3582
3583         /*
3584          * There are certain command types we don't want to abort.  And we
3585          * don't want to abort commands that are already in the process of
3586          * being aborted.
3587          */
3588         icmd = &cmdiocb->iocb;
3589         if (icmd->ulpCommand == CMD_ABORT_XRI_CN ||
3590             icmd->ulpCommand == CMD_CLOSE_XRI_CN ||
3591             (cmdiocb->iocb_flag & LPFC_DRIVER_ABORTED) != 0)
3592                 return 0;
3593
3594         /* If we're unloading, don't abort iocb on the ELS ring, but change the
3595          * callback so that nothing happens when it finishes.
3596          */
3597         if ((vport->load_flag & FC_UNLOADING) &&
3598             (pring->ringno == LPFC_ELS_RING)) {
3599                 if (cmdiocb->iocb_flag & LPFC_IO_FABRIC)
3600                         cmdiocb->fabric_iocb_cmpl = lpfc_ignore_els_cmpl;
3601                 else
3602                         cmdiocb->iocb_cmpl = lpfc_ignore_els_cmpl;
3603                 goto abort_iotag_exit;
3604         }
3605
3606         /* issue ABTS for this IOCB based on iotag */
3607         abtsiocbp = __lpfc_sli_get_iocbq(phba);
3608         if (abtsiocbp == NULL)
3609                 return 0;
3610
3611         /* This signals the response to set the correct status
3612          * before calling the completion handler.
3613          */
3614         cmdiocb->iocb_flag |= LPFC_DRIVER_ABORTED;
3615
3616         iabt = &abtsiocbp->iocb;
3617         iabt->un.acxri.abortType = ABORT_TYPE_ABTS;
3618         iabt->un.acxri.abortContextTag = icmd->ulpContext;
3619         iabt->un.acxri.abortIoTag = icmd->ulpIoTag;
3620         iabt->ulpLe = 1;
3621         iabt->ulpClass = icmd->ulpClass;
3622
3623         if (phba->link_state >= LPFC_LINK_UP)
3624                 iabt->ulpCommand = CMD_ABORT_XRI_CN;
3625         else
3626                 iabt->ulpCommand = CMD_CLOSE_XRI_CN;
3627
3628         abtsiocbp->iocb_cmpl = lpfc_sli_abort_els_cmpl;
3629
3630         lpfc_printf_vlog(vport, KERN_INFO, LOG_SLI,
3631                          "0339 Abort xri x%x, original iotag x%x, "
3632                          "abort cmd iotag x%x\n",
3633                          iabt->un.acxri.abortContextTag,
3634                          iabt->un.acxri.abortIoTag, abtsiocbp->iotag);
3635         retval = __lpfc_sli_issue_iocb(phba, pring, abtsiocbp, 0);
3636
3637 abort_iotag_exit:
3638         /*
3639          * Caller to this routine should check for IOCB_ERROR
3640          * and handle it properly.  This routine no longer removes
3641          * iocb off txcmplq and call compl in case of IOCB_ERROR.
3642          */
3643         return retval;
3644 }
3645
3646 static int
3647 lpfc_sli_validate_fcp_iocb(struct lpfc_iocbq *iocbq, struct lpfc_vport *vport,
3648                            uint16_t tgt_id, uint64_t lun_id,
3649                            lpfc_ctx_cmd ctx_cmd)
3650 {
3651         struct lpfc_scsi_buf *lpfc_cmd;
3652         struct scsi_cmnd *cmnd;
3653         int rc = 1;
3654
3655         if (!(iocbq->iocb_flag &  LPFC_IO_FCP))
3656                 return rc;
3657
3658         if (iocbq->vport != vport)
3659                 return rc;
3660
3661         lpfc_cmd = container_of(iocbq, struct lpfc_scsi_buf, cur_iocbq);
3662         cmnd = lpfc_cmd->pCmd;
3663
3664         if (cmnd == NULL)
3665                 return rc;
3666
3667         switch (ctx_cmd) {
3668         case LPFC_CTX_LUN:
3669                 if ((cmnd->device->id == tgt_id) &&
3670                     (cmnd->device->lun == lun_id))
3671                         rc = 0;
3672                 break;
3673         case LPFC_CTX_TGT:
3674                 if (cmnd->device->id == tgt_id)
3675                         rc = 0;
3676                 break;
3677         case LPFC_CTX_HOST:
3678                 rc = 0;
3679                 break;
3680         default:
3681                 printk(KERN_ERR "%s: Unknown context cmd type, value %d\n",
3682                         __FUNCTION__, ctx_cmd);
3683                 break;
3684         }
3685
3686         return rc;
3687 }
3688
3689 int
3690 lpfc_sli_sum_iocb(struct lpfc_vport *vport, uint16_t tgt_id, uint64_t lun_id,
3691                   lpfc_ctx_cmd ctx_cmd)
3692 {
3693         struct lpfc_hba *phba = vport->phba;
3694         struct lpfc_iocbq *iocbq;
3695         int sum, i;
3696
3697         for (i = 1, sum = 0; i <= phba->sli.last_iotag; i++) {
3698                 iocbq = phba->sli.iocbq_lookup[i];
3699
3700                 if (lpfc_sli_validate_fcp_iocb (iocbq, vport, tgt_id, lun_id,
3701                                                 ctx_cmd) == 0)
3702                         sum++;
3703         }
3704
3705         return sum;
3706 }
3707
3708 void
3709 lpfc_sli_abort_fcp_cmpl(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
3710                         struct lpfc_iocbq *rspiocb)
3711 {
3712         lpfc_sli_release_iocbq(phba, cmdiocb);
3713         return;
3714 }
3715
3716 int
3717 lpfc_sli_abort_iocb(struct lpfc_vport *vport, struct lpfc_sli_ring *pring,
3718                     uint16_t tgt_id, uint64_t lun_id, lpfc_ctx_cmd abort_cmd)
3719 {
3720         struct lpfc_hba *phba = vport->phba;
3721         struct lpfc_iocbq *iocbq;
3722         struct lpfc_iocbq *abtsiocb;
3723         IOCB_t *cmd = NULL;
3724         int errcnt = 0, ret_val = 0;
3725         int i;
3726
3727         for (i = 1; i <= phba->sli.last_iotag; i++) {
3728                 iocbq = phba->sli.iocbq_lookup[i];
3729
3730                 if (lpfc_sli_validate_fcp_iocb(iocbq, vport, tgt_id, lun_id,
3731                                                abort_cmd) != 0)
3732                         continue;
3733
3734                 /* issue ABTS for this IOCB based on iotag */
3735                 abtsiocb = lpfc_sli_get_iocbq(phba);
3736                 if (abtsiocb == NULL) {
3737                         errcnt++;
3738                         continue;
3739                 }
3740
3741                 cmd = &iocbq->iocb;
3742                 abtsiocb->iocb.un.acxri.abortType = ABORT_TYPE_ABTS;
3743                 abtsiocb->iocb.un.acxri.abortContextTag = cmd->ulpContext;
3744                 abtsiocb->iocb.un.acxri.abortIoTag = cmd->ulpIoTag;
3745                 abtsiocb->iocb.ulpLe = 1;
3746                 abtsiocb->iocb.ulpClass = cmd->ulpClass;
3747                 abtsiocb->vport = phba->pport;
3748
3749                 if (lpfc_is_link_up(phba))
3750                         abtsiocb->iocb.ulpCommand = CMD_ABORT_XRI_CN;
3751                 else
3752                         abtsiocb->iocb.ulpCommand = CMD_CLOSE_XRI_CN;
3753
3754                 /* Setup callback routine and issue the command. */
3755                 abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl;
3756                 ret_val = lpfc_sli_issue_iocb(phba, pring, abtsiocb, 0);
3757                 if (ret_val == IOCB_ERROR) {
3758                         lpfc_sli_release_iocbq(phba, abtsiocb);
3759                         errcnt++;
3760                         continue;
3761                 }
3762         }
3763
3764         return errcnt;
3765 }
3766
3767 static void
3768 lpfc_sli_wake_iocb_wait(struct lpfc_hba *phba,
3769                         struct lpfc_iocbq *cmdiocbq,
3770                         struct lpfc_iocbq *rspiocbq)
3771 {
3772         wait_queue_head_t *pdone_q;
3773         unsigned long iflags;
3774
3775         spin_lock_irqsave(&phba->hbalock, iflags);
3776         cmdiocbq->iocb_flag |= LPFC_IO_WAKE;
3777         if (cmdiocbq->context2 && rspiocbq)
3778                 memcpy(&((struct lpfc_iocbq *)cmdiocbq->context2)->iocb,
3779                        &rspiocbq->iocb, sizeof(IOCB_t));
3780
3781         pdone_q = cmdiocbq->context_un.wait_queue;
3782         if (pdone_q)
3783                 wake_up(pdone_q);
3784         spin_unlock_irqrestore(&phba->hbalock, iflags);
3785         return;
3786 }
3787
3788 /*
3789  * Issue the caller's iocb and wait for its completion, but no longer than the
3790  * caller's timeout.  Note that iocb_flags is cleared before the
3791  * lpfc_sli_issue_call since the wake routine sets a unique value and by
3792  * definition this is a wait function.
3793  */
3794
3795 int
3796 lpfc_sli_issue_iocb_wait(struct lpfc_hba *phba,
3797                          struct lpfc_sli_ring *pring,
3798                          struct lpfc_iocbq *piocb,
3799                          struct lpfc_iocbq *prspiocbq,
3800                          uint32_t timeout)
3801 {
3802         DECLARE_WAIT_QUEUE_HEAD_ONSTACK(done_q);
3803         long timeleft, timeout_req = 0;
3804         int retval = IOCB_SUCCESS;
3805         uint32_t creg_val;
3806
3807         /*
3808          * If the caller has provided a response iocbq buffer, then context2
3809          * is NULL or its an error.
3810          */
3811         if (prspiocbq) {
3812                 if (piocb->context2)
3813                         return IOCB_ERROR;
3814                 piocb->context2 = prspiocbq;
3815         }
3816
3817         piocb->iocb_cmpl = lpfc_sli_wake_iocb_wait;
3818         piocb->context_un.wait_queue = &done_q;
3819         piocb->iocb_flag &= ~LPFC_IO_WAKE;
3820
3821         if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
3822                 creg_val = readl(phba->HCregaddr);
3823                 creg_val |= (HC_R0INT_ENA << LPFC_FCP_RING);
3824                 writel(creg_val, phba->HCregaddr);
3825                 readl(phba->HCregaddr); /* flush */
3826         }
3827
3828         retval = lpfc_sli_issue_iocb(phba, pring, piocb, 0);
3829         if (retval == IOCB_SUCCESS) {
3830                 timeout_req = timeout * HZ;
3831                 timeleft = wait_event_timeout(done_q,
3832                                 piocb->iocb_flag & LPFC_IO_WAKE,
3833                                 timeout_req);
3834
3835                 if (piocb->iocb_flag & LPFC_IO_WAKE) {
3836                         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
3837                                         "0331 IOCB wake signaled\n");
3838                 } else if (timeleft == 0) {
3839                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3840                                         "0338 IOCB wait timeout error - no "
3841                                         "wake response Data x%x\n", timeout);
3842                         retval = IOCB_TIMEDOUT;
3843                 } else {
3844                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3845                                         "0330 IOCB wake NOT set, "
3846                                         "Data x%x x%lx\n",
3847                                         timeout, (timeleft / jiffies));
3848                         retval = IOCB_TIMEDOUT;
3849                 }
3850         } else {
3851                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
3852                                 ":0332 IOCB wait issue failed, Data x%x\n",
3853                                 retval);
3854                 retval = IOCB_ERROR;
3855         }
3856
3857         if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
3858                 creg_val = readl(phba->HCregaddr);
3859                 creg_val &= ~(HC_R0INT_ENA << LPFC_FCP_RING);
3860                 writel(creg_val, phba->HCregaddr);
3861                 readl(phba->HCregaddr); /* flush */
3862         }
3863
3864         if (prspiocbq)
3865                 piocb->context2 = NULL;
3866
3867         piocb->context_un.wait_queue = NULL;
3868         piocb->iocb_cmpl = NULL;
3869         return retval;
3870 }
3871
3872 int
3873 lpfc_sli_issue_mbox_wait(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq,
3874                          uint32_t timeout)
3875 {
3876         DECLARE_WAIT_QUEUE_HEAD_ONSTACK(done_q);
3877         int retval;
3878         unsigned long flag;
3879
3880         /* The caller must leave context1 empty. */
3881         if (pmboxq->context1)
3882                 return MBX_NOT_FINISHED;
3883
3884         /* setup wake call as IOCB callback */
3885         pmboxq->mbox_cmpl = lpfc_sli_wake_mbox_wait;
3886         /* setup context field to pass wait_queue pointer to wake function  */
3887         pmboxq->context1 = &done_q;
3888
3889         /* now issue the command */
3890         retval = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT);
3891
3892         if (retval == MBX_BUSY || retval == MBX_SUCCESS) {
3893                 wait_event_interruptible_timeout(done_q,
3894                                 pmboxq->mbox_flag & LPFC_MBX_WAKE,
3895                                 timeout * HZ);
3896
3897                 spin_lock_irqsave(&phba->hbalock, flag);
3898                 pmboxq->context1 = NULL;
3899                 /*
3900                  * if LPFC_MBX_WAKE flag is set the mailbox is completed
3901                  * else do not free the resources.
3902                  */
3903                 if (pmboxq->mbox_flag & LPFC_MBX_WAKE)
3904                         retval = MBX_SUCCESS;
3905                 else {
3906                         retval = MBX_TIMEOUT;
3907                         pmboxq->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
3908                 }
3909                 spin_unlock_irqrestore(&phba->hbalock, flag);
3910         }
3911
3912         return retval;
3913 }
3914
3915 int
3916 lpfc_sli_flush_mbox_queue(struct lpfc_hba * phba)
3917 {
3918         struct lpfc_vport *vport = phba->pport;
3919         int i = 0;
3920         uint32_t ha_copy;
3921
3922         while (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE && !vport->stopped) {
3923                 if (i++ > LPFC_MBOX_TMO * 1000)
3924                         return 1;
3925
3926                 /*
3927                  * Call lpfc_sli_handle_mb_event only if a mailbox cmd
3928                  * did finish. This way we won't get the misleading
3929                  * "Stray Mailbox Interrupt" message.
3930                  */
3931                 spin_lock_irq(&phba->hbalock);
3932                 ha_copy = phba->work_ha;
3933                 phba->work_ha &= ~HA_MBATT;
3934                 spin_unlock_irq(&phba->hbalock);
3935
3936                 if (ha_copy & HA_MBATT)
3937                         if (lpfc_sli_handle_mb_event(phba) == 0)
3938                                 i = 0;
3939
3940                 msleep(1);
3941         }
3942
3943         return (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE) ? 1 : 0;
3944 }
3945
3946 irqreturn_t
3947 lpfc_intr_handler(int irq, void *dev_id)
3948 {
3949         struct lpfc_hba  *phba;
3950         uint32_t ha_copy;
3951         uint32_t work_ha_copy;
3952         unsigned long status;
3953         uint32_t control;
3954
3955         MAILBOX_t *mbox, *pmbox;
3956         struct lpfc_vport *vport;
3957         struct lpfc_nodelist *ndlp;
3958         struct lpfc_dmabuf *mp;
3959         LPFC_MBOXQ_t *pmb;
3960         int rc;
3961
3962         /*
3963          * Get the driver's phba structure from the dev_id and
3964          * assume the HBA is not interrupting.
3965          */
3966         phba = (struct lpfc_hba *) dev_id;
3967
3968         if (unlikely(!phba))
3969                 return IRQ_NONE;
3970
3971         /* If the pci channel is offline, ignore all the interrupts. */
3972         if (unlikely(pci_channel_offline(phba->pcidev)))
3973                 return IRQ_NONE;
3974
3975         phba->sli.slistat.sli_intr++;
3976
3977         /*
3978          * Call the HBA to see if it is interrupting.  If not, don't claim
3979          * the interrupt
3980          */
3981
3982         /* Ignore all interrupts during initialization. */
3983         if (unlikely(phba->link_state < LPFC_LINK_DOWN))
3984                 return IRQ_NONE;
3985
3986         /*
3987          * Read host attention register to determine interrupt source
3988          * Clear Attention Sources, except Error Attention (to
3989          * preserve status) and Link Attention
3990          */
3991         spin_lock(&phba->hbalock);
3992         ha_copy = readl(phba->HAregaddr);
3993         /* If somebody is waiting to handle an eratt don't process it
3994          * here.  The brdkill function will do this.
3995          */
3996         if (phba->link_flag & LS_IGNORE_ERATT)
3997                 ha_copy &= ~HA_ERATT;
3998         writel((ha_copy & ~(HA_LATT | HA_ERATT)), phba->HAregaddr);
3999         readl(phba->HAregaddr); /* flush */
4000         spin_unlock(&phba->hbalock);
4001
4002         if (unlikely(!ha_copy))
4003                 return IRQ_NONE;
4004
4005         work_ha_copy = ha_copy & phba->work_ha_mask;
4006
4007         if (unlikely(work_ha_copy)) {
4008                 if (work_ha_copy & HA_LATT) {
4009                         if (phba->sli.sli_flag & LPFC_PROCESS_LA) {
4010                                 /*
4011                                  * Turn off Link Attention interrupts
4012                                  * until CLEAR_LA done
4013                                  */
4014                                 spin_lock(&phba->hbalock);
4015                                 phba->sli.sli_flag &= ~LPFC_PROCESS_LA;
4016                                 control = readl(phba->HCregaddr);
4017                                 control &= ~HC_LAINT_ENA;
4018                                 writel(control, phba->HCregaddr);
4019                                 readl(phba->HCregaddr); /* flush */
4020                                 spin_unlock(&phba->hbalock);
4021                         }
4022                         else
4023                                 work_ha_copy &= ~HA_LATT;
4024                 }
4025
4026                 if (work_ha_copy & ~(HA_ERATT|HA_MBATT|HA_LATT)) {
4027                         /*
4028                          * Turn off Slow Rings interrupts, LPFC_ELS_RING is
4029                          * the only slow ring.
4030                          */
4031                         status = (work_ha_copy &
4032                                 (HA_RXMASK  << (4*LPFC_ELS_RING)));
4033                         status >>= (4*LPFC_ELS_RING);
4034                         if (status & HA_RXMASK) {
4035                                 spin_lock(&phba->hbalock);
4036                                 control = readl(phba->HCregaddr);
4037
4038                                 lpfc_debugfs_slow_ring_trc(phba,
4039                                 "ISR slow ring:   ctl:x%x stat:x%x isrcnt:x%x",
4040                                 control, status,
4041                                 (uint32_t)phba->sli.slistat.sli_intr);
4042
4043                                 if (control & (HC_R0INT_ENA << LPFC_ELS_RING)) {
4044                                         lpfc_debugfs_slow_ring_trc(phba,
4045                                                 "ISR Disable ring:"
4046                                                 "pwork:x%x hawork:x%x wait:x%x",
4047                                                 phba->work_ha, work_ha_copy,
4048                                                 (uint32_t)((unsigned long)
4049                                                 phba->work_wait));
4050
4051                                         control &=
4052                                             ~(HC_R0INT_ENA << LPFC_ELS_RING);
4053                                         writel(control, phba->HCregaddr);
4054                                         readl(phba->HCregaddr); /* flush */
4055                                 }
4056                                 else {
4057                                         lpfc_debugfs_slow_ring_trc(phba,
4058                                                 "ISR slow ring:   pwork:"
4059                                                 "x%x hawork:x%x wait:x%x",
4060                                                 phba->work_ha, work_ha_copy,
4061                                                 (uint32_t)((unsigned long)
4062                                                 phba->work_wait));
4063                                 }
4064                                 spin_unlock(&phba->hbalock);
4065                         }
4066                 }
4067
4068                 if (work_ha_copy & HA_ERATT) {
4069                         /*
4070                          * There was a link/board error.  Read the
4071                          * status register to retrieve the error event
4072                          * and process it.
4073                          */
4074                         phba->sli.slistat.err_attn_event++;
4075                         /* Save status info */
4076                         phba->work_hs = readl(phba->HSregaddr);
4077                         phba->work_status[0] = readl(phba->MBslimaddr + 0xa8);
4078                         phba->work_status[1] = readl(phba->MBslimaddr + 0xac);
4079
4080                         /* Clear Chip error bit */
4081                         writel(HA_ERATT, phba->HAregaddr);
4082                         readl(phba->HAregaddr); /* flush */
4083                         phba->pport->stopped = 1;
4084                 }
4085
4086                 if ((work_ha_copy & HA_MBATT) &&
4087                     (phba->sli.mbox_active)) {
4088                         pmb = phba->sli.mbox_active;
4089                         pmbox = &pmb->mb;
4090                         mbox = &phba->slim2p->mbx;
4091                         vport = pmb->vport;
4092
4093                         /* First check out the status word */
4094                         lpfc_sli_pcimem_bcopy(mbox, pmbox, sizeof(uint32_t));
4095                         if (pmbox->mbxOwner != OWN_HOST) {
4096                                 /*
4097                                  * Stray Mailbox Interrupt, mbxCommand <cmd>
4098                                  * mbxStatus <status>
4099                                  */
4100                                 lpfc_printf_log(phba, KERN_ERR, LOG_MBOX |
4101                                                 LOG_SLI,
4102                                                 "(%d):0304 Stray Mailbox "
4103                                                 "Interrupt mbxCommand x%x "
4104                                                 "mbxStatus x%x\n",
4105                                                 (vport ? vport->vpi : 0),
4106                                                 pmbox->mbxCommand,
4107                                                 pmbox->mbxStatus);
4108                                 /* clear mailbox attention bit */
4109                                 work_ha_copy &= ~HA_MBATT;
4110                         } else {
4111                                 phba->last_completion_time = jiffies;
4112                                 del_timer(&phba->sli.mbox_tmo);
4113
4114                                 phba->sli.mbox_active = NULL;
4115                                 if (pmb->mbox_cmpl) {
4116                                         lpfc_sli_pcimem_bcopy(mbox, pmbox,
4117                                                         MAILBOX_CMD_SIZE);
4118                                 }
4119                                 if (pmb->mbox_flag & LPFC_MBX_IMED_UNREG) {
4120                                         pmb->mbox_flag &= ~LPFC_MBX_IMED_UNREG;
4121
4122                                         lpfc_debugfs_disc_trc(vport,
4123                                                 LPFC_DISC_TRC_MBOX_VPORT,
4124                                                 "MBOX dflt rpi: : "
4125                                                 "status:x%x rpi:x%x",
4126                                                 (uint32_t)pmbox->mbxStatus,
4127                                                 pmbox->un.varWords[0], 0);
4128
4129                                         if (!pmbox->mbxStatus) {
4130                                                 mp = (struct lpfc_dmabuf *)
4131                                                         (pmb->context1);
4132                                                 ndlp = (struct lpfc_nodelist *)
4133                                                         pmb->context2;
4134
4135                                                 /* Reg_LOGIN of dflt RPI was
4136                                                  * successful. new lets get
4137                                                  * rid of the RPI using the
4138                                                  * same mbox buffer.
4139                                                  */
4140                                                 lpfc_unreg_login(phba,
4141                                                         vport->vpi,
4142                                                         pmbox->un.varWords[0],
4143                                                         pmb);
4144                                                 pmb->mbox_cmpl =
4145                                                         lpfc_mbx_cmpl_dflt_rpi;
4146                                                 pmb->context1 = mp;
4147                                                 pmb->context2 = ndlp;
4148                                                 pmb->vport = vport;
4149                                                 spin_lock(&phba->hbalock);
4150                                                 phba->sli.sli_flag &=
4151                                                         ~LPFC_SLI_MBOX_ACTIVE;
4152                                                 spin_unlock(&phba->hbalock);
4153                                                 goto send_current_mbox;
4154                                         }
4155                                 }
4156                                 spin_lock(&phba->pport->work_port_lock);
4157                                 phba->pport->work_port_events &=
4158                                         ~WORKER_MBOX_TMO;
4159                                 spin_unlock(&phba->pport->work_port_lock);
4160                                 lpfc_mbox_cmpl_put(phba, pmb);
4161                         }
4162                 }
4163                 if ((work_ha_copy & HA_MBATT) &&
4164                     (phba->sli.mbox_active == NULL)) {
4165 send_next_mbox:
4166                         spin_lock(&phba->hbalock);
4167                         phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
4168                         pmb = lpfc_mbox_get(phba);
4169                         spin_unlock(&phba->hbalock);
4170 send_current_mbox:
4171                         /* Process next mailbox command if there is one */
4172                         if (pmb != NULL) {
4173                                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
4174                                 if (rc == MBX_NOT_FINISHED) {
4175                                         pmb->mb.mbxStatus = MBX_NOT_FINISHED;
4176                                         lpfc_mbox_cmpl_put(phba, pmb);
4177                                         goto send_next_mbox;
4178                                 }
4179                         }
4180
4181                 }
4182
4183                 spin_lock(&phba->hbalock);
4184                 phba->work_ha |= work_ha_copy;
4185                 if (phba->work_wait)
4186                         lpfc_worker_wake_up(phba);
4187                 spin_unlock(&phba->hbalock);
4188         }
4189
4190         ha_copy &= ~(phba->work_ha_mask);
4191
4192         /*
4193          * Process all events on FCP ring.  Take the optimized path for
4194          * FCP IO.  Any other IO is slow path and is handled by
4195          * the worker thread.
4196          */
4197         status = (ha_copy & (HA_RXMASK  << (4*LPFC_FCP_RING)));
4198         status >>= (4*LPFC_FCP_RING);
4199         if (status & HA_RXMASK)
4200                 lpfc_sli_handle_fast_ring_event(phba,
4201                                                 &phba->sli.ring[LPFC_FCP_RING],
4202                                                 status);
4203
4204         if (phba->cfg_multi_ring_support == 2) {
4205                 /*
4206                  * Process all events on extra ring.  Take the optimized path
4207                  * for extra ring IO.  Any other IO is slow path and is handled
4208                  * by the worker thread.
4209                  */
4210                 status = (ha_copy & (HA_RXMASK  << (4*LPFC_EXTRA_RING)));
4211                 status >>= (4*LPFC_EXTRA_RING);
4212                 if (status & HA_RXMASK) {
4213                         lpfc_sli_handle_fast_ring_event(phba,
4214                                         &phba->sli.ring[LPFC_EXTRA_RING],
4215                                         status);
4216                 }
4217         }
4218         return IRQ_HANDLED;
4219
4220 } /* lpfc_intr_handler */