1 files changed, 16 insertions, 6 deletions

diff --git a/drivers/scsi/lpfc/lpfc_scsi.c b/drivers/scsi/lpfc/lpfc_scsi.c
index bb9a2249b75d..f035f3c7ec09 100644
--- a/drivers/scsi/lpfc/lpfc_scsi.c
+++ b/drivers/scsi/lpfc/lpfc_scsi.c
@@ -3919,6 +3919,8 @@ lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
         struct lpfc_iocbq *piocbq = &(lpfc_cmd->cur_iocbq);
         int datadir = scsi_cmnd->sc_data_direction;
         char tag[2];
+        uint8_t *ptr;
+        bool sli4;
 
         if (!pnode || !NLP_CHK_NODE_ACT(pnode))
                 return;
@@ -3930,8 +3932,13 @@ lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
         int_to_scsilun(lpfc_cmd->pCmd->device->lun,
                         &lpfc_cmd->fcp_cmnd->fcp_lun);
 
-        memset(&fcp_cmnd->fcpCdb[0], 0, LPFC_FCP_CDB_LEN);
-        memcpy(&fcp_cmnd->fcpCdb[0], scsi_cmnd->cmnd, scsi_cmnd->cmd_len);
+        ptr = &fcp_cmnd->fcpCdb[0];
+        memcpy(ptr, scsi_cmnd->cmnd, scsi_cmnd->cmd_len);
+        if (scsi_cmnd->cmd_len < LPFC_FCP_CDB_LEN) {
+                ptr += scsi_cmnd->cmd_len;
+                memset(ptr, 0, (LPFC_FCP_CDB_LEN - scsi_cmnd->cmd_len));
+        }
+
         if (scsi_populate_tag_msg(scsi_cmnd, tag)) {
                 switch (tag[0]) {
                 case HEAD_OF_QUEUE_TAG:
@@ -3947,6 +3954,8 @@ lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
         } else
                 fcp_cmnd->fcpCntl1 = 0;
 
+        sli4 = (phba->sli_rev == LPFC_SLI_REV4);
+
         /*
          * There are three possibilities here - use scatter-gather segment, use
          * the single mapping, or neither.  Start the lpfc command prep by
@@ -3956,11 +3965,12 @@ lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
         if (scsi_sg_count(scsi_cmnd)) {
                 if (datadir == DMA_TO_DEVICE) {
                         iocb_cmd->ulpCommand = CMD_FCP_IWRITE64_CR;
-                        if (phba->sli_rev < LPFC_SLI_REV4) {
+                        if (sli4)
+                                iocb_cmd->ulpPU = PARM_READ_CHECK;
+                        else {
                                 iocb_cmd->un.fcpi.fcpi_parm = 0;
                                 iocb_cmd->ulpPU = 0;
-                        } else
-                                iocb_cmd->ulpPU = PARM_READ_CHECK;
+                        }
                         fcp_cmnd->fcpCntl3 = WRITE_DATA;
                         phba->fc4OutputRequests++;
                 } else {
@@ -3984,7 +3994,7 @@ lpfc_scsi_prep_cmnd(struct lpfc_vport *vport, struct lpfc_scsi_buf *lpfc_cmd,
          * of the scsi_cmnd request_buffer
          */
         piocbq->iocb.ulpContext = pnode->nlp_rpi;
-        if (phba->sli_rev == LPFC_SLI_REV4)
+        if (sli4)
                 piocbq->iocb.ulpContext =
                   phba->sli4_hba.rpi_ids[pnode->nlp_rpi];
         if (pnode->nlp_fcp_info & NLP_FCP_2_DEVICE)