}
 }
 
-srb_t *
-qla2x00_get_sp_from_handle(scsi_qla_host_t *vha, const char *func,
-    struct req_que *req, void *iocb)
+static srb_t *
+qla_get_sp_from_handle(scsi_qla_host_t *vha, const char *func,
+                      struct req_que *req, void *iocb, u16 *ret_index)
 {
        struct qla_hw_data *ha = vha->hw;
        sts_entry_t *pkt = iocb;
                return NULL;
        }
 
-       req->outstanding_cmds[index] = NULL;
-
+       *ret_index = index;
        qla_put_fw_resources(sp->qpair, &sp->iores);
        return sp;
 }
 
+srb_t *
+qla2x00_get_sp_from_handle(scsi_qla_host_t *vha, const char *func,
+                          struct req_que *req, void *iocb)
+{
+       uint16_t index;
+       srb_t *sp;
+
+       sp = qla_get_sp_from_handle(vha, func, req, iocb, &index);
+       if (sp)
+               req->outstanding_cmds[index] = NULL;
+
+       return sp;
+}
+
 static void
 qla2x00_mbx_iocb_entry(scsi_qla_host_t *vha, struct req_que *req,
     struct mbx_entry *mbx)
                return;
        }
 
-       req->outstanding_cmds[handle] = NULL;
        cp = GET_CMD_SP(sp);
        if (cp == NULL) {
                ql_dbg(ql_dbg_io, vha, 0x3018,
                    "Command already returned (0x%x/%p).\n",
                    sts->handle, sp);
 
+               req->outstanding_cmds[handle] = NULL;
                return;
        }
 
 
        if (rsp->status_srb == NULL)
                sp->done(sp, res);
+
+       /* for io's, clearing of outstanding_cmds[handle] means scsi_done was called */
+       req->outstanding_cmds[handle] = NULL;
 }
 
 /**
        uint16_t que = MSW(pkt->handle);
        struct req_que *req = NULL;
        int res = DID_ERROR << 16;
+       u16 index;
 
        ql_dbg(ql_dbg_async, vha, 0x502a,
            "iocb type %xh with error status %xh, handle %xh, rspq id %d\n",
 
        switch (pkt->entry_type) {
        case NOTIFY_ACK_TYPE:
-       case STATUS_TYPE:
        case STATUS_CONT_TYPE:
        case LOGINOUT_PORT_IOCB_TYPE:
        case CT_IOCB_TYPE:
        case CTIO_TYPE7:
        case CTIO_CRC2:
                return 1;
+       case STATUS_TYPE:
+               sp = qla_get_sp_from_handle(vha, func, req, pkt, &index);
+               if (sp) {
+                       sp->done(sp, res);
+                       req->outstanding_cmds[index] = NULL;
+                       return 0;
+               }
+               break;
        }
 fatal:
        ql_log(ql_log_warn, vha, 0x5030,
 
        return 0;
 }
 
-/*
- * qla2x00_eh_wait_on_command
- *    Waits for the command to be returned by the Firmware for some
- *    max time.
- *
- * Input:
- *    cmd = Scsi Command to wait on.
- *
- * Return:
- *    Completed in time : QLA_SUCCESS
- *    Did not complete in time : QLA_FUNCTION_FAILED
- */
-static int
-qla2x00_eh_wait_on_command(struct scsi_cmnd *cmd)
-{
-#define ABORT_POLLING_PERIOD   1000
-#define ABORT_WAIT_ITER                ((2 * 1000) / (ABORT_POLLING_PERIOD))
-       unsigned long wait_iter = ABORT_WAIT_ITER;
-       scsi_qla_host_t *vha = shost_priv(cmd->device->host);
-       struct qla_hw_data *ha = vha->hw;
-       srb_t *sp = scsi_cmd_priv(cmd);
-       int ret = QLA_SUCCESS;
-
-       if (unlikely(pci_channel_offline(ha->pdev)) || ha->flags.eeh_busy) {
-               ql_dbg(ql_dbg_taskm, vha, 0x8005,
-                   "Return:eh_wait.\n");
-               return ret;
-       }
-
-       while (sp->type && wait_iter--)
-               msleep(ABORT_POLLING_PERIOD);
-       if (sp->type)
-               ret = QLA_FUNCTION_FAILED;
-
-       return ret;
-}
-
 /*
  * qla2x00_wait_for_hba_online
  *    Wait till the HBA is online after going through
        return ret;
 }
 
+#define ABORT_POLLING_PERIOD   1000
+#define ABORT_WAIT_ITER                ((2 * 1000) / (ABORT_POLLING_PERIOD))
+
 /*
  * Returns: QLA_SUCCESS or QLA_FUNCTION_FAILED.
  */
        struct req_que *req = qpair->req;
        srb_t *sp;
        struct scsi_cmnd *cmd;
