From: Adam Manzanares <adam.manzana...@wdc.com>

We previously had a check to see if the device has support for
prioritized ncq commands and a check to see if a device flag
is set, through a sysfs variable, in order to send a prioritized
command.

This patch only allows the sysfs variable to be set if the device
supports prioritized commands enabling one check in ata_build_rw_tf
in order to determine whether or not to send a prioritized command.

This patch depends on ata: ATA Command Priority Disabled By Default

tj: Minor subject and formatting updates.

Signed-off-by: Adam Manzanares <adam.manzana...@wdc.com>
---
 drivers/ata/libata-core.c |  3 +--
 drivers/ata/libata-scsi.c | 21 +++++++++++++++------
 2 files changed, 16 insertions(+), 8 deletions(-)

diff --git a/drivers/ata/libata-core.c b/drivers/ata/libata-core.c
index f6a631a..324e76e 100644
--- a/drivers/ata/libata-core.c
+++ b/drivers/ata/libata-core.c
@@ -787,8 +787,7 @@ int ata_build_rw_tf(struct ata_taskfile *tf, struct 
ata_device *dev,
                if (tf->flags & ATA_TFLAG_FUA)
                        tf->device |= 1 << 7;
 
-               if ((dev->flags & ATA_DFLAG_NCQ_PRIO) &&
-                   (dev->flags & ATA_DFLAG_NCQ_PRIO_ENABLE)) {
+               if (dev->flags & ATA_DFLAG_NCQ_PRIO_ENABLE) {
                        if (class == IOPRIO_CLASS_RT)
                                tf->hob_nsect |= ATA_PRIO_HIGH <<
                                                 ATA_SHIFT_PRIO;
diff --git a/drivers/ata/libata-scsi.c b/drivers/ata/libata-scsi.c
index 328a601..c24cbf1 100644
--- a/drivers/ata/libata-scsi.c
+++ b/drivers/ata/libata-scsi.c
@@ -317,17 +317,26 @@ static ssize_t ata_ncq_prio_enable_store(struct device 
*device,
 
        ap = ata_shost_to_port(sdev->host);
 
-       spin_lock_irqsave(ap->lock, flags);
        dev = ata_scsi_find_dev(ap, sdev);
-       if (unlikely(!dev)) {
-               rc = -ENODEV;
-               goto unlock;
+       if (unlikely(!dev))
+               return  -ENODEV;
+
+       if (!(dev->flags & ATA_DFLAG_NCQ_PRIO)) {
+               if (ata_id_has_ncq_prio(dev->id))
+                       ata_dev_config_ncq_prio(dev);
        }
 
-       if (input)
+       spin_lock_irqsave(ap->lock, flags);
+       if (input) {
+               if (!(dev->flags & ATA_DFLAG_NCQ_PRIO)) {
+                       rc = -EOPNOTSUPP;
+                       goto unlock;
+               }
+
                dev->flags |= ATA_DFLAG_NCQ_PRIO_ENABLE;
-       else
+       } else {
                dev->flags &= ~ATA_DFLAG_NCQ_PRIO_ENABLE;
+       }
 
 unlock:
        spin_unlock_irqrestore(ap->lock, flags);
-- 
2.7.4

Reply via email to