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>

2 files changed, 25 insertions, 0 deletions

diff --git a/include/linux/ata.h b/include/linux/ata.h
index f63fb1afc5cc..bf4c69ca76df 100644
--- a/include/linux/ata.h
+++ b/include/linux/ata.h
@@ -239,6 +239,8 @@ enum {
         ATA_CMD_WRITE_QUEUED_FUA_EXT = 0x3E,
         ATA_CMD_FPDMA_READ      = 0x60,
         ATA_CMD_FPDMA_WRITE     = 0x61,
+        ATA_CMD_FPDMA_SEND      = 0x64,
+        ATA_CMD_FPDMA_RECV      = 0x65,
         ATA_CMD_PIO_READ        = 0x20,
         ATA_CMD_PIO_READ_EXT    = 0x24,
         ATA_CMD_PIO_WRITE       = 0x30,
@@ -293,8 +295,13 @@ enum {
         /* marked obsolete in the ATA/ATAPI-7 spec */
         ATA_CMD_RESTORE         = 0x10,
 
+        /* Subcmds for ATA_CMD_FPDMA_SEND */
+        ATA_SUBCMD_FPDMA_SEND_DSM            = 0x00,
+        ATA_SUBCMD_FPDMA_SEND_WR_LOG_DMA_EXT = 0x02,
+
         /* READ_LOG_EXT pages */
         ATA_LOG_SATA_NCQ        = 0x10,
+        ATA_LOG_NCQ_SEND_RECV     = 0x13,
         ATA_LOG_SATA_ID_DEV_DATA  = 0x30,
         ATA_LOG_SATA_SETTINGS     = 0x08,
         ATA_LOG_DEVSLP_OFFSET     = 0x30,
@@ -305,6 +312,15 @@ enum {
         ATA_LOG_DEVSLP_VALID      = 0x07,
         ATA_LOG_DEVSLP_VALID_MASK = 0x80,
 
+        /* NCQ send and receive log */
+        ATA_LOG_NCQ_SEND_RECV_SUBCMDS_OFFSET    = 0x00,
+        ATA_LOG_NCQ_SEND_RECV_SUBCMDS_DSM       = (1 << 0),
+        ATA_LOG_NCQ_SEND_RECV_DSM_OFFSET        = 0x04,
+        ATA_LOG_NCQ_SEND_RECV_DSM_TRIM          = (1 << 0),
+        ATA_LOG_NCQ_SEND_RECV_RD_LOG_OFFSET     = 0x08,
+        ATA_LOG_NCQ_SEND_RECV_WR_LOG_OFFSET     = 0x0C,
+        ATA_LOG_NCQ_SEND_RECV_SIZE              = 0x10,
+
         /* READ/WRITE LONG (obsolete) */
         ATA_CMD_READ_LONG       = 0x22,
         ATA_CMD_READ_LONG_ONCE  = 0x23,
@@ -772,6 +788,11 @@ static inline int ata_id_rotation_rate(const u16 *id)
         return val;
 }
 
+static inline bool ata_id_has_ncq_send_and_recv(const u16 *id)
+{
+        return id[ATA_ID_SATA_CAPABILITY_2] & BIT(6);
+}
+
 static inline bool ata_id_has_trim(const u16 *id)
 {
         if (ata_id_major_version(id) >= 7 &&
diff --git a/include/linux/libata.h b/include/linux/libata.h
index 578f98c3ff57..a988c2d7d0e8 100644
--- a/include/linux/libata.h
+++ b/include/linux/libata.h
@@ -172,6 +172,7 @@ enum {
         ATA_DFLAG_DUBIOUS_XFER  = (1 << 16), /* data transfer not verified */
         ATA_DFLAG_NO_UNLOAD     = (1 << 17), /* device doesn't support unload */
         ATA_DFLAG_UNLOCK_HPA    = (1 << 18), /* unlock HPA */
+        ATA_DFLAG_NCQ_SEND_RECV = (1 << 19), /* device supports NCQ SEND and RECV */
         ATA_DFLAG_INIT_MASK     = (1 << 24) - 1,
 
         ATA_DFLAG_DETACH        = (1 << 24),
@@ -704,6 +705,9 @@ struct ata_device {
         /* DEVSLP Timing Variables from Identify Device Data Log */
         u8                      devslp_timing[ATA_LOG_DEVSLP_SIZE];
 
+        /* NCQ send and receive log subcommand support */
+        u8                      ncq_send_recv_cmds[ATA_LOG_NCQ_SEND_RECV_SIZE];
+
         /* error history */
         int                     spdn_cnt;
         /* ering is CLEAR_END, read comment above CLEAR_END */