scsi: qla2xxx: Allow 32-byte CDBs
System crashes when a 32-byte CDB was sent to a non T10 PI disk: [ 177.143279] ? qla2xxx_dif_start_scsi_mq+0xcd8/0xce0 [qla2xxx] [ 177.149165] ? internal_add_timer+0x42/0x70 [ 177.153372] qla2xxx_mqueuecommand+0x207/0x2b0 [qla2xxx] [ 177.158730] scsi_queue_rq+0x2b7/0xc00 [ 177.162501] blk_mq_dispatch_rq_list+0x3ea/0x7e0 Current code attempted to use CRC IOCB to send the command but failed. Instead, type 6 IOCB should be used to send the I/O. Clone existing type 6 IOCB code with addition of MQ support to allow 32-byte CDBs to go through. Signed-off-by: Quinn Tran <qutran@marvell.com> Cc: Laurence Oberman <loberman@redhat.com> Signed-off-by: Nilesh Javali <njavali@marvell.com> Link: https://lore.kernel.org/r/20230817063132.21900-3-njavali@marvell.com Reviewed-by: Himanshu Madhani <himanshu.madhani@oracle.com> Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
This commit is contained in:
committed by
Martin K. Petersen
parent
efeda3bf91
commit
ae25f65a35
@@ -11,6 +11,7 @@
|
|||||||
|
|
||||||
#include <scsi/scsi_tcq.h>
|
#include <scsi/scsi_tcq.h>
|
||||||
|
|
||||||
|
static int qla_start_scsi_type6(srb_t *sp);
|
||||||
/**
|
/**
|
||||||
* qla2x00_get_cmd_direction() - Determine control_flag data direction.
|
* qla2x00_get_cmd_direction() - Determine control_flag data direction.
|
||||||
* @sp: SCSI command
|
* @sp: SCSI command
|
||||||
@@ -1721,6 +1722,8 @@ qla24xx_dif_start_scsi(srb_t *sp)
|
|||||||
if (scsi_get_prot_op(cmd) == SCSI_PROT_NORMAL) {
|
if (scsi_get_prot_op(cmd) == SCSI_PROT_NORMAL) {
|
||||||
if (cmd->cmd_len <= 16)
|
if (cmd->cmd_len <= 16)
|
||||||
return qla24xx_start_scsi(sp);
|
return qla24xx_start_scsi(sp);
|
||||||
|
else
|
||||||
|
return qla_start_scsi_type6(sp);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Setup device pointers. */
|
/* Setup device pointers. */
|
||||||
@@ -2100,6 +2103,8 @@ qla2xxx_dif_start_scsi_mq(srb_t *sp)
|
|||||||
if (scsi_get_prot_op(cmd) == SCSI_PROT_NORMAL) {
|
if (scsi_get_prot_op(cmd) == SCSI_PROT_NORMAL) {
|
||||||
if (cmd->cmd_len <= 16)
|
if (cmd->cmd_len <= 16)
|
||||||
return qla2xxx_start_scsi_mq(sp);
|
return qla2xxx_start_scsi_mq(sp);
|
||||||
|
else
|
||||||
|
return qla_start_scsi_type6(sp);
|
||||||
}
|
}
|
||||||
|
|
||||||
spin_lock_irqsave(&qpair->qp_lock, flags);
|
spin_lock_irqsave(&qpair->qp_lock, flags);
|
||||||
@@ -4197,3 +4202,267 @@ queuing_error:
|
|||||||
|
|
||||||
return rval;
|
return rval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* qla_start_scsi_type6() - Send a SCSI command to the ISP
|
||||||
|
* @sp: command to send to the ISP
|
||||||
|
*
|
||||||
|
* Returns non-zero if a failure occurred, else zero.
|
||||||
|
*/
|
||||||
|
static int
|
||||||
|
qla_start_scsi_type6(srb_t *sp)
|
||||||
|
{
|
||||||
|
int nseg;
|
||||||
|
unsigned long flags;
|
||||||
|
uint32_t *clr_ptr;
|
||||||
|
uint32_t handle;
|
||||||
|
struct cmd_type_6 *cmd_pkt;
|
||||||
|
uint16_t cnt;
|
||||||
|
uint16_t req_cnt;
|
||||||
|
uint16_t tot_dsds;
|
||||||
|
struct req_que *req = NULL;
|
||||||
|
struct rsp_que *rsp;
|
||||||
|
struct scsi_cmnd *cmd = GET_CMD_SP(sp);
|
||||||
|
struct scsi_qla_host *vha = sp->fcport->vha;
|
||||||
|
struct qla_hw_data *ha = vha->hw;
|
||||||
|
struct qla_qpair *qpair = sp->qpair;
|
||||||
|
uint16_t more_dsd_lists = 0;
|
||||||
|
struct dsd_dma *dsd_ptr;
|
||||||
|
uint16_t i;
|
||||||
|
__be32 *fcp_dl;
|
||||||
|
uint8_t additional_cdb_len;
|
||||||
|
struct ct6_dsd *ctx;
|
||||||
|
|
||||||
|
/* Acquire qpair specific lock */
|
||||||
|
spin_lock_irqsave(&qpair->qp_lock, flags);
|
||||||
|
|
||||||
|
/* Setup qpair pointers */
|
||||||
|
req = qpair->req;
|
||||||
|
rsp = qpair->rsp;
|
||||||
|
|
||||||
|
/* So we know we haven't pci_map'ed anything yet */
|
||||||
|
tot_dsds = 0;
|
||||||
|
|
||||||
|
/* Send marker if required */
|
||||||
|
if (vha->marker_needed != 0) {
|
||||||
|
if (__qla2x00_marker(vha, qpair, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) {
|
||||||
|
spin_unlock_irqrestore(&qpair->qp_lock, flags);
|
||||||
|
return QLA_FUNCTION_FAILED;
|
||||||
|
}
|
||||||
|
vha->marker_needed = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
handle = qla2xxx_get_next_handle(req);
|
||||||
|
if (handle == 0)
|
||||||
|
goto queuing_error;
|
||||||
|
|
||||||
|
/* Map the sg table so we have an accurate count of sg entries needed */
|
||||||
|
if (scsi_sg_count(cmd)) {
|
||||||
|
nseg = dma_map_sg(&ha->pdev->dev, scsi_sglist(cmd),
|
||||||
|
scsi_sg_count(cmd), cmd->sc_data_direction);
|
||||||
|
if (unlikely(!nseg))
|
||||||
|
goto queuing_error;
|
||||||
|
} else {
|
||||||
|
nseg = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
tot_dsds = nseg;
|
||||||
|
|
||||||
|
/* eventhough driver only need 1 T6 IOCB, FW still convert DSD to Continueation IOCB */
|
||||||
|
req_cnt = qla24xx_calc_iocbs(vha, tot_dsds);
|
||||||
|
|
||||||
|
sp->iores.res_type = RESOURCE_IOCB | RESOURCE_EXCH;
|
||||||
|
sp->iores.exch_cnt = 1;
|
||||||
|
sp->iores.iocb_cnt = req_cnt;
|
||||||
|
|
||||||
|
if (qla_get_fw_resources(sp->qpair, &sp->iores))
|
||||||
|
goto queuing_error;
|
||||||
|
|
||||||
|
more_dsd_lists = qla24xx_calc_dsd_lists(tot_dsds);
|
||||||
|
if ((more_dsd_lists + qpair->dsd_inuse) >= NUM_DSD_CHAIN) {
|
||||||
|
ql_dbg(ql_dbg_io, vha, 0x3028,
|
||||||
|
"Num of DSD list %d is than %d for cmd=%p.\n",
|
||||||
|
more_dsd_lists + qpair->dsd_inuse, NUM_DSD_CHAIN, cmd);
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (more_dsd_lists <= qpair->dsd_avail)
|
||||||
|
goto sufficient_dsds;
|
||||||
|
else
|
||||||
|
more_dsd_lists -= qpair->dsd_avail;
|
||||||
|
|
||||||
|
for (i = 0; i < more_dsd_lists; i++) {
|
||||||
|
dsd_ptr = kzalloc(sizeof(*dsd_ptr), GFP_ATOMIC);
|
||||||
|
if (!dsd_ptr) {
|
||||||
|
ql_log(ql_log_fatal, vha, 0x3029,
|
||||||
|
"Failed to allocate memory for dsd_dma for cmd=%p.\n", cmd);
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
INIT_LIST_HEAD(&dsd_ptr->list);
|
||||||
|
|
||||||
|
dsd_ptr->dsd_addr = dma_pool_alloc(ha->dl_dma_pool,
|
||||||
|
GFP_ATOMIC, &dsd_ptr->dsd_list_dma);
|
||||||
|
if (!dsd_ptr->dsd_addr) {
|
||||||
|
kfree(dsd_ptr);
|
||||||
|
ql_log(ql_log_fatal, vha, 0x302a,
|
||||||
|
"Failed to allocate memory for dsd_addr for cmd=%p.\n", cmd);
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
list_add_tail(&dsd_ptr->list, &qpair->dsd_list);
|
||||||
|
qpair->dsd_avail++;
|
||||||
|
}
|
||||||
|
|
||||||
|
sufficient_dsds:
|
||||||
|
req_cnt = 1;
|
||||||
|
|
||||||
|
if (req->cnt < (req_cnt + 2)) {
|
||||||
|
if (IS_SHADOW_REG_CAPABLE(ha)) {
|
||||||
|
cnt = *req->out_ptr;
|
||||||
|
} else {
|
||||||
|
cnt = (uint16_t)rd_reg_dword_relaxed(req->req_q_out);
|
||||||
|
if (qla2x00_check_reg16_for_disconnect(vha, cnt))
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (req->ring_index < cnt)
|
||||||
|
req->cnt = cnt - req->ring_index;
|
||||||
|
else
|
||||||
|
req->cnt = req->length - (req->ring_index - cnt);
|
||||||
|
if (req->cnt < (req_cnt + 2))
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
|
||||||
|
ctx = &sp->u.scmd.ct6_ctx;
|
||||||
|
|
||||||
|
memset(ctx, 0, sizeof(struct ct6_dsd));
|
||||||
|
ctx->fcp_cmnd = dma_pool_zalloc(ha->fcp_cmnd_dma_pool,
|
||||||
|
GFP_ATOMIC, &ctx->fcp_cmnd_dma);
|
||||||
|
if (!ctx->fcp_cmnd) {
|
||||||
|
ql_log(ql_log_fatal, vha, 0x3031,
|
||||||
|
"Failed to allocate fcp_cmnd for cmd=%p.\n", cmd);
|
||||||
|
goto queuing_error;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Initialize the DSD list and dma handle */
|
||||||
|
INIT_LIST_HEAD(&ctx->dsd_list);
|
||||||
|
ctx->dsd_use_cnt = 0;
|
||||||
|
|
||||||
|
if (cmd->cmd_len > 16) {
|
||||||
|
additional_cdb_len = cmd->cmd_len - 16;
|
||||||
|
if (cmd->cmd_len % 4 ||
|
||||||
|
cmd->cmd_len > QLA_CDB_BUF_SIZE) {
|
||||||
|
/*
|
||||||
|
* SCSI command bigger than 16 bytes must be
|
||||||
|
* multiple of 4 or too big.
|
||||||
|
*/
|
||||||
|
ql_log(ql_log_warn, vha, 0x3033,
|
||||||
|
"scsi cmd len %d not multiple of 4 for cmd=%p.\n",
|
||||||
|
cmd->cmd_len, cmd);
|
||||||
|
goto queuing_error_fcp_cmnd;
|
||||||
|
}
|
||||||
|
ctx->fcp_cmnd_len = 12 + cmd->cmd_len + 4;
|
||||||
|
} else {
|
||||||
|
additional_cdb_len = 0;
|
||||||
|
ctx->fcp_cmnd_len = 12 + 16 + 4;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Build command packet. */
|
||||||
|
req->current_outstanding_cmd = handle;
|
||||||
|
req->outstanding_cmds[handle] = sp;
|
||||||
|
sp->handle = handle;
|
||||||
|
cmd->host_scribble = (unsigned char *)(unsigned long)handle;
|
||||||
|
req->cnt -= req_cnt;
|
||||||
|
|
||||||
|
cmd_pkt = (struct cmd_type_6 *)req->ring_ptr;
|
||||||
|
cmd_pkt->handle = make_handle(req->id, handle);
|
||||||
|
|
||||||
|
/* tagged queuing modifier -- default is TSK_SIMPLE (0). */
|
||||||
|
clr_ptr = (uint32_t *)cmd_pkt + 2;
|
||||||
|
memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8);
|
||||||
|
cmd_pkt->dseg_count = cpu_to_le16(tot_dsds);
|
||||||
|
|
||||||
|
/* Set NPORT-ID and LUN number */
|
||||||
|
cmd_pkt->nport_handle = cpu_to_le16(sp->fcport->loop_id);
|
||||||
|
cmd_pkt->port_id[0] = sp->fcport->d_id.b.al_pa;
|
||||||
|
cmd_pkt->port_id[1] = sp->fcport->d_id.b.area;
|
||||||
|
cmd_pkt->port_id[2] = sp->fcport->d_id.b.domain;
|
||||||
|
cmd_pkt->vp_index = sp->vha->vp_idx;
|
||||||
|
|
||||||
|
/* Build IOCB segments */
|
||||||
|
qla24xx_build_scsi_type_6_iocbs(sp, cmd_pkt, tot_dsds);
|
||||||
|
|
||||||
|
int_to_scsilun(cmd->device->lun, &cmd_pkt->lun);
|
||||||
|
host_to_fcp_swap((uint8_t *)&cmd_pkt->lun, sizeof(cmd_pkt->lun));
|
||||||
|
|
||||||
|
/* build FCP_CMND IU */
|
||||||
|
int_to_scsilun(cmd->device->lun, &ctx->fcp_cmnd->lun);
|
||||||
|
ctx->fcp_cmnd->additional_cdb_len = additional_cdb_len;
|
||||||
|
|
||||||
|
if (cmd->sc_data_direction == DMA_TO_DEVICE)
|
||||||
|
ctx->fcp_cmnd->additional_cdb_len |= 1;
|
||||||
|
else if (cmd->sc_data_direction == DMA_FROM_DEVICE)
|
||||||
|
ctx->fcp_cmnd->additional_cdb_len |= 2;
|
||||||
|
|
||||||
|
/* Populate the FCP_PRIO. */
|
||||||
|
if (ha->flags.fcp_prio_enabled)
|
||||||
|
ctx->fcp_cmnd->task_attribute |=
|
||||||
|
sp->fcport->fcp_prio << 3;
|
||||||
|
|
||||||
|
memcpy(ctx->fcp_cmnd->cdb, cmd->cmnd, cmd->cmd_len);
|
||||||
|
|
||||||
|
fcp_dl = (__be32 *)(ctx->fcp_cmnd->cdb + 16 +
|
||||||
|
additional_cdb_len);
|
||||||
|
*fcp_dl = htonl((uint32_t)scsi_bufflen(cmd));
|
||||||
|
|
||||||
|
cmd_pkt->fcp_cmnd_dseg_len = cpu_to_le16(ctx->fcp_cmnd_len);
|
||||||
|
put_unaligned_le64(ctx->fcp_cmnd_dma,
|
||||||
|
&cmd_pkt->fcp_cmnd_dseg_address);
|
||||||
|
|
||||||
|
sp->flags |= SRB_FCP_CMND_DMA_VALID;
|
||||||
|
cmd_pkt->byte_count = cpu_to_le32((uint32_t)scsi_bufflen(cmd));
|
||||||
|
/* Set total data segment count. */
|
||||||
|
cmd_pkt->entry_count = (uint8_t)req_cnt;
|
||||||
|
|
||||||
|
wmb();
|
||||||
|
/* Adjust ring index. */
|
||||||
|
req->ring_index++;
|
||||||
|
if (req->ring_index == req->length) {
|
||||||
|
req->ring_index = 0;
|
||||||
|
req->ring_ptr = req->ring;
|
||||||
|
} else {
|
||||||
|
req->ring_ptr++;
|
||||||
|
}
|
||||||
|
|
||||||
|
sp->qpair->cmd_cnt++;
|
||||||
|
sp->flags |= SRB_DMA_VALID;
|
||||||
|
|
||||||
|
/* Set chip new ring index. */
|
||||||
|
wrt_reg_dword(req->req_q_in, req->ring_index);
|
||||||
|
|
||||||
|
/* Manage unprocessed RIO/ZIO commands in response queue. */
|
||||||
|
if (vha->flags.process_response_queue &&
|
||||||
|
rsp->ring_ptr->signature != RESPONSE_PROCESSED)
|
||||||
|
qla24xx_process_response_queue(vha, rsp);
|
||||||
|
|
||||||
|
spin_unlock_irqrestore(&qpair->qp_lock, flags);
|
||||||
|
|
||||||
|
return QLA_SUCCESS;
|
||||||
|
|
||||||
|
queuing_error_fcp_cmnd:
|
||||||
|
dma_pool_free(ha->fcp_cmnd_dma_pool, ctx->fcp_cmnd, ctx->fcp_cmnd_dma);
|
||||||
|
|
||||||
|
queuing_error:
|
||||||
|
if (tot_dsds)
|
||||||
|
scsi_dma_unmap(cmd);
|
||||||
|
|
||||||
|
qla_put_fw_resources(sp->qpair, &sp->iores);
|
||||||
|
|
||||||
|
if (sp->u.scmd.crc_ctx) {
|
||||||
|
mempool_free(sp->u.scmd.crc_ctx, ha->ctx_mempool);
|
||||||
|
sp->u.scmd.crc_ctx = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
spin_unlock_irqrestore(&qpair->qp_lock, flags);
|
||||||
|
|
||||||
|
return QLA_FUNCTION_FAILED;
|
||||||
|
}
|
||||||
|
|||||||
@@ -857,7 +857,9 @@ struct fcp_cmnd {
|
|||||||
uint8_t task_attribute;
|
uint8_t task_attribute;
|
||||||
uint8_t task_management;
|
uint8_t task_management;
|
||||||
uint8_t additional_cdb_len;
|
uint8_t additional_cdb_len;
|
||||||
uint8_t cdb[260]; /* 256 for CDB len and 4 for FCP_DL */
|
#define QLA_CDB_BUF_SIZE 256
|
||||||
|
#define QLA_FCP_DL_SIZE 4
|
||||||
|
uint8_t cdb[QLA_CDB_BUF_SIZE + QLA_FCP_DL_SIZE]; /* 256 for CDB len and 4 for FCP_DL */
|
||||||
};
|
};
|
||||||
|
|
||||||
struct dsd_dma {
|
struct dsd_dma {
|
||||||
|
|||||||
Reference in New Issue
Block a user