1 files changed, 39 insertions, 11 deletions

diff --git a/drivers/scsi/qla2xxx/qla_mbx.c b/drivers/scsi/qla2xxx/qla_mbx.c
index b6202fe118ac..05d595d9a7ef 100644
--- a/drivers/scsi/qla2xxx/qla_mbx.c
+++ b/drivers/scsi/qla2xxx/qla_mbx.c
@@ -2006,7 +2006,7 @@ qla2x00_get_id_list(scsi_qla_host_t *vha, void *id_list, dma_addr_t id_list_dma,
 int
 qla2x00_get_resource_cnts(scsi_qla_host_t *vha, uint16_t *cur_xchg_cnt,
     uint16_t *orig_xchg_cnt, uint16_t *cur_iocb_cnt,
-    uint16_t *orig_iocb_cnt, uint16_t *max_npiv_vports)
+    uint16_t *orig_iocb_cnt, uint16_t *max_npiv_vports, uint16_t *max_fcfs)
 {
         int rval;
         mbx_cmd_t mc;
@@ -2017,6 +2017,8 @@ qla2x00_get_resource_cnts(scsi_qla_host_t *vha, uint16_t *cur_xchg_cnt,
         mcp->mb[0] = MBC_GET_RESOURCE_COUNTS;
         mcp->out_mb = MBX_0;
         mcp->in_mb = MBX_11|MBX_10|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
+        if (IS_QLA81XX(vha->hw))
+                mcp->in_mb |= MBX_12;
         mcp->tov = MBX_TOV_SECONDS;
         mcp->flags = 0;
         rval = qla2x00_mailbox_command(vha, mcp);
@@ -2027,9 +2029,10 @@ qla2x00_get_resource_cnts(scsi_qla_host_t *vha, uint16_t *cur_xchg_cnt,
                     vha->host_no, mcp->mb[0]));
         } else {
                 DEBUG11(printk("%s(%ld): done. mb1=%x mb2=%x mb3=%x mb6=%x "
-                    "mb7=%x mb10=%x mb11=%x.\n", __func__, vha->host_no,
-                    mcp->mb[1], mcp->mb[2], mcp->mb[3], mcp->mb[6], mcp->mb[7],
-                    mcp->mb[10], mcp->mb[11]));
+                    "mb7=%x mb10=%x mb11=%x mb12=%x.\n", __func__,
+                    vha->host_no, mcp->mb[1], mcp->mb[2], mcp->mb[3],
+                    mcp->mb[6], mcp->mb[7], mcp->mb[10], mcp->mb[11],
+                    mcp->mb[12]));
 
                 if (cur_xchg_cnt)
                         *cur_xchg_cnt = mcp->mb[3];
@@ -2041,6 +2044,8 @@ qla2x00_get_resource_cnts(scsi_qla_host_t *vha, uint16_t *cur_xchg_cnt,
                         *orig_iocb_cnt = mcp->mb[10];
                 if (vha->hw->flags.npiv_supported && max_npiv_vports)
                         *max_npiv_vports = mcp->mb[11];
+                if (IS_QLA81XX(vha->hw) && max_fcfs)
+                        *max_fcfs = mcp->mb[12];
         }
 
         return (rval);
@@ -2313,6 +2318,7 @@ __qla24xx_issue_tmf(char *name, uint32_t type, struct fc_port *fcport,
 {
         int             rval, rval2;
         struct tsk_mgmt_cmd *tsk;
+        struct sts_entry_24xx *sts;
         dma_addr_t      tsk_dma;
         scsi_qla_host_t *vha;
         struct qla_hw_data *ha;
@@ -2352,20 +2358,37 @@ __qla24xx_issue_tmf(char *name, uint32_t type, struct fc_port *fcport,
                     sizeof(tsk->p.tsk.lun));
         }
 
+        sts = &tsk->p.sts;
         rval = qla2x00_issue_iocb(vha, tsk, tsk_dma, 0);
         if (rval != QLA_SUCCESS) {
                 DEBUG2_3_11(printk("%s(%ld): failed to issue %s Reset IOCB "
                     "(%x).\n", __func__, vha->host_no, name, rval));
-        } else if (tsk->p.sts.entry_status != 0) {
+        } else if (sts->entry_status != 0) {
                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
                     "-- error status (%x).\n", __func__, vha->host_no,
-                    tsk->p.sts.entry_status));
+                    sts->entry_status));
                 rval = QLA_FUNCTION_FAILED;
-        } else if (tsk->p.sts.comp_status !=
+        } else if (sts->comp_status !=
             __constant_cpu_to_le16(CS_COMPLETE)) {
                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
                     "-- completion status (%x).\n", __func__,
-                    vha->host_no, le16_to_cpu(tsk->p.sts.comp_status)));
+                    vha->host_no, le16_to_cpu(sts->comp_status)));
+                rval = QLA_FUNCTION_FAILED;
+        } else if (!(le16_to_cpu(sts->scsi_status) &
+            SS_RESPONSE_INFO_LEN_VALID)) {
+                DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
+                    "-- no response info (%x).\n", __func__, vha->host_no,
+                    le16_to_cpu(sts->scsi_status)));
+                rval = QLA_FUNCTION_FAILED;
+        } else if (le32_to_cpu(sts->rsp_data_len) < 4) {
+                DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
+                    "-- not enough response info (%d).\n", __func__,
+                    vha->host_no, le32_to_cpu(sts->rsp_data_len)));
+                rval = QLA_FUNCTION_FAILED;
+        } else if (sts->data[3]) {
+                DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
+                    "-- response (%x).\n", __func__,
+                    vha->host_no, sts->data[3]));
                 rval = QLA_FUNCTION_FAILED;
         }
 
@@ -2759,8 +2782,10 @@ qla24xx_report_id_acquisition(scsi_qla_host_t *vha,
                     vp_idx, MSB(stat),
                     rptid_entry->port_id[2], rptid_entry->port_id[1],
                     rptid_entry->port_id[0]));
-                if (vp_idx == 0)
-                        return;
+
+                vp = vha;
+                if (vp_idx == 0 && (MSB(stat) != 1))
+                        goto reg_needed;
 
                 if (MSB(stat) == 1) {
                         DEBUG2(printk("scsi(%ld): Could not acquire ID for "
@@ -2783,8 +2808,11 @@ qla24xx_report_id_acquisition(scsi_qla_host_t *vha,
                  * response queue. Handle it in dpc context.
                  */
                 set_bit(VP_IDX_ACQUIRED, &vp->vp_flags);
-                set_bit(VP_DPC_NEEDED, &vha->dpc_flags);
 
+reg_needed:
+                set_bit(REGISTER_FC4_NEEDED, &vp->dpc_flags);
+                set_bit(REGISTER_FDMI_NEEDED, &vp->dpc_flags);
+                set_bit(VP_DPC_NEEDED, &vha->dpc_flags);
                 qla2xxx_wake_dpc(vha);
         }
 }