2 files changed, 13 insertions, 21 deletions

diff --git a/drivers/scsi/libsas/sas_discover.c b/drivers/scsi/libsas/sas_discover.c
index 5252143b6297..a18c0f6d6668 100644
--- a/drivers/scsi/libsas/sas_discover.c
+++ b/drivers/scsi/libsas/sas_discover.c
@@ -371,6 +371,7 @@ static int sas_issue_ata_cmd(struct domain_device *dev, u8 command,
 
         task->dev = dev;
 
+        task->ata_task.fis.fis_type = 0x27;
         task->ata_task.fis.command = command;
         task->ata_task.fis.features = features;
         task->ata_task.fis.device = d2h_fis->device;
@@ -483,11 +484,7 @@ cont1:
 
         sas_fill_in_rphy(dev, dev->rphy);
 
-        res = sas_rphy_add(dev->rphy);
-        if (res)
-                goto out_err;
-
-        return res;
+        return 0;
 out_err:
         dev->sata_dev.identify_packet_device = NULL;
         dev->sata_dev.identify_device = NULL;
@@ -555,7 +552,7 @@ int sas_discover_sata(struct domain_device *dev)
 
         res = sas_notify_lldd_dev_found(dev);
         if (res)
-                goto out_err2;
+                return res;
 
         switch (dev->dev_type) {
         case SATA_DEV:
@@ -567,23 +564,12 @@ int sas_discover_sata(struct domain_device *dev)
         default:
                 break;
         }
-        if (res)
-                goto out_err;
-
         sas_notify_lldd_dev_gone(dev);
-        res = sas_notify_lldd_dev_found(dev);
-        if (res)
-                goto out_err2;
-
-        res = sas_rphy_add(dev->rphy);
-        if (res)
-                goto out_err;
-
-        return res;
+        if (!res) {
+                sas_notify_lldd_dev_found(dev);
+                res = sas_rphy_add(dev->rphy);
+        }
 
-out_err:
-        sas_notify_lldd_dev_gone(dev);
-out_err2:
         return res;
 }
 
diff --git a/drivers/scsi/libsas/sas_scsi_host.c b/drivers/scsi/libsas/sas_scsi_host.c
index 5ff14ed9baf6..0dc7c02b3837 100644
--- a/drivers/scsi/libsas/sas_scsi_host.c
+++ b/drivers/scsi/libsas/sas_scsi_host.c
@@ -812,6 +812,12 @@ static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
         task->task_proto = SAS_PROTOCOL_STP;
         task->task_done = sas_ata_task_done;
 
+        if (qc->tf.command == ATA_CMD_FPDMA_WRITE ||
+            qc->tf.command == ATA_CMD_FPDMA_READ) {
+                /* Need to zero out the tag libata assigned us */
+                qc->tf.nsect = 0;
+        }
+
         ata_tf_to_fis(&qc->tf, (u8*)&task->ata_task.fis, 0);
         task->uldd_task = qc;
         if (is_atapi_taskfile(&qc->tf)) {