Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e315cd28 authored by Anirban Chakraborty's avatar Anirban Chakraborty Committed by James Bottomley
Browse files

[SCSI] qla2xxx: Code changes for qla data structure refactoring



Following changes have been made:

1. Outstanding commands are based on a request queue, scsi_qla_host
   does not maintain it anymore.

2. start_scsi is accessed via isp_ops struct instead of direct
   invocation.

3. Interrupt registrations are done using response queue instead of
   device id.

Signed-off-by: default avatarAnirban Chakraborty <anirban.chakraborty@qlogic.com>
Signed-off-by: default avatarJames Bottomley <James.Bottomley@HansenPartnership.com>
parent 7b867cf7
Loading
Loading
Loading
Loading
+563 −550

File changed.

Preview size limit exceeded, changes collapsed.

+11 −16
Original line number Original line Diff line number Diff line
@@ -32,21 +32,15 @@ qla2x00_debounce_register(volatile uint16_t __iomem *addr)
}
}


static inline void
static inline void
qla2x00_poll(scsi_qla_host_t *ha)
qla2x00_poll(struct rsp_que *rsp)
{
{
	unsigned long flags;
	unsigned long flags;

	struct qla_hw_data *ha = rsp->hw;
	local_irq_save(flags);
	local_irq_save(flags);
	ha->isp_ops->intr_handler(0, ha);
	ha->isp_ops->intr_handler(0, rsp);
	local_irq_restore(flags);
	local_irq_restore(flags);
}
}


static __inline__ scsi_qla_host_t *
to_qla_parent(scsi_qla_host_t *ha)
{
	return ha->parent ? ha->parent : ha;
}

/**
/**
 * qla2x00_issue_marker() - Issue a Marker IOCB if necessary.
 * qla2x00_issue_marker() - Issue a Marker IOCB if necessary.
 * @ha: HA context
 * @ha: HA context
@@ -55,20 +49,20 @@ to_qla_parent(scsi_qla_host_t *ha)
 * Returns non-zero if a failure occurred, else zero.
 * Returns non-zero if a failure occurred, else zero.
 */
 */
static inline int
static inline int
qla2x00_issue_marker(scsi_qla_host_t *ha, int ha_locked)
qla2x00_issue_marker(scsi_qla_host_t *vha, int ha_locked)
{
{
	/* Send marker if required */
	/* Send marker if required */
	if (ha->marker_needed != 0) {
	if (vha->marker_needed != 0) {
		if (ha_locked) {
		if (ha_locked) {
			if (__qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) !=
			if (__qla2x00_marker(vha, 0, 0, MK_SYNC_ALL) !=
			    QLA_SUCCESS)
			    QLA_SUCCESS)
				return (QLA_FUNCTION_FAILED);
				return (QLA_FUNCTION_FAILED);
		} else {
		} else {
			if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) !=
			if (qla2x00_marker(vha, 0, 0, MK_SYNC_ALL) !=
			    QLA_SUCCESS)
			    QLA_SUCCESS)
				return (QLA_FUNCTION_FAILED);
				return (QLA_FUNCTION_FAILED);
		}
		}
		ha->marker_needed = 0;
		vha->marker_needed = 0;
	}
	}
	return (QLA_SUCCESS);
	return (QLA_SUCCESS);
}
}
@@ -87,11 +81,12 @@ host_to_fcp_swap(uint8_t *fcp, uint32_t bsize)
}
}


static inline int
static inline int
qla2x00_is_reserved_id(scsi_qla_host_t *ha, uint16_t loop_id)
qla2x00_is_reserved_id(scsi_qla_host_t *vha, uint16_t loop_id)
{
{
	struct qla_hw_data *ha = vha->hw;
	if (IS_FWI2_CAPABLE(ha))
	if (IS_FWI2_CAPABLE(ha))
		return (loop_id > NPH_LAST_HANDLE);
		return (loop_id > NPH_LAST_HANDLE);


	return ((loop_id > ha->last_loop_id && loop_id < SNS_FIRST_LOOP_ID) ||
	return ((loop_id > ha->max_loop_id && loop_id < SNS_FIRST_LOOP_ID) ||
	    loop_id == MANAGEMENT_SERVER || loop_id == BROADCAST);
	    loop_id == MANAGEMENT_SERVER || loop_id == BROADCAST);
};
};
+134 −124
Original line number Original line Diff line number Diff line
@@ -11,8 +11,8 @@


#include <scsi/scsi_tcq.h>
#include <scsi/scsi_tcq.h>


static request_t *qla2x00_req_pkt(scsi_qla_host_t *ha);
static request_t *qla2x00_req_pkt(scsi_qla_host_t *);
static void qla2x00_isp_cmd(scsi_qla_host_t *ha);
static void qla2x00_isp_cmd(scsi_qla_host_t *);


