Commit dedaf2b0 authored by Tejun Heo's avatar Tejun Heo
Browse files

[PATCH] libata-ncq: implement ap->qc_active, ap->sactive and complete helper 



Add ap->qc_active and ap->sactive, mask of all active qcs and libata's
view of the SActive register, respectively.  Also, implement
ata_qc_complete_multiple() which takes new qc_active mask and complete
multiple qcs according to the mask.

These will be used to track NCQ commands and complete them.  The
distinction between ap->qc_active and ap->sactive is also useful for
later PM implementation.

Signed-off-by: default avatarTejun Heo <htejun@gmail.com>
parent 6cec4a39

drivers/scsi/libata-core.c

+79 −2
Original line number Diff line number Diff line
@@ -981,6 +981,7 @@ unsigned ata_exec_internal(struct ata_device *dev, 
	u8 command = tf->command;

	struct ata_queued_cmd *qc;

	unsigned int tag, preempted_tag;

	u32 preempted_sactive, preempted_qc_active;

	DECLARE_COMPLETION(wait);

	unsigned long flags;

	unsigned int err_mask;
@@ -1017,7 +1018,11 @@ unsigned ata_exec_internal(struct ata_device *dev, 
	ata_qc_reinit(qc);



	preempted_tag = ap->active_tag;

	preempted_sactive = ap->sactive;

	preempted_qc_active = ap->qc_active;

	ap->active_tag = ATA_TAG_POISON;

	ap->sactive = 0;

	ap->qc_active = 0;



	/* prepare & issue qc */

	qc->tf = *tf;
@@ -1082,6 +1087,8 @@ unsigned ata_exec_internal(struct ata_device *dev, 


	ata_qc_free(qc);

	ap->active_tag = preempted_tag;

	ap->sactive = preempted_sactive;

	ap->qc_active = preempted_qc_active;



	/* XXX - Some LLDDs (sata_mv) disable port on command failure.

	 * Until those drivers are fixed, we detect the condition
@@ -4270,6 +4277,8 @@ void ata_qc_free(struct ata_queued_cmd *qc) 


void __ata_qc_complete(struct ata_queued_cmd *qc)

{

	struct ata_port *ap = qc->ap;



	WARN_ON(qc == NULL);	/* ata_qc_from_tag _might_ return NULL */

	WARN_ON(!(qc->flags & ATA_QCFLAG_ACTIVE));
@@ -4277,13 +4286,17 @@ void __ata_qc_complete(struct ata_queued_cmd *qc) 
		ata_sg_clean(qc);



	/* command should be marked inactive atomically with qc completion */

	qc->ap->active_tag = ATA_TAG_POISON;

	if (qc->tf.protocol == ATA_PROT_NCQ)

		ap->sactive &= ~(1 << qc->tag);

	else

		ap->active_tag = ATA_TAG_POISON;



	/* atapi: mark qc as inactive to prevent the interrupt handler

	 * from completing the command twice later, before the error handler

	 * is called. (when rc != 0 and atapi request sense is needed)

	 */

	qc->flags &= ~ATA_QCFLAG_ACTIVE;

	ap->qc_active &= ~(1 << qc->tag);



	/* call completion callback */

	qc->complete_fn(qc);
@@ -4349,6 +4362,55 @@ void ata_qc_complete(struct ata_queued_cmd *qc) 
	}

}



/**

 *	ata_qc_complete_multiple - Complete multiple qcs successfully

 *	@ap: port in question

 *	@qc_active: new qc_active mask

 *	@finish_qc: LLDD callback invoked before completing a qc

 *

 *	Complete in-flight commands.  This functions is meant to be

 *	called from low-level driver's interrupt routine to complete

 *	requests normally.  ap->qc_active and @qc_active is compared

 *	and commands are completed accordingly.

 *

 *	LOCKING:

 *	spin_lock_irqsave(host_set lock)

 *

 *	RETURNS:

 *	Number of completed commands on success, -errno otherwise.

 */

int ata_qc_complete_multiple(struct ata_port *ap, u32 qc_active,

			     void (*finish_qc)(struct ata_queued_cmd *))

{

	int nr_done = 0;

	u32 done_mask;

	int i;



	done_mask = ap->qc_active ^ qc_active;



	if (unlikely(done_mask & qc_active)) {

		ata_port_printk(ap, KERN_ERR, "illegal qc_active transition "

				"(%08x->%08x)\n", ap->qc_active, qc_active);

		return -EINVAL;

	}



	for (i = 0; i < ATA_MAX_QUEUE; i++) {

		struct ata_queued_cmd *qc;



		if (!(done_mask & (1 << i)))

			continue;



		if ((qc = ata_qc_from_tag(ap, i))) {

			if (finish_qc)

				finish_qc(qc);

			ata_qc_complete(qc);

			nr_done++;

		}

	}



	return nr_done;

}



static inline int ata_should_dma_map(struct ata_queued_cmd *qc)

{

	struct ata_port *ap = qc->ap;
@@ -4388,8 +4450,22 @@ void ata_qc_issue(struct ata_queued_cmd *qc) 
{

	struct ata_port *ap = qc->ap;



	qc->ap->active_tag = qc->tag;

	/* Make sure only one non-NCQ command is outstanding.  The

	 * check is skipped for old EH because it reuses active qc to

	 * request ATAPI sense.

	 */

	WARN_ON(ap->ops->error_handler && ata_tag_valid(ap->active_tag));



	if (qc->tf.protocol == ATA_PROT_NCQ) {

		WARN_ON(ap->sactive & (1 << qc->tag));

		ap->sactive |= 1 << qc->tag;

	} else {

		WARN_ON(ap->sactive);

		ap->active_tag = qc->tag;

	}



	qc->flags |= ATA_QCFLAG_ACTIVE;

	ap->qc_active |= 1 << qc->tag;



	if (ata_should_dma_map(qc)) {

		if (qc->flags & ATA_QCFLAG_SG) {
@@ -5549,6 +5625,7 @@ EXPORT_SYMBOL_GPL(ata_host_set_remove); 
EXPORT_SYMBOL_GPL(ata_sg_init);

EXPORT_SYMBOL_GPL(ata_sg_init_one);

EXPORT_SYMBOL_GPL(ata_qc_complete);

EXPORT_SYMBOL_GPL(ata_qc_complete_multiple);

EXPORT_SYMBOL_GPL(ata_qc_issue_prot);

EXPORT_SYMBOL_GPL(ata_tf_load);

EXPORT_SYMBOL_GPL(ata_tf_read);

include/linux/libata.h

+5 −0
Original line number Diff line number Diff line
@@ -475,7 +475,10 @@ struct ata_port { 


	struct ata_queued_cmd	qcmd[ATA_MAX_QUEUE];

	unsigned long		qc_allocated;

	unsigned int		qc_active;



	unsigned int		active_tag;

	u32			sactive;



	struct ata_host_stats	stats;

	struct ata_host_set	*host_set;
@@ -668,6 +671,8 @@ extern void ata_bmdma_drive_eh(struct ata_port *ap, 
extern void ata_bmdma_error_handler(struct ata_port *ap);

extern void ata_bmdma_post_internal_cmd(struct ata_queued_cmd *qc);

extern void ata_qc_complete(struct ata_queued_cmd *qc);

extern int ata_qc_complete_multiple(struct ata_port *ap, u32 qc_active,

				    void (*finish_qc)(struct ata_queued_cmd *));

extern void ata_scsi_simulate(struct ata_device *dev, struct scsi_cmnd *cmd,

			      void (*done)(struct scsi_cmnd *));

extern int ata_std_bios_param(struct scsi_device *sdev,

CRA Git | Maintained and supported by SUSTech CRA and CCSE