|  | /******************************************************************* | 
|  | * This file is part of the Emulex Linux Device Driver for         * | 
|  | * Fibre Channel Host Bus Adapters.                                * | 
|  | * Copyright (C) 2004-2005 Emulex.  All rights reserved.           * | 
|  | * EMULEX and SLI are trademarks of Emulex.                        * | 
|  | * www.emulex.com                                                  * | 
|  | * Portions Copyright (C) 2004-2005 Christoph Hellwig              * | 
|  | *                                                                 * | 
|  | * This program is free software; you can redistribute it and/or   * | 
|  | * modify it under the terms of version 2 of the GNU General       * | 
|  | * Public License as published by the Free Software Foundation.    * | 
|  | * This program is distributed in the hope that it will be useful. * | 
|  | * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          * | 
|  | * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  * | 
|  | * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      * | 
|  | * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD * | 
|  | * TO BE LEGALLY INVALID.  See the GNU General Public License for  * | 
|  | * more details, a copy of which can be found in the file COPYING  * | 
|  | * included with this package.                                     * | 
|  | *******************************************************************/ | 
|  |  | 
|  | #include <linux/blkdev.h> | 
|  | #include <linux/pci.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/delay.h> | 
|  |  | 
|  | #include <scsi/scsi_cmnd.h> | 
|  | #include <scsi/scsi_device.h> | 
|  | #include <scsi/scsi_host.h> | 
|  |  | 
|  | #include "lpfc_hw.h" | 
|  | #include "lpfc_sli.h" | 
|  | #include "lpfc_disc.h" | 
|  | #include "lpfc_scsi.h" | 
|  | #include "lpfc.h" | 
|  | #include "lpfc_crtn.h" | 
|  | #include "lpfc_logmsg.h" | 
|  | #include "lpfc_compat.h" | 
|  |  | 
|  | /* | 
|  | * Define macro to log: Mailbox command x%x cannot issue Data | 
|  | * This allows multiple uses of lpfc_msgBlk0311 | 
|  | * w/o perturbing log msg utility. | 
|  | */ | 
|  | #define LOG_MBOX_CANNOT_ISSUE_DATA( phba, mb, psli, flag) \ | 
|  | lpfc_printf_log(phba, \ | 
|  | KERN_INFO, \ | 
|  | LOG_MBOX | LOG_SLI, \ | 
|  | "%d:0311 Mailbox command x%x cannot issue " \ | 
|  | "Data: x%x x%x x%x\n", \ | 
|  | phba->brd_no, \ | 
|  | mb->mbxCommand,		\ | 
|  | phba->hba_state,	\ | 
|  | psli->sli_flag,	\ | 
|  | flag); | 
|  |  | 
|  |  | 
|  | /* There are only four IOCB completion types. */ | 
|  | typedef enum _lpfc_iocb_type { | 
|  | LPFC_UNKNOWN_IOCB, | 
|  | LPFC_UNSOL_IOCB, | 
|  | LPFC_SOL_IOCB, | 
|  | LPFC_ABORT_IOCB | 
|  | } lpfc_iocb_type; | 
|  |  | 
|  | /* | 
|  | * Translate the iocb command to an iocb command type used to decide the final | 
|  | * disposition of each completed IOCB. | 
|  | */ | 
|  | static lpfc_iocb_type | 
|  | lpfc_sli_iocb_cmd_type(uint8_t iocb_cmnd) | 
|  | { | 
|  | lpfc_iocb_type type = LPFC_UNKNOWN_IOCB; | 
|  |  | 
|  | if (iocb_cmnd > CMD_MAX_IOCB_CMD) | 
|  | return 0; | 
|  |  | 
|  | switch (iocb_cmnd) { | 
|  | case CMD_XMIT_SEQUENCE_CR: | 
|  | case CMD_XMIT_SEQUENCE_CX: | 
|  | case CMD_XMIT_BCAST_CN: | 
|  | case CMD_XMIT_BCAST_CX: | 
|  | case CMD_ELS_REQUEST_CR: | 
|  | case CMD_ELS_REQUEST_CX: | 
|  | case CMD_CREATE_XRI_CR: | 
|  | case CMD_CREATE_XRI_CX: | 
|  | case CMD_GET_RPI_CN: | 
|  | case CMD_XMIT_ELS_RSP_CX: | 
|  | case CMD_GET_RPI_CR: | 
|  | case CMD_FCP_IWRITE_CR: | 
|  | case CMD_FCP_IWRITE_CX: | 
|  | case CMD_FCP_IREAD_CR: | 
|  | case CMD_FCP_IREAD_CX: | 
|  | case CMD_FCP_ICMND_CR: | 
|  | case CMD_FCP_ICMND_CX: | 
|  | case CMD_ADAPTER_MSG: | 
|  | case CMD_ADAPTER_DUMP: | 
|  | case CMD_XMIT_SEQUENCE64_CR: | 
|  | case CMD_XMIT_SEQUENCE64_CX: | 
|  | case CMD_XMIT_BCAST64_CN: | 
|  | case CMD_XMIT_BCAST64_CX: | 
|  | case CMD_ELS_REQUEST64_CR: | 
|  | case CMD_ELS_REQUEST64_CX: | 
|  | case CMD_FCP_IWRITE64_CR: | 
|  | case CMD_FCP_IWRITE64_CX: | 
|  | case CMD_FCP_IREAD64_CR: | 
|  | case CMD_FCP_IREAD64_CX: | 
|  | case CMD_FCP_ICMND64_CR: | 
|  | case CMD_FCP_ICMND64_CX: | 
|  | case CMD_GEN_REQUEST64_CR: | 
|  | case CMD_GEN_REQUEST64_CX: | 
|  | case CMD_XMIT_ELS_RSP64_CX: | 
|  | type = LPFC_SOL_IOCB; | 
|  | break; | 
|  | case CMD_ABORT_XRI_CN: | 
|  | case CMD_ABORT_XRI_CX: | 
|  | case CMD_CLOSE_XRI_CN: | 
|  | case CMD_CLOSE_XRI_CX: | 
|  | case CMD_XRI_ABORTED_CX: | 
|  | case CMD_ABORT_MXRI64_CN: | 
|  | type = LPFC_ABORT_IOCB; | 
|  | break; | 
|  | case CMD_RCV_SEQUENCE_CX: | 
|  | case CMD_RCV_ELS_REQ_CX: | 
|  | case CMD_RCV_SEQUENCE64_CX: | 
|  | case CMD_RCV_ELS_REQ64_CX: | 
|  | type = LPFC_UNSOL_IOCB; | 
|  | break; | 
|  | default: | 
|  | type = LPFC_UNKNOWN_IOCB; | 
|  | break; | 
|  | } | 
|  |  | 
|  | return type; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_ring_map(struct lpfc_hba * phba, LPFC_MBOXQ_t *pmb) | 
|  | { | 
|  | struct lpfc_sli *psli = &phba->sli; | 
|  | MAILBOX_t *pmbox = &pmb->mb; | 
|  | int i, rc; | 
|  |  | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | phba->hba_state = LPFC_INIT_MBX_CMDS; | 
|  | lpfc_config_ring(phba, i, pmb); | 
|  | rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL); | 
|  | if (rc != MBX_SUCCESS) { | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_INIT, | 
|  | "%d:0446 Adapter failed to init, " | 
|  | "mbxCmd x%x CFG_RING, mbxStatus x%x, " | 
|  | "ring %d\n", | 
|  | phba->brd_no, | 
|  | pmbox->mbxCommand, | 
|  | pmbox->mbxStatus, | 
|  | i); | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | return -ENXIO; | 
|  | } | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_ringtxcmpl_put(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, struct lpfc_iocbq * piocb) | 
|  | { | 
|  | uint16_t iotag; | 
|  |  | 
|  | list_add_tail(&piocb->list, &pring->txcmplq); | 
|  | pring->txcmplq_cnt++; | 
|  | if (unlikely(pring->ringno == LPFC_ELS_RING)) | 
|  | mod_timer(&phba->els_tmofunc, | 
|  | jiffies + HZ * (phba->fc_ratov << 1)); | 
|  |  | 
|  | if (pring->fast_lookup) { | 
|  | /* Setup fast lookup based on iotag for completion */ | 
|  | iotag = piocb->iocb.ulpIoTag; | 
|  | if (iotag && (iotag < pring->fast_iotag)) | 
|  | *(pring->fast_lookup + iotag) = piocb; | 
|  | else { | 
|  |  | 
|  | /* Cmd ring <ringno> put: iotag <iotag> greater then | 
|  | configured max <fast_iotag> wd0 <icmd> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_SLI, | 
|  | "%d:0316 Cmd ring %d put: iotag x%x " | 
|  | "greater then configured max x%x " | 
|  | "wd0 x%x\n", | 
|  | phba->brd_no, | 
|  | pring->ringno, iotag, | 
|  | pring->fast_iotag, | 
|  | *(((uint32_t *)(&piocb->iocb)) + 7)); | 
|  | } | 
|  | } | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | static struct lpfc_iocbq * | 
|  | lpfc_sli_ringtx_get(struct lpfc_hba * phba, struct lpfc_sli_ring * pring) | 
|  | { | 
|  | struct list_head *dlp; | 
|  | struct lpfc_iocbq *cmd_iocb; | 
|  |  | 
|  | dlp = &pring->txq; | 
|  | cmd_iocb = NULL; | 
|  | list_remove_head((&pring->txq), cmd_iocb, | 
|  | struct lpfc_iocbq, | 
|  | list); | 
|  | if (cmd_iocb) { | 
|  | /* If the first ptr is not equal to the list header, | 
|  | * deque the IOCBQ_t and return it. | 
|  | */ | 
|  | pring->txq_cnt--; | 
|  | } | 
|  | return (cmd_iocb); | 
|  | } | 
|  |  | 
|  | static IOCB_t * | 
|  | lpfc_sli_next_iocb_slot (struct lpfc_hba *phba, struct lpfc_sli_ring *pring) | 
|  | { | 
|  | struct lpfc_pgp *pgp = &phba->slim2p->mbx.us.s2.port[pring->ringno]; | 
|  | uint32_t  max_cmd_idx = pring->numCiocb; | 
|  | IOCB_t *iocb = NULL; | 
|  |  | 
|  | if ((pring->next_cmdidx == pring->cmdidx) && | 
|  | (++pring->next_cmdidx >= max_cmd_idx)) | 
|  | pring->next_cmdidx = 0; | 
|  |  | 
|  | if (unlikely(pring->local_getidx == pring->next_cmdidx)) { | 
|  |  | 
|  | pring->local_getidx = le32_to_cpu(pgp->cmdGetInx); | 
|  |  | 
|  | if (unlikely(pring->local_getidx >= max_cmd_idx)) { | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_SLI, | 
|  | "%d:0315 Ring %d issue: portCmdGet %d " | 
|  | "is bigger then cmd ring %d\n", | 
|  | phba->brd_no, pring->ringno, | 
|  | pring->local_getidx, max_cmd_idx); | 
|  |  | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | /* | 
|  | * All error attention handlers are posted to | 
|  | * worker thread | 
|  | */ | 
|  | phba->work_ha |= HA_ERATT; | 
|  | phba->work_hs = HS_FFER3; | 
|  | if (phba->work_wait) | 
|  | wake_up(phba->work_wait); | 
|  |  | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | if (pring->local_getidx == pring->next_cmdidx) | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | iocb = IOCB_ENTRY(pring->cmdringaddr, pring->cmdidx); | 
|  |  | 
|  | return iocb; | 
|  | } | 
|  |  | 
|  | static uint32_t | 
|  | lpfc_sli_next_iotag(struct lpfc_hba * phba, struct lpfc_sli_ring * pring) | 
|  | { | 
|  | uint32_t search_start; | 
|  |  | 
|  | if (pring->fast_lookup == NULL) { | 
|  | pring->iotag_ctr++; | 
|  | if (pring->iotag_ctr >= pring->iotag_max) | 
|  | pring->iotag_ctr = 1; | 
|  | return pring->iotag_ctr; | 
|  | } | 
|  |  | 
|  | search_start = pring->iotag_ctr; | 
|  |  | 
|  | do { | 
|  | pring->iotag_ctr++; | 
|  | if (pring->iotag_ctr >= pring->fast_iotag) | 
|  | pring->iotag_ctr = 1; | 
|  |  | 
|  | if (*(pring->fast_lookup + pring->iotag_ctr) == NULL) | 
|  | return pring->iotag_ctr; | 
|  |  | 
|  | } while (pring->iotag_ctr != search_start); | 
|  |  | 
|  | /* | 
|  | * Outstanding I/O count for ring <ringno> is at max <fast_iotag> | 
|  | */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_SLI, | 
|  | "%d:0318 Outstanding I/O count for ring %d is at max x%x\n", | 
|  | phba->brd_no, | 
|  | pring->ringno, | 
|  | pring->fast_iotag); | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_sli_submit_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | IOCB_t *iocb, struct lpfc_iocbq *nextiocb) | 
|  | { | 
|  | /* | 
|  | * Allocate and set up an iotag | 
|  | */ | 
|  | nextiocb->iocb.ulpIoTag = | 
|  | lpfc_sli_next_iotag(phba, &phba->sli.ring[phba->sli.fcp_ring]); | 
|  |  | 
|  | /* | 
|  | * Issue iocb command to adapter | 
|  | */ | 
|  | lpfc_sli_pcimem_bcopy(&nextiocb->iocb, iocb, sizeof (IOCB_t)); | 
|  | wmb(); | 
|  | pring->stats.iocb_cmd++; | 
|  |  | 
|  | /* | 
|  | * If there is no completion routine to call, we can release the | 
|  | * IOCB buffer back right now. For IOCBs, like QUE_RING_BUF, | 
|  | * that have no rsp ring completion, iocb_cmpl MUST be NULL. | 
|  | */ | 
|  | if (nextiocb->iocb_cmpl) | 
|  | lpfc_sli_ringtxcmpl_put(phba, pring, nextiocb); | 
|  | else { | 
|  | list_add_tail(&nextiocb->list, &phba->lpfc_iocb_list); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Let the HBA know what IOCB slot will be the next one the | 
|  | * driver will put a command into. | 
|  | */ | 
|  | pring->cmdidx = pring->next_cmdidx; | 
|  | writeb(pring->cmdidx, phba->MBslimaddr | 
|  | + (SLIMOFF + (pring->ringno * 2)) * 4); | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_sli_update_full_ring(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring *pring) | 
|  | { | 
|  | int ringno = pring->ringno; | 
|  |  | 
|  | pring->flag |= LPFC_CALL_RING_AVAILABLE; | 
|  |  | 
|  | wmb(); | 
|  |  | 
|  | /* | 
|  | * Set ring 'ringno' to SET R0CE_REQ in Chip Att register. | 
|  | * The HBA will tell us when an IOCB entry is available. | 
|  | */ | 
|  | writel((CA_R0ATT|CA_R0CE_REQ) << (ringno*4), phba->CAregaddr); | 
|  | readl(phba->CAregaddr); /* flush */ | 
|  |  | 
|  | pring->stats.iocb_cmd_full++; | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_sli_update_ring(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring *pring) | 
|  | { | 
|  | int ringno = pring->ringno; | 
|  |  | 
|  | /* | 
|  | * Tell the HBA that there is work to do in this ring. | 
|  | */ | 
|  | wmb(); | 
|  | writel(CA_R0ATT << (ringno * 4), phba->CAregaddr); | 
|  | readl(phba->CAregaddr); /* flush */ | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_sli_resume_iocb(struct lpfc_hba * phba, struct lpfc_sli_ring * pring) | 
|  | { | 
|  | IOCB_t *iocb; | 
|  | struct lpfc_iocbq *nextiocb; | 
|  |  | 
|  | /* | 
|  | * Check to see if: | 
|  | *  (a) there is anything on the txq to send | 
|  | *  (b) link is up | 
|  | *  (c) link attention events can be processed (fcp ring only) | 
|  | *  (d) IOCB processing is not blocked by the outstanding mbox command. | 
|  | */ | 
|  | if (pring->txq_cnt && | 
|  | (phba->hba_state > LPFC_LINK_DOWN) && | 
|  | (pring->ringno != phba->sli.fcp_ring || | 
|  | phba->sli.sli_flag & LPFC_PROCESS_LA) && | 
|  | !(pring->flag & LPFC_STOP_IOCB_MBX)) { | 
|  |  | 
|  | while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) && | 
|  | (nextiocb = lpfc_sli_ringtx_get(phba, pring))) | 
|  | lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb); | 
|  |  | 
|  | if (iocb) | 
|  | lpfc_sli_update_ring(phba, pring); | 
|  | else | 
|  | lpfc_sli_update_full_ring(phba, pring); | 
|  | } | 
|  |  | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* lpfc_sli_turn_on_ring is only called by lpfc_sli_handle_mb_event below */ | 
|  | static void | 
|  | lpfc_sli_turn_on_ring(struct lpfc_hba * phba, int ringno) | 
|  | { | 
|  | struct lpfc_pgp *pgp = &phba->slim2p->mbx.us.s2.port[ringno]; | 
|  |  | 
|  | /* If the ring is active, flag it */ | 
|  | if (phba->sli.ring[ringno].cmdringaddr) { | 
|  | if (phba->sli.ring[ringno].flag & LPFC_STOP_IOCB_MBX) { | 
|  | phba->sli.ring[ringno].flag &= ~LPFC_STOP_IOCB_MBX; | 
|  | /* | 
|  | * Force update of the local copy of cmdGetInx | 
|  | */ | 
|  | phba->sli.ring[ringno].local_getidx | 
|  | = le32_to_cpu(pgp->cmdGetInx); | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | lpfc_sli_resume_iocb(phba, &phba->sli.ring[ringno]); | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_chk_mbx_command(uint8_t mbxCommand) | 
|  | { | 
|  | uint8_t ret; | 
|  |  | 
|  | switch (mbxCommand) { | 
|  | case MBX_LOAD_SM: | 
|  | case MBX_READ_NV: | 
|  | case MBX_WRITE_NV: | 
|  | case MBX_RUN_BIU_DIAG: | 
|  | case MBX_INIT_LINK: | 
|  | case MBX_DOWN_LINK: | 
|  | case MBX_CONFIG_LINK: | 
|  | case MBX_CONFIG_RING: | 
|  | case MBX_RESET_RING: | 
|  | case MBX_READ_CONFIG: | 
|  | case MBX_READ_RCONFIG: | 
|  | case MBX_READ_SPARM: | 
|  | case MBX_READ_STATUS: | 
|  | case MBX_READ_RPI: | 
|  | case MBX_READ_XRI: | 
|  | case MBX_READ_REV: | 
|  | case MBX_READ_LNK_STAT: | 
|  | case MBX_REG_LOGIN: | 
|  | case MBX_UNREG_LOGIN: | 
|  | case MBX_READ_LA: | 
|  | case MBX_CLEAR_LA: | 
|  | case MBX_DUMP_MEMORY: | 
|  | case MBX_DUMP_CONTEXT: | 
|  | case MBX_RUN_DIAGS: | 
|  | case MBX_RESTART: | 
|  | case MBX_UPDATE_CFG: | 
|  | case MBX_DOWN_LOAD: | 
|  | case MBX_DEL_LD_ENTRY: | 
|  | case MBX_RUN_PROGRAM: | 
|  | case MBX_SET_MASK: | 
|  | case MBX_SET_SLIM: | 
|  | case MBX_UNREG_D_ID: | 
|  | case MBX_CONFIG_FARP: | 
|  | case MBX_LOAD_AREA: | 
|  | case MBX_RUN_BIU_DIAG64: | 
|  | case MBX_CONFIG_PORT: | 
|  | case MBX_READ_SPARM64: | 
|  | case MBX_READ_RPI64: | 
|  | case MBX_REG_LOGIN64: | 
|  | case MBX_READ_LA64: | 
|  | case MBX_FLASH_WR_ULA: | 
|  | case MBX_SET_DEBUG: | 
|  | case MBX_LOAD_EXP_ROM: | 
|  | ret = mbxCommand; | 
|  | break; | 
|  | default: | 
|  | ret = MBX_SHUTDOWN; | 
|  | break; | 
|  | } | 
|  | return (ret); | 
|  | } | 
|  | static void | 
|  | lpfc_sli_wake_mbox_wait(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmboxq) | 
|  | { | 
|  | wait_queue_head_t *pdone_q; | 
|  |  | 
|  | /* | 
|  | * If pdone_q is empty, the driver thread gave up waiting and | 
|  | * continued running. | 
|  | */ | 
|  | pdone_q = (wait_queue_head_t *) pmboxq->context1; | 
|  | if (pdone_q) | 
|  | wake_up_interruptible(pdone_q); | 
|  | return; | 
|  | } | 
|  |  | 
|  | void | 
|  | lpfc_sli_def_mbox_cmpl(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmb) | 
|  | { | 
|  | struct lpfc_dmabuf *mp; | 
|  | mp = (struct lpfc_dmabuf *) (pmb->context1); | 
|  | if (mp) { | 
|  | lpfc_mbuf_free(phba, mp->virt, mp->phys); | 
|  | kfree(mp); | 
|  | } | 
|  | mempool_free( pmb, phba->mbox_mem_pool); | 
|  | return; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_handle_mb_event(struct lpfc_hba * phba) | 
|  | { | 
|  | MAILBOX_t *mbox; | 
|  | MAILBOX_t *pmbox; | 
|  | LPFC_MBOXQ_t *pmb; | 
|  | struct lpfc_sli *psli; | 
|  | int i, rc; | 
|  | uint32_t process_next; | 
|  |  | 
|  | psli = &phba->sli; | 
|  | /* We should only get here if we are in SLI2 mode */ | 
|  | if (!(phba->sli.sli_flag & LPFC_SLI2_ACTIVE)) { | 
|  | return (1); | 
|  | } | 
|  |  | 
|  | phba->sli.slistat.mbox_event++; | 
|  |  | 
|  | /* Get a Mailbox buffer to setup mailbox commands for callback */ | 
|  | if ((pmb = phba->sli.mbox_active)) { | 
|  | pmbox = &pmb->mb; | 
|  | mbox = &phba->slim2p->mbx; | 
|  |  | 
|  | /* First check out the status word */ | 
|  | lpfc_sli_pcimem_bcopy(mbox, pmbox, sizeof (uint32_t)); | 
|  |  | 
|  | /* Sanity check to ensure the host owns the mailbox */ | 
|  | if (pmbox->mbxOwner != OWN_HOST) { | 
|  | /* Lets try for a while */ | 
|  | for (i = 0; i < 10240; i++) { | 
|  | /* First copy command data */ | 
|  | lpfc_sli_pcimem_bcopy(mbox, pmbox, | 
|  | sizeof (uint32_t)); | 
|  | if (pmbox->mbxOwner == OWN_HOST) | 
|  | goto mbout; | 
|  | } | 
|  | /* Stray Mailbox Interrupt, mbxCommand <cmd> mbxStatus | 
|  | <status> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0304 Stray Mailbox Interrupt " | 
|  | "mbxCommand x%x mbxStatus x%x\n", | 
|  | phba->brd_no, | 
|  | pmbox->mbxCommand, | 
|  | pmbox->mbxStatus); | 
|  |  | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | phba->sli.sli_flag |= LPFC_SLI_MBOX_ACTIVE; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | return (1); | 
|  | } | 
|  |  | 
|  | mbout: | 
|  | del_timer_sync(&phba->sli.mbox_tmo); | 
|  | phba->work_hba_events &= ~WORKER_MBOX_TMO; | 
|  |  | 
|  | /* | 
|  | * It is a fatal error if unknown mbox command completion. | 
|  | */ | 
|  | if (lpfc_sli_chk_mbx_command(pmbox->mbxCommand) == | 
|  | MBX_SHUTDOWN) { | 
|  |  | 
|  | /* Unknow mailbox command compl */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0323 Unknown Mailbox command %x Cmpl\n", | 
|  | phba->brd_no, | 
|  | pmbox->mbxCommand); | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | phba->work_hs = HS_FFER3; | 
|  | lpfc_handle_eratt(phba); | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | phba->sli.mbox_active = NULL; | 
|  | if (pmbox->mbxStatus) { | 
|  | phba->sli.slistat.mbox_stat_err++; | 
|  | if (pmbox->mbxStatus == MBXERR_NO_RESOURCES) { | 
|  | /* Mbox cmd cmpl error - RETRYing */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_INFO, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0305 Mbox cmd cmpl error - " | 
|  | "RETRYing Data: x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | pmbox->mbxCommand, | 
|  | pmbox->mbxStatus, | 
|  | pmbox->un.varWords[0], | 
|  | phba->hba_state); | 
|  | pmbox->mbxStatus = 0; | 
|  | pmbox->mbxOwner = OWN_HOST; | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT); | 
|  | if (rc == MBX_SUCCESS) | 
|  | return (0); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* Mailbox cmd <cmd> Cmpl <cmpl> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_INFO, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0307 Mailbox cmd x%x Cmpl x%p " | 
|  | "Data: x%x x%x x%x x%x x%x x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | pmbox->mbxCommand, | 
|  | pmb->mbox_cmpl, | 
|  | *((uint32_t *) pmbox), | 
|  | pmbox->un.varWords[0], | 
|  | pmbox->un.varWords[1], | 
|  | pmbox->un.varWords[2], | 
|  | pmbox->un.varWords[3], | 
|  | pmbox->un.varWords[4], | 
|  | pmbox->un.varWords[5], | 
|  | pmbox->un.varWords[6], | 
|  | pmbox->un.varWords[7]); | 
|  |  | 
|  | if (pmb->mbox_cmpl) { | 
|  | lpfc_sli_pcimem_bcopy(mbox, pmbox, MAILBOX_CMD_SIZE); | 
|  | pmb->mbox_cmpl(phba,pmb); | 
|  | } | 
|  | } | 
|  |  | 
|  |  | 
|  | do { | 
|  | process_next = 0;	/* by default don't loop */ | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  |  | 
|  | /* Process next mailbox command if there is one */ | 
|  | if ((pmb = lpfc_mbox_get(phba))) { | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT); | 
|  | if (rc == MBX_NOT_FINISHED) { | 
|  | pmb->mb.mbxStatus = MBX_NOT_FINISHED; | 
|  | pmb->mbox_cmpl(phba,pmb); | 
|  | process_next = 1; | 
|  | continue;	/* loop back */ | 
|  | } | 
|  | } else { | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | /* Turn on IOCB processing */ | 
|  | for (i = 0; i < phba->sli.num_rings; i++) { | 
|  | lpfc_sli_turn_on_ring(phba, i); | 
|  | } | 
|  |  | 
|  | /* Free any lpfc_dmabuf's waiting for mbox cmd cmpls */ | 
|  | while (!list_empty(&phba->freebufList)) { | 
|  | struct lpfc_dmabuf *mp; | 
|  |  | 
|  | mp = NULL; | 
|  | list_remove_head((&phba->freebufList), | 
|  | mp, | 
|  | struct lpfc_dmabuf, | 
|  | list); | 
|  | if (mp) { | 
|  | lpfc_mbuf_free(phba, mp->virt, | 
|  | mp->phys); | 
|  | kfree(mp); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | } while (process_next); | 
|  |  | 
|  | return (0); | 
|  | } | 
|  | static int | 
|  | lpfc_sli_process_unsol_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | struct lpfc_iocbq *saveq) | 
|  | { | 
|  | IOCB_t           * irsp; | 
|  | WORD5            * w5p; | 
|  | uint32_t           Rctl, Type; | 
|  | uint32_t           match, i; | 
|  |  | 
|  | match = 0; | 
|  | irsp = &(saveq->iocb); | 
|  | if ((irsp->ulpCommand == CMD_RCV_ELS_REQ64_CX) | 
|  | || (irsp->ulpCommand == CMD_RCV_ELS_REQ_CX)) { | 
|  | Rctl = FC_ELS_REQ; | 
|  | Type = FC_ELS_DATA; | 
|  | } else { | 
|  | w5p = | 
|  | (WORD5 *) & (saveq->iocb.un. | 
|  | ulpWord[5]); | 
|  | Rctl = w5p->hcsw.Rctl; | 
|  | Type = w5p->hcsw.Type; | 
|  |  | 
|  | /* Firmware Workaround */ | 
|  | if ((Rctl == 0) && (pring->ringno == LPFC_ELS_RING) && | 
|  | (irsp->ulpCommand == CMD_RCV_SEQUENCE64_CX)) { | 
|  | Rctl = FC_ELS_REQ; | 
|  | Type = FC_ELS_DATA; | 
|  | w5p->hcsw.Rctl = Rctl; | 
|  | w5p->hcsw.Type = Type; | 
|  | } | 
|  | } | 
|  | /* unSolicited Responses */ | 
|  | if (pring->prt[0].profile) { | 
|  | (pring->prt[0].lpfc_sli_rcv_unsol_event) (phba, pring, saveq); | 
|  | match = 1; | 
|  | } else { | 
|  | /* We must search, based on rctl / type | 
|  | for the right routine */ | 
|  | for (i = 0; i < pring->num_mask; | 
|  | i++) { | 
|  | if ((pring->prt[i].rctl == | 
|  | Rctl) | 
|  | && (pring->prt[i]. | 
|  | type == Type)) { | 
|  | (pring->prt[i].lpfc_sli_rcv_unsol_event) | 
|  | (phba, pring, saveq); | 
|  | match = 1; | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | if (match == 0) { | 
|  | /* Unexpected Rctl / Type received */ | 
|  | /* Ring <ringno> handler: unexpected | 
|  | Rctl <Rctl> Type <Type> received */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_WARNING, | 
|  | LOG_SLI, | 
|  | "%d:0313 Ring %d handler: unexpected Rctl x%x " | 
|  | "Type x%x received \n", | 
|  | phba->brd_no, | 
|  | pring->ringno, | 
|  | Rctl, | 
|  | Type); | 
|  | } | 
|  | return(1); | 
|  | } | 
|  |  | 
|  | static struct lpfc_iocbq * | 
|  | lpfc_sli_txcmpl_ring_search_slow(struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq * prspiocb) | 
|  | { | 
|  | IOCB_t *icmd = NULL; | 
|  | IOCB_t *irsp = NULL; | 
|  | struct lpfc_iocbq *cmd_iocb; | 
|  | struct lpfc_iocbq *iocb, *next_iocb; | 
|  | uint16_t iotag; | 
|  |  | 
|  | irsp = &prspiocb->iocb; | 
|  | iotag = irsp->ulpIoTag; | 
|  | cmd_iocb = NULL; | 
|  |  | 
|  | /* Search through txcmpl from the begining */ | 
|  | list_for_each_entry_safe(iocb, next_iocb, &(pring->txcmplq), list) { | 
|  | icmd = &iocb->iocb; | 
|  | if (iotag == icmd->ulpIoTag) { | 
|  | /* Found a match.  */ | 
|  | cmd_iocb = iocb; | 
|  | list_del(&iocb->list); | 
|  | pring->txcmplq_cnt--; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | return (cmd_iocb); | 
|  | } | 
|  |  | 
|  | static struct lpfc_iocbq * | 
|  | lpfc_sli_txcmpl_ring_iotag_lookup(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq * prspiocb) | 
|  | { | 
|  | IOCB_t *irsp = NULL; | 
|  | struct lpfc_iocbq *cmd_iocb = NULL; | 
|  | uint16_t iotag; | 
|  |  | 
|  | if (unlikely(pring->fast_lookup == NULL)) | 
|  | return NULL; | 
|  |  | 
|  | /* Use fast lookup based on iotag for completion */ | 
|  | irsp = &prspiocb->iocb; | 
|  | iotag = irsp->ulpIoTag; | 
|  | if (iotag < pring->fast_iotag) { | 
|  | cmd_iocb = *(pring->fast_lookup + iotag); | 
|  | *(pring->fast_lookup + iotag) = NULL; | 
|  | if (cmd_iocb) { | 
|  | list_del(&cmd_iocb->list); | 
|  | pring->txcmplq_cnt--; | 
|  | return cmd_iocb; | 
|  | } else { | 
|  | /* | 
|  | * This is clearly an error.  A ring that uses iotags | 
|  | * should never have a interrupt for a completion that | 
|  | * is not on the ring.  Return NULL and log a error. | 
|  | */ | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_SLI, | 
|  | "%d:0327 Rsp ring %d error -  command " | 
|  | "completion for iotag x%x not found\n", | 
|  | phba->brd_no, pring->ringno, iotag); | 
|  | return NULL; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Rsp ring <ringno> get: iotag <iotag> greater then | 
|  | * configured max <fast_iotag> wd0 <irsp>.  This is an | 
|  | * error.  Just return NULL. | 
|  | */ | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_SLI, | 
|  | "%d:0317 Rsp ring %d get: iotag x%x greater then " | 
|  | "configured max x%x wd0 x%x\n", | 
|  | phba->brd_no, pring->ringno, iotag, pring->fast_iotag, | 
|  | *(((uint32_t *) irsp) + 7)); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_process_sol_iocb(struct lpfc_hba * phba, struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq *saveq) | 
|  | { | 
|  | struct lpfc_iocbq * cmdiocbp; | 
|  | int rc = 1; | 
|  | unsigned long iflag; | 
|  |  | 
|  | /* Based on the iotag field, get the cmd IOCB from the txcmplq */ | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | cmdiocbp = lpfc_sli_txcmpl_ring_search_slow(pring, saveq); | 
|  | if (cmdiocbp) { | 
|  | if (cmdiocbp->iocb_cmpl) { | 
|  | /* | 
|  | * Post all ELS completions to the worker thread. | 
|  | * All other are passed to the completion callback. | 
|  | */ | 
|  | if (pring->ringno == LPFC_ELS_RING) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | iflag); | 
|  | (cmdiocbp->iocb_cmpl) (phba, cmdiocbp, saveq); | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | } | 
|  | else { | 
|  | if (cmdiocbp->iocb_flag & LPFC_IO_POLL) | 
|  | rc = 0; | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | iflag); | 
|  | (cmdiocbp->iocb_cmpl) (phba, cmdiocbp, saveq); | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | } | 
|  | } else { | 
|  | list_add_tail(&cmdiocbp->list, &phba->lpfc_iocb_list); | 
|  | } | 
|  | } else { | 
|  | /* | 
|  | * Unknown initiating command based on the response iotag. | 
|  | * This could be the case on the ELS ring because of | 
|  | * lpfc_els_abort(). | 
|  | */ | 
|  | if (pring->ringno != LPFC_ELS_RING) { | 
|  | /* | 
|  | * Ring <ringno> handler: unexpected completion IoTag | 
|  | * <IoTag> | 
|  | */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_WARNING, | 
|  | LOG_SLI, | 
|  | "%d:0322 Ring %d handler: unexpected " | 
|  | "completion IoTag x%x Data: x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | pring->ringno, | 
|  | saveq->iocb.ulpIoTag, | 
|  | saveq->iocb.ulpStatus, | 
|  | saveq->iocb.un.ulpWord[4], | 
|  | saveq->iocb.ulpCommand, | 
|  | saveq->iocb.ulpContext); | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This routine presumes LPFC_FCP_RING handling and doesn't bother | 
|  | * to check it explicitly. | 
|  | */ | 
|  | static int | 
|  | lpfc_sli_handle_fast_ring_event(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, uint32_t mask) | 
|  | { | 
|  | struct lpfc_pgp *pgp = &phba->slim2p->mbx.us.s2.port[pring->ringno]; | 
|  | IOCB_t *irsp = NULL; | 
|  | IOCB_t *entry = NULL; | 
|  | struct lpfc_iocbq *cmdiocbq = NULL; | 
|  | struct lpfc_iocbq rspiocbq; | 
|  | uint32_t status; | 
|  | uint32_t portRspPut, portRspMax; | 
|  | int rc = 1; | 
|  | lpfc_iocb_type type; | 
|  | unsigned long iflag; | 
|  | uint32_t rsp_cmpl = 0; | 
|  | void __iomem  *to_slim; | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | pring->stats.iocb_event++; | 
|  |  | 
|  | /* | 
|  | * The next available response entry should never exceed the maximum | 
|  | * entries.  If it does, treat it as an adapter hardware error. | 
|  | */ | 
|  | portRspMax = pring->numRiocb; | 
|  | portRspPut = le32_to_cpu(pgp->rspPutInx); | 
|  | if (unlikely(portRspPut >= portRspMax)) { | 
|  | /* | 
|  | * Ring <ringno> handler: portRspPut <portRspPut> is bigger then | 
|  | * rsp ring <portRspMax> | 
|  | */ | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_SLI, | 
|  | "%d:0312 Ring %d handler: portRspPut %d " | 
|  | "is bigger then rsp ring %d\n", | 
|  | phba->brd_no, pring->ringno, portRspPut, | 
|  | portRspMax); | 
|  |  | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  |  | 
|  | /* All error attention handlers are posted to worker thread */ | 
|  | phba->work_ha |= HA_ERATT; | 
|  | phba->work_hs = HS_FFER3; | 
|  | if (phba->work_wait) | 
|  | wake_up(phba->work_wait); | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | rmb(); | 
|  | while (pring->rspidx != portRspPut) { | 
|  | /* | 
|  | * Fetch an entry off the ring and copy it into a local data | 
|  | * structure.  The copy involves a byte-swap since the | 
|  | * network byte order and pci byte orders are different. | 
|  | */ | 
|  | entry = (IOCB_t *) IOCB_ENTRY(pring->rspringaddr, pring->rspidx); | 
|  | lpfc_sli_pcimem_bcopy((uint32_t *) entry, | 
|  | (uint32_t *) &rspiocbq.iocb, | 
|  | sizeof (IOCB_t)); | 
|  | irsp = &rspiocbq.iocb; | 
|  |  | 
|  | type = lpfc_sli_iocb_cmd_type(irsp->ulpCommand & CMD_IOCB_MASK); | 
|  | pring->stats.iocb_rsp++; | 
|  | rsp_cmpl++; | 
|  |  | 
|  | if (unlikely(irsp->ulpStatus)) { | 
|  | /* Rsp ring <ringno> error: IOCB */ | 
|  | lpfc_printf_log(phba, KERN_WARNING, LOG_SLI, | 
|  | "%d:0326 Rsp Ring %d error: IOCB Data: " | 
|  | "x%x x%x x%x x%x x%x x%x x%x x%x\n", | 
|  | phba->brd_no, pring->ringno, | 
|  | irsp->un.ulpWord[0], irsp->un.ulpWord[1], | 
|  | irsp->un.ulpWord[2], irsp->un.ulpWord[3], | 
|  | irsp->un.ulpWord[4], irsp->un.ulpWord[5], | 
|  | *(((uint32_t *) irsp) + 6), | 
|  | *(((uint32_t *) irsp) + 7)); | 
|  | } | 
|  |  | 
|  | switch (type) { | 
|  | case LPFC_ABORT_IOCB: | 
|  | case LPFC_SOL_IOCB: | 
|  | /* | 
|  | * Idle exchange closed via ABTS from port.  No iocb | 
|  | * resources need to be recovered. | 
|  | */ | 
|  | if (unlikely(irsp->ulpCommand == CMD_XRI_ABORTED_CX)) { | 
|  | printk(KERN_INFO "%s: IOCB cmd 0x%x processed. " | 
|  | "Skipping completion\n", __FUNCTION__, | 
|  | irsp->ulpCommand); | 
|  | break; | 
|  | } | 
|  |  | 
|  | cmdiocbq = lpfc_sli_txcmpl_ring_iotag_lookup(phba, | 
|  | pring, | 
|  | &rspiocbq); | 
|  | if ((cmdiocbq) && (cmdiocbq->iocb_cmpl)) { | 
|  | spin_unlock_irqrestore( | 
|  | phba->host->host_lock, iflag); | 
|  | (cmdiocbq->iocb_cmpl)(phba, cmdiocbq, | 
|  | &rspiocbq); | 
|  | spin_lock_irqsave(phba->host->host_lock, | 
|  | iflag); | 
|  | } | 
|  | break; | 
|  | default: | 
|  | if (irsp->ulpCommand == CMD_ADAPTER_MSG) { | 
|  | char adaptermsg[LPFC_MAX_ADPTMSG]; | 
|  | memset(adaptermsg, 0, LPFC_MAX_ADPTMSG); | 
|  | memcpy(&adaptermsg[0], (uint8_t *) irsp, | 
|  | MAX_MSG_DATA); | 
|  | dev_warn(&((phba->pcidev)->dev), "lpfc%d: %s", | 
|  | phba->brd_no, adaptermsg); | 
|  | } else { | 
|  | /* Unknown IOCB command */ | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_SLI, | 
|  | "%d:0321 Unknown IOCB command " | 
|  | "Data: x%x, x%x x%x x%x x%x\n", | 
|  | phba->brd_no, type, irsp->ulpCommand, | 
|  | irsp->ulpStatus, irsp->ulpIoTag, | 
|  | irsp->ulpContext); | 
|  | } | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * The response IOCB has been processed.  Update the ring | 
|  | * pointer in SLIM.  If the port response put pointer has not | 
|  | * been updated, sync the pgp->rspPutInx and fetch the new port | 
|  | * response put pointer. | 
|  | */ | 
|  | if (++pring->rspidx >= portRspMax) | 
|  | pring->rspidx = 0; | 
|  |  | 
|  | to_slim = phba->MBslimaddr + | 
|  | (SLIMOFF + (pring->ringno * 2) + 1) * 4; | 
|  | writeb(pring->rspidx, to_slim); | 
|  |  | 
|  | if (pring->rspidx == portRspPut) | 
|  | portRspPut = le32_to_cpu(pgp->rspPutInx); | 
|  | } | 
|  |  | 
|  | if ((rsp_cmpl > 0) && (mask & HA_R0RE_REQ)) { | 
|  | pring->stats.iocb_rsp_full++; | 
|  | status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4)); | 
|  | writel(status, phba->CAregaddr); | 
|  | readl(phba->CAregaddr); | 
|  | } | 
|  | if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) { | 
|  | pring->flag &= ~LPFC_CALL_RING_AVAILABLE; | 
|  | pring->stats.iocb_cmd_empty++; | 
|  |  | 
|  | /* Force update of the local copy of cmdGetInx */ | 
|  | pring->local_getidx = le32_to_cpu(pgp->cmdGetInx); | 
|  | lpfc_sli_resume_iocb(phba, pring); | 
|  |  | 
|  | if ((pring->lpfc_sli_cmd_available)) | 
|  | (pring->lpfc_sli_cmd_available) (phba, pring); | 
|  |  | 
|  | } | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  | return rc; | 
|  | } | 
|  |  | 
|  |  | 
|  | int | 
|  | lpfc_sli_handle_slow_ring_event(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, uint32_t mask) | 
|  | { | 
|  | IOCB_t *entry; | 
|  | IOCB_t *irsp = NULL; | 
|  | struct lpfc_iocbq *rspiocbp = NULL; | 
|  | struct lpfc_iocbq *next_iocb; | 
|  | struct lpfc_iocbq *cmdiocbp; | 
|  | struct lpfc_iocbq *saveq; | 
|  | struct list_head *lpfc_iocb_list = &phba->lpfc_iocb_list; | 
|  | struct lpfc_pgp *pgp = &phba->slim2p->mbx.us.s2.port[pring->ringno]; | 
|  | uint8_t iocb_cmd_type; | 
|  | lpfc_iocb_type type; | 
|  | uint32_t status, free_saveq; | 
|  | uint32_t portRspPut, portRspMax; | 
|  | int rc = 1; | 
|  | unsigned long iflag; | 
|  | void __iomem  *to_slim; | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | pring->stats.iocb_event++; | 
|  |  | 
|  | /* | 
|  | * The next available response entry should never exceed the maximum | 
|  | * entries.  If it does, treat it as an adapter hardware error. | 
|  | */ | 
|  | portRspMax = pring->numRiocb; | 
|  | portRspPut = le32_to_cpu(pgp->rspPutInx); | 
|  | if (portRspPut >= portRspMax) { | 
|  | /* | 
|  | * Ring <ringno> handler: portRspPut <portRspPut> is bigger then | 
|  | * rsp ring <portRspMax> | 
|  | */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_SLI, | 
|  | "%d:0312 Ring %d handler: portRspPut %d " | 
|  | "is bigger then rsp ring %d\n", | 
|  | phba->brd_no, | 
|  | pring->ringno, portRspPut, portRspMax); | 
|  |  | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  |  | 
|  | phba->work_hs = HS_FFER3; | 
|  | lpfc_handle_eratt(phba); | 
|  |  | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | rmb(); | 
|  | lpfc_iocb_list = &phba->lpfc_iocb_list; | 
|  | while (pring->rspidx != portRspPut) { | 
|  | /* | 
|  | * Build a completion list and call the appropriate handler. | 
|  | * The process is to get the next available response iocb, get | 
|  | * a free iocb from the list, copy the response data into the | 
|  | * free iocb, insert to the continuation list, and update the | 
|  | * next response index to slim.  This process makes response | 
|  | * iocb's in the ring available to DMA as fast as possible but | 
|  | * pays a penalty for a copy operation.  Since the iocb is | 
|  | * only 32 bytes, this penalty is considered small relative to | 
|  | * the PCI reads for register values and a slim write.  When | 
|  | * the ulpLe field is set, the entire Command has been | 
|  | * received. | 
|  | */ | 
|  | entry = IOCB_ENTRY(pring->rspringaddr, pring->rspidx); | 
|  | list_remove_head(lpfc_iocb_list, rspiocbp, struct lpfc_iocbq, | 
|  | list); | 
|  | if (rspiocbp == NULL) { | 
|  | printk(KERN_ERR "%s: out of buffers! Failing " | 
|  | "completion.\n", __FUNCTION__); | 
|  | break; | 
|  | } | 
|  |  | 
|  | lpfc_sli_pcimem_bcopy(entry, &rspiocbp->iocb, sizeof (IOCB_t)); | 
|  | irsp = &rspiocbp->iocb; | 
|  |  | 
|  | if (++pring->rspidx >= portRspMax) | 
|  | pring->rspidx = 0; | 
|  |  | 
|  | to_slim = phba->MBslimaddr + (SLIMOFF + (pring->ringno * 2) | 
|  | + 1) * 4; | 
|  | writeb(pring->rspidx, to_slim); | 
|  |  | 
|  | if (list_empty(&(pring->iocb_continueq))) { | 
|  | list_add(&rspiocbp->list, &(pring->iocb_continueq)); | 
|  | } else { | 
|  | list_add_tail(&rspiocbp->list, | 
|  | &(pring->iocb_continueq)); | 
|  | } | 
|  |  | 
|  | pring->iocb_continueq_cnt++; | 
|  | if (irsp->ulpLe) { | 
|  | /* | 
|  | * By default, the driver expects to free all resources | 
|  | * associated with this iocb completion. | 
|  | */ | 
|  | free_saveq = 1; | 
|  | saveq = list_get_first(&pring->iocb_continueq, | 
|  | struct lpfc_iocbq, list); | 
|  | irsp = &(saveq->iocb); | 
|  | list_del_init(&pring->iocb_continueq); | 
|  | pring->iocb_continueq_cnt = 0; | 
|  |  | 
|  | pring->stats.iocb_rsp++; | 
|  |  | 
|  | if (irsp->ulpStatus) { | 
|  | /* Rsp ring <ringno> error: IOCB */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_WARNING, | 
|  | LOG_SLI, | 
|  | "%d:0328 Rsp Ring %d error: IOCB Data: " | 
|  | "x%x x%x x%x x%x x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | pring->ringno, | 
|  | irsp->un.ulpWord[0], | 
|  | irsp->un.ulpWord[1], | 
|  | irsp->un.ulpWord[2], | 
|  | irsp->un.ulpWord[3], | 
|  | irsp->un.ulpWord[4], | 
|  | irsp->un.ulpWord[5], | 
|  | *(((uint32_t *) irsp) + 6), | 
|  | *(((uint32_t *) irsp) + 7)); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Fetch the IOCB command type and call the correct | 
|  | * completion routine.  Solicited and Unsolicited | 
|  | * IOCBs on the ELS ring get freed back to the | 
|  | * lpfc_iocb_list by the discovery kernel thread. | 
|  | */ | 
|  | iocb_cmd_type = irsp->ulpCommand & CMD_IOCB_MASK; | 
|  | type = lpfc_sli_iocb_cmd_type(iocb_cmd_type); | 
|  | if (type == LPFC_SOL_IOCB) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | iflag); | 
|  | rc = lpfc_sli_process_sol_iocb(phba, pring, | 
|  | saveq); | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | } else if (type == LPFC_UNSOL_IOCB) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | iflag); | 
|  | rc = lpfc_sli_process_unsol_iocb(phba, pring, | 
|  | saveq); | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | } else if (type == LPFC_ABORT_IOCB) { | 
|  | if ((irsp->ulpCommand != CMD_XRI_ABORTED_CX) && | 
|  | ((cmdiocbp = | 
|  | lpfc_sli_txcmpl_ring_search_slow(pring, | 
|  | saveq)))) { | 
|  | /* Call the specified completion | 
|  | routine */ | 
|  | if (cmdiocbp->iocb_cmpl) { | 
|  | spin_unlock_irqrestore( | 
|  | phba->host->host_lock, | 
|  | iflag); | 
|  | (cmdiocbp->iocb_cmpl) (phba, | 
|  | cmdiocbp, saveq); | 
|  | spin_lock_irqsave( | 
|  | phba->host->host_lock, | 
|  | iflag); | 
|  | } else { | 
|  | list_add_tail(&cmdiocbp->list, | 
|  | lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  | } else if (type == LPFC_UNKNOWN_IOCB) { | 
|  | if (irsp->ulpCommand == CMD_ADAPTER_MSG) { | 
|  |  | 
|  | char adaptermsg[LPFC_MAX_ADPTMSG]; | 
|  |  | 
|  | memset(adaptermsg, 0, | 
|  | LPFC_MAX_ADPTMSG); | 
|  | memcpy(&adaptermsg[0], (uint8_t *) irsp, | 
|  | MAX_MSG_DATA); | 
|  | dev_warn(&((phba->pcidev)->dev), | 
|  | "lpfc%d: %s", | 
|  | phba->brd_no, adaptermsg); | 
|  | } else { | 
|  | /* Unknown IOCB command */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_SLI, | 
|  | "%d:0321 Unknown IOCB command " | 
|  | "Data: x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | irsp->ulpCommand, | 
|  | irsp->ulpStatus, | 
|  | irsp->ulpIoTag, | 
|  | irsp->ulpContext); | 
|  | } | 
|  | } | 
|  |  | 
|  | if (free_saveq) { | 
|  | if (!list_empty(&saveq->list)) { | 
|  | list_for_each_entry_safe(rspiocbp, | 
|  | next_iocb, | 
|  | &saveq->list, | 
|  | list) { | 
|  | list_add_tail(&rspiocbp->list, | 
|  | lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  |  | 
|  | list_add_tail(&saveq->list, lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * If the port response put pointer has not been updated, sync | 
|  | * the pgp->rspPutInx in the MAILBOX_tand fetch the new port | 
|  | * response put pointer. | 
|  | */ | 
|  | if (pring->rspidx == portRspPut) { | 
|  | portRspPut = le32_to_cpu(pgp->rspPutInx); | 
|  | } | 
|  | } /* while (pring->rspidx != portRspPut) */ | 
|  |  | 
|  | if ((rspiocbp != 0) && (mask & HA_R0RE_REQ)) { | 
|  | /* At least one response entry has been freed */ | 
|  | pring->stats.iocb_rsp_full++; | 
|  | /* SET RxRE_RSP in Chip Att register */ | 
|  | status = ((CA_R0ATT | CA_R0RE_RSP) << (pring->ringno * 4)); | 
|  | writel(status, phba->CAregaddr); | 
|  | readl(phba->CAregaddr); /* flush */ | 
|  | } | 
|  | if ((mask & HA_R0CE_RSP) && (pring->flag & LPFC_CALL_RING_AVAILABLE)) { | 
|  | pring->flag &= ~LPFC_CALL_RING_AVAILABLE; | 
|  | pring->stats.iocb_cmd_empty++; | 
|  |  | 
|  | /* Force update of the local copy of cmdGetInx */ | 
|  | pring->local_getidx = le32_to_cpu(pgp->cmdGetInx); | 
|  | lpfc_sli_resume_iocb(phba, pring); | 
|  |  | 
|  | if ((pring->lpfc_sli_cmd_available)) | 
|  | (pring->lpfc_sli_cmd_available) (phba, pring); | 
|  |  | 
|  | } | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_abort_iocb_ring(struct lpfc_hba *phba, struct lpfc_sli_ring *pring) | 
|  | { | 
|  | struct lpfc_iocbq *iocb, *next_iocb; | 
|  | IOCB_t *icmd = NULL, *cmd = NULL; | 
|  | int errcnt; | 
|  | uint16_t iotag; | 
|  |  | 
|  | errcnt = 0; | 
|  |  | 
|  | /* Error everything on txq and txcmplq | 
|  | * First do the txq. | 
|  | */ | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | list_for_each_entry_safe(iocb, next_iocb, &pring->txq, list) { | 
|  | list_del_init(&iocb->list); | 
|  | if (iocb->iocb_cmpl) { | 
|  | icmd = &iocb->iocb; | 
|  | icmd->ulpStatus = IOSTAT_LOCAL_REJECT; | 
|  | icmd->un.ulpWord[4] = IOERR_SLI_ABORTED; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | (iocb->iocb_cmpl) (phba, iocb, iocb); | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | } else { | 
|  | list_add_tail(&iocb->list, &phba->lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  | pring->txq_cnt = 0; | 
|  | INIT_LIST_HEAD(&(pring->txq)); | 
|  |  | 
|  | /* Next issue ABTS for everything on the txcmplq */ | 
|  | list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) { | 
|  | cmd = &iocb->iocb; | 
|  |  | 
|  | /* | 
|  | * Imediate abort of IOCB, clear fast_lookup entry, | 
|  | * if any, deque and call compl | 
|  | */ | 
|  | iotag = cmd->ulpIoTag; | 
|  | if (iotag && pring->fast_lookup && | 
|  | (iotag < pring->fast_iotag)) | 
|  | pring->fast_lookup[iotag] = NULL; | 
|  |  | 
|  | list_del_init(&iocb->list); | 
|  | pring->txcmplq_cnt--; | 
|  |  | 
|  | if (iocb->iocb_cmpl) { | 
|  | cmd->ulpStatus = IOSTAT_LOCAL_REJECT; | 
|  | cmd->un.ulpWord[4] = IOERR_SLI_ABORTED; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | (iocb->iocb_cmpl) (phba, iocb, iocb); | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | } else { | 
|  | list_add_tail(&iocb->list, &phba->lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  |  | 
|  | INIT_LIST_HEAD(&pring->txcmplq); | 
|  | pring->txcmplq_cnt = 0; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  |  | 
|  | return errcnt; | 
|  | } | 
|  |  | 
|  | /****************************************************************************** | 
|  | * lpfc_sli_send_reset | 
|  | * | 
|  | * Note: After returning from this function, the HBA cannot be accessed for | 
|  | * 1 ms. Since we do not wish to delay in interrupt context, it is the | 
|  | * responsibility of the caller to perform the mdelay(1) and flush via readl(). | 
|  | ******************************************************************************/ | 
|  | static int | 
|  | lpfc_sli_send_reset(struct lpfc_hba * phba, uint16_t skip_post) | 
|  | { | 
|  | MAILBOX_t *swpmb; | 
|  | volatile uint32_t word0; | 
|  | void __iomem *to_slim; | 
|  | unsigned long flags = 0; | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  |  | 
|  | /* A board reset must use REAL SLIM. */ | 
|  | phba->sli.sli_flag &= ~LPFC_SLI2_ACTIVE; | 
|  |  | 
|  | word0 = 0; | 
|  | swpmb = (MAILBOX_t *) & word0; | 
|  | swpmb->mbxCommand = MBX_RESTART; | 
|  | swpmb->mbxHc = 1; | 
|  |  | 
|  | to_slim = phba->MBslimaddr; | 
|  | writel(*(uint32_t *) swpmb, to_slim); | 
|  | readl(to_slim); /* flush */ | 
|  |  | 
|  | /* Only skip post after fc_ffinit is completed */ | 
|  | if (skip_post) { | 
|  | word0 = 1;	/* This is really setting up word1 */ | 
|  | } else { | 
|  | word0 = 0;	/* This is really setting up word1 */ | 
|  | } | 
|  | to_slim = phba->MBslimaddr + sizeof (uint32_t); | 
|  | writel(*(uint32_t *) swpmb, to_slim); | 
|  | readl(to_slim); /* flush */ | 
|  |  | 
|  | /* Turn off parity checking and serr during the physical reset */ | 
|  | pci_read_config_word(phba->pcidev, PCI_COMMAND, &phba->pci_cfg_value); | 
|  | pci_write_config_word(phba->pcidev, PCI_COMMAND, | 
|  | (phba->pci_cfg_value & | 
|  | ~(PCI_COMMAND_PARITY | PCI_COMMAND_SERR))); | 
|  |  | 
|  | writel(HC_INITFF, phba->HCregaddr); | 
|  |  | 
|  | phba->hba_state = LPFC_INIT_START; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_brdreset(struct lpfc_hba * phba, uint16_t skip_post) | 
|  | { | 
|  | struct lpfc_sli_ring *pring; | 
|  | int i; | 
|  | struct lpfc_dmabuf *mp, *next_mp; | 
|  | unsigned long flags = 0; | 
|  |  | 
|  | lpfc_sli_send_reset(phba, skip_post); | 
|  | mdelay(1); | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | /* Risk the write on flush case ie no delay after the readl */ | 
|  | readl(phba->HCregaddr); /* flush */ | 
|  | /* Now toggle INITFF bit set by lpfc_sli_send_reset */ | 
|  | writel(0, phba->HCregaddr); | 
|  | readl(phba->HCregaddr); /* flush */ | 
|  |  | 
|  | /* Restore PCI cmd register */ | 
|  | pci_write_config_word(phba->pcidev, PCI_COMMAND, phba->pci_cfg_value); | 
|  |  | 
|  | /* perform board reset */ | 
|  | phba->fc_eventTag = 0; | 
|  | phba->fc_myDID = 0; | 
|  | phba->fc_prevDID = Mask_DID; | 
|  |  | 
|  | /* Reset HBA */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_INFO, | 
|  | LOG_SLI, | 
|  | "%d:0325 Reset HBA Data: x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | phba->hba_state, | 
|  | phba->sli.sli_flag, | 
|  | skip_post); | 
|  |  | 
|  | /* Initialize relevant SLI info */ | 
|  | for (i = 0; i < phba->sli.num_rings; i++) { | 
|  | pring = &phba->sli.ring[i]; | 
|  | pring->flag = 0; | 
|  | pring->rspidx = 0; | 
|  | pring->next_cmdidx  = 0; | 
|  | pring->local_getidx = 0; | 
|  | pring->cmdidx = 0; | 
|  | pring->missbufcnt = 0; | 
|  | } | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  |  | 
|  | if (skip_post) { | 
|  | mdelay(100); | 
|  | } else { | 
|  | mdelay(2000); | 
|  | } | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | /* Cleanup preposted buffers on the ELS ring */ | 
|  | pring = &phba->sli.ring[LPFC_ELS_RING]; | 
|  | list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) { | 
|  | list_del(&mp->list); | 
|  | pring->postbufq_cnt--; | 
|  | lpfc_mbuf_free(phba, mp->virt, mp->phys); | 
|  | kfree(mp); | 
|  | } | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  |  | 
|  | for (i = 0; i < phba->sli.num_rings; i++) | 
|  | lpfc_sli_abort_iocb_ring(phba, &phba->sli.ring[i]); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_chipset_init(struct lpfc_hba *phba) | 
|  | { | 
|  | uint32_t status, i = 0; | 
|  |  | 
|  | /* Read the HBA Host Status Register */ | 
|  | status = readl(phba->HSregaddr); | 
|  |  | 
|  | /* Check status register to see what current state is */ | 
|  | i = 0; | 
|  | while ((status & (HS_FFRDY | HS_MBRDY)) != (HS_FFRDY | HS_MBRDY)) { | 
|  |  | 
|  | /* Check every 100ms for 5 retries, then every 500ms for 5, then | 
|  | * every 2.5 sec for 5, then reset board and every 2.5 sec for | 
|  | * 4. | 
|  | */ | 
|  | if (i++ >= 20) { | 
|  | /* Adapter failed to init, timeout, status reg | 
|  | <status> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_INIT, | 
|  | "%d:0436 Adapter failed to init, " | 
|  | "timeout, status reg x%x\n", | 
|  | phba->brd_no, | 
|  | status); | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | return -ETIMEDOUT; | 
|  | } | 
|  |  | 
|  | /* Check to see if any errors occurred during init */ | 
|  | if (status & HS_FFERM) { | 
|  | /* ERROR: During chipset initialization */ | 
|  | /* Adapter failed to init, chipset, status reg | 
|  | <status> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_INIT, | 
|  | "%d:0437 Adapter failed to init, " | 
|  | "chipset, status reg x%x\n", | 
|  | phba->brd_no, | 
|  | status); | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | if (i <= 5) { | 
|  | msleep(10); | 
|  | } else if (i <= 10) { | 
|  | msleep(500); | 
|  | } else { | 
|  | msleep(2500); | 
|  | } | 
|  |  | 
|  | if (i == 15) { | 
|  | lpfc_sli_brdreset(phba, 0); | 
|  | } | 
|  | /* Read the HBA Host Status Register */ | 
|  | status = readl(phba->HSregaddr); | 
|  | } | 
|  |  | 
|  | /* Check to see if any errors occurred during init */ | 
|  | if (status & HS_FFERM) { | 
|  | /* ERROR: During chipset initialization */ | 
|  | /* Adapter failed to init, chipset, status reg <status> */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_INIT, | 
|  | "%d:0438 Adapter failed to init, chipset, " | 
|  | "status reg x%x\n", | 
|  | phba->brd_no, | 
|  | status); | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | /* Clear all interrupt enable conditions */ | 
|  | writel(0, phba->HCregaddr); | 
|  | readl(phba->HCregaddr); /* flush */ | 
|  |  | 
|  | /* setup host attn register */ | 
|  | writel(0xffffffff, phba->HAregaddr); | 
|  | readl(phba->HAregaddr); /* flush */ | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_hba_setup(struct lpfc_hba * phba) | 
|  | { | 
|  | LPFC_MBOXQ_t *pmb; | 
|  | uint32_t resetcount = 0, rc = 0, done = 0; | 
|  |  | 
|  | pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL); | 
|  | if (!pmb) { | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | while (resetcount < 2 && !done) { | 
|  | phba->hba_state = 0; | 
|  | lpfc_sli_brdreset(phba, 0); | 
|  | msleep(2500); | 
|  | rc = lpfc_sli_chipset_init(phba); | 
|  | if (rc) | 
|  | break; | 
|  |  | 
|  | resetcount++; | 
|  |  | 
|  | /* Call pre CONFIG_PORT mailbox command initialization.  A value of 0 | 
|  | * means the call was successful.  Any other nonzero value is a failure, | 
|  | * but if ERESTART is returned, the driver may reset the HBA and try | 
|  | * again. | 
|  | */ | 
|  | rc = lpfc_config_port_prep(phba); | 
|  | if (rc == -ERESTART) { | 
|  | phba->hba_state = 0; | 
|  | continue; | 
|  | } else if (rc) { | 
|  | break; | 
|  | } | 
|  |  | 
|  | phba->hba_state = LPFC_INIT_MBX_CMDS; | 
|  | lpfc_config_port(phba, pmb); | 
|  | rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL); | 
|  | if (rc == MBX_SUCCESS) | 
|  | done = 1; | 
|  | else { | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_INIT, | 
|  | "%d:0442 Adapter failed to init, mbxCmd x%x " | 
|  | "CONFIG_PORT, mbxStatus x%x Data: x%x\n", | 
|  | phba->brd_no, pmb->mb.mbxCommand, | 
|  | pmb->mb.mbxStatus, 0); | 
|  | phba->sli.sli_flag &= ~LPFC_SLI2_ACTIVE; | 
|  | } | 
|  | } | 
|  | if (!done) | 
|  | goto lpfc_sli_hba_setup_error; | 
|  |  | 
|  | rc = lpfc_sli_ring_map(phba, pmb); | 
|  |  | 
|  | if (rc) | 
|  | goto lpfc_sli_hba_setup_error; | 
|  |  | 
|  | phba->sli.sli_flag |= LPFC_PROCESS_LA; | 
|  |  | 
|  | rc = lpfc_config_port_post(phba); | 
|  | if (rc) | 
|  | goto lpfc_sli_hba_setup_error; | 
|  |  | 
|  | goto lpfc_sli_hba_setup_exit; | 
|  | lpfc_sli_hba_setup_error: | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | lpfc_sli_hba_setup_exit: | 
|  | mempool_free(pmb, phba->mbox_mem_pool); | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_mbox_abort(struct lpfc_hba * phba) | 
|  | { | 
|  | LPFC_MBOXQ_t *pmbox; | 
|  | MAILBOX_t *mb; | 
|  |  | 
|  | if (phba->sli.mbox_active) { | 
|  | del_timer_sync(&phba->sli.mbox_tmo); | 
|  | phba->work_hba_events &= ~WORKER_MBOX_TMO; | 
|  | pmbox = phba->sli.mbox_active; | 
|  | mb = &pmbox->mb; | 
|  | phba->sli.mbox_active = NULL; | 
|  | if (pmbox->mbox_cmpl) { | 
|  | mb->mbxStatus = MBX_NOT_FINISHED; | 
|  | (pmbox->mbox_cmpl) (phba, pmbox); | 
|  | } | 
|  | phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | } | 
|  |  | 
|  | /* Abort all the non active mailbox commands. */ | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | pmbox = lpfc_mbox_get(phba); | 
|  | while (pmbox) { | 
|  | mb = &pmbox->mb; | 
|  | if (pmbox->mbox_cmpl) { | 
|  | mb->mbxStatus = MBX_NOT_FINISHED; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | (pmbox->mbox_cmpl) (phba, pmbox); | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | } | 
|  | pmbox = lpfc_mbox_get(phba); | 
|  | } | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /*! lpfc_mbox_timeout | 
|  | * | 
|  | * \pre | 
|  | * \post | 
|  | * \param hba Pointer to per struct lpfc_hba structure | 
|  | * \param l1  Pointer to the driver's mailbox queue. | 
|  | * \return | 
|  | *   void | 
|  | * | 
|  | * \b Description: | 
|  | * | 
|  | * This routine handles mailbox timeout events at timer interrupt context. | 
|  | */ | 
|  | void | 
|  | lpfc_mbox_timeout(unsigned long ptr) | 
|  | { | 
|  | struct lpfc_hba *phba; | 
|  | unsigned long iflag; | 
|  |  | 
|  | phba = (struct lpfc_hba *)ptr; | 
|  | spin_lock_irqsave(phba->host->host_lock, iflag); | 
|  | if (!(phba->work_hba_events & WORKER_MBOX_TMO)) { | 
|  | phba->work_hba_events |= WORKER_MBOX_TMO; | 
|  | if (phba->work_wait) | 
|  | wake_up(phba->work_wait); | 
|  | } | 
|  | spin_unlock_irqrestore(phba->host->host_lock, iflag); | 
|  | } | 
|  |  | 
|  | void | 
|  | lpfc_mbox_timeout_handler(struct lpfc_hba *phba) | 
|  | { | 
|  | LPFC_MBOXQ_t *pmbox; | 
|  | MAILBOX_t *mb; | 
|  |  | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | if (!(phba->work_hba_events & WORKER_MBOX_TMO)) { | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | return; | 
|  | } | 
|  |  | 
|  | phba->work_hba_events &= ~WORKER_MBOX_TMO; | 
|  |  | 
|  | pmbox = phba->sli.mbox_active; | 
|  | mb = &pmbox->mb; | 
|  |  | 
|  | /* Mbox cmd <mbxCommand> timeout */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_ERR, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0310 Mailbox command x%x timeout Data: x%x x%x x%p\n", | 
|  | phba->brd_no, | 
|  | mb->mbxCommand, | 
|  | phba->hba_state, | 
|  | phba->sli.sli_flag, | 
|  | phba->sli.mbox_active); | 
|  |  | 
|  | phba->sli.mbox_active = NULL; | 
|  | if (pmbox->mbox_cmpl) { | 
|  | mb->mbxStatus = MBX_NOT_FINISHED; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | (pmbox->mbox_cmpl) (phba, pmbox); | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | } | 
|  | phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  |  | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | lpfc_mbox_abort(phba); | 
|  | return; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_issue_mbox(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmbox, uint32_t flag) | 
|  | { | 
|  | MAILBOX_t *mb; | 
|  | struct lpfc_sli *psli; | 
|  | uint32_t status, evtctr; | 
|  | uint32_t ha_copy; | 
|  | int i; | 
|  | unsigned long drvr_flag = 0; | 
|  | volatile uint32_t word0, ldata; | 
|  | void __iomem *to_slim; | 
|  |  | 
|  | psli = &phba->sli; | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, drvr_flag); | 
|  |  | 
|  |  | 
|  | mb = &pmbox->mb; | 
|  | status = MBX_SUCCESS; | 
|  |  | 
|  | if (psli->sli_flag & LPFC_SLI_MBOX_ACTIVE) { | 
|  | /* Polling for a mbox command when another one is already active | 
|  | * is not allowed in SLI. Also, the driver must have established | 
|  | * SLI2 mode to queue and process multiple mbox commands. | 
|  | */ | 
|  |  | 
|  | if (flag & MBX_POLL) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  |  | 
|  | /* Mbox command <mbxCommand> cannot issue */ | 
|  | LOG_MBOX_CANNOT_ISSUE_DATA( phba, mb, psli, flag) | 
|  | return (MBX_NOT_FINISHED); | 
|  | } | 
|  |  | 
|  | if (!(psli->sli_flag & LPFC_SLI2_ACTIVE)) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  | /* Mbox command <mbxCommand> cannot issue */ | 
|  | LOG_MBOX_CANNOT_ISSUE_DATA( phba, mb, psli, flag) | 
|  | return (MBX_NOT_FINISHED); | 
|  | } | 
|  |  | 
|  | /* Handle STOP IOCB processing flag. This is only meaningful | 
|  | * if we are not polling for mbox completion. | 
|  | */ | 
|  | if (flag & MBX_STOP_IOCB) { | 
|  | flag &= ~MBX_STOP_IOCB; | 
|  | /* Now flag each ring */ | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | /* If the ring is active, flag it */ | 
|  | if (psli->ring[i].cmdringaddr) { | 
|  | psli->ring[i].flag |= | 
|  | LPFC_STOP_IOCB_MBX; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | /* Another mailbox command is still being processed, queue this | 
|  | * command to be processed later. | 
|  | */ | 
|  | lpfc_mbox_put(phba, pmbox); | 
|  |  | 
|  | /* Mbox cmd issue - BUSY */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_INFO, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0308 Mbox cmd issue - BUSY Data: x%x x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | mb->mbxCommand, | 
|  | phba->hba_state, | 
|  | psli->sli_flag, | 
|  | flag); | 
|  |  | 
|  | psli->slistat.mbox_busy++; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  |  | 
|  | return (MBX_BUSY); | 
|  | } | 
|  |  | 
|  | /* Handle STOP IOCB processing flag. This is only meaningful | 
|  | * if we are not polling for mbox completion. | 
|  | */ | 
|  | if (flag & MBX_STOP_IOCB) { | 
|  | flag &= ~MBX_STOP_IOCB; | 
|  | if (flag == MBX_NOWAIT) { | 
|  | /* Now flag each ring */ | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | /* If the ring is active, flag it */ | 
|  | if (psli->ring[i].cmdringaddr) { | 
|  | psli->ring[i].flag |= | 
|  | LPFC_STOP_IOCB_MBX; | 
|  | } | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | psli->sli_flag |= LPFC_SLI_MBOX_ACTIVE; | 
|  |  | 
|  | /* If we are not polling, we MUST be in SLI2 mode */ | 
|  | if (flag != MBX_POLL) { | 
|  | if (!(psli->sli_flag & LPFC_SLI2_ACTIVE)) { | 
|  | psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  | /* Mbox command <mbxCommand> cannot issue */ | 
|  | LOG_MBOX_CANNOT_ISSUE_DATA( phba, mb, psli, flag); | 
|  | return (MBX_NOT_FINISHED); | 
|  | } | 
|  | /* timeout active mbox command */ | 
|  | mod_timer(&psli->mbox_tmo, jiffies + HZ * LPFC_MBOX_TMO); | 
|  | } | 
|  |  | 
|  | /* Mailbox cmd <cmd> issue */ | 
|  | lpfc_printf_log(phba, | 
|  | KERN_INFO, | 
|  | LOG_MBOX | LOG_SLI, | 
|  | "%d:0309 Mailbox cmd x%x issue Data: x%x x%x x%x\n", | 
|  | phba->brd_no, | 
|  | mb->mbxCommand, | 
|  | phba->hba_state, | 
|  | psli->sli_flag, | 
|  | flag); | 
|  |  | 
|  | psli->slistat.mbox_cmd++; | 
|  | evtctr = psli->slistat.mbox_event; | 
|  |  | 
|  | /* next set own bit for the adapter and copy over command word */ | 
|  | mb->mbxOwner = OWN_CHIP; | 
|  |  | 
|  | if (psli->sli_flag & LPFC_SLI2_ACTIVE) { | 
|  | /* First copy command data to host SLIM area */ | 
|  | lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx, MAILBOX_CMD_SIZE); | 
|  | } else { | 
|  | if (mb->mbxCommand == MBX_CONFIG_PORT) { | 
|  | /* copy command data into host mbox for cmpl */ | 
|  | lpfc_sli_pcimem_bcopy(mb, &phba->slim2p->mbx, | 
|  | MAILBOX_CMD_SIZE); | 
|  | } | 
|  |  | 
|  | /* First copy mbox command data to HBA SLIM, skip past first | 
|  | word */ | 
|  | to_slim = phba->MBslimaddr + sizeof (uint32_t); | 
|  | lpfc_memcpy_to_slim(to_slim, &mb->un.varWords[0], | 
|  | MAILBOX_CMD_SIZE - sizeof (uint32_t)); | 
|  |  | 
|  | /* Next copy over first word, with mbxOwner set */ | 
|  | ldata = *((volatile uint32_t *)mb); | 
|  | to_slim = phba->MBslimaddr; | 
|  | writel(ldata, to_slim); | 
|  | readl(to_slim); /* flush */ | 
|  |  | 
|  | if (mb->mbxCommand == MBX_CONFIG_PORT) { | 
|  | /* switch over to host mailbox */ | 
|  | psli->sli_flag |= LPFC_SLI2_ACTIVE; | 
|  | } | 
|  | } | 
|  |  | 
|  | wmb(); | 
|  | /* interrupt board to doit right away */ | 
|  | writel(CA_MBATT, phba->CAregaddr); | 
|  | readl(phba->CAregaddr); /* flush */ | 
|  |  | 
|  | switch (flag) { | 
|  | case MBX_NOWAIT: | 
|  | /* Don't wait for it to finish, just return */ | 
|  | psli->mbox_active = pmbox; | 
|  | break; | 
|  |  | 
|  | case MBX_POLL: | 
|  | i = 0; | 
|  | psli->mbox_active = NULL; | 
|  | if (psli->sli_flag & LPFC_SLI2_ACTIVE) { | 
|  | /* First read mbox status word */ | 
|  | word0 = *((volatile uint32_t *)&phba->slim2p->mbx); | 
|  | word0 = le32_to_cpu(word0); | 
|  | } else { | 
|  | /* First read mbox status word */ | 
|  | word0 = readl(phba->MBslimaddr); | 
|  | } | 
|  |  | 
|  | /* Read the HBA Host Attention Register */ | 
|  | ha_copy = readl(phba->HAregaddr); | 
|  |  | 
|  | /* Wait for command to complete */ | 
|  | while (((word0 & OWN_CHIP) == OWN_CHIP) | 
|  | || !(ha_copy & HA_MBATT)) { | 
|  | if (i++ >= 100) { | 
|  | psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  | return (MBX_NOT_FINISHED); | 
|  | } | 
|  |  | 
|  | /* Check if we took a mbox interrupt while we were | 
|  | polling */ | 
|  | if (((word0 & OWN_CHIP) != OWN_CHIP) | 
|  | && (evtctr != psli->slistat.mbox_event)) | 
|  | break; | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | drvr_flag); | 
|  |  | 
|  | /* Can be in interrupt context, do not sleep */ | 
|  | /* (or might be called with interrupts disabled) */ | 
|  | mdelay(i); | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, drvr_flag); | 
|  |  | 
|  | if (psli->sli_flag & LPFC_SLI2_ACTIVE) { | 
|  | /* First copy command data */ | 
|  | word0 = *((volatile uint32_t *) | 
|  | &phba->slim2p->mbx); | 
|  | word0 = le32_to_cpu(word0); | 
|  | if (mb->mbxCommand == MBX_CONFIG_PORT) { | 
|  | MAILBOX_t *slimmb; | 
|  | volatile uint32_t slimword0; | 
|  | /* Check real SLIM for any errors */ | 
|  | slimword0 = readl(phba->MBslimaddr); | 
|  | slimmb = (MAILBOX_t *) & slimword0; | 
|  | if (((slimword0 & OWN_CHIP) != OWN_CHIP) | 
|  | && slimmb->mbxStatus) { | 
|  | psli->sli_flag &= | 
|  | ~LPFC_SLI2_ACTIVE; | 
|  | word0 = slimword0; | 
|  | } | 
|  | } | 
|  | } else { | 
|  | /* First copy command data */ | 
|  | word0 = readl(phba->MBslimaddr); | 
|  | } | 
|  | /* Read the HBA Host Attention Register */ | 
|  | ha_copy = readl(phba->HAregaddr); | 
|  | } | 
|  |  | 
|  | if (psli->sli_flag & LPFC_SLI2_ACTIVE) { | 
|  | /* copy results back to user */ | 
|  | lpfc_sli_pcimem_bcopy(&phba->slim2p->mbx, mb, | 
|  | MAILBOX_CMD_SIZE); | 
|  | } else { | 
|  | /* First copy command data */ | 
|  | lpfc_memcpy_from_slim(mb, phba->MBslimaddr, | 
|  | MAILBOX_CMD_SIZE); | 
|  | if ((mb->mbxCommand == MBX_DUMP_MEMORY) && | 
|  | pmbox->context2) { | 
|  | lpfc_memcpy_from_slim((void *)pmbox->context2, | 
|  | phba->MBslimaddr + DMP_RSP_OFFSET, | 
|  | mb->un.varDmp.word_cnt); | 
|  | } | 
|  | } | 
|  |  | 
|  | writel(HA_MBATT, phba->HAregaddr); | 
|  | readl(phba->HAregaddr); /* flush */ | 
|  |  | 
|  | psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | status = mb->mbxStatus; | 
|  | } | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, drvr_flag); | 
|  | return (status); | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_ringtx_put(struct lpfc_hba * phba, struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq * piocb) | 
|  | { | 
|  | /* Insert the caller's iocb in the txq tail for later processing. */ | 
|  | list_add_tail(&piocb->list, &pring->txq); | 
|  | pring->txq_cnt++; | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | static struct lpfc_iocbq * | 
|  | lpfc_sli_next_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | struct lpfc_iocbq ** piocb) | 
|  | { | 
|  | struct lpfc_iocbq * nextiocb; | 
|  |  | 
|  | nextiocb = lpfc_sli_ringtx_get(phba, pring); | 
|  | if (!nextiocb) { | 
|  | nextiocb = *piocb; | 
|  | *piocb = NULL; | 
|  | } | 
|  |  | 
|  | return nextiocb; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_issue_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | struct lpfc_iocbq *piocb, uint32_t flag) | 
|  | { | 
|  | struct lpfc_iocbq *nextiocb; | 
|  | IOCB_t *iocb; | 
|  |  | 
|  | /* | 
|  | * We should never get an IOCB if we are in a < LINK_DOWN state | 
|  | */ | 
|  | if (unlikely(phba->hba_state < LPFC_LINK_DOWN)) | 
|  | return IOCB_ERROR; | 
|  |  | 
|  | /* | 
|  | * Check to see if we are blocking IOCB processing because of a | 
|  | * outstanding mbox command. | 
|  | */ | 
|  | if (unlikely(pring->flag & LPFC_STOP_IOCB_MBX)) | 
|  | goto iocb_busy; | 
|  |  | 
|  | if (unlikely(phba->hba_state == LPFC_LINK_DOWN)) { | 
|  | /* | 
|  | * Only CREATE_XRI, CLOSE_XRI, ABORT_XRI, and QUE_RING_BUF | 
|  | * can be issued if the link is not up. | 
|  | */ | 
|  | switch (piocb->iocb.ulpCommand) { | 
|  | case CMD_QUE_RING_BUF_CN: | 
|  | case CMD_QUE_RING_BUF64_CN: | 
|  | /* | 
|  | * For IOCBs, like QUE_RING_BUF, that have no rsp ring | 
|  | * completion, iocb_cmpl MUST be 0. | 
|  | */ | 
|  | if (piocb->iocb_cmpl) | 
|  | piocb->iocb_cmpl = NULL; | 
|  | /*FALLTHROUGH*/ | 
|  | case CMD_CREATE_XRI_CR: | 
|  | break; | 
|  | default: | 
|  | goto iocb_busy; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * For FCP commands, we must be in a state where we can process link | 
|  | * attention events. | 
|  | */ | 
|  | } else if (unlikely(pring->ringno == phba->sli.fcp_ring && | 
|  | !(phba->sli.sli_flag & LPFC_PROCESS_LA))) | 
|  | goto iocb_busy; | 
|  |  | 
|  | /* | 
|  | * Check to see if this is a high priority command. | 
|  | * If so bypass tx queue processing. | 
|  | */ | 
|  | if (unlikely((flag & SLI_IOCB_HIGH_PRIORITY) && | 
|  | (iocb = lpfc_sli_next_iocb_slot(phba, pring)))) { | 
|  | lpfc_sli_submit_iocb(phba, pring, iocb, piocb); | 
|  | piocb = NULL; | 
|  | } | 
|  |  | 
|  | while ((iocb = lpfc_sli_next_iocb_slot(phba, pring)) && | 
|  | (nextiocb = lpfc_sli_next_iocb(phba, pring, &piocb))) | 
|  | lpfc_sli_submit_iocb(phba, pring, iocb, nextiocb); | 
|  |  | 
|  | if (iocb) | 
|  | lpfc_sli_update_ring(phba, pring); | 
|  | else | 
|  | lpfc_sli_update_full_ring(phba, pring); | 
|  |  | 
|  | if (!piocb) | 
|  | return IOCB_SUCCESS; | 
|  |  | 
|  | goto out_busy; | 
|  |  | 
|  | iocb_busy: | 
|  | pring->stats.iocb_cmd_delay++; | 
|  |  | 
|  | out_busy: | 
|  |  | 
|  | if (!(flag & SLI_IOCB_RET_IOCB)) { | 
|  | lpfc_sli_ringtx_put(phba, pring, piocb); | 
|  | return IOCB_SUCCESS; | 
|  | } | 
|  |  | 
|  | return IOCB_BUSY; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_setup(struct lpfc_hba *phba) | 
|  | { | 
|  | int i, totiocb = 0; | 
|  | struct lpfc_sli *psli = &phba->sli; | 
|  | struct lpfc_sli_ring *pring; | 
|  |  | 
|  | psli->num_rings = MAX_CONFIGURED_RINGS; | 
|  | psli->sli_flag = 0; | 
|  | psli->fcp_ring = LPFC_FCP_RING; | 
|  | psli->next_ring = LPFC_FCP_NEXT_RING; | 
|  | psli->ip_ring = LPFC_IP_RING; | 
|  |  | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | pring = &psli->ring[i]; | 
|  | switch (i) { | 
|  | case LPFC_FCP_RING:	/* ring 0 - FCP */ | 
|  | /* numCiocb and numRiocb are used in config_port */ | 
|  | pring->numCiocb = SLI2_IOCB_CMD_R0_ENTRIES; | 
|  | pring->numRiocb = SLI2_IOCB_RSP_R0_ENTRIES; | 
|  | pring->numCiocb += SLI2_IOCB_CMD_R1XTRA_ENTRIES; | 
|  | pring->numRiocb += SLI2_IOCB_RSP_R1XTRA_ENTRIES; | 
|  | pring->numCiocb += SLI2_IOCB_CMD_R3XTRA_ENTRIES; | 
|  | pring->numRiocb += SLI2_IOCB_RSP_R3XTRA_ENTRIES; | 
|  | pring->iotag_ctr = 0; | 
|  | pring->iotag_max = | 
|  | (phba->cfg_hba_queue_depth * 2); | 
|  | pring->fast_iotag = pring->iotag_max; | 
|  | pring->num_mask = 0; | 
|  | break; | 
|  | case LPFC_IP_RING:	/* ring 1 - IP */ | 
|  | /* numCiocb and numRiocb are used in config_port */ | 
|  | pring->numCiocb = SLI2_IOCB_CMD_R1_ENTRIES; | 
|  | pring->numRiocb = SLI2_IOCB_RSP_R1_ENTRIES; | 
|  | pring->num_mask = 0; | 
|  | break; | 
|  | case LPFC_ELS_RING:	/* ring 2 - ELS / CT */ | 
|  | /* numCiocb and numRiocb are used in config_port */ | 
|  | pring->numCiocb = SLI2_IOCB_CMD_R2_ENTRIES; | 
|  | pring->numRiocb = SLI2_IOCB_RSP_R2_ENTRIES; | 
|  | pring->fast_iotag = 0; | 
|  | pring->iotag_ctr = 0; | 
|  | pring->iotag_max = 4096; | 
|  | pring->num_mask = 4; | 
|  | pring->prt[0].profile = 0;	/* Mask 0 */ | 
|  | pring->prt[0].rctl = FC_ELS_REQ; | 
|  | pring->prt[0].type = FC_ELS_DATA; | 
|  | pring->prt[0].lpfc_sli_rcv_unsol_event = | 
|  | lpfc_els_unsol_event; | 
|  | pring->prt[1].profile = 0;	/* Mask 1 */ | 
|  | pring->prt[1].rctl = FC_ELS_RSP; | 
|  | pring->prt[1].type = FC_ELS_DATA; | 
|  | pring->prt[1].lpfc_sli_rcv_unsol_event = | 
|  | lpfc_els_unsol_event; | 
|  | pring->prt[2].profile = 0;	/* Mask 2 */ | 
|  | /* NameServer Inquiry */ | 
|  | pring->prt[2].rctl = FC_UNSOL_CTL; | 
|  | /* NameServer */ | 
|  | pring->prt[2].type = FC_COMMON_TRANSPORT_ULP; | 
|  | pring->prt[2].lpfc_sli_rcv_unsol_event = | 
|  | lpfc_ct_unsol_event; | 
|  | pring->prt[3].profile = 0;	/* Mask 3 */ | 
|  | /* NameServer response */ | 
|  | pring->prt[3].rctl = FC_SOL_CTL; | 
|  | /* NameServer */ | 
|  | pring->prt[3].type = FC_COMMON_TRANSPORT_ULP; | 
|  | pring->prt[3].lpfc_sli_rcv_unsol_event = | 
|  | lpfc_ct_unsol_event; | 
|  | break; | 
|  | } | 
|  | totiocb += (pring->numCiocb + pring->numRiocb); | 
|  | } | 
|  | if (totiocb > MAX_SLI2_IOCB) { | 
|  | /* Too many cmd / rsp ring entries in SLI2 SLIM */ | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_INIT, | 
|  | "%d:0462 Too many cmd / rsp ring entries in " | 
|  | "SLI2 SLIM Data: x%x x%x\n", | 
|  | phba->brd_no, totiocb, MAX_SLI2_IOCB); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_queue_setup(struct lpfc_hba * phba) | 
|  | { | 
|  | struct lpfc_sli *psli; | 
|  | struct lpfc_sli_ring *pring; | 
|  | int i, cnt; | 
|  |  | 
|  | psli = &phba->sli; | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | INIT_LIST_HEAD(&psli->mboxq); | 
|  | /* Initialize list headers for txq and txcmplq as double linked lists */ | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | pring = &psli->ring[i]; | 
|  | pring->ringno = i; | 
|  | pring->next_cmdidx  = 0; | 
|  | pring->local_getidx = 0; | 
|  | pring->cmdidx = 0; | 
|  | INIT_LIST_HEAD(&pring->txq); | 
|  | INIT_LIST_HEAD(&pring->txcmplq); | 
|  | INIT_LIST_HEAD(&pring->iocb_continueq); | 
|  | INIT_LIST_HEAD(&pring->postbufq); | 
|  | cnt = pring->fast_iotag; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | if (cnt) { | 
|  | pring->fast_lookup = | 
|  | kmalloc(cnt * sizeof (struct lpfc_iocbq *), | 
|  | GFP_KERNEL); | 
|  | if (pring->fast_lookup == 0) { | 
|  | return (0); | 
|  | } | 
|  | memset((char *)pring->fast_lookup, 0, | 
|  | cnt * sizeof (struct lpfc_iocbq *)); | 
|  | } | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | } | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | return (1); | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_hba_down(struct lpfc_hba * phba) | 
|  | { | 
|  | struct lpfc_sli *psli; | 
|  | struct lpfc_sli_ring *pring; | 
|  | LPFC_MBOXQ_t *pmb; | 
|  | struct lpfc_iocbq *iocb, *next_iocb; | 
|  | IOCB_t *icmd = NULL; | 
|  | int i; | 
|  | unsigned long flags = 0; | 
|  |  | 
|  | psli = &phba->sli; | 
|  | lpfc_hba_down_prep(phba); | 
|  |  | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  |  | 
|  | for (i = 0; i < psli->num_rings; i++) { | 
|  | pring = &psli->ring[i]; | 
|  | pring->flag |= LPFC_DEFERRED_RING_EVENT; | 
|  |  | 
|  | /* | 
|  | * Error everything on the txq since these iocbs have not been | 
|  | * given to the FW yet. | 
|  | */ | 
|  | pring->txq_cnt = 0; | 
|  |  | 
|  | list_for_each_entry_safe(iocb, next_iocb, &pring->txq, list) { | 
|  | list_del_init(&iocb->list); | 
|  | if (iocb->iocb_cmpl) { | 
|  | icmd = &iocb->iocb; | 
|  | icmd->ulpStatus = IOSTAT_LOCAL_REJECT; | 
|  | icmd->un.ulpWord[4] = IOERR_SLI_DOWN; | 
|  | spin_unlock_irqrestore(phba->host->host_lock, | 
|  | flags); | 
|  | (iocb->iocb_cmpl) (phba, iocb, iocb); | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | } else { | 
|  | list_add_tail(&iocb->list, | 
|  | &phba->lpfc_iocb_list); | 
|  | } | 
|  | } | 
|  |  | 
|  | INIT_LIST_HEAD(&(pring->txq)); | 
|  |  | 
|  | if (pring->fast_lookup) { | 
|  | kfree(pring->fast_lookup); | 
|  | pring->fast_lookup = NULL; | 
|  | } | 
|  |  | 
|  | } | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  |  | 
|  | /* Return any active mbox cmds */ | 
|  | del_timer_sync(&psli->mbox_tmo); | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | phba->work_hba_events &= ~WORKER_MBOX_TMO; | 
|  | if (psli->mbox_active) { | 
|  | pmb = psli->mbox_active; | 
|  | pmb->mb.mbxStatus = MBX_NOT_FINISHED; | 
|  | if (pmb->mbox_cmpl) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  | pmb->mbox_cmpl(phba,pmb); | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | } | 
|  | } | 
|  | psli->sli_flag &= ~LPFC_SLI_MBOX_ACTIVE; | 
|  | psli->mbox_active = NULL; | 
|  |  | 
|  | /* Return any pending mbox cmds */ | 
|  | while ((pmb = lpfc_mbox_get(phba)) != NULL) { | 
|  | pmb->mb.mbxStatus = MBX_NOT_FINISHED; | 
|  | if (pmb->mbox_cmpl) { | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  | pmb->mbox_cmpl(phba,pmb); | 
|  | spin_lock_irqsave(phba->host->host_lock, flags); | 
|  | } | 
|  | } | 
|  |  | 
|  | INIT_LIST_HEAD(&psli->mboxq); | 
|  |  | 
|  | spin_unlock_irqrestore(phba->host->host_lock, flags); | 
|  |  | 
|  | /* | 
|  | * Provided the hba is not in an error state, reset it.  It is not | 
|  | * capable of IO anymore. | 
|  | */ | 
|  | if (phba->hba_state != LPFC_HBA_ERROR) { | 
|  | phba->hba_state = LPFC_INIT_START; | 
|  | lpfc_sli_brdreset(phba, 1); | 
|  | } | 
|  |  | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | void | 
|  | lpfc_sli_pcimem_bcopy(void *srcp, void *destp, uint32_t cnt) | 
|  | { | 
|  | uint32_t *src = srcp; | 
|  | uint32_t *dest = destp; | 
|  | uint32_t ldata; | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < (int)cnt; i += sizeof (uint32_t)) { | 
|  | ldata = *src; | 
|  | ldata = le32_to_cpu(ldata); | 
|  | *dest = ldata; | 
|  | src++; | 
|  | dest++; | 
|  | } | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_ringpostbuf_put(struct lpfc_hba * phba, struct lpfc_sli_ring * pring, | 
|  | struct lpfc_dmabuf * mp) | 
|  | { | 
|  | /* Stick struct lpfc_dmabuf at end of postbufq so driver can look it up | 
|  | later */ | 
|  | list_add_tail(&mp->list, &pring->postbufq); | 
|  |  | 
|  | pring->postbufq_cnt++; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | struct lpfc_dmabuf * | 
|  | lpfc_sli_ringpostbuf_get(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | dma_addr_t phys) | 
|  | { | 
|  | struct lpfc_dmabuf *mp, *next_mp; | 
|  | struct list_head *slp = &pring->postbufq; | 
|  |  | 
|  | /* Search postbufq, from the begining, looking for a match on phys */ | 
|  | list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) { | 
|  | if (mp->phys == phys) { | 
|  | list_del_init(&mp->list); | 
|  | pring->postbufq_cnt--; | 
|  | return mp; | 
|  | } | 
|  | } | 
|  |  | 
|  | lpfc_printf_log(phba, KERN_ERR, LOG_INIT, | 
|  | "%d:0410 Cannot find virtual addr for mapped buf on " | 
|  | "ring %d Data x%llx x%p x%p x%x\n", | 
|  | phba->brd_no, pring->ringno, (unsigned long long)phys, | 
|  | slp->next, slp->prev, pring->postbufq_cnt); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | static void | 
|  | lpfc_sli_abort_elsreq_cmpl(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb, | 
|  | struct lpfc_iocbq * rspiocb) | 
|  | { | 
|  | struct lpfc_dmabuf *buf_ptr, *buf_ptr1; | 
|  | /* Free the resources associated with the ELS_REQUEST64 IOCB the driver | 
|  | * just aborted. | 
|  | * In this case, context2  = cmd,  context2->next = rsp, context3 = bpl | 
|  | */ | 
|  | if (cmdiocb->context2) { | 
|  | buf_ptr1 = (struct lpfc_dmabuf *) cmdiocb->context2; | 
|  |  | 
|  | /* Free the response IOCB before completing the abort | 
|  | command.  */ | 
|  | buf_ptr = NULL; | 
|  | list_remove_head((&buf_ptr1->list), buf_ptr, | 
|  | struct lpfc_dmabuf, list); | 
|  | if (buf_ptr) { | 
|  | lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys); | 
|  | kfree(buf_ptr); | 
|  | } | 
|  | lpfc_mbuf_free(phba, buf_ptr1->virt, buf_ptr1->phys); | 
|  | kfree(buf_ptr1); | 
|  | } | 
|  |  | 
|  | if (cmdiocb->context3) { | 
|  | buf_ptr = (struct lpfc_dmabuf *) cmdiocb->context3; | 
|  | lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys); | 
|  | kfree(buf_ptr); | 
|  | } | 
|  |  | 
|  | list_add_tail(&cmdiocb->list, &phba->lpfc_iocb_list); | 
|  | return; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_issue_abort_iotag32(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq * cmdiocb) | 
|  | { | 
|  | struct list_head *lpfc_iocb_list = &phba->lpfc_iocb_list; | 
|  | struct lpfc_iocbq *abtsiocbp = NULL; | 
|  | IOCB_t *icmd = NULL; | 
|  | IOCB_t *iabt = NULL; | 
|  |  | 
|  | /* issue ABTS for this IOCB based on iotag */ | 
|  | list_remove_head(lpfc_iocb_list, abtsiocbp, struct lpfc_iocbq, list); | 
|  | if (abtsiocbp == NULL) | 
|  | return 0; | 
|  | memset(abtsiocbp, 0, sizeof (struct lpfc_iocbq)); | 
|  |  | 
|  | iabt = &abtsiocbp->iocb; | 
|  | icmd = &cmdiocb->iocb; | 
|  | switch (icmd->ulpCommand) { | 
|  | case CMD_ELS_REQUEST64_CR: | 
|  | /* Even though we abort the ELS command, the firmware may access | 
|  | * the BPL or other resources before it processes our | 
|  | * ABORT_MXRI64. Thus we must delay reusing the cmdiocb | 
|  | * resources till the actual abort request completes. | 
|  | */ | 
|  | abtsiocbp->context1 = (void *)((unsigned long)icmd->ulpCommand); | 
|  | abtsiocbp->context2 = cmdiocb->context2; | 
|  | abtsiocbp->context3 = cmdiocb->context3; | 
|  | cmdiocb->context2 = NULL; | 
|  | cmdiocb->context3 = NULL; | 
|  | abtsiocbp->iocb_cmpl = lpfc_sli_abort_elsreq_cmpl; | 
|  | break; | 
|  | default: | 
|  | list_add_tail(&abtsiocbp->list, lpfc_iocb_list); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | iabt->un.amxri.abortType = ABORT_TYPE_ABTS; | 
|  | iabt->un.amxri.iotag32 = icmd->un.elsreq64.bdl.ulpIoTag32; | 
|  |  | 
|  | iabt->ulpLe = 1; | 
|  | iabt->ulpClass = CLASS3; | 
|  | iabt->ulpCommand = CMD_ABORT_MXRI64_CN; | 
|  |  | 
|  | if (lpfc_sli_issue_iocb(phba, pring, abtsiocbp, 0) == IOCB_ERROR) { | 
|  | list_add_tail(&abtsiocbp->list, lpfc_iocb_list); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static int | 
|  | lpfc_sli_validate_iocb_cmd(struct lpfc_scsi_buf *lpfc_cmd, uint16_t tgt_id, | 
|  | uint64_t lun_id, struct lpfc_iocbq *iocb, | 
|  | uint32_t ctx, lpfc_ctx_cmd ctx_cmd) | 
|  | { | 
|  | int rc = 1; | 
|  |  | 
|  | if (lpfc_cmd == NULL) | 
|  | return rc; | 
|  |  | 
|  | switch (ctx_cmd) { | 
|  | case LPFC_CTX_LUN: | 
|  | if ((lpfc_cmd->pCmd->device->id == tgt_id) && | 
|  | (lpfc_cmd->pCmd->device->lun == lun_id)) | 
|  | rc = 0; | 
|  | break; | 
|  | case LPFC_CTX_TGT: | 
|  | if (lpfc_cmd->pCmd->device->id == tgt_id) | 
|  | rc = 0; | 
|  | break; | 
|  | case LPFC_CTX_CTX: | 
|  | if (iocb->iocb.ulpContext == ctx) | 
|  | rc = 0; | 
|  | case LPFC_CTX_HOST: | 
|  | rc = 0; | 
|  | break; | 
|  | default: | 
|  | printk(KERN_ERR "%s: Unknown context cmd type, value %d\n", | 
|  | __FUNCTION__, ctx_cmd); | 
|  | break; | 
|  | } | 
|  |  | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_sum_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | uint16_t tgt_id, uint64_t lun_id, lpfc_ctx_cmd ctx_cmd) | 
|  | { | 
|  | struct lpfc_iocbq *iocb, *next_iocb; | 
|  | IOCB_t *cmd = NULL; | 
|  | struct lpfc_scsi_buf *lpfc_cmd; | 
|  | int sum = 0, ret_val = 0; | 
|  |  | 
|  | /* Next check the txcmplq */ | 
|  | list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) { | 
|  | cmd = &iocb->iocb; | 
|  |  | 
|  | /* Must be a FCP command */ | 
|  | if ((cmd->ulpCommand != CMD_FCP_ICMND64_CR) && | 
|  | (cmd->ulpCommand != CMD_FCP_IWRITE64_CR) && | 
|  | (cmd->ulpCommand != CMD_FCP_IREAD64_CR)) { | 
|  | continue; | 
|  | } | 
|  |  | 
|  | /* context1 MUST be a struct lpfc_scsi_buf */ | 
|  | lpfc_cmd = (struct lpfc_scsi_buf *) (iocb->context1); | 
|  | ret_val = lpfc_sli_validate_iocb_cmd(lpfc_cmd, tgt_id, lun_id, | 
|  | NULL, 0, ctx_cmd); | 
|  | if (ret_val != 0) | 
|  | continue; | 
|  | sum++; | 
|  | } | 
|  | return sum; | 
|  | } | 
|  |  | 
|  | void | 
|  | lpfc_sli_abort_fcp_cmpl(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb, | 
|  | struct lpfc_iocbq * rspiocb) | 
|  | { | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | list_add_tail(&cmdiocb->list, &phba->lpfc_iocb_list); | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | return; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_abort_iocb(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, | 
|  | uint16_t tgt_id, uint64_t lun_id, uint32_t ctx, | 
|  | lpfc_ctx_cmd abort_cmd) | 
|  | { | 
|  | struct lpfc_iocbq *iocb, *next_iocb; | 
|  | struct lpfc_iocbq *abtsiocb = NULL; | 
|  | struct list_head *lpfc_iocb_list = &phba->lpfc_iocb_list; | 
|  | IOCB_t *cmd = NULL; | 
|  | struct lpfc_scsi_buf *lpfc_cmd; | 
|  | int errcnt = 0, ret_val = 0; | 
|  |  | 
|  | list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) { | 
|  | cmd = &iocb->iocb; | 
|  |  | 
|  | /* Must be a FCP command */ | 
|  | if ((cmd->ulpCommand != CMD_FCP_ICMND64_CR) && | 
|  | (cmd->ulpCommand != CMD_FCP_IWRITE64_CR) && | 
|  | (cmd->ulpCommand != CMD_FCP_IREAD64_CR)) { | 
|  | continue; | 
|  | } | 
|  |  | 
|  | /* context1 MUST be a struct lpfc_scsi_buf */ | 
|  | lpfc_cmd = (struct lpfc_scsi_buf *) (iocb->context1); | 
|  | ret_val = lpfc_sli_validate_iocb_cmd(lpfc_cmd, tgt_id, lun_id, | 
|  | iocb, ctx, abort_cmd); | 
|  | if (ret_val != 0) | 
|  | continue; | 
|  |  | 
|  | /* issue ABTS for this IOCB based on iotag */ | 
|  | list_remove_head(lpfc_iocb_list, abtsiocb, struct lpfc_iocbq, | 
|  | list); | 
|  | if (abtsiocb == NULL) { | 
|  | errcnt++; | 
|  | continue; | 
|  | } | 
|  | memset(abtsiocb, 0, sizeof (struct lpfc_iocbq)); | 
|  |  | 
|  | abtsiocb->iocb.un.acxri.abortType = ABORT_TYPE_ABTS; | 
|  | abtsiocb->iocb.un.acxri.abortContextTag = cmd->ulpContext; | 
|  | abtsiocb->iocb.un.acxri.abortIoTag = cmd->ulpIoTag; | 
|  | abtsiocb->iocb.ulpLe = 1; | 
|  | abtsiocb->iocb.ulpClass = cmd->ulpClass; | 
|  |  | 
|  | if (phba->hba_state >= LPFC_LINK_UP) | 
|  | abtsiocb->iocb.ulpCommand = CMD_ABORT_XRI_CN; | 
|  | else | 
|  | abtsiocb->iocb.ulpCommand = CMD_CLOSE_XRI_CN; | 
|  |  | 
|  | /* Setup callback routine and issue the command. */ | 
|  | abtsiocb->iocb_cmpl = lpfc_sli_abort_fcp_cmpl; | 
|  | ret_val = lpfc_sli_issue_iocb(phba, pring, abtsiocb, 0); | 
|  | if (ret_val == IOCB_ERROR) { | 
|  | list_add_tail(&abtsiocb->list, lpfc_iocb_list); | 
|  | errcnt++; | 
|  | continue; | 
|  | } | 
|  | } | 
|  |  | 
|  | return errcnt; | 
|  | } | 
|  |  | 
|  | void | 
|  | lpfc_sli_wake_iocb_high_priority(struct lpfc_hba * phba, | 
|  | struct lpfc_iocbq * queue1, | 
|  | struct lpfc_iocbq * queue2) | 
|  | { | 
|  | if (queue1->context2 && queue2) | 
|  | memcpy(queue1->context2, queue2, sizeof (struct lpfc_iocbq)); | 
|  |  | 
|  | /* The waiter is looking for LPFC_IO_HIPRI bit to be set | 
|  | as a signal to wake up */ | 
|  | queue1->iocb_flag |= LPFC_IO_HIPRI; | 
|  | return; | 
|  | } | 
|  |  | 
|  | int | 
|  | lpfc_sli_issue_iocb_wait_high_priority(struct lpfc_hba * phba, | 
|  | struct lpfc_sli_ring * pring, | 
|  | struct lpfc_iocbq * piocb, | 
|  | uint32_t flag, | 
|  | struct lpfc_iocbq * prspiocbq, | 
|  | uint32_t timeout) | 
|  | { | 
|  | int j, delay_time,  retval = IOCB_ERROR; | 
|  |  | 
|  | /* The caller must left context1 empty.  */ | 
|  | if (piocb->context_un.hipri_wait_queue != 0) { | 
|  | return IOCB_ERROR; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * If the caller has provided a response iocbq buffer, context2 must | 
|  | * be NULL or its an error. | 
|  | */ | 
|  | if (prspiocbq && piocb->context2) { | 
|  | return IOCB_ERROR; | 
|  | } | 
|  |  | 
|  | piocb->context2 = prspiocbq; | 
|  |  | 
|  | /* Setup callback routine and issue the command. */ | 
|  | piocb->iocb_cmpl = lpfc_sli_wake_iocb_high_priority; | 
|  | retval = lpfc_sli_issue_iocb(phba, pring, piocb, | 
|  | flag | SLI_IOCB_HIGH_PRIORITY); | 
|  | if (retval != IOCB_SUCCESS) { | 
|  | piocb->context2 = NULL; | 
|  | return IOCB_ERROR; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This high-priority iocb was sent out-of-band.  Poll for its | 
|  | * completion rather than wait for a signal.  Note that the host_lock | 
|  | * is held by the midlayer and must be released here to allow the | 
|  | * interrupt handlers to complete the IO and signal this routine via | 
|  | * the iocb_flag. | 
|  | * Also, the delay_time is computed to be one second longer than | 
|  | * the scsi command timeout to give the FW time to abort on | 
|  | * timeout rather than the driver just giving up.  Typically, | 
|  | * the midlayer does not specify a time for this command so the | 
|  | * driver is free to enforce its own timeout. | 
|  | */ | 
|  |  | 
|  | delay_time = ((timeout + 1) * 1000) >> 6; | 
|  | retval = IOCB_ERROR; | 
|  | spin_unlock_irq(phba->host->host_lock); | 
|  | for (j = 0; j < 64; j++) { | 
|  | msleep(delay_time); | 
|  | if (piocb->iocb_flag & LPFC_IO_HIPRI) { | 
|  | piocb->iocb_flag &= ~LPFC_IO_HIPRI; | 
|  | retval = IOCB_SUCCESS; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | spin_lock_irq(phba->host->host_lock); | 
|  | piocb->context2 = NULL; | 
|  | return retval; | 
|  | } | 
|  | int | 
|  | lpfc_sli_issue_mbox_wait(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmboxq, | 
|  | uint32_t timeout) | 
|  | { | 
|  | DECLARE_WAIT_QUEUE_HEAD(done_q); | 
|  | DECLARE_WAITQUEUE(wq_entry, current); | 
|  | uint32_t timeleft = 0; | 
|  | int retval; | 
|  |  | 
|  | /* The caller must leave context1 empty. */ | 
|  | if (pmboxq->context1 != 0) { | 
|  | return (MBX_NOT_FINISHED); | 
|  | } | 
|  |  | 
|  | /* setup wake call as IOCB callback */ | 
|  | pmboxq->mbox_cmpl = lpfc_sli_wake_mbox_wait; | 
|  | /* setup context field to pass wait_queue pointer to wake function  */ | 
|  | pmboxq->context1 = &done_q; | 
|  |  | 
|  | /* start to sleep before we wait, to avoid races */ | 
|  | set_current_state(TASK_INTERRUPTIBLE); | 
|  | add_wait_queue(&done_q, &wq_entry); | 
|  |  | 
|  | /* now issue the command */ | 
|  | retval = lpfc_sli_issue_mbox(phba, pmboxq, MBX_NOWAIT); | 
|  |  | 
|  | if (retval == MBX_BUSY || retval == MBX_SUCCESS) { | 
|  | timeleft = schedule_timeout(timeout * HZ); | 
|  | pmboxq->context1 = NULL; | 
|  | /* if schedule_timeout returns 0, we timed out and were not | 
|  | woken up */ | 
|  | if (timeleft == 0) { | 
|  | retval = MBX_TIMEOUT; | 
|  | } else { | 
|  | retval = MBX_SUCCESS; | 
|  | } | 
|  | } | 
|  |  | 
|  |  | 
|  | set_current_state(TASK_RUNNING); | 
|  | remove_wait_queue(&done_q, &wq_entry); | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | irqreturn_t | 
|  | lpfc_intr_handler(int irq, void *dev_id, struct pt_regs * regs) | 
|  | { | 
|  | struct lpfc_hba *phba; | 
|  | uint32_t ha_copy; | 
|  | uint32_t work_ha_copy; | 
|  | unsigned long status; | 
|  | int i; | 
|  | uint32_t control; | 
|  |  | 
|  | /* | 
|  | * Get the driver's phba structure from the dev_id and | 
|  | * assume the HBA is not interrupting. | 
|  | */ | 
|  | phba = (struct lpfc_hba *) dev_id; | 
|  |  | 
|  | if (unlikely(!phba)) | 
|  | return IRQ_NONE; | 
|  |  | 
|  | phba->sli.slistat.sli_intr++; | 
|  |  | 
|  | /* | 
|  | * Call the HBA to see if it is interrupting.  If not, don't claim | 
|  | * the interrupt | 
|  | */ | 
|  |  | 
|  | /* Ignore all interrupts during initialization. */ | 
|  | if (unlikely(phba->hba_state < LPFC_LINK_DOWN)) | 
|  | return IRQ_NONE; | 
|  |  | 
|  | /* | 
|  | * Read host attention register to determine interrupt source | 
|  | * Clear Attention Sources, except Error Attention (to | 
|  | * preserve status) and Link Attention | 
|  | */ | 
|  | spin_lock(phba->host->host_lock); | 
|  | ha_copy = readl(phba->HAregaddr); | 
|  | writel((ha_copy & ~(HA_LATT | HA_ERATT)), phba->HAregaddr); | 
|  | readl(phba->HAregaddr); /* flush */ | 
|  | spin_unlock(phba->host->host_lock); | 
|  |  | 
|  | if (unlikely(!ha_copy)) | 
|  | return IRQ_NONE; | 
|  |  | 
|  | work_ha_copy = ha_copy & phba->work_ha_mask; | 
|  |  | 
|  | if (unlikely(work_ha_copy)) { | 
|  | if (work_ha_copy & HA_LATT) { | 
|  | if (phba->sli.sli_flag & LPFC_PROCESS_LA) { | 
|  | /* | 
|  | * Turn off Link Attention interrupts | 
|  | * until CLEAR_LA done | 
|  | */ | 
|  | spin_lock(phba->host->host_lock); | 
|  | phba->sli.sli_flag &= ~LPFC_PROCESS_LA; | 
|  | control = readl(phba->HCregaddr); | 
|  | control &= ~HC_LAINT_ENA; | 
|  | writel(control, phba->HCregaddr); | 
|  | readl(phba->HCregaddr); /* flush */ | 
|  | spin_unlock(phba->host->host_lock); | 
|  | } | 
|  | else | 
|  | work_ha_copy &= ~HA_LATT; | 
|  | } | 
|  |  | 
|  | if (work_ha_copy & ~(HA_ERATT|HA_MBATT|HA_LATT)) { | 
|  | for (i = 0; i < phba->sli.num_rings; i++) { | 
|  | if (work_ha_copy & (HA_RXATT << (4*i))) { | 
|  | /* | 
|  | * Turn off Slow Rings interrupts | 
|  | */ | 
|  | spin_lock(phba->host->host_lock); | 
|  | control = readl(phba->HCregaddr); | 
|  | control &= ~(HC_R0INT_ENA << i); | 
|  | writel(control, phba->HCregaddr); | 
|  | readl(phba->HCregaddr); /* flush */ | 
|  | spin_unlock(phba->host->host_lock); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | if (work_ha_copy & HA_ERATT) { | 
|  | phba->hba_state = LPFC_HBA_ERROR; | 
|  | /* | 
|  | * There was a link/board error.  Read the | 
|  | * status register to retrieve the error event | 
|  | * and process it. | 
|  | */ | 
|  | phba->sli.slistat.err_attn_event++; | 
|  | /* Save status info */ | 
|  | phba->work_hs = readl(phba->HSregaddr); | 
|  | phba->work_status[0] = readl(phba->MBslimaddr + 0xa8); | 
|  | phba->work_status[1] = readl(phba->MBslimaddr + 0xac); | 
|  |  | 
|  | /* Clear Chip error bit */ | 
|  | writel(HA_ERATT, phba->HAregaddr); | 
|  | readl(phba->HAregaddr); /* flush */ | 
|  |  | 
|  | /* | 
|  | * Reseting the HBA is the only reliable way | 
|  | * to shutdown interrupt when there is a | 
|  | * ERROR. | 
|  | */ | 
|  | lpfc_sli_send_reset(phba, phba->hba_state); | 
|  | } | 
|  |  | 
|  | spin_lock(phba->host->host_lock); | 
|  | phba->work_ha |= work_ha_copy; | 
|  | if (phba->work_wait) | 
|  | wake_up(phba->work_wait); | 
|  | spin_unlock(phba->host->host_lock); | 
|  | } | 
|  |  | 
|  | ha_copy &= ~(phba->work_ha_mask); | 
|  |  | 
|  | /* | 
|  | * Process all events on FCP ring.  Take the optimized path for | 
|  | * FCP IO.  Any other IO is slow path and is handled by | 
|  | * the worker thread. | 
|  | */ | 
|  | status = (ha_copy & (HA_RXMASK  << (4*LPFC_FCP_RING))); | 
|  | status >>= (4*LPFC_FCP_RING); | 
|  | if (status & HA_RXATT) | 
|  | lpfc_sli_handle_fast_ring_event(phba, | 
|  | &phba->sli.ring[LPFC_FCP_RING], | 
|  | status); | 
|  | return IRQ_HANDLED; | 
|  |  | 
|  | } /* lpfc_intr_handler */ |