/**
/**
 * qla2x00_get_cmd_direction() - Determine control_flag data direction.
 * qla2x00_get_cmd_direction() - Determine control_flag data direction.
@@ -30,11 +30,11 @@ qla2x00_get_cmd_direction(srb_t *sp)
	/* Set transfer direction */
	/* Set transfer direction */
	if (sp->cmd->sc_data_direction == DMA_TO_DEVICE) {
	if (sp->cmd->sc_data_direction == DMA_TO_DEVICE) {
		cflags = CF_WRITE;
		cflags = CF_WRITE;
		sp->fcport->ha->qla_stats.output_bytes +=
		sp->fcport->vha->hw->qla_stats.output_bytes +=
		    scsi_bufflen(sp->cmd);
		    scsi_bufflen(sp->cmd);
	} else if (sp->cmd->sc_data_direction == DMA_FROM_DEVICE) {
	} else if (sp->cmd->sc_data_direction == DMA_FROM_DEVICE) {
		cflags = CF_READ;
		cflags = CF_READ;
		sp->fcport->ha->qla_stats.input_bytes +=
		sp->fcport->vha->hw->qla_stats.input_bytes +=
		    scsi_bufflen(sp->cmd);
		    scsi_bufflen(sp->cmd);
	}
	}
	return (cflags);
	return (cflags);
@@ -91,20 +91,20 @@ qla2x00_calc_iocbs_64(uint16_t dsds)
 * Returns a pointer to the Continuation Type 0 IOCB packet.
 * Returns a pointer to the Continuation Type 0 IOCB packet.
 */
 */
static inline cont_entry_t *
static inline cont_entry_t *
qla2x00_prep_cont_type0_iocb(scsi_qla_host_t *ha)
qla2x00_prep_cont_type0_iocb(scsi_qla_host_t *vha)
{
{
	cont_entry_t *cont_pkt;
	cont_entry_t *cont_pkt;

	struct req_que *req = vha->hw->req;
	/* Adjust ring index. */
	/* Adjust ring index. */
	ha->req_ring_index++;
	req->ring_index++;
	if (ha->req_ring_index == ha->request_q_length) {
	if (req->ring_index == req->length) {
		ha->req_ring_index = 0;
		req->ring_index = 0;
		ha->request_ring_ptr = ha->request_ring;
		req->ring_ptr = req->ring;
	} else {
	} else {
		ha->request_ring_ptr++;
		req->ring_ptr++;
	}
	}


	cont_pkt = (cont_entry_t *)ha->request_ring_ptr;
	cont_pkt = (cont_entry_t *)req->ring_ptr;


	/* Load packet defaults. */
	/* Load packet defaults. */
	*((uint32_t *)(&cont_pkt->entry_type)) =
	*((uint32_t *)(&cont_pkt->entry_type)) =
@@ -120,20 +120,21 @@ qla2x00_prep_cont_type0_iocb(scsi_qla_host_t *ha)
 * Returns a pointer to the continuation type 1 IOCB packet.
 * Returns a pointer to the continuation type 1 IOCB packet.
 */
 */
static inline cont_a64_entry_t *
static inline cont_a64_entry_t *
qla2x00_prep_cont_type1_iocb(scsi_qla_host_t *ha)
qla2x00_prep_cont_type1_iocb(scsi_qla_host_t *vha)
{
{
	cont_a64_entry_t *cont_pkt;
	cont_a64_entry_t *cont_pkt;
	struct req_que *req = vha->hw->req;


	/* Adjust ring index. */
	/* Adjust ring index. */
	ha->req_ring_index++;
	req->ring_index++;
	if (ha->req_ring_index == ha->request_q_length) {
	if (req->ring_index == req->length) {
		ha->req_ring_index = 0;
		req->ring_index = 0;
		ha->request_ring_ptr = ha->request_ring;
		req->ring_ptr = req->ring;
	} else {
	} else {
		ha->request_ring_ptr++;
		req->ring_ptr++;
	}
	}


	cont_pkt = (cont_a64_entry_t *)ha->request_ring_ptr;
	cont_pkt = (cont_a64_entry_t *)req->ring_ptr;


	/* Load packet defaults. */
	/* Load packet defaults. */
	*((uint32_t *)(&cont_pkt->entry_type)) =
	*((uint32_t *)(&cont_pkt->entry_type)) =
@@ -155,7 +156,7 @@ void qla2x00_build_scsi_iocbs_32(srb_t *sp, cmd_entry_t *cmd_pkt,
{
{
	uint16_t	avail_dsds;
	uint16_t	avail_dsds;
	uint32_t	*cur_dsd;
	uint32_t	*cur_dsd;
	scsi_qla_host_t	*ha;
	scsi_qla_host_t	*vha;
	struct scsi_cmnd *cmd;
	struct scsi_cmnd *cmd;
	struct scatterlist *sg;
	struct scatterlist *sg;
	int i;
	int i;
@@ -172,7 +173,7 @@ void qla2x00_build_scsi_iocbs_32(srb_t *sp, cmd_entry_t *cmd_pkt,
		return;
		return;
	}
	}


	ha = sp->ha;
	vha = sp->vha;


	cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));
	cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));


@@ -190,7 +191,7 @@ void qla2x00_build_scsi_iocbs_32(srb_t *sp, cmd_entry_t *cmd_pkt,
			 * Seven DSDs are available in the Continuation
			 * Seven DSDs are available in the Continuation
			 * Type 0 IOCB.
			 * Type 0 IOCB.
			 */
			 */
			cont_pkt = qla2x00_prep_cont_type0_iocb(ha);
			cont_pkt = qla2x00_prep_cont_type0_iocb(vha);
			cur_dsd = (uint32_t *)&cont_pkt->dseg_0_address;
			cur_dsd = (uint32_t *)&cont_pkt->dseg_0_address;
			avail_dsds = 7;
			avail_dsds = 7;
		}
		}
@@ -214,7 +215,7 @@ void qla2x00_build_scsi_iocbs_64(srb_t *sp, cmd_entry_t *cmd_pkt,
{
{
	uint16_t	avail_dsds;
	uint16_t	avail_dsds;
	uint32_t	*cur_dsd;
	uint32_t	*cur_dsd;
	scsi_qla_host_t	*ha;
	scsi_qla_host_t	*vha;
	struct scsi_cmnd *cmd;
	struct scsi_cmnd *cmd;
	struct scatterlist *sg;
	struct scatterlist *sg;
	int i;
	int i;
@@ -231,7 +232,7 @@ void qla2x00_build_scsi_iocbs_64(srb_t *sp, cmd_entry_t *cmd_pkt,
		return;
		return;
	}
	}


	ha = sp->ha;
	vha = sp->vha;


	cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));
	cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));