+       unsigned long wait_iter = ABORT_WAIT_ITER;
+       bool found;
+       struct qla_hw_data *ha = vha->hw;
 
        status = QLA_SUCCESS;
 
-       spin_lock_irqsave(qpair->qp_lock_ptr, flags);
-       for (cnt = 1; status == QLA_SUCCESS &&
-               cnt < req->num_outstanding_cmds; cnt++) {
-               sp = req->outstanding_cmds[cnt];
-               if (!sp)
-                       continue;
-               if (sp->type != SRB_SCSI_CMD)
-                       continue;
-               if (vha->vp_idx != sp->vha->vp_idx)
-                       continue;
-               match = 0;
-               cmd = GET_CMD_SP(sp);
-               switch (type) {
-               case WAIT_HOST:
-                       match = 1;
-                       break;
-               case WAIT_TARGET:
-                       match = cmd->device->id == t;
-                       break;
-               case WAIT_LUN:
-                       match = (cmd->device->id == t &&
-                               cmd->device->lun == l);
-                       break;
-               }
-               if (!match)
-                       continue;
+       while (wait_iter--) {
+               found = false;
 
-               spin_unlock_irqrestore(qpair->qp_lock_ptr, flags);
-               status = qla2x00_eh_wait_on_command(cmd);
                spin_lock_irqsave(qpair->qp_lock_ptr, flags);
+               for (cnt = 1; cnt < req->num_outstanding_cmds; cnt++) {
+                       sp = req->outstanding_cmds[cnt];
+                       if (!sp)
+                               continue;
+                       if (sp->type != SRB_SCSI_CMD)
+                               continue;
+                       if (vha->vp_idx != sp->vha->vp_idx)
+                               continue;
+                       match = 0;
+                       cmd = GET_CMD_SP(sp);
+                       switch (type) {
+                       case WAIT_HOST:
+                               match = 1;
+                               break;
+                       case WAIT_TARGET:
+                               if (sp->fcport)
+                                       match = sp->fcport->d_id.b24 == t;
+                               else
+                                       match = 0;
+                               break;
+                       case WAIT_LUN:
+                               if (sp->fcport)
+                                       match = (sp->fcport->d_id.b24 == t &&
+                                               cmd->device->lun == l);
+                               else
+                                       match = 0;
+                               break;
+                       }
+                       if (!match)
+                               continue;
+
+                       spin_unlock_irqrestore(qpair->qp_lock_ptr, flags);
+
+                       if (unlikely(pci_channel_offline(ha->pdev)) ||
+                           ha->flags.eeh_busy) {
+                               ql_dbg(ql_dbg_taskm, vha, 0x8005,
+                                   "Return:eh_wait.\n");
+                               return status;
+                       }
+
+                       /*
+                        * SRB_SCSI_CMD is still in the outstanding_cmds array.
+                        * it means scsi_done has not called. Wait for it to
+                        * clear from outstanding_cmds.
+                        */
+                       msleep(ABORT_POLLING_PERIOD);
+                       spin_lock_irqsave(qpair->qp_lock_ptr, flags);
+                       found = true;
+               }
+               spin_unlock_irqrestore(qpair->qp_lock_ptr, flags);
+
+               if (!found)
+                       break;
        }
-       spin_unlock_irqrestore(qpair->qp_lock_ptr, flags);
+
+       if (!wait_iter && found)
+               status = QLA_FUNCTION_FAILED;
 
        return status;
 }