mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-24 05:04:00 +08:00
[SCSI] qla2xxx: Add CT passthru support for ISP23xx adapters
Signed-off-by: Harish Zunjarrao <harish.zunjarrao@qlogic.com> Signed-off-by: Giridhar Malavali <giridhar.malavali@qlogic.com> Signed-off-by: James Bottomley <James.Bottomley@suse.de>
This commit is contained in:
parent
9a15eb4b51
commit
9bc4f4fb44
@ -396,15 +396,6 @@ qla2x00_process_ct(struct fc_bsg_job *bsg_job)
|
|||||||
char *type = "FC_BSG_HST_CT";
|
char *type = "FC_BSG_HST_CT";
|
||||||
struct srb_ctx *ct;
|
struct srb_ctx *ct;
|
||||||
|
|
||||||
/* pass through is supported only for ISP 4Gb or higher */
|
|
||||||
if (!IS_FWI2_CAPABLE(ha)) {
|
|
||||||
DEBUG2(qla_printk(KERN_INFO, ha,
|
|
||||||
"scsi(%ld):Firmware is not capable to support FC "
|
|
||||||
"CT pass thru\n", vha->host_no));
|
|
||||||
rval = -EPERM;
|
|
||||||
goto done;
|
|
||||||
}
|
|
||||||
|
|
||||||
req_sg_cnt =
|
req_sg_cnt =
|
||||||
dma_map_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
|
dma_map_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
|
||||||
bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
|
bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
|
||||||
|
@ -1764,6 +1764,82 @@ qla24xx_els_iocb(srb_t *sp, struct els_entry_24xx *els_iocb)
|
|||||||
(bsg_job->reply_payload.sg_list));
|
(bsg_job->reply_payload.sg_list));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
qla2x00_ct_iocb(srb_t *sp, ms_iocb_entry_t *ct_iocb)
|
||||||
|
{
|
||||||
|
uint16_t avail_dsds;
|
||||||
|
uint32_t *cur_dsd;
|
||||||
|
struct scatterlist *sg;
|
||||||
|
int index;
|
||||||
|
uint16_t tot_dsds;
|
||||||
|
scsi_qla_host_t *vha = sp->fcport->vha;
|
||||||
|
struct qla_hw_data *ha = vha->hw;
|
||||||
|
struct fc_bsg_job *bsg_job = ((struct srb_ctx *)sp->ctx)->u.bsg_job;
|
||||||
|
int loop_iterartion = 0;
|
||||||
|
int cont_iocb_prsnt = 0;
|
||||||
|
int entry_count = 1;
|
||||||
|
|
||||||
|
memset(ct_iocb, 0, sizeof(ms_iocb_entry_t));
|
||||||
|
ct_iocb->entry_type = CT_IOCB_TYPE;
|
||||||
|
ct_iocb->entry_status = 0;
|
||||||
|
ct_iocb->handle1 = sp->handle;
|
||||||
|
SET_TARGET_ID(ha, ct_iocb->loop_id, sp->fcport->loop_id);
|
||||||
|
ct_iocb->status = __constant_cpu_to_le16(0);
|
||||||
|
ct_iocb->control_flags = __constant_cpu_to_le16(0);
|
||||||
|
ct_iocb->timeout = 0;
|
||||||
|
ct_iocb->cmd_dsd_count =
|
||||||
|
__constant_cpu_to_le16(bsg_job->request_payload.sg_cnt);
|
||||||
|
ct_iocb->total_dsd_count =
|
||||||
|
__constant_cpu_to_le16(bsg_job->request_payload.sg_cnt + 1);
|
||||||
|
ct_iocb->req_bytecount =
|
||||||
|
cpu_to_le32(bsg_job->request_payload.payload_len);
|
||||||
|
ct_iocb->rsp_bytecount =
|
||||||
|
cpu_to_le32(bsg_job->reply_payload.payload_len);
|
||||||
|
|
||||||
|
ct_iocb->dseg_req_address[0] = cpu_to_le32(LSD(sg_dma_address
|
||||||
|
(bsg_job->request_payload.sg_list)));
|
||||||
|
ct_iocb->dseg_req_address[1] = cpu_to_le32(MSD(sg_dma_address
|
||||||
|
(bsg_job->request_payload.sg_list)));
|
||||||
|
ct_iocb->dseg_req_length = ct_iocb->req_bytecount;
|
||||||
|
|
||||||
|
ct_iocb->dseg_rsp_address[0] = cpu_to_le32(LSD(sg_dma_address
|
||||||
|
(bsg_job->reply_payload.sg_list)));
|
||||||
|
ct_iocb->dseg_rsp_address[1] = cpu_to_le32(MSD(sg_dma_address
|
||||||
|
(bsg_job->reply_payload.sg_list)));
|
||||||
|
ct_iocb->dseg_rsp_length = ct_iocb->rsp_bytecount;
|
||||||
|
|
||||||
|
avail_dsds = 1;
|
||||||
|
cur_dsd = (uint32_t *)ct_iocb->dseg_rsp_address;
|
||||||
|
index = 0;
|
||||||
|
tot_dsds = bsg_job->reply_payload.sg_cnt;
|
||||||
|
|
||||||
|
for_each_sg(bsg_job->reply_payload.sg_list, sg, tot_dsds, index) {
|
||||||
|
dma_addr_t sle_dma;
|
||||||
|
cont_a64_entry_t *cont_pkt;
|
||||||
|
|
||||||
|
/* Allocate additional continuation packets? */
|
||||||
|
if (avail_dsds == 0) {
|
||||||
|
/*
|
||||||
|
* Five DSDs are available in the Cont.
|
||||||
|
* Type 1 IOCB.
|
||||||
|
*/
|
||||||
|
cont_pkt = qla2x00_prep_cont_type1_iocb(vha);
|
||||||
|
cur_dsd = (uint32_t *) cont_pkt->dseg_0_address;
|
||||||
|
avail_dsds = 5;
|
||||||
|
cont_iocb_prsnt = 1;
|
||||||
|
entry_count++;
|
||||||
|
}
|
||||||
|
|
||||||
|
sle_dma = sg_dma_address(sg);
|
||||||
|
*cur_dsd++ = cpu_to_le32(LSD(sle_dma));
|
||||||
|
*cur_dsd++ = cpu_to_le32(MSD(sle_dma));
|
||||||
|
*cur_dsd++ = cpu_to_le32(sg_dma_len(sg));
|
||||||
|
loop_iterartion++;
|
||||||
|
avail_dsds--;
|
||||||
|
}
|
||||||
|
ct_iocb->entry_count = entry_count;
|
||||||
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
qla24xx_ct_iocb(srb_t *sp, struct ct_entry_24xx *ct_iocb)
|
qla24xx_ct_iocb(srb_t *sp, struct ct_entry_24xx *ct_iocb)
|
||||||
{
|
{
|
||||||
@ -1867,7 +1943,9 @@ qla2x00_start_sp(srb_t *sp)
|
|||||||
qla24xx_els_iocb(sp, pkt);
|
qla24xx_els_iocb(sp, pkt);
|
||||||
break;
|
break;
|
||||||
case SRB_CT_CMD:
|
case SRB_CT_CMD:
|
||||||
qla24xx_ct_iocb(sp, pkt);
|
IS_FWI2_CAPABLE(ha) ?
|
||||||
|
qla24xx_ct_iocb(sp, pkt) :
|
||||||
|
qla2x00_ct_iocb(sp, pkt);
|
||||||
break;
|
break;
|
||||||
case SRB_ADISC_CMD:
|
case SRB_ADISC_CMD:
|
||||||
IS_FWI2_CAPABLE(ha) ?
|
IS_FWI2_CAPABLE(ha) ?
|
||||||
|
@ -983,6 +983,86 @@ logio_done:
|
|||||||
lio->done(sp);
|
lio->done(sp);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
qla2x00_ct_entry(scsi_qla_host_t *vha, struct req_que *req,
|
||||||
|
sts_entry_t *pkt, int iocb_type)
|
||||||
|
{
|
||||||
|
const char func[] = "CT_IOCB";
|
||||||
|
const char *type;
|
||||||
|
struct qla_hw_data *ha = vha->hw;
|
||||||
|
srb_t *sp;
|
||||||
|
struct srb_ctx *sp_bsg;
|
||||||
|
struct fc_bsg_job *bsg_job;
|
||||||
|
uint16_t comp_status;
|
||||||
|
|
||||||
|
sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
|
||||||
|
if (!sp)
|
||||||
|
return;
|
||||||
|
|
||||||
|
sp_bsg = sp->ctx;
|
||||||
|
bsg_job = sp_bsg->u.bsg_job;
|
||||||
|
|
||||||
|
type = NULL;
|
||||||
|
switch (sp_bsg->type) {
|
||||||
|
case SRB_CT_CMD:
|
||||||
|
type = "ct pass-through";
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
qla_printk(KERN_WARNING, ha,
|
||||||
|
"%s: Unrecognized SRB: (%p) type=%d.\n", func, sp,
|
||||||
|
sp_bsg->type);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
comp_status = le16_to_cpu(pkt->comp_status);
|
||||||
|
|
||||||
|
/* return FC_CTELS_STATUS_OK and leave the decoding of the ELS/CT
|
||||||
|
* fc payload to the caller
|
||||||
|
*/
|
||||||
|
bsg_job->reply->reply_data.ctels_reply.status = FC_CTELS_STATUS_OK;
|
||||||
|
bsg_job->reply_len = sizeof(struct fc_bsg_reply);
|
||||||
|
|
||||||
|
if (comp_status != CS_COMPLETE) {
|
||||||
|
if (comp_status == CS_DATA_UNDERRUN) {
|
||||||
|
bsg_job->reply->result = DID_OK << 16;
|
||||||
|
bsg_job->reply->reply_payload_rcv_len =
|
||||||
|
le16_to_cpu(((sts_entry_t *)pkt)->rsp_info_len);
|
||||||
|
|
||||||
|
DEBUG2(qla_printk(KERN_WARNING, ha,
|
||||||
|
"scsi(%ld): CT pass-through-%s error "
|
||||||
|
"comp_status-status=0x%x total_byte = 0x%x.\n",
|
||||||
|
vha->host_no, type, comp_status,
|
||||||
|
bsg_job->reply->reply_payload_rcv_len));
|
||||||
|
} else {
|
||||||
|
DEBUG2(qla_printk(KERN_WARNING, ha,
|
||||||
|
"scsi(%ld): CT pass-through-%s error "
|
||||||
|
"comp_status-status=0x%x.\n",
|
||||||
|
vha->host_no, type, comp_status));
|
||||||
|
bsg_job->reply->result = DID_ERROR << 16;
|
||||||
|
bsg_job->reply->reply_payload_rcv_len = 0;
|
||||||
|
}
|
||||||
|
DEBUG2(qla2x00_dump_buffer((uint8_t *)pkt, sizeof(*pkt)));
|
||||||
|
} else {
|
||||||
|
bsg_job->reply->result = DID_OK << 16;;
|
||||||
|
bsg_job->reply->reply_payload_rcv_len =
|
||||||
|
bsg_job->reply_payload.payload_len;
|
||||||
|
bsg_job->reply_len = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
dma_unmap_sg(&ha->pdev->dev, bsg_job->request_payload.sg_list,
|
||||||
|
bsg_job->request_payload.sg_cnt, DMA_TO_DEVICE);
|
||||||
|
|
||||||
|
dma_unmap_sg(&ha->pdev->dev, bsg_job->reply_payload.sg_list,
|
||||||
|
bsg_job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
|
||||||
|
|
||||||
|
if (sp_bsg->type == SRB_ELS_CMD_HST || sp_bsg->type == SRB_CT_CMD)
|
||||||
|
kfree(sp->fcport);
|
||||||
|
|
||||||
|
kfree(sp->ctx);
|
||||||
|
mempool_free(sp, ha->srb_mempool);
|
||||||
|
bsg_job->job_done(bsg_job);
|
||||||
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
qla24xx_els_ct_entry(scsi_qla_host_t *vha, struct req_que *req,
|
qla24xx_els_ct_entry(scsi_qla_host_t *vha, struct req_que *req,
|
||||||
struct sts_entry_24xx *pkt, int iocb_type)
|
struct sts_entry_24xx *pkt, int iocb_type)
|
||||||
@ -1303,6 +1383,9 @@ qla2x00_process_response_queue(struct rsp_que *rsp)
|
|||||||
qla2x00_mbx_iocb_entry(vha, rsp->req,
|
qla2x00_mbx_iocb_entry(vha, rsp->req,
|
||||||
(struct mbx_entry *)pkt);
|
(struct mbx_entry *)pkt);
|
||||||
break;
|
break;
|
||||||
|
case CT_IOCB_TYPE:
|
||||||
|
qla2x00_ct_entry(vha, rsp->req, pkt, CT_IOCB_TYPE);
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
/* Type Not Supported. */
|
/* Type Not Supported. */
|
||||||
DEBUG4(printk(KERN_WARNING
|
DEBUG4(printk(KERN_WARNING
|
||||||
|
Loading…
Reference in New Issue
Block a user