|
@@ -418,6 +418,7 @@ void ata_sff_tf_load(struct ata_port *ap, const struct ata_taskfile *tf)
|
|
|
if (ioaddr->ctl_addr)
|
|
|
iowrite8(tf->ctl, ioaddr->ctl_addr);
|
|
|
ap->last_ctl = tf->ctl;
|
|
|
+ ata_wait_idle(ap);
|
|
|
}
|
|
|
|
|
|
if (is_addr && (tf->flags & ATA_TFLAG_LBA48)) {
|
|
@@ -453,6 +454,8 @@ void ata_sff_tf_load(struct ata_port *ap, const struct ata_taskfile *tf)
|
|
|
iowrite8(tf->device, ioaddr->device_addr);
|
|
|
VPRINTK("device 0x%X\n", tf->device);
|
|
|
}
|
|
|
+
|
|
|
+ ata_wait_idle(ap);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(ata_sff_tf_load);
|
|
|
|
|
@@ -1042,7 +1045,8 @@ static void ata_hsm_qc_complete(struct ata_queued_cmd *qc, int in_wq)
|
|
|
int ata_sff_hsm_move(struct ata_port *ap, struct ata_queued_cmd *qc,
|
|
|
u8 status, int in_wq)
|
|
|
{
|
|
|
- struct ata_eh_info *ehi = &ap->link.eh_info;
|
|
|
+ struct ata_link *link = qc->dev->link;
|
|
|
+ struct ata_eh_info *ehi = &link->eh_info;
|
|
|
unsigned long flags = 0;
|
|
|
int poll_next;
|
|
|
|
|
@@ -1298,8 +1302,14 @@ fsm_start:
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(ata_sff_hsm_move);
|
|
|
|
|
|
-void ata_sff_queue_pio_task(struct ata_port *ap, unsigned long delay)
|
|
|
+void ata_sff_queue_pio_task(struct ata_link *link, unsigned long delay)
|
|
|
{
|
|
|
+ struct ata_port *ap = link->ap;
|
|
|
+
|
|
|
+ WARN_ON((ap->sff_pio_task_link != NULL) &&
|
|
|
+ (ap->sff_pio_task_link != link));
|
|
|
+ ap->sff_pio_task_link = link;
|
|
|
+
|
|
|
/* may fail if ata_sff_flush_pio_task() in progress */
|
|
|
queue_delayed_work(ata_sff_wq, &ap->sff_pio_task,
|
|
|
msecs_to_jiffies(delay));
|
|
@@ -1321,14 +1331,18 @@ static void ata_sff_pio_task(struct work_struct *work)
|
|
|
{
|
|
|
struct ata_port *ap =
|
|
|
container_of(work, struct ata_port, sff_pio_task.work);
|
|
|
+ struct ata_link *link = ap->sff_pio_task_link;
|
|
|
struct ata_queued_cmd *qc;
|
|
|
u8 status;
|
|
|
int poll_next;
|
|
|
|
|
|
+ BUG_ON(ap->sff_pio_task_link == NULL);
|
|
|
/* qc can be NULL if timeout occurred */
|
|
|
- qc = ata_qc_from_tag(ap, ap->link.active_tag);
|
|
|
- if (!qc)
|
|
|
+ qc = ata_qc_from_tag(ap, link->active_tag);
|
|
|
+ if (!qc) {
|
|
|
+ ap->sff_pio_task_link = NULL;
|
|
|
return;
|
|
|
+ }
|
|
|
|
|
|
fsm_start:
|
|
|
WARN_ON_ONCE(ap->hsm_task_state == HSM_ST_IDLE);
|
|
@@ -1345,11 +1359,16 @@ fsm_start:
|
|
|
msleep(2);
|
|
|
status = ata_sff_busy_wait(ap, ATA_BUSY, 10);
|
|
|
if (status & ATA_BUSY) {
|
|
|
- ata_sff_queue_pio_task(ap, ATA_SHORT_PAUSE);
|
|
|
+ ata_sff_queue_pio_task(link, ATA_SHORT_PAUSE);
|
|
|
return;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ /*
|
|
|
+ * hsm_move() may trigger another command to be processed.
|
|
|
+ * clean the link beforehand.
|
|
|
+ */
|
|
|
+ ap->sff_pio_task_link = NULL;
|
|
|
/* move the HSM */
|
|
|
poll_next = ata_sff_hsm_move(ap, qc, status, 1);
|
|
|
|
|
@@ -1376,6 +1395,7 @@ fsm_start:
|
|
|
unsigned int ata_sff_qc_issue(struct ata_queued_cmd *qc)
|
|
|
{
|
|
|
struct ata_port *ap = qc->ap;
|
|
|
+ struct ata_link *link = qc->dev->link;
|
|
|
|
|
|
/* Use polling pio if the LLD doesn't handle
|
|
|
* interrupt driven pio and atapi CDB interrupt.
|
|
@@ -1396,7 +1416,7 @@ unsigned int ata_sff_qc_issue(struct ata_queued_cmd *qc)
|
|
|
ap->hsm_task_state = HSM_ST_LAST;
|
|
|
|
|
|
if (qc->tf.flags & ATA_TFLAG_POLLING)
|
|
|
- ata_sff_queue_pio_task(ap, 0);
|
|
|
+ ata_sff_queue_pio_task(link, 0);
|
|
|
|
|
|
break;
|
|
|
|
|
@@ -1409,7 +1429,7 @@ unsigned int ata_sff_qc_issue(struct ata_queued_cmd *qc)
|
|
|
if (qc->tf.flags & ATA_TFLAG_WRITE) {
|
|
|
/* PIO data out protocol */
|
|
|
ap->hsm_task_state = HSM_ST_FIRST;
|
|
|
- ata_sff_queue_pio_task(ap, 0);
|
|
|
+ ata_sff_queue_pio_task(link, 0);
|
|
|
|
|
|
/* always send first data block using the
|
|
|
* ata_sff_pio_task() codepath.
|
|
@@ -1419,7 +1439,7 @@ unsigned int ata_sff_qc_issue(struct ata_queued_cmd *qc)
|
|
|
ap->hsm_task_state = HSM_ST;
|
|
|
|
|
|
if (qc->tf.flags & ATA_TFLAG_POLLING)
|
|
|
- ata_sff_queue_pio_task(ap, 0);
|
|
|
+ ata_sff_queue_pio_task(link, 0);
|
|
|
|
|
|
/* if polling, ata_sff_pio_task() handles the
|
|
|
* rest. otherwise, interrupt handler takes
|
|
@@ -1441,7 +1461,7 @@ unsigned int ata_sff_qc_issue(struct ata_queued_cmd *qc)
|
|
|
/* send cdb by polling if no cdb interrupt */
|
|
|
if ((!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) ||
|
|
|
(qc->tf.flags & ATA_TFLAG_POLLING))
|
|
|
- ata_sff_queue_pio_task(ap, 0);
|
|
|
+ ata_sff_queue_pio_task(link, 0);
|
|
|
break;
|
|
|
|
|
|
default:
|
|
@@ -2734,6 +2754,7 @@ EXPORT_SYMBOL_GPL(ata_bmdma_dumb_qc_prep);
|
|
|
unsigned int ata_bmdma_qc_issue(struct ata_queued_cmd *qc)
|
|
|
{
|
|
|
struct ata_port *ap = qc->ap;
|
|
|
+ struct ata_link *link = qc->dev->link;
|
|
|
|
|
|
/* defer PIO handling to sff_qc_issue */
|
|
|
if (!ata_is_dma(qc->tf.protocol))
|
|
@@ -2762,7 +2783,7 @@ unsigned int ata_bmdma_qc_issue(struct ata_queued_cmd *qc)
|
|
|
|
|
|
/* send cdb by polling if no cdb interrupt */
|
|
|
if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR))
|
|
|
- ata_sff_queue_pio_task(ap, 0);
|
|
|
+ ata_sff_queue_pio_task(link, 0);
|
|
|
break;
|
|
|
|
|
|
default:
|