libata: Add support for SEND/RECEIVE FPDMA QUEUED

Add support for the following ATA opcodes, which are present
in SATA 3.1 and T13 ATA ACS-3:

        SEND FPDMA QUEUED
        RECEIVE FPDMA QUEUED

Signed-off-by: Marc Carino <marc.ceeeee@gmail.com>
Signed-off-by: Tejun Heo <tj@kernel.org>

1 files changed, 16 insertions, 0 deletions

diff --git a/drivers/ata/libata-core.c b/drivers/ata/libata-core.c
index 2b4e92568850..a044be99841a 100644
--- a/drivers/ata/libata-core.c
+++ b/drivers/ata/libata-core.c
@@ -2141,6 +2141,22 @@ static int ata_dev_config_ncq(struct ata_device *dev,
         else
                 snprintf(desc, desc_sz, "NCQ (depth %d/%d)%s", hdepth,
                         ddepth, aa_desc);
+
+        if ((ap->flags & ATA_FLAG_FPDMA_AUX) &&
+            ata_id_has_ncq_send_and_recv(dev->id)) {
+                err_mask = ata_read_log_page(dev, ATA_LOG_NCQ_SEND_RECV,
+                                             0, ap->sector_buf, 1);
+                if (err_mask) {
+                        ata_dev_dbg(dev,
+                                    "failed to get NCQ Send/Recv Log Emask 0x%x\n",
+                                    err_mask);
+                } else {
+                        dev->flags |= ATA_DFLAG_NCQ_SEND_RECV;
+                        memcpy(dev->ncq_send_recv_cmds, ap->sector_buf,
+                                ATA_LOG_NCQ_SEND_RECV_SIZE);
+                }
+        }
+
         return 0;
 }