@@ -250,7 +251,7 @@ void qla2x00_build_scsi_iocbs_64(srb_t *sp, cmd_entry_t *cmd_pkt,
			 * Five DSDs are available in the Continuation
			 * Five DSDs are available in the Continuation
			 * Type 1 IOCB.
			 * Type 1 IOCB.
			 */
			 */
			cont_pkt = qla2x00_prep_cont_type1_iocb(ha);
			cont_pkt = qla2x00_prep_cont_type1_iocb(vha);
			cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
			cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
			avail_dsds = 5;
			avail_dsds = 5;
		}
		}
@@ -274,7 +275,7 @@ qla2x00_start_scsi(srb_t *sp)
{
{
	int		ret, nseg;
	int		ret, nseg;
	unsigned long   flags;
	unsigned long   flags;
	scsi_qla_host_t	*ha;
	scsi_qla_host_t	*vha;
	struct scsi_cmnd *cmd;
	struct scsi_cmnd *cmd;
	uint32_t	*clr_ptr;
	uint32_t	*clr_ptr;
	uint32_t        index;
	uint32_t        index;
@@ -284,33 +285,36 @@ qla2x00_start_scsi(srb_t *sp)
	uint16_t	req_cnt;
	uint16_t	req_cnt;
	uint16_t	tot_dsds;
	uint16_t	tot_dsds;
	struct device_reg_2xxx __iomem *reg;
	struct device_reg_2xxx __iomem *reg;
	struct qla_hw_data *ha;
	struct req_que *req;


	/* Setup device pointers. */
	/* Setup device pointers. */
	ret = 0;
	ret = 0;
	ha = sp->ha;
	vha = sp->vha;
	ha = vha->hw;
	reg = &ha->iobase->isp;
	reg = &ha->iobase->isp;
	cmd = sp->cmd;
	cmd = sp->cmd;
	req = ha->req;
	/* So we know we haven't pci_map'ed anything yet */
	/* So we know we haven't pci_map'ed anything yet */
	tot_dsds = 0;
	tot_dsds = 0;


	/* Send marker if required */
	/* Send marker if required */
	if (ha->marker_needed != 0) {
	if (vha->marker_needed != 0) {
		if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) {
		if (qla2x00_marker(vha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS)
			return (QLA_FUNCTION_FAILED);
			return (QLA_FUNCTION_FAILED);
		}
		vha->marker_needed = 0;
		ha->marker_needed = 0;
	}
	}


	/* Acquire ring specific lock */
	/* Acquire ring specific lock */
	spin_lock_irqsave(&ha->hardware_lock, flags);
	spin_lock_irqsave(&ha->hardware_lock, flags);


	/* Check for room in outstanding command list. */
	/* Check for room in outstanding command list. */
	handle = ha->current_outstanding_cmd;
	handle = req->current_outstanding_cmd;
	for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
	for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
		handle++;
		handle++;
		if (handle == MAX_OUTSTANDING_COMMANDS)
		if (handle == MAX_OUTSTANDING_COMMANDS)
			handle = 1;
			handle = 1;
		if (!ha->outstanding_cmds[handle])
		if (!req->outstanding_cmds[handle])
			break;
			break;
	}
	}
	if (index == MAX_OUTSTANDING_COMMANDS)
	if (index == MAX_OUTSTANDING_COMMANDS)
@@ -329,25 +333,25 @@ qla2x00_start_scsi(srb_t *sp)


	/* Calculate the number of request entries needed. */
	/* Calculate the number of request entries needed. */
	req_cnt = ha->isp_ops->calc_req_entries(tot_dsds);
	req_cnt = ha->isp_ops->calc_req_entries(tot_dsds);
	if (ha->req_q_cnt < (req_cnt + 2)) {
	if (req->cnt < (req_cnt + 2)) {
		cnt = RD_REG_WORD_RELAXED(ISP_REQ_Q_OUT(ha, reg));
		cnt = RD_REG_WORD_RELAXED(ISP_REQ_Q_OUT(ha, reg));
		if (ha->req_ring_index < cnt)
		if (req->ring_index < cnt)
			ha->req_q_cnt = cnt - ha->req_ring_index;
			req->cnt = cnt - req->ring_index;
		else
		else
			ha->req_q_cnt = ha->request_q_length -
			req->cnt = req->length -
			    (ha->req_ring_index - cnt);
			    (req->ring_index - cnt);
	}
	}
	if (ha->req_q_cnt < (req_cnt + 2))
	if (req->cnt < (req_cnt + 2))
		goto queuing_error;
		goto queuing_error;


	/* Build command packet */
	/* Build command packet */
	ha->current_outstanding_cmd = handle;
	req->current_outstanding_cmd = handle;
	ha->outstanding_cmds[handle] = sp;
	req->outstanding_cmds[handle] = sp;
	sp->ha = ha;
	sp->vha = vha;
	sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
	sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
	ha->req_q_cnt -= req_cnt;
	req->cnt -= req_cnt;


	cmd_pkt = (cmd_entry_t *)ha->request_ring_ptr;
	cmd_pkt = (cmd_entry_t *)req->ring_ptr;
	cmd_pkt->handle = handle;
	cmd_pkt->handle = handle;
	/* Zero out remaining portion of packet. */
	/* Zero out remaining portion of packet. */
	clr_ptr = (uint32_t *)cmd_pkt + 2;
	clr_ptr = (uint32_t *)cmd_pkt + 2;
@@ -373,23 +377,23 @@ qla2x00_start_scsi(srb_t *sp)
	wmb();
	wmb();


	/* Adjust ring index. */
	/* Adjust ring index. */
	ha->req_ring_index++;
	req->ring_index++;
	if (ha->req_ring_index == ha->request_q_length) {
	if (req->ring_index == req->length) {
		ha->req_ring_index = 0;
		req->ring_index = 0;
		ha->request_ring_ptr = ha->request_ring;
		req->ring_ptr = req->ring;
	} else
	} else
		ha->request_ring_ptr++;
		req->ring_ptr++;


	sp->flags |= SRB_DMA_VALID;
	sp->flags |= SRB_DMA_VALID;


	/* Set chip new ring index. */
	/* Set chip new ring index. */
	WRT_REG_WORD(ISP_REQ_Q_IN(ha, reg), ha->req_ring_index);
	WRT_REG_WORD(ISP_REQ_Q_IN(ha, reg), req->ring_index);
	RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, reg));	/* PCI Posting. */
	RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, reg));	/* PCI Posting. */


	/* Manage unprocessed RIO/ZIO commands in response queue. */
	/* Manage unprocessed RIO/ZIO commands in response queue. */
	if (ha->flags.process_response_queue &&
	if (vha->flags.process_response_queue &&
	    ha->response_ring_ptr->signature != RESPONSE_PROCESSED)
	    ha->rsp->ring_ptr->signature != RESPONSE_PROCESSED)
		qla2x00_process_response_queue(ha);
		qla2x00_process_response_queue(vha);


	spin_unlock_irqrestore(&ha->hardware_lock, flags);
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
	return (QLA_SUCCESS);
	return (QLA_SUCCESS);
@@ -415,18 +419,19 @@ qla2x00_start_scsi(srb_t *sp)
 * Returns non-zero if a failure occurred, else zero.
 * Returns non-zero if a failure occurred, else zero.
 */
 */
int
int
__qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
__qla2x00_marker(scsi_qla_host_t *vha, uint16_t loop_id, uint16_t lun,
    uint8_t type)
    uint8_t type)
{
{
	mrk_entry_t *mrk;
	mrk_entry_t *mrk;
	struct mrk_entry_24xx *mrk24;
	struct mrk_entry_24xx *mrk24;
	scsi_qla_host_t *pha = to_qla_parent(ha);
	struct qla_hw_data *ha = vha->hw;
	scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);


	mrk24 = NULL;
	mrk24 = NULL;
	mrk = (mrk_entry_t *)qla2x00_req_pkt(pha);
	mrk = (mrk_entry_t *)qla2x00_req_pkt(base_vha);
	if (mrk == NULL) {
	if (mrk == NULL) {
		DEBUG2_3(printk("%s(%ld): failed to allocate Marker IOCB.\n",
		DEBUG2_3(printk("%s(%ld): failed to allocate Marker IOCB.\n",
		    __func__, ha->host_no));
		    __func__, base_vha->host_no));


		return (QLA_FUNCTION_FAILED);
		return (QLA_FUNCTION_FAILED);
	}
	}
@@ -440,7 +445,7 @@ __qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
			mrk24->lun[1] = LSB(lun);
			mrk24->lun[1] = LSB(lun);
			mrk24->lun[2] = MSB(lun);
			mrk24->lun[2] = MSB(lun);
			host_to_fcp_swap(mrk24->lun, sizeof(mrk24->lun));
			host_to_fcp_swap(mrk24->lun, sizeof(mrk24->lun));
			mrk24->vp_index = ha->vp_idx;
			mrk24->vp_index = vha->vp_idx;
		} else {
		} else {
			SET_TARGET_ID(ha, mrk->target, loop_id);
			SET_TARGET_ID(ha, mrk->target, loop_id);
			mrk->lun = cpu_to_le16(lun);
			mrk->lun = cpu_to_le16(lun);
@@ -448,22 +453,22 @@ __qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
	}
	}
	wmb();
	wmb();


	qla2x00_isp_cmd(pha);
	qla2x00_isp_cmd(base_vha);


	return (QLA_SUCCESS);
	return (QLA_SUCCESS);
}
}


int
int
qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
qla2x00_marker(scsi_qla_host_t *vha, uint16_t loop_id, uint16_t lun,
    uint8_t type)
    uint8_t type)
{
{
	int ret;
	int ret;
	unsigned long flags = 0;
	unsigned long flags = 0;
	scsi_qla_host_t *pha = to_qla_parent(ha);
	struct qla_hw_data *ha = vha->hw;


	spin_lock_irqsave(&pha->hardware_lock, flags);
	spin_lock_irqsave(&ha->hardware_lock, flags);
	ret = __qla2x00_marker(ha, loop_id, lun, type);
	ret = __qla2x00_marker(vha, loop_id, lun, type);
	spin_unlock_irqrestore(&pha->hardware_lock, flags);
	spin_unlock_irqrestore(&ha->hardware_lock, flags);


	return (ret);
	return (ret);
}
}
@@ -477,18 +482,20 @@ qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
 * Returns NULL if function failed, else, a pointer to the request packet.
 * Returns NULL if function failed, else, a pointer to the request packet.
 */
 */
static request_t *
static request_t *
qla2x00_req_pkt(scsi_qla_host_t *ha)
qla2x00_req_pkt(scsi_qla_host_t *vha)
{
{
	struct qla_hw_data *ha = vha->hw;
	device_reg_t __iomem *reg = ha->iobase;
	device_reg_t __iomem *reg = ha->iobase;
	request_t	*pkt = NULL;
	request_t	*pkt = NULL;
	uint16_t	cnt;
	uint16_t	cnt;
	uint32_t	*dword_ptr;
	uint32_t	*dword_ptr;
	uint32_t	timer;
	uint32_t	timer;
	uint16_t	req_cnt = 1;
	uint16_t	req_cnt = 1;
	struct req_que *req = ha->req;


	/* Wait 1 second for slot. */
	/* Wait 1 second for slot. */
	for (timer = HZ; timer; timer--) {
	for (timer = HZ; timer; timer--) {
		if ((req_cnt + 2) >= ha->req_q_cnt) {
		if ((req_cnt + 2) >= req->cnt) {
			/* Calculate number of free request entries. */
			/* Calculate number of free request entries. */
			if (IS_FWI2_CAPABLE(ha))
			if (IS_FWI2_CAPABLE(ha))
				cnt = (uint16_t)RD_REG_DWORD(
				cnt = (uint16_t)RD_REG_DWORD(
@@ -496,16 +503,16 @@ qla2x00_req_pkt(scsi_qla_host_t *ha)
			else
			else
				cnt = qla2x00_debounce_register(
				cnt = qla2x00_debounce_register(
				    ISP_REQ_Q_OUT(ha, &reg->isp));
				    ISP_REQ_Q_OUT(ha, &reg->isp));
			if  (ha->req_ring_index < cnt)
			if  (req->ring_index < cnt)
				ha->req_q_cnt = cnt - ha->req_ring_index;
				req->cnt = cnt - req->ring_index;
			else
			else
				ha->req_q_cnt = ha->request_q_length -
				req->cnt = req->length -
				    (ha->req_ring_index - cnt);
				    (req->ring_index - cnt);
		}
		}
		/* If room for request in request ring. */
		/* If room for request in request ring. */
		if ((req_cnt + 2) < ha->req_q_cnt) {
		if ((req_cnt + 2) < req->cnt) {
			ha->req_q_cnt--;
			req->cnt--;
			pkt = ha->request_ring_ptr;
			pkt = req->ring_ptr;


			/* Zero out packet. */
			/* Zero out packet. */
			dword_ptr = (uint32_t *)pkt;
			dword_ptr = (uint32_t *)pkt;
@@ -513,7 +520,7 @@ qla2x00_req_pkt(scsi_qla_host_t *ha)
				*dword_ptr++ = 0;
				*dword_ptr++ = 0;


			/* Set system defined field. */
			/* Set system defined field. */
			pkt->sys_define = (uint8_t)ha->req_ring_index;
			pkt->sys_define = (uint8_t)req->ring_index;


			/* Set entry count. */
			/* Set entry count. */
			pkt->entry_count = 1;
			pkt->entry_count = 1;
@@ -522,15 +529,14 @@ qla2x00_req_pkt(scsi_qla_host_t *ha)
		}
		}


		/* Release ring specific lock */
		/* Release ring specific lock */
		spin_unlock(&ha->hardware_lock);
		spin_unlock_irq(&ha->hardware_lock);


		udelay(2);   /* 2 us */
		udelay(2);   /* 2 us */


		/* Check for pending interrupts. */
		/* Check for pending interrupts. */
		/* During init we issue marker directly */
		/* During init we issue marker directly */
		if (!ha->marker_needed && !ha->flags.init_done)
		if (!vha->marker_needed && !vha->flags.init_done)
			qla2x00_poll(ha);
			qla2x00_poll(ha->rsp);

		spin_lock_irq(&ha->hardware_lock);
		spin_lock_irq(&ha->hardware_lock);
	}
	}
	if (!pkt) {
	if (!pkt) {
@@ -547,28 +553,30 @@ qla2x00_req_pkt(scsi_qla_host_t *ha)
 * Note: The caller must hold the hardware lock before calling this routine.
 * Note: The caller must hold the hardware lock before calling this routine.
 */
 */
static void
static void
qla2x00_isp_cmd(scsi_qla_host_t *ha)
qla2x00_isp_cmd(scsi_qla_host_t *vha)
{
{
	struct qla_hw_data *ha = vha->hw;
	device_reg_t __iomem *reg = ha->iobase;
	device_reg_t __iomem *reg = ha->iobase;
	struct req_que *req = ha->req;


	DEBUG5(printk("%s(): IOCB data:\n", __func__));
	DEBUG5(printk("%s(): IOCB data:\n", __func__));
	DEBUG5(qla2x00_dump_buffer(
	DEBUG5(qla2x00_dump_buffer(
	    (uint8_t *)ha->request_ring_ptr, REQUEST_ENTRY_SIZE));
	    (uint8_t *)req->ring_ptr, REQUEST_ENTRY_SIZE));


	/* Adjust ring index. */
	/* Adjust ring index. */
	ha->req_ring_index++;
	req->ring_index++;
	if (ha->req_ring_index == ha->request_q_length) {
	if (req->ring_index == req->length) {
		ha->req_ring_index = 0;
		req->ring_index = 0;
		ha->request_ring_ptr = ha->request_ring;
		req->ring_ptr = req->ring;
	} else
	} else
		ha->request_ring_ptr++;
		req->ring_ptr++;


	/* Set chip new ring index. */
	/* Set chip new ring index. */
	if (IS_FWI2_CAPABLE(ha)) {
	if (IS_FWI2_CAPABLE(ha)) {
		WRT_REG_DWORD(&reg->isp24.req_q_in, ha->req_ring_index);
		WRT_REG_DWORD(&reg->isp24.req_q_in, req->ring_index);
		RD_REG_DWORD_RELAXED(&reg->isp24.req_q_in);
		RD_REG_DWORD_RELAXED(&reg->isp24.req_q_in);
	} else {
	} else {
		WRT_REG_WORD(ISP_REQ_Q_IN(ha, &reg->isp), ha->req_ring_index);
		WRT_REG_WORD(ISP_REQ_Q_IN(ha, &reg->isp), req->ring_index);
		RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, &reg->isp));
		RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, &reg->isp));
	}
	}


@@ -610,7 +618,7 @@ qla24xx_build_scsi_iocbs(srb_t *sp, struct cmd_type_7 *cmd_pkt,
{
{
	uint16_t	avail_dsds;
	uint16_t	avail_dsds;
	uint32_t	*cur_dsd;
	uint32_t	*cur_dsd;
	scsi_qla_host_t	*ha;
	scsi_qla_host_t	*vha;
	struct scsi_cmnd *cmd;
	struct scsi_cmnd *cmd;
	struct scatterlist *sg;
	struct scatterlist *sg;
	int i;
	int i;
@@ -627,18 +635,18 @@ qla24xx_build_scsi_iocbs(srb_t *sp, struct cmd_type_7 *cmd_pkt,
		return;
		return;
	}
	}


	ha = sp->ha;
	vha = sp->vha;


	/* Set transfer direction */
	/* Set transfer direction */
	if (cmd->sc_data_direction == DMA_TO_DEVICE) {
	if (cmd->sc_data_direction == DMA_TO_DEVICE) {
		cmd_pkt->task_mgmt_flags =
		cmd_pkt->task_mgmt_flags =
		    __constant_cpu_to_le16(TMF_WRITE_DATA);
		    __constant_cpu_to_le16(TMF_WRITE_DATA);
		sp->fcport->ha->qla_stats.output_bytes +=
		sp->fcport->vha->hw->qla_stats.output_bytes +=
		    scsi_bufflen(sp->cmd);
		    scsi_bufflen(sp->cmd);
	} else if (cmd->sc_data_direction == DMA_FROM_DEVICE) {
	} else if (cmd->sc_data_direction == DMA_FROM_DEVICE) {
		cmd_pkt->task_mgmt_flags =
		cmd_pkt->task_mgmt_flags =
		    __constant_cpu_to_le16(TMF_READ_DATA);
		    __constant_cpu_to_le16(TMF_READ_DATA);
		sp->fcport->ha->qla_stats.input_bytes +=
		sp->fcport->vha->hw->qla_stats.input_bytes +=
		    scsi_bufflen(sp->cmd);
		    scsi_bufflen(sp->cmd);
	}
	}


@@ -658,7 +666,7 @@ qla24xx_build_scsi_iocbs(srb_t *sp, struct cmd_type_7 *cmd_pkt,
			 * Five DSDs are available in the Continuation
			 * Five DSDs are available in the Continuation
			 * Type 1 IOCB.
			 * Type 1 IOCB.
			 */
			 */
			cont_pkt = qla2x00_prep_cont_type1_iocb(ha);
			cont_pkt = qla2x00_prep_cont_type1_iocb(vha);
			cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
			cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
			avail_dsds = 5;
			avail_dsds = 5;
		}
		}
@@ -683,7 +691,7 @@ qla24xx_start_scsi(srb_t *sp)
{
{
	int		ret, nseg;
	int		ret, nseg;
	unsigned long   flags;
	unsigned long   flags;
	scsi_qla_host_t	*ha, *pha;
	scsi_qla_host_t	*vha;
	struct scsi_cmnd *cmd;
	struct scsi_cmnd *cmd;
	uint32_t	*clr_ptr;
	uint32_t	*clr_ptr;
	uint32_t        index;
	uint32_t        index;
@@ -693,34 +701,36 @@ qla24xx_start_scsi(srb_t *sp)
	uint16_t	req_cnt;
	uint16_t	req_cnt;
	uint16_t	tot_dsds;
	uint16_t	tot_dsds;
	struct device_reg_24xx __iomem *reg;
	struct device_reg_24xx __iomem *reg;
	struct qla_hw_data *ha;
	struct req_que *req;


	/* Setup device pointers. */
	/* Setup device pointers. */
	ret = 0;
	ret = 0;
	ha = sp->ha;
	vha = sp->vha;
	pha = to_qla_parent(ha);
	ha = vha->hw;
	reg = &ha->iobase->isp24;
	reg = &ha->iobase->isp24;
	cmd = sp->cmd;
	cmd = sp->cmd;
	req = ha->req;
	/* So we know we haven't pci_map'ed anything yet */
	/* So we know we haven't pci_map'ed anything yet */
	tot_dsds = 0;
	tot_dsds = 0;


	/* Send marker if required */
	/* Send marker if required */
	if (ha->marker_needed != 0) {
	if (vha->marker_needed != 0) {
		if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) {
		if (qla2x00_marker(vha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS)
			return QLA_FUNCTION_FAILED;
			return QLA_FUNCTION_FAILED;
		}
		vha->marker_needed = 0;
		ha->marker_needed = 0;
	}
	}


	/* Acquire ring specific lock */
	/* Acquire ring specific lock */
	spin_lock_irqsave(&pha->hardware_lock, flags);
	spin_lock_irqsave(&ha->hardware_lock, flags);


	/* Check for room in outstanding command list. */
	/* Check for room in outstanding command list. */
	handle = ha->current_outstanding_cmd;
	handle = req->current_outstanding_cmd;
	for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
	for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
		handle++;
		handle++;
		if (handle == MAX_OUTSTANDING_COMMANDS)
		if (handle == MAX_OUTSTANDING_COMMANDS)
			handle = 1;
			handle = 1;
		if (!ha->outstanding_cmds[handle])
		if (!req->outstanding_cmds[handle])
			break;
			break;
	}
	}
	if (index == MAX_OUTSTANDING_COMMANDS)
	if (index == MAX_OUTSTANDING_COMMANDS)
@@ -738,25 +748,25 @@ qla24xx_start_scsi(srb_t *sp)
	tot_dsds = nseg;
	tot_dsds = nseg;


	req_cnt = qla24xx_calc_iocbs(tot_dsds);
	req_cnt = qla24xx_calc_iocbs(tot_dsds);
	if (ha->req_q_cnt < (req_cnt + 2)) {
	if (req->cnt < (req_cnt + 2)) {
		cnt = (uint16_t)RD_REG_DWORD_RELAXED(&reg->req_q_out);
		cnt = (uint16_t)RD_REG_DWORD_RELAXED(&reg->req_q_out);
		if (ha->req_ring_index < cnt)
		if (req->ring_index < cnt)
			ha->req_q_cnt = cnt - ha->req_ring_index;
			req->cnt = cnt - req->ring_index;
		else
		else
			ha->req_q_cnt = ha->request_q_length -
			req->cnt = req->length -
				(ha->req_ring_index - cnt);
				(req->ring_index - cnt);
	}
	}
	if (ha->req_q_cnt < (req_cnt + 2))
	if (req->cnt < (req_cnt + 2))
		goto queuing_error;
		goto queuing_error;


	/* Build command packet. */
	/* Build command packet. */
	ha->current_outstanding_cmd = handle;
	req->current_outstanding_cmd = handle;
	ha->outstanding_cmds[handle] = sp;
	req->outstanding_cmds[handle] = sp;
	sp->ha = ha;
	sp->vha = vha;
	sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
	sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
	ha->req_q_cnt -= req_cnt;
	req->cnt -= req_cnt;


	cmd_pkt = (struct cmd_type_7 *)ha->request_ring_ptr;
	cmd_pkt = (struct cmd_type_7 *)req->ring_ptr;
	cmd_pkt->handle = handle;
	cmd_pkt->handle = handle;


	/* Zero out remaining portion of packet. */
	/* Zero out remaining portion of packet. */
@@ -789,32 +799,32 @@ qla24xx_start_scsi(srb_t *sp)
	wmb();
	wmb();


	/* Adjust ring index. */
	/* Adjust ring index. */
	ha->req_ring_index++;
	req->ring_index++;
	if (ha->req_ring_index == ha->request_q_length) {
	if (req->ring_index == req->length) {
		ha->req_ring_index = 0;
		req->ring_index = 0;
		ha->request_ring_ptr = ha->request_ring;
		req->ring_ptr = req->ring;
	} else
	} else
		ha->request_ring_ptr++;
		req->ring_ptr++;


	sp->flags |= SRB_DMA_VALID;
	sp->flags |= SRB_DMA_VALID;


	/* Set chip new ring index. */
	/* Set chip new ring index. */
	WRT_REG_DWORD(&reg->req_q_in, ha->req_ring_index);
	WRT_REG_DWORD(&reg->req_q_in, req->ring_index);
	RD_REG_DWORD_RELAXED(&reg->req_q_in);		/* PCI Posting. */
	RD_REG_DWORD_RELAXED(&reg->req_q_in);		/* PCI Posting. */


	/* Manage unprocessed RIO/ZIO commands in response queue. */
	/* Manage unprocessed RIO/ZIO commands in response queue. */
	if (ha->flags.process_response_queue &&
	if (vha->flags.process_response_queue &&
	    ha->response_ring_ptr->signature != RESPONSE_PROCESSED)
	    ha->rsp->ring_ptr->signature != RESPONSE_PROCESSED)
		qla24xx_process_response_queue(ha);
		qla24xx_process_response_queue(vha);


	spin_unlock_irqrestore(&pha->hardware_lock, flags);
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
	return QLA_SUCCESS;
	return QLA_SUCCESS;


queuing_error:
queuing_error:
	if (tot_dsds)
	if (tot_dsds)
		scsi_dma_unmap(cmd);
		scsi_dma_unmap(cmd);


	spin_unlock_irqrestore(&pha->hardware_lock, flags);
	spin_unlock_irqrestore(&ha->hardware_lock, flags);


	return QLA_FUNCTION_FAILED;
	return QLA_FUNCTION_FAILED;
}
}
+351 −282

File changed.

Preview size limit exceeded, changes collapsed.

+688 −577

File changed.

Preview size limit exceeded, changes collapsed.

Loading