//
// Do NOT modify or remove this copyright and license
//
// Copyright (c) 2012-2023 Seagate Technology LLC and/or its Affiliates, All Rights Reserved
//
// This software is subject to the terms of the Mozilla Public
// License, v. 2.0. If a copy of the MPL was not distributed with this
// file, You can obtain one at http://mozilla.org/MPL/2.0/.
//
// ******************************************************************************************
// 

#include "common.h"
#include "common_public.h"
#include "ata_helper.h"
#include "ata_helper_func.h"
#include "scsi_helper_func.h"
#include <ctype.h> //for isprint

//This is a basic validity indicator for a given ATA identify word. Checks that it is non-zero and not FFFFh
bool is_ATA_Identify_Word_Valid(uint16_t word)
{
    bool valid = false;
    if (word != UINT16_C(0) && word != UINT16_MAX)
    {
        valid = true;
    }
    return valid;
}

bool is_ATA_Identify_Word_Valid_With_Bits_14_And_15(uint16_t word)
{
    bool valid = false;
    if (is_ATA_Identify_Word_Valid(word) && (word & BIT15) == 0 && (word & BIT14) == BIT14)
    {
        valid = true;
    }
    return valid;
}

bool is_ATA_Identify_Word_Valid_SATA(uint16_t word)
{
    bool valid = false;
    if (is_ATA_Identify_Word_Valid(word) && (word & BIT0) == 0)
    {
        valid = true;
    }
    return valid;
}

static bool is_Buffer_Non_Zero(uint8_t* ptrData, uint32_t dataLen)
{
    bool isNonZero = false;
    if (ptrData)
    {
        for (uint32_t iter = 0; iter < dataLen; ++iter)
        {
            if (ptrData[iter] != 0)
            {
                isNonZero = true;
                break;
            }
        }
    }
    return isNonZero;
}

//This will send a read log ext command, and if it's DMA and sense data tells us that we had an invalid field in CDB, then we retry with PIO mode
int send_ATA_Read_Log_Ext_Cmd(tDevice *device, uint8_t logAddress, uint16_t pageNumber, uint8_t *ptrData, uint32_t dataSize, uint16_t featureRegister)
{
    int ret = NOT_SUPPORTED;
    if (device->drive_info.ata_Options.generalPurposeLoggingSupported)
    {
        bool dmaRetry = false;
        bool sataLogRequiresPIO = false;
        if (!device->drive_info.ata_Options.sataReadLogDMASameAsPIO && (logAddress == ATA_LOG_NCQ_COMMAND_ERROR_LOG || logAddress == ATA_LOG_SATA_PHY_EVENT_COUNTERS_LOG))
        {
            //special case for SATA NCQ error log and Phy event counters log! 
            // Old drives may require PIO mode to read these logs!
            //This uses SATA id word 76 to identify the case and adjust which command to issue in this case.
            sataLogRequiresPIO = true;
        }
        if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && device->drive_info.ata_Options.readLogWriteLogDMASupported && !sataLogRequiresPIO)
        {
            //try a read log ext DMA command
            ret = ata_Read_Log_Ext(device, logAddress, pageNumber, ptrData, dataSize, true, featureRegister);
            if (ret == SUCCESS)
            {
                return ret;
            }
            else
            {
                uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
                get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
                //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
                if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
                {
                    //turn off DMA mode
                    dmaRetry = true;
                    device->drive_info.ata_Options.readLogWriteLogDMASupported = false;
                }
                else
                {
                    //we likely had a failure not related to DMA mode command, so return the error
                    return ret;
                }
            }
        }
        //Send PIO Command
        ret = ata_Read_Log_Ext(device, logAddress, pageNumber, ptrData, dataSize, false, featureRegister);
        if (dmaRetry && ret != SUCCESS)
        {
            //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
            device->drive_info.ata_Options.readLogWriteLogDMASupported = true;
        }
    }
    return ret;
}

int send_ATA_Write_Log_Ext_Cmd(tDevice *device, uint8_t logAddress, uint16_t pageNumber, uint8_t *ptrData, uint32_t dataSize, bool forceRTFRs)
{
    int ret = NOT_SUPPORTED;
    if (device->drive_info.ata_Options.generalPurposeLoggingSupported)
    {
        bool dmaRetry = false;
        if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && device->drive_info.ata_Options.readLogWriteLogDMASupported)
        {
            //try a write log ext DMA command
            ret = ata_Write_Log_Ext(device, logAddress, pageNumber, ptrData, dataSize, true, forceRTFRs);
            if (ret == SUCCESS)
            {
                return ret;
            }
            else
            {
                uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
                get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
                //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
                if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
                {
                    //turn off DMA mode
                    dmaRetry = true;
                    device->drive_info.ata_Options.readLogWriteLogDMASupported = false;
                }
                else
                {
                    //we likely had a failure not related to DMA mode command, so return the error
                    return ret;
                }
            }
        }
        //Send PIO command
        ret = ata_Write_Log_Ext(device, logAddress, pageNumber, ptrData, dataSize, false, forceRTFRs);
        if (dmaRetry && ret != SUCCESS)
        {
            //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
            device->drive_info.ata_Options.readLogWriteLogDMASupported = true;
        }
    }
    return ret;
}

int send_ATA_SCT(tDevice *device, eDataTransferDirection direction, uint8_t logAddress, uint8_t *dataBuf, uint32_t dataSize, bool forceRTFRs)
{
    int ret = UNKNOWN;
    if (logAddress != ATA_SCT_COMMAND_STATUS && logAddress != ATA_SCT_DATA_TRANSFER)
    {
        return BAD_PARAMETER;
    }
    bool useGPL = device->drive_info.ata_Options.generalPurposeLoggingSupported;
    //This is a hack for some USB drives. While a caller somewhere above this should handle this, this needs to be here to ensure we don't hang these devices.
    if (device->drive_info.passThroughHacks.ataPTHacks.smartCommandTransportWithSMARTLogCommandsOnly)
    {
        useGPL = false;
    }
    if (useGPL)
    {
        if (direction == XFER_DATA_IN)
        {
            ret = send_ATA_Read_Log_Ext_Cmd(device, logAddress, 0, dataBuf, dataSize, 0);
        }
        else if (direction == XFER_DATA_OUT)
        {
            ret = send_ATA_Write_Log_Ext_Cmd(device, logAddress, 0, dataBuf, dataSize, forceRTFRs);
        }
        else
        {
            ret = BAD_PARAMETER;
        }
    }
    else
    {
        if (direction == XFER_DATA_IN)//data in
        {
            ret = ata_SMART_Read_Log(device, logAddress, dataBuf, dataSize);
        }
        else if (direction == XFER_DATA_OUT)
        {
            ret = ata_SMART_Write_Log(device, logAddress, dataBuf, dataSize, forceRTFRs);
        }
        else
        {
            ret = BAD_PARAMETER;
        }
    }
    return ret;
}

int send_ATA_SCT_Status(tDevice *device, uint8_t *dataBuf, uint32_t dataSize)
{
    int ret = UNKNOWN;
    if (dataSize < LEGACY_DRIVE_SEC_SIZE)
    {
        return FAILURE;
    }
    ret = send_ATA_SCT(device, XFER_DATA_IN, ATA_SCT_COMMAND_STATUS, dataBuf, LEGACY_DRIVE_SEC_SIZE, false);

    return ret;
}

int send_ATA_SCT_Command(tDevice *device, uint8_t *dataBuf, uint32_t dataSize, bool forceRTFRs)
{
    int ret = UNKNOWN;
    if (dataSize < LEGACY_DRIVE_SEC_SIZE)
    {
        return FAILURE;
    }
    ret = send_ATA_SCT(device, XFER_DATA_OUT, ATA_SCT_COMMAND_STATUS, dataBuf, LEGACY_DRIVE_SEC_SIZE, forceRTFRs);

    return ret;
}

int send_ATA_SCT_Data_Transfer(tDevice *device, eDataTransferDirection direction, uint8_t *dataBuf, uint32_t dataSize)
{
    int ret = UNKNOWN;

    ret = send_ATA_SCT(device, direction, ATA_SCT_DATA_TRANSFER, dataBuf, dataSize, false);

    return ret;
}

int send_ATA_SCT_Read_Write_Long(tDevice *device, eSCTRWLMode mode, uint64_t lba, uint8_t *dataBuf, uint32_t dataSize, uint16_t *numberOfECCCRCBytes, uint16_t *numberOfBlocksRequested)
{
    int ret = UNKNOWN;
    uint8_t readWriteLongCommandSector[LEGACY_DRIVE_SEC_SIZE] = { 0 };

    //action code
    readWriteLongCommandSector[0] = M_Byte0(SCT_READ_WRITE_LONG);
    readWriteLongCommandSector[1] = M_Byte1(SCT_READ_WRITE_LONG);
    //function code set in if below
    //LBA
    readWriteLongCommandSector[4] = M_Byte0(lba);
    readWriteLongCommandSector[5] = M_Byte1(lba);
    readWriteLongCommandSector[6] = M_Byte2(lba);
    readWriteLongCommandSector[7] = M_Byte3(lba);
    readWriteLongCommandSector[8] = M_Byte4(lba);
    readWriteLongCommandSector[9] = M_Byte5(lba);
    readWriteLongCommandSector[10] = RESERVED;
    readWriteLongCommandSector[11] = RESERVED;

    if (mode == SCT_RWL_READ_LONG)
    {
        readWriteLongCommandSector[2] = M_Byte0(SCT_RWL_READ_LONG);
        readWriteLongCommandSector[3] = M_Byte1(SCT_RWL_READ_LONG);

        //send a SCT command
        if (SUCCESS == send_ATA_SCT_Command(device, readWriteLongCommandSector, LEGACY_DRIVE_SEC_SIZE, true))
        {
            if (numberOfECCCRCBytes)
            {
                *numberOfECCCRCBytes = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaLow, device->drive_info.lastCommandRTFRs.secCnt);
            }
            if (numberOfBlocksRequested)
            {
                *numberOfBlocksRequested = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaHi, device->drive_info.lastCommandRTFRs.lbaMid);
            }
            //Read the SCT data log
            ret = send_ATA_SCT_Data_Transfer(device, XFER_DATA_IN, dataBuf, dataSize);
        }
    }
    else if (mode == SCT_RWL_WRITE_LONG)
    {
        readWriteLongCommandSector[2] = M_Byte0(SCT_RWL_WRITE_LONG);
        readWriteLongCommandSector[3] = M_Byte1(SCT_RWL_WRITE_LONG);

        //send a SCT command
        if (SUCCESS == send_ATA_SCT_Command(device, readWriteLongCommandSector, LEGACY_DRIVE_SEC_SIZE, true))
        {
            if (numberOfECCCRCBytes)
            {
                *numberOfECCCRCBytes = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaLow, device->drive_info.lastCommandRTFRs.secCnt);
            }
            if (numberOfBlocksRequested)
            {
                *numberOfBlocksRequested = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaHi, device->drive_info.lastCommandRTFRs.lbaMid);
            }
            //Write the SCT data log
            ret = send_ATA_SCT_Data_Transfer(device, XFER_DATA_OUT, dataBuf, dataSize);
        }
    }
    else
    {
        ret = NOT_SUPPORTED;
    }
    return ret;
}

int send_ATA_SCT_Write_Same(tDevice *device, eSCTWriteSameFunctions functionCode, uint64_t startLBA, uint64_t fillCount, uint8_t *pattern, uint64_t patternLength)
{
    int ret = UNKNOWN;
    uint8_t *writeSameBuffer = C_CAST(uint8_t*, calloc_aligned(LEGACY_DRIVE_SEC_SIZE, sizeof(uint8_t), device->os_info.minimumAlignment));
    if (!writeSameBuffer)
    {
        perror("Calloc failure!\n");
        return MEMORY_FAILURE;
    }
    //action code
    writeSameBuffer[0] = M_Byte0(SCT_WRITE_SAME);
    writeSameBuffer[1] = M_Byte1(SCT_WRITE_SAME);
    //function code
    writeSameBuffer[2] = M_Byte0(C_CAST(uint16_t, functionCode));
    writeSameBuffer[3] = M_Byte1(C_CAST(uint16_t, functionCode));
    //start
    writeSameBuffer[4] = M_Byte0(startLBA);
    writeSameBuffer[5] = M_Byte1(startLBA);
    writeSameBuffer[6] = M_Byte2(startLBA);
    writeSameBuffer[7] = M_Byte3(startLBA);
    writeSameBuffer[8] = M_Byte4(startLBA);
    writeSameBuffer[9] = M_Byte5(startLBA);
    writeSameBuffer[10] = RESERVED;
    writeSameBuffer[11] = RESERVED;
    //Fill Count
    writeSameBuffer[12] = M_Byte0(fillCount);
    writeSameBuffer[13] = M_Byte1(fillCount);
    writeSameBuffer[14] = M_Byte2(fillCount);
    writeSameBuffer[15] = M_Byte3(fillCount);
    writeSameBuffer[16] = M_Byte4(fillCount);
    writeSameBuffer[17] = M_Byte5(fillCount);
    writeSameBuffer[18] = M_Byte6(fillCount);
    writeSameBuffer[19] = M_Byte7(fillCount);
    //Pattern field (when it applies)
    if (functionCode == WRITE_SAME_BACKGROUND_USE_PATTERN_FIELD || functionCode == WRITE_SAME_FOREGROUND_USE_PATTERN_FIELD)
    {
        uint32_t thePattern = 0;
        uint64_t patternIter = 0;
        //copy at most a 32bit pattern into thePattern
        for (patternIter = 0; patternIter < patternLength && patternIter < 4; patternIter++)
        {
            thePattern |= pattern[patternIter];
            if ((patternIter + 1) == 4)
            {
                break;
            }
            thePattern = thePattern << 8;
        }
        writeSameBuffer[20] = M_Byte0(thePattern);
        writeSameBuffer[21] = M_Byte1(thePattern);
        writeSameBuffer[22] = M_Byte2(thePattern);
        writeSameBuffer[23] = M_Byte3(thePattern);
    }
    //pattern length (when it applies)
    if (functionCode == WRITE_SAME_BACKGROUND_USE_MULTIPLE_LOGICAL_SECTORS || functionCode == WRITE_SAME_FOREGROUND_USE_MULTIPLE_LOGICAL_SECTORS)
    {
        writeSameBuffer[24] = M_Byte0(patternLength);
        writeSameBuffer[25] = M_Byte1(patternLength);
        writeSameBuffer[26] = M_Byte2(patternLength);
        writeSameBuffer[27] = M_Byte3(patternLength);
        writeSameBuffer[28] = M_Byte4(patternLength);
        writeSameBuffer[29] = M_Byte5(patternLength);
        writeSameBuffer[30] = M_Byte6(patternLength);
        writeSameBuffer[31] = M_Byte7(patternLength);
    }

    ret = send_ATA_SCT_Command(device, writeSameBuffer, LEGACY_DRIVE_SEC_SIZE, false);

    if (functionCode == WRITE_SAME_BACKGROUND_USE_MULTIPLE_LOGICAL_SECTORS || functionCode == WRITE_SAME_FOREGROUND_USE_MULTIPLE_LOGICAL_SECTORS
        || functionCode == WRITE_SAME_BACKGROUND_USE_SINGLE_LOGICAL_SECTOR || functionCode == WRITE_SAME_FOREGROUND_USE_SINGLE_LOGICAL_SECTOR)
    {
        //send the pattern to the data transfer log
        ret = send_ATA_SCT_Data_Transfer(device, XFER_DATA_OUT, pattern, C_CAST(uint32_t, patternLength * device->drive_info.deviceBlockSize));
    }

    safe_Free_aligned(writeSameBuffer)
    return ret;
}

int send_ATA_SCT_Error_Recovery_Control(tDevice *device, uint16_t functionCode, uint16_t selectionCode, uint16_t *currentValue, uint16_t recoveryTimeLimit)
{
    int ret = UNKNOWN;
    uint8_t *errorRecoveryBuffer = C_CAST(uint8_t*, calloc_aligned(LEGACY_DRIVE_SEC_SIZE, sizeof(uint8_t), device->os_info.minimumAlignment));
    if (!errorRecoveryBuffer)
    {
        perror("Calloc failure!\n");
        return MEMORY_FAILURE;
    }
    //if we are retrieving the current values, then we better have a good pointer...no point in sending the command if we don't
    if ((functionCode == 0x0002 || functionCode == 0x0004) && !currentValue)
    {
        safe_Free_aligned(errorRecoveryBuffer)
        return BAD_PARAMETER;
    }

    //action code
    errorRecoveryBuffer[0] = M_Byte0(SCT_ERROR_RECOVERY_CONTROL);
    errorRecoveryBuffer[1] = M_Byte1(SCT_ERROR_RECOVERY_CONTROL);
    //function code
    errorRecoveryBuffer[2] = M_Byte0(functionCode);
    errorRecoveryBuffer[3] = M_Byte1(functionCode);
    //selection code
    errorRecoveryBuffer[4] = M_Byte0(selectionCode);
    errorRecoveryBuffer[5] = M_Byte1(selectionCode);
    //recovery time limit
    errorRecoveryBuffer[6] = M_Byte0(recoveryTimeLimit);
    errorRecoveryBuffer[7] = M_Byte1(recoveryTimeLimit);

    ret = send_ATA_SCT_Command(device, errorRecoveryBuffer, LEGACY_DRIVE_SEC_SIZE, true);

    if ((functionCode == 0x0002 || functionCode == 0x0004) && currentValue != NULL)
    {
        *currentValue = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaLow, device->drive_info.lastCommandRTFRs.secCnt);
    }
    safe_Free_aligned(errorRecoveryBuffer)
    return ret;
}

int send_ATA_SCT_Feature_Control(tDevice *device, uint16_t functionCode, uint16_t featureCode, uint16_t *state, uint16_t *optionFlags)
{
    int ret = UNKNOWN;
    uint8_t *featureControlBuffer = C_CAST(uint8_t*, calloc_aligned(LEGACY_DRIVE_SEC_SIZE, sizeof(uint8_t), device->os_info.minimumAlignment));
    if (!featureControlBuffer)
    {
        perror("Calloc Failure!\n");
        return MEMORY_FAILURE;
    }
    //make sure we have valid pointers for state and optionFlags
    if (!state || !optionFlags)
    {
        safe_Free_aligned(featureControlBuffer)
        return BAD_PARAMETER;
    }
    //clear the state and option flags out, unless we are setting something
    if (functionCode != 0x0001)
    {
        *state = 0;
        *optionFlags = 0;
    }
    //fill in the buffer with the correct information
    //action code
    featureControlBuffer[0] = M_Byte0(SCT_FEATURE_CONTROL);
    featureControlBuffer[1] = M_Byte1(SCT_FEATURE_CONTROL);
    //function code
    featureControlBuffer[2] = M_Byte0(functionCode);
    featureControlBuffer[3] = M_Byte1(functionCode);
    //feature code
    featureControlBuffer[4] = M_Byte0(featureCode);
    featureControlBuffer[5] = M_Byte1(featureCode);
    //state
    featureControlBuffer[6] = M_Byte0(*state);
    featureControlBuffer[7] = M_Byte1(*state);
    //option flags
    featureControlBuffer[8] = M_Byte0(*optionFlags);
    featureControlBuffer[9] = M_Byte1(*optionFlags);

    ret = send_ATA_SCT_Command(device, featureControlBuffer, LEGACY_DRIVE_SEC_SIZE, true);

    //add in copying rtfrs into status or option flags here
    if (ret == SUCCESS)
    {
        if (functionCode == 0x0002)
        {
            *state = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaLow, device->drive_info.lastCommandRTFRs.secCnt);
        }
        else if (functionCode == 0x0003)
        {
            *optionFlags = M_BytesTo2ByteValue(device->drive_info.lastCommandRTFRs.lbaLow, device->drive_info.lastCommandRTFRs.secCnt);
        }
    }
    safe_Free_aligned(featureControlBuffer)
    return ret;
}

int send_ATA_SCT_Data_Table(tDevice *device, uint16_t functionCode, uint16_t tableID, uint8_t *dataBuf, uint32_t dataSize)
{
    int ret = UNKNOWN;

    if (!dataBuf)
    {
        return BAD_PARAMETER;
    }
    //Action code
    dataBuf[0] = M_Byte0(SCT_DATA_TABLES);
    dataBuf[1] = M_Byte1(SCT_DATA_TABLES);
    //Function code
    dataBuf[2] = M_Byte0(functionCode);
    dataBuf[3] = M_Byte1(functionCode);
    //Table ID
    dataBuf[4] = M_Byte0(tableID);
    dataBuf[5] = M_Byte1(tableID);

    ret = send_ATA_SCT_Command(device, dataBuf, LEGACY_DRIVE_SEC_SIZE, false);

    if (ret == SUCCESS)
    {
        if (functionCode == 0x0001)
        {
            //now read the log that tells us the table we requested
            memset(dataBuf, 0, dataSize);//clear the buffer before we read in data since we are done with what we had to send to the drive
            ret = send_ATA_SCT_Data_Transfer(device, XFER_DATA_IN, dataBuf, dataSize);
        }
        //else we need to add functionality since something new was added to the spec
    }
    return ret;
}

int send_ATA_Download_Microcode_Cmd(tDevice *device, eDownloadMicrocodeFeatures subCommand, uint16_t blockCount, uint16_t bufferOffset, uint8_t *pData, uint32_t dataLen, bool firstSegment, bool lastSegment, uint32_t timeoutSeconds)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && device->drive_info.ata_Options.downloadMicrocodeDMASupported)
    {
        ret = ata_Download_Microcode(device, subCommand, blockCount, bufferOffset, true, pData, dataLen, firstSegment, lastSegment, timeoutSeconds);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                device->drive_info.ata_Options.downloadMicrocodeDMASupported = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Download_Microcode(device, subCommand, blockCount, bufferOffset, false, pData, dataLen, firstSegment, lastSegment, timeoutSeconds);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        device->drive_info.ata_Options.downloadMicrocodeDMASupported = true;
    }
    return ret;
}

int send_ATA_Trusted_Send_Cmd(tDevice *device, uint8_t securityProtocol, uint16_t securityProtocolSpecific, uint8_t *ptrData, uint32_t dataSize)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    static bool dmaTrustedCmd = true;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && dmaTrustedCmd && device->drive_info.ata_Options.dmaSupported)
    {
        ret = ata_Trusted_Send(device, true, securityProtocol, securityProtocolSpecific, ptrData, dataSize);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                dmaTrustedCmd = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Trusted_Send(device, false, securityProtocol, securityProtocolSpecific, ptrData, dataSize);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        dmaTrustedCmd = true;
    }
    return ret;
}

int send_ATA_Trusted_Receive_Cmd(tDevice *device, uint8_t securityProtocol, uint16_t securityProtocolSpecific, uint8_t *ptrData, uint32_t dataSize)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    static bool dmaTrustedCmd = true;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && dmaTrustedCmd && device->drive_info.ata_Options.dmaSupported)
    {
        ret = ata_Trusted_Receive(device, true, securityProtocol, securityProtocolSpecific, ptrData, dataSize);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                dmaTrustedCmd = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Trusted_Receive(device, false, securityProtocol, securityProtocolSpecific, ptrData, dataSize);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        dmaTrustedCmd = true;
    }
    return ret;
}

int send_ATA_Read_Buffer_Cmd(tDevice *device, uint8_t *ptrData)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && device->drive_info.ata_Options.readBufferDMASupported)
    {
        ret = ata_Read_Buffer(device, ptrData, true);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                device->drive_info.ata_Options.readBufferDMASupported = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Read_Buffer(device, ptrData, false);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        device->drive_info.ata_Options.readBufferDMASupported = true;
    }
    return ret;
}

int send_ATA_Write_Buffer_Cmd(tDevice *device, uint8_t *ptrData)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && device->drive_info.ata_Options.writeBufferDMASupported)
    {
        ret = ata_Write_Buffer(device, ptrData, true);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                device->drive_info.ata_Options.writeBufferDMASupported = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Write_Buffer(device, ptrData, false);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        device->drive_info.ata_Options.writeBufferDMASupported = true;
    }
    return ret;
}

int send_ATA_Read_Stream_Cmd(tDevice *device, uint8_t streamID, bool notSequential, bool readContinuous, uint8_t commandCCTL, uint64_t LBA, uint8_t *ptrData, uint32_t dataSize)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    static bool streamDMA = true;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && streamDMA && device->drive_info.ata_Options.dmaSupported)
    {
        ret = ata_Read_Stream_Ext(device, true, streamID, notSequential, readContinuous, commandCCTL, LBA, ptrData, dataSize);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                streamDMA = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Read_Stream_Ext(device, false, streamID, notSequential, readContinuous, commandCCTL, LBA, ptrData, dataSize);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        streamDMA = true;
    }
    return ret;
}

int send_ATA_Write_Stream_Cmd(tDevice *device, uint8_t streamID, bool flush, bool writeContinuous, uint8_t commandCCTL, uint64_t LBA, uint8_t *ptrData, uint32_t dataSize)
{
    int ret = NOT_SUPPORTED;
    bool dmaRetry = false;
    static bool streamDMA = true;
    if (device->drive_info.ata_Options.dmaMode != ATA_DMA_MODE_NO_DMA && streamDMA && device->drive_info.ata_Options.dmaSupported)
    {
        ret = ata_Write_Stream_Ext(device, true, streamID, flush, writeContinuous, commandCCTL, LBA, ptrData, dataSize);
        if (ret == SUCCESS)
        {
            return ret;
        }
        else
        {
            uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
            get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
            //Checking for illegal request, invalid field in CDB since this is what we've seen reported when DMA commands are not supported.
            if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x24 && ascq == 0x00)
            {
                //turn off DMA mode
                dmaRetry = true;
                streamDMA = false;
            }
            else
            {
                //we likely had a failure not related to DMA mode command, so return the error
                return ret;
            }
        }
    }
    ret = ata_Write_Stream_Ext(device, false, streamID, flush, writeContinuous, commandCCTL, LBA, ptrData, dataSize);
    if (dmaRetry && ret != SUCCESS)
    {
        //this means something else is wrong, and it's not the DMA mode, so we can turn it back on
        streamDMA = true;
    }
    return ret;
}

void byte_Swap_ID_Data_Buffer(uint16_t *idData)
{
    uint16_t idIter = 0;
    for(idIter = 0; idIter < 256; ++idIter)
    {
        byte_Swap_16(&idData[idIter]);
    }
}

//This is a quick check to assist with the fill in ATA drive info function to be more efficient
static bool is_SAT_Invalid_Operation_Code(tDevice *device)
{
    bool invalidOP = false;
    uint8_t senseKey = 0, asc = 0, ascq = 0, fru = 0;
    get_Sense_Key_ASC_ASCQ_FRU(device->drive_info.lastCommandSenseData, SPC3_SENSE_LEN, &senseKey, &asc, &ascq, &fru);
    if (senseKey == SENSE_KEY_ILLEGAL_REQUEST && asc == 0x20 && ascq == 0x00)
    {
        invalidOP = true;
    }
    return invalidOP;
}

void fill_ATA_Strings_From_Identify_Data(uint8_t* ptrIdentifyData, char ataMN[ATA_IDENTIFY_MN_LENGTH + 1], char ataSN[ATA_IDENTIFY_SN_LENGTH + 1], char ataFW[ATA_IDENTIFY_FW_LENGTH + 1])
{
    if (ptrIdentifyData)
    {
        ptAtaIdentifyData idData = C_CAST(ptAtaIdentifyData, ptrIdentifyData);
        bool validSN = true;
        bool validMN = true;
        bool validFW = true;
        //check for valid strings (ATA-2 mentioned if these are set to zero, then they are not defined in the standards
        if (idData->Word010 == 0)
        {
            validSN = false;
        }
        if (idData->Word023 == 0)
        {
            validFW = false;
        }
        if (idData->Word027 == 0)
        {
            validFW = false;
        }
        //fill each buffer with data from ATA ID data
        if (validSN && ataSN)
        {
            uint16_t snLimit = M_Min(SERIAL_NUM_LEN, ATA_IDENTIFY_SN_LENGTH);
            memset(ataSN, 0, snLimit + 1);
            memcpy(ataSN, idData->SerNum, snLimit);
            for (uint8_t iter = 0; iter < snLimit; ++iter)
            {
                if (!is_ASCII(ataSN[iter]) || !isprint(ataSN[iter]))
                {
                    ataSN[iter] = ' ';//replace with a space
                }
            }
#if !defined(__BIG_ENDIAN__)
            byte_Swap_String(ataSN);
#endif
            remove_Leading_And_Trailing_Whitespace(ataSN);
        }
        if (validFW && ataFW)
        {
            uint16_t fwLimit = M_Min(FW_REV_LEN, ATA_IDENTIFY_FW_LENGTH);
            memset(ataFW, 0, fwLimit + 1);
            memcpy(ataFW, idData->FirmVer, fwLimit);
            for (uint8_t iter = 0; iter < fwLimit; ++iter)
            {
                if (!is_ASCII(ataFW[iter]) || !isprint(ataFW[iter]))
                {
                    ataFW[iter] = ' ';//replace with a space
                }
            }
#if !defined(__BIG_ENDIAN__)
            byte_Swap_String(ataFW);
#endif
            remove_Leading_And_Trailing_Whitespace(ataFW);
        }
        if (validMN && ataMN)
        {
            uint16_t mnLimit = M_Min(MODEL_NUM_LEN, ATA_IDENTIFY_MN_LENGTH);
            memset(ataMN, 0, mnLimit + 1);
            memcpy(ataMN, idData->ModelNum, mnLimit);
            for (uint8_t iter = 0; iter < mnLimit; ++iter)
            {
                if (!is_ASCII(ataMN[iter]) || !isprint(ataMN[iter]))
                {
                    ataMN[iter] = ' ';//replace with a space
                }
            }
#if !defined(__BIG_ENDIAN__)
            byte_Swap_String(ataMN);
#endif
            remove_Leading_And_Trailing_Whitespace(ataMN);
        }
    }
    return;
}

int fill_In_ATA_Drive_Info(tDevice *device)
{
    int ret = UNKNOWN;
    //Both pointers pointing to the same data. 
    uint16_t *ident_word = &device->drive_info.IdentifyData.ata.Word000;
    uint8_t *identifyData = C_CAST(uint8_t *, &device->drive_info.IdentifyData.ata.Word000);
#ifdef _DEBUG
    printf("%s -->\n", __FUNCTION__);
#endif

    bool retrievedIdentifyData = false;
    //try an identify command, then also try an identify packet device command. The data we care about parsing will be in the same location so everything inside this if should work as expected
    //Note: if this is NOT an ATA HDD or SSD, then this code will only try one command: 85h SAT CDB since most ATAPI devices do not properly validate all fields of A1h and often receive it as a packet passthrough command for "blank"
    if ((device->drive_info.drive_type == ATAPI_DRIVE || device->drive_info.drive_type == LEGACY_TAPE_DRIVE || device->drive_info.media_type == MEDIA_OPTICAL || device->drive_info.media_type == MEDIA_TAPE)
        && !(device->drive_info.passThroughHacks.hacksSetByReportedID || device->drive_info.passThroughHacks.someHacksSetByOSDiscovery))
    {
        //make sure we disable sending the A1h SAT CDB or we could accidentally send a "blank" command due to how most of these devices receive commands under different OSs or through translators.
        device->drive_info.passThroughHacks.ataPTHacks.a1NeverSupported = true;
    }
    if ((SUCCESS == ata_Identify(device, C_CAST(uint8_t *, ident_word), sizeof(tAtaIdentifyData)) && is_Buffer_Non_Zero(C_CAST(uint8_t*, ident_word), 512)) || (!is_SAT_Invalid_Operation_Code(device) && SUCCESS == ata_Identify_Packet_Device(device, C_CAST(uint8_t *, ident_word), sizeof(tAtaIdentifyData)) && is_Buffer_Non_Zero(C_CAST(uint8_t*, ident_word), 512)))
    {
        retrievedIdentifyData = true;
    }
    else if(!device->drive_info.passThroughHacks.ataPTHacks.a1NeverSupported)//retry only if this is not already set to true since the above commands would have been sent with 85h already
    {
        //TODO: Check the sense data to see if it was invalid operation code. If so, then the device does not support the A1h command.
        //If this failed, issue a test unit ready command, followed by switching to 16B sat commands. Most devices tested will support A1h and very few will not if they support SAT at all.
        if (device->drive_info.passThroughHacks.passthroughType == ATA_PASSTHROUGH_SAT)
        {
            //If IDE_INTERFACE, do not attempt the test unit ready, since this will go through softwareSAT translation and fail/get hung in an infinite loop.
            //This test unit ready exists to help clear out stuck bad status for other devices (such as USB) where this can help work around limitations. - TJE
            if (device->drive_info.interface_type != IDE_INTERFACE)
            {
                scsi_Test_Unit_Ready(device, NULL);
            }
            memset(identifyData, 0, 512);
            device->drive_info.passThroughHacks.ataPTHacks.a1NeverSupported = true;
            if ((SUCCESS == ata_Identify(device, C_CAST(uint8_t *, ident_word), sizeof(tAtaIdentifyData)) && is_Buffer_Non_Zero(C_CAST(uint8_t*, ident_word), 512)) || (!is_SAT_Invalid_Operation_Code(device) && SUCCESS == ata_Identify_Packet_Device(device, C_CAST(uint8_t *, ident_word), sizeof(tAtaIdentifyData)) && is_Buffer_Non_Zero(C_CAST(uint8_t*, ident_word), 512)))
            {
                retrievedIdentifyData = true;
            }
        }
    }
    if (retrievedIdentifyData)
    {
        if (device->drive_info.interface_type == IDE_INTERFACE && device->drive_info.scsiVersion == SCSI_VERSION_NO_STANDARD)
        {
            device->drive_info.scsiVersion = SCSI_VERSION_SPC_5;//SPC5. This is what software translator will set at the moment. Can make this configurable later, but this should be OK
        }
        ret = SUCCESS;
        if (device->drive_info.lastCommandRTFRs.device & DEVICE_SELECT_BIT)//Checking for the device select bit being set to know it's device 1 (Not that we really need it). This may not always be reported correctly depending on the lower layers of the OS and hardware. - TJE
        {
            device->drive_info.ata_Options.isDevice1 = true;
        }

        if (ident_word[0] & BIT15)
        {
            device->drive_info.drive_type = ATAPI_DRIVE;
            device->drive_info.media_type = MEDIA_OPTICAL;
        }
        else
        {
            device->drive_info.drive_type = ATA_DRIVE;
        }
        if (device->drive_info.IdentifyData.ata.Word217 == 0x0001) //Nominal media rotation rate.
        {
            device->drive_info.media_type = MEDIA_SSD;
        }

        //set some pointers to where we want to fill in information...we're doing this so that on USB, we can store some info about the child drive, without disrupting the standard drive_info that has already been filled in by the fill_SCSI_Info function
        uint64_t *fillWWN = &device->drive_info.worldWideName;
        uint32_t *fillLogicalSectorSize = &device->drive_info.deviceBlockSize;
        uint32_t *fillPhysicalSectorSize = &device->drive_info.devicePhyBlockSize;
        uint16_t *fillSectorAlignment = &device->drive_info.sectorAlignment;
        uint64_t *fillMaxLba = &device->drive_info.deviceMaxLba;

        //IDE interface means we're connected to a native SATA/PATA interface so we leave the default pointer alone and don't touch the drive info that was filled in by the SCSI commands since that is how the OS talks to it for read/write and we don't want to disrupt that
        //Everything else is some sort of SAT interface (UDS, SAS, IEEE1394, etc) so we want to fill in bridge info here
        if ((device->drive_info.interface_type != IDE_INTERFACE) && (device->drive_info.interface_type != RAID_INTERFACE))
        {
            device->drive_info.bridge_info.isValid = true;
            fillWWN = &device->drive_info.bridge_info.childWWN;
            fillLogicalSectorSize = &device->drive_info.bridge_info.childDeviceBlockSize;
            fillPhysicalSectorSize = &device->drive_info.bridge_info.childDevicePhyBlockSize;
            fillSectorAlignment = &device->drive_info.bridge_info.childSectorAlignment;
            fillMaxLba = &device->drive_info.bridge_info.childDeviceMaxLba;
        }
        //this will catch all IDE interface devices to set a vendor identification IF one is not already set
        else if (strlen(device->drive_info.T10_vendor_ident) == 0)
        {
            //vendor ID is not set, so set it to ATA like SAT spec
            device->drive_info.T10_vendor_ident[0] = 'A';
            device->drive_info.T10_vendor_ident[1] = 'T';
            device->drive_info.T10_vendor_ident[2] = 'A';
            device->drive_info.T10_vendor_ident[3] = 0;
            device->drive_info.T10_vendor_ident[4] = 0;
            device->drive_info.T10_vendor_ident[5] = 0;
            device->drive_info.T10_vendor_ident[6] = 0;
            device->drive_info.T10_vendor_ident[7] = 0;
        }
        device->drive_info.numberOfLUs = 1;
        
        if ((device->drive_info.interface_type != IDE_INTERFACE) && (device->drive_info.interface_type != RAID_INTERFACE))
        {
            fill_ATA_Strings_From_Identify_Data(identifyData, device->drive_info.bridge_info.childDriveMN, device->drive_info.bridge_info.childDriveSN, device->drive_info.bridge_info.childDriveFW);
        }
        else
        {
            fill_ATA_Strings_From_Identify_Data(identifyData, device->drive_info.product_identification, device->drive_info.serialNumber, device->drive_info.product_revision);
        }

        //get the WWN
        *fillWWN = M_WordsTo8ByteValue(device->drive_info.IdentifyData.ata.Word108,\
                                       device->drive_info.IdentifyData.ata.Word109,\
                                       device->drive_info.IdentifyData.ata.Word110,\
                                       device->drive_info.IdentifyData.ata.Word111);

        //Special case for SSD detection. One of these SSDs didn't set the media_type to SSD
        //but it is an SSD. So this match will catch it when this happens. It should be uncommon to find though -TJE
        if (device->drive_info.media_type != MEDIA_SSD && 
            strlen(device->drive_info.bridge_info.childDriveMN) > 0 && (strstr(device->drive_info.bridge_info.childDriveMN, "Seagate SSD") != NULL) && 
            strlen(device->drive_info.bridge_info.childDriveFW) > 0 && (strstr(device->drive_info.bridge_info.childDriveFW, "UHFS") != NULL))
        {
            device->drive_info.media_type = MEDIA_SSD;
        }

        //get the sector sizes from the identify data
        if (is_ATA_Identify_Word_Valid_With_Bits_14_And_15(ident_word[106])) //making sure this word has valid data
        {
            //word 117 is only valid when word 106 bit 12 is set
            if ((ident_word[106] & BIT12) == BIT12)
            {
                *fillLogicalSectorSize = M_BytesTo2ByteValue(ident_word[118], ident_word[117]);
                *fillLogicalSectorSize *= 2; //convert to words to bytes
            }
            else //means that logical sector size is 512bytes
            {
                *fillLogicalSectorSize = LEGACY_DRIVE_SEC_SIZE;
            }
            if ((ident_word[106] & BIT13) == 0)
            {
                *fillPhysicalSectorSize = *fillLogicalSectorSize;
            }
            else //multiple logical sectors per physical sector
            {
                uint8_t sectorSizeExponent = 0;
                //get the number of logical blocks per physical blocks
                sectorSizeExponent = ident_word[106] & 0x000F;
                *fillPhysicalSectorSize = C_CAST(uint32_t, *fillLogicalSectorSize * power_Of_Two(sectorSizeExponent));
            }
        }
        else
        {
            *fillLogicalSectorSize = LEGACY_DRIVE_SEC_SIZE;
            *fillPhysicalSectorSize = LEGACY_DRIVE_SEC_SIZE;
        }
        //get the sector alignment
        if (is_ATA_Identify_Word_Valid_With_Bits_14_And_15(ident_word[209]))
        {
            //bits 13:0 are valid for alignment. bit 15 will be 0 and bit 14 will be 1. remove bit 14 with an xor
            *fillSectorAlignment = ident_word[209] ^ BIT14;
        }

        //maxLBA
        if (ident_word[83] & BIT10)
        {
            //acs4 - word 69 bit3 means extended number of user addressable sectors word supported (words 230 - 233) (Use this to get the max LBA since words 100 - 103 may only contain a value of FFFF_FFFF)
            if (ident_word[69] & BIT3)
            {
                *fillMaxLba = M_BytesTo8ByteValue(identifyData[467], identifyData[466], identifyData[465], identifyData[464], identifyData[463], identifyData[462], identifyData[461], identifyData[460]);
            }
            else
            {
                *fillMaxLba = M_BytesTo8ByteValue(identifyData[207], identifyData[206], identifyData[205], identifyData[204], identifyData[203], identifyData[202], identifyData[201], identifyData[200]);
            }
        }
        else
        {
            *fillMaxLba = M_BytesTo4ByteValue(identifyData[123], identifyData[122], identifyData[121], identifyData[120]);
        }
        if (*fillMaxLba > 0)
        {
            *fillMaxLba -= 1;
        }

        //This flag will get set so we can do a software translation of LBA to CHS during read/write
        if (!is_LBA_Mode_Supported(device) && is_CHS_Mode_Supported(device))
        {
            device->drive_info.ata_Options.chsModeOnly = true;
            //simulate a max LBA into device information
            uint16_t cylinder = M_BytesTo2ByteValue(identifyData[109], identifyData[108]);//word 54
            uint8_t head = identifyData[110];//Word55
            uint8_t sector = identifyData[112];//Word56
            uint32_t lba = C_CAST(uint32_t, cylinder) * C_CAST(uint32_t, head) * C_CAST(uint32_t, sector);
            if (lba == 0)
            {
                //Cannot use "current" settings on this drive...use default (really old drive)
                cylinder = M_BytesTo2ByteValue(identifyData[3], identifyData[2]);//word 1
                head = identifyData[6];//Word3
                sector = identifyData[12];//Word6
                lba = C_CAST(uint32_t, cylinder) * C_CAST(uint32_t, head) * C_CAST(uint32_t, sector);
            }
            *fillMaxLba = lba;
        }

        if (!device->drive_info.passThroughHacks.ataPTHacks.dmaNotSupported)
        {

            //Now determine if the drive supports DMA and which DMA modes it supports
            if (ident_word[49] & BIT8)
            {
                device->drive_info.ata_Options.dmaSupported = true;
                device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_DMA;
            }
            //obsolete since ATA3, holds single word DMA support
            if (ident_word[62])
            {
                device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_DMA;
            }
            //check for multiword dma support
            if (ident_word[63] & (BIT0 | BIT1 | BIT2))
            {
                device->drive_info.ata_Options.dmaSupported = true;
                device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_MWDMA;
            }
            //check for UDMA support
            if (ident_word[88] & 0x007F)
            {
                device->drive_info.ata_Options.dmaSupported = true;
                device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_UDMA;
            }

            if (is_ATA_Identify_Word_Valid(device->drive_info.IdentifyData.ata.Word069))
            {
                //DCO DMA
                if (ident_word[69] & BIT12)
                {
                    device->drive_info.ata_Options.dcoDMASupported = true;
                }
                //set read/write buffer DMA
                if (ident_word[69] & BIT11)
                {
                    device->drive_info.ata_Options.readBufferDMASupported = true;
                }
                if (ident_word[69] & BIT10)
                {
                    device->drive_info.ata_Options.writeBufferDMASupported = true;
                }
                //HPA security ext DMA
                if (ident_word[69] & BIT9)
                {
                    device->drive_info.ata_Options.hpaSecurityExtDMASupported = true;
                }
                //set download microcode DMA support
                if (ident_word[69] & BIT8)
                {
                    device->drive_info.ata_Options.downloadMicrocodeDMASupported = true;
                }
            }
        }
        //set zoned device type
        if (device->drive_info.zonedType != ZONED_TYPE_HOST_MANAGED)
        {
            switch (ident_word[69] & (BIT0 | BIT1))
            {
            case 0:
                device->drive_info.zonedType = ZONED_TYPE_NOT_ZONED;
                break;
            case 1:
                device->drive_info.zonedType = ZONED_TYPE_HOST_AWARE;
                break;
            case 2:
                device->drive_info.zonedType = ZONED_TYPE_DEVICE_MANAGED;
                break;
            case 3:
                device->drive_info.zonedType = ZONED_TYPE_RESERVED;
                break;
            default:
                break;
            }
        }
        if (!device->drive_info.passThroughHacks.ataPTHacks.dmaNotSupported)
        {
            //Determine if read/write log ext DMA commands are supported
            if (ident_word[119] & BIT3 || ident_word[120] & BIT3)
            {
                device->drive_info.ata_Options.readLogWriteLogDMASupported = true;
            }
        }
        if (ident_word[47] != UINT16_MAX && ident_word[47] != 0)
        {
            if (M_Byte0(ident_word[47]) != 0)
            {
                device->drive_info.ata_Options.readWriteMultipleSupported = true;
                //set the number of logical sectors per DRQ data block (current setting)
                device->drive_info.ata_Options.logicalSectorsPerDRQDataBlock = M_Byte0(ident_word[59]);
            }
        }
        //check for tagged command queuing support
        if (ident_word[83] & BIT1 || ident_word[86] & BIT1)
        {
            device->drive_info.ata_Options.taggedCommandQueuingSupported = true;
        }
        
        //check if the device is parallel or serial
        uint8_t transportType = (ident_word[222] & (BIT15 | BIT14 | BIT13 | BIT12)) >> 12;
        switch (transportType)
        {
        case 0x00://parallel
            device->drive_info.ata_Options.isParallelTransport = true;
            break;
        case 0x01://serial
        case 0x0E://PCIe
        default:
            break;
        }
        //non-SATA compliant (PATA) devices will set this to 0 or FFFFh
        if (is_ATA_Identify_Word_Valid_SATA(device->drive_info.IdentifyData.ata.Word076))
        {
            device->drive_info.ata_Options.isParallelTransport = false;
            device->drive_info.ata_Options.noNeedLegacyDeviceHeadCompatBits = true;//TODO: May need to retry and test this just in case! Can use identify to validate. May be necessary for old controllers or drivers or weird controller modes
            //check for native command queuing support
            if (ident_word[76] & BIT8)
            {
                device->drive_info.ata_Options.nativeCommandQueuingSupported = true;
            }
            if (!device->drive_info.passThroughHacks.ataPTHacks.dmaNotSupported)
            {
                if (device->drive_info.IdentifyData.ata.Word076 & BIT15)
                {
                    device->drive_info.ata_Options.sataReadLogDMASameAsPIO = true;
                }
            }
        }
        else
        {
            device->drive_info.ata_Options.isParallelTransport = true;
            device->drive_info.ata_Options.noNeedLegacyDeviceHeadCompatBits = false;//for PATA devices, continue setting these bits for backwards compatibility.
            //NOTE: It may be possible to remove these bits on some PATA drives, but that will take more research that is likely not worth the time.-TJE
            //if parallel ATA, check the current mode. If not DMA, turn off ALL DMA command support since the HBA or OS or bridge may not support DMA mode and we don't want to lose communication with the host
            //now check if any DMA mode is enabled...if none are enabled, then it's running in PIO mode
            if (!(M_GETBITRANGE(ident_word[62], 10, 8) != 0 //SWDMA
                || M_GETBITRANGE(ident_word[63], 10, 8) != 0 //MWDMA
                || M_GETBITRANGE(ident_word[88], 14, 8) != 0 //UDMA
                ))
            {
                //in this case, remove all the support flags for DMA versions of commands since that is the easiest way to handle the rest of the library
                device->drive_info.ata_Options.dmaSupported = false;
                device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_NO_DMA;
                device->drive_info.ata_Options.downloadMicrocodeDMASupported = false;
                device->drive_info.ata_Options.readBufferDMASupported = false;
                device->drive_info.ata_Options.readLogWriteLogDMASupported = false;
                device->drive_info.ata_Options.writeBufferDMASupported = false;
                device->drive_info.ata_Options.dcoDMASupported = false;
                device->drive_info.ata_Options.hpaSecurityExtDMASupported = false;
            }
        }
        if (ident_word[119] & BIT2 || ident_word[120] & BIT2)
        {
            device->drive_info.ata_Options.writeUncorrectableExtSupported = true;
        }
        if (ident_word[120] & BIT6)//word120 holds if this is enabled
        {
            device->drive_info.ata_Options.senseDataReportingEnabled = true;
        }
        //check that 48bit is supported
        if (ident_word[83] & BIT10)
        {
            device->drive_info.ata_Options.fourtyEightBitAddressFeatureSetSupported = true;
        }
        //GPL support
        if (ident_word[84] & BIT5 || ident_word[87] & BIT5)
        {
            device->drive_info.ata_Options.generalPurposeLoggingSupported = true;
        }

        //This is to detect realtek USB to NVMe device since it will respond to SAT ATA identify commands with valid strings and NOTHING else.
        //If it has a SATA drive, these will all report DMA mode of some kind and a maxLBA and will never be ATAPI
        //So this should be a reasonably good check to catch this thing for now.
        if (device->drive_info.passThroughHacks.ataPTHacks.possilbyEmulatedNVMe && 
            (!device->drive_info.ata_Options.dmaSupported && device->drive_info.ata_Options.dmaMode == ATA_DMA_MODE_NO_DMA && *fillMaxLba == 0 && device->drive_info.drive_type != ATAPI_DRIVE))
        {
            //This means it's an emulated NVMe device where only the MN/SN/FW were reported.
            device->drive_info.drive_type = SCSI_DRIVE;
        }
        else if ((!device->drive_info.ata_Options.dmaSupported && device->drive_info.ata_Options.dmaMode == ATA_DMA_MODE_NO_DMA && *fillMaxLba == 0 && device->drive_info.drive_type != ATAPI_DRIVE))
        {
            //This very likely is emulated since a valid ATA device will have fillMaxLba set to SOMETHING even in really old CHS drives since the LBA is simulated in software.
            if (device->deviceVerbosity <= VERBOSITY_DEFAULT)
            {
                printf("WARNING: possible RTL 9210 detected and missed with all other checks.\n");
                printf("         this may cause adverse behavior and require --forceSCSI\n");
            }
        }

        if (device->drive_info.interface_type == SCSI_INTERFACE)
        {
            //for the SCSI interface, copy this information back to the main drive info since SCSI translated info may truncate these fields and we don't want that
            memcpy(device->drive_info.product_identification, device->drive_info.bridge_info.childDriveMN, MODEL_NUM_LEN);
            memcpy(device->drive_info.serialNumber, device->drive_info.bridge_info.childDriveSN, SERIAL_NUM_LEN);
            memcpy(device->drive_info.product_revision, device->drive_info.bridge_info.childDriveFW, FW_REV_LEN);
            device->drive_info.worldWideName = device->drive_info.bridge_info.childWWN;
        }
    }
    else
    {
        ret = FAILURE;
    }
    //This may not be required...need to do some testing to see if reading the logs below wakes a drive up - TJE
    if (M_Word0(device->dFlags) == DO_NOT_WAKE_DRIVE || M_Word0(device->dFlags) == FAST_SCAN)
    {
#ifdef _DEBUG
        printf("Quiting device discovery early for %s per DO_NOT_WAKE_DRIVE\n", device->drive_info.serialNumber);
        printf("Drive type: %d\n",device->drive_info.drive_type);
        printf("Interface type: %d\n",device->drive_info.interface_type);
        printf("Media type: %d\n",device->drive_info.media_type);
        printf("SN: %s\n",device->drive_info.serialNumber);
        printf("%s <--\n",__FUNCTION__);
#endif
        return ret;
    }

    if (!device->drive_info.passThroughHacks.ataPTHacks.dmaNotSupported)
    {
        if (device->drive_info.passThroughHacks.ataPTHacks.alwaysUseDMAInsteadOfUDMA)
        {
            //forcing using DMA mode instead of UDMA since the translator doesn't like UDMA mode set
            device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_DMA;
        }
    }

    //Check if we were given any force flags regarding how we talk to ATA drives.
    if ((device->dFlags & FORCE_ATA_PIO_ONLY) != 0)
    {
        //in this case, remove all the support flags for DMA versions of commands since that is the easiest way to handle the rest of the library
        device->drive_info.ata_Options.dmaSupported = false;
        device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_NO_DMA;
        device->drive_info.ata_Options.downloadMicrocodeDMASupported = false;
        device->drive_info.ata_Options.readBufferDMASupported = false;
        device->drive_info.ata_Options.readLogWriteLogDMASupported = false;
        device->drive_info.ata_Options.writeBufferDMASupported = false;
    }
    //check if we're being asked to set the protocol to DMA for DMA commands (default behavior depends on drive support from identify)
    if ((device->dFlags & FORCE_ATA_DMA_SAT_MODE) != 0)
    {
        device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_DMA;
    }
    //check if we're being asked to set the protocol to UDMA for DMA commands (default behavior depends on drive support from identify)
    if ((device->dFlags & FORCE_ATA_UDMA_SAT_MODE) != 0)
    {
        device->drive_info.ata_Options.dmaMode = ATA_DMA_MODE_UDMA;
    }

    //device->drive_info.softSATFlags.senseDataDescriptorFormat = true;//by default software SAT will set this to descriptor format so that ATA pass-through works as expected with RTFRs.
    //only bother reading logs if GPL is supported...not going to bother with SMART even though some of the things we are looking for are in SMART - TJE
    if (retrievedIdentifyData && device->drive_info.ata_Options.generalPurposeLoggingSupported)
    {
        uint8_t logBuffer[LEGACY_DRIVE_SEC_SIZE] = { 0 };
        if (SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_DIRECTORY, 0, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
        {
            bool readIDDataLog = false;
            bool readDeviceStatisticsLog = false;
            //check for support of ID Data Log, Current Device Internal Status, Saved Device Internal Status, Device Statistics Log
            if (M_BytesTo2ByteValue(logBuffer[(ATA_LOG_DEVICE_STATISTICS * 2) + 1], logBuffer[(ATA_LOG_DEVICE_STATISTICS * 2)]) > 0)
            {
                readDeviceStatisticsLog = true;
            }
            if (M_BytesTo2ByteValue(logBuffer[(ATA_LOG_CURRENT_DEVICE_INTERNAL_STATUS_DATA_LOG * 2) + 1], logBuffer[(ATA_LOG_CURRENT_DEVICE_INTERNAL_STATUS_DATA_LOG * 2)]) > 0)
            {
                device->drive_info.softSATFlags.currentInternalStatusLogSupported = true;
            }
            if (M_BytesTo2ByteValue(logBuffer[(ATA_LOG_SAVED_DEVICE_INTERNAL_STATUS_DATA_LOG * 2) + 1], logBuffer[(ATA_LOG_SAVED_DEVICE_INTERNAL_STATUS_DATA_LOG * 2)]) > 0)
            {
                device->drive_info.softSATFlags.savedInternalStatusLogSupported = true;
            }
            if (M_BytesTo2ByteValue(logBuffer[(ATA_LOG_IDENTIFY_DEVICE_DATA * 2) + 1], logBuffer[(ATA_LOG_IDENTIFY_DEVICE_DATA * 2)]) > 0)
            {
                readIDDataLog = true;
            }
            //could check any log from address 80h through 9Fh...but one should be enough (used for SAT application client log page translation)
            //Using 90h since that is the first page the application client translation uses.
            if (M_BytesTo2ByteValue(logBuffer[(0x90 * 2) + 1], logBuffer[(0x90 * 2)]) > 0)
            {
                device->drive_info.softSATFlags.hostLogsSupported = true;
            }
            //now read the couple pages of logs we care about to set some more flags for software SAT
            if (readIDDataLog)
            {
                bool copyOfIDData = false;
                bool supportedCapabilities = false;
                bool zonedDeviceInfo = false;
                memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                if (SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_IDENTIFY_DEVICE_DATA, ATA_ID_DATA_LOG_SUPPORTED_PAGES, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                {
                    uint8_t pageNumber = logBuffer[2];
                    uint16_t revision = M_BytesTo2ByteValue(logBuffer[1], logBuffer[0]);
                    if (pageNumber == C_CAST(uint8_t, ATA_ID_DATA_LOG_SUPPORTED_PAGES) && revision >= 0x0001)
                    {
                        //data is valid, so figure out supported pages
                        uint8_t listLen = logBuffer[8];
                        for (uint16_t iter = 9; iter < C_CAST(uint16_t, listLen + 9) && iter < UINT16_C(512); ++iter)
                        {
                            switch (logBuffer[iter])
                            {
                            case ATA_ID_DATA_LOG_SUPPORTED_PAGES:
                                break;
                            case ATA_ID_DATA_LOG_COPY_OF_IDENTIFY_DATA:
                                copyOfIDData = true;
                                break;
                            case ATA_ID_DATA_LOG_CAPACITY:
                                break;
                            case ATA_ID_DATA_LOG_SUPPORTED_CAPABILITIES:
                                supportedCapabilities = true;
                                break;
                            case ATA_ID_DATA_LOG_CURRENT_SETTINGS:
                            case ATA_ID_DATA_LOG_ATA_STRINGS:
                            case ATA_ID_DATA_LOG_SECURITY:
                            case ATA_ID_DATA_LOG_PARALLEL_ATA:
                            case ATA_ID_DATA_LOG_SERIAL_ATA:
                                break;
                            case ATA_ID_DATA_LOG_ZONED_DEVICE_INFORMATION:
                                zonedDeviceInfo = true;
                                break;
                            default:
                                break;
                            }
                        }
                    }
                }
                memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                if (copyOfIDData && SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_IDENTIFY_DEVICE_DATA, ATA_ID_DATA_LOG_COPY_OF_IDENTIFY_DATA, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                {
                    device->drive_info.softSATFlags.identifyDeviceDataLogSupported = true;
                }
                memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                if (supportedCapabilities && SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_IDENTIFY_DEVICE_DATA, ATA_ID_DATA_LOG_SUPPORTED_CAPABILITIES, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                {
                    uint64_t qword0 = M_BytesTo8ByteValue(logBuffer[7], logBuffer[6], logBuffer[5], logBuffer[4], logBuffer[3], logBuffer[2], logBuffer[1], logBuffer[0]);
                    if (qword0 & BIT63 && M_Byte2(qword0) == ATA_ID_DATA_LOG_SUPPORTED_CAPABILITIES && M_Word0(qword0) >= 0x0001)
                    {
                        uint64_t supportedCapabilitiesQWord = M_BytesTo8ByteValue(logBuffer[15], logBuffer[14], logBuffer[13], logBuffer[12], logBuffer[11], logBuffer[10], logBuffer[9], logBuffer[8]);
                        if (supportedCapabilitiesQWord & BIT63)
                        {
                            if (supportedCapabilitiesQWord & BIT50)
                            {
                                device->drive_info.softSATFlags.dataSetManagementXLSupported = true;
                            }
                            if (supportedCapabilitiesQWord & BIT48)
                            {
                                device->drive_info.softSATFlags.zeroExtSupported = true;
                            }
                        }
                        uint64_t downloadCapabilities = M_BytesTo8ByteValue(logBuffer[23], logBuffer[22], logBuffer[21], logBuffer[20], logBuffer[19], logBuffer[18], logBuffer[17], logBuffer[16]);
                        if (downloadCapabilities & BIT63 && downloadCapabilities & BIT34)
                        {
                            device->drive_info.softSATFlags.deferredDownloadSupported = true;
                        }
                        uint64_t supportedZACCapabilities = M_BytesTo8ByteValue(logBuffer[119], logBuffer[118], logBuffer[117], logBuffer[116], logBuffer[115], logBuffer[114], logBuffer[113], logBuffer[112]);
                        if (supportedZACCapabilities & BIT63)//qword valid
                        {
                            //check if any of the ZAC commands are supported.
                            if (supportedZACCapabilities & BIT0 || supportedZACCapabilities & BIT1 || supportedZACCapabilities & BIT2 || supportedZACCapabilities & BIT3 || supportedZACCapabilities & BIT4)
                            {
                                //according to what I can find in the spec, a HOST Managed drive reports a different signature, but doens't set any identify bytes like a host aware drive.
                                //because of this and not being able to get the real signature, this check is the only way to determine we are talking to an ATA host managed drive. - TJE
                                if (device->drive_info.zonedType == ZONED_TYPE_NOT_ZONED)
                                {
                                    device->drive_info.zonedType = ZONED_TYPE_HOST_MANAGED;
                                }
                            }
                        }
                    }
                }
                memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                if (zonedDeviceInfo && SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_IDENTIFY_DEVICE_DATA, ATA_ID_DATA_LOG_ZONED_DEVICE_INFORMATION, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                {
                    uint64_t qword0 = M_BytesTo8ByteValue(logBuffer[7], logBuffer[6], logBuffer[5], logBuffer[4], logBuffer[3], logBuffer[2], logBuffer[1], logBuffer[0]);
                    if (qword0 & BIT63 && M_Byte2(qword0) == ATA_ID_DATA_LOG_ZONED_DEVICE_INFORMATION && M_Word0(qword0) >= 0x0001)//validating we got the right page
                    {
                        //according to what I can find in the spec, a HOST Managed drive reports a different signature, but doens't set any identify bytes like a host aware drive.
                        //because of this and not being able to get the real signature, this check is the only way to determine we are talking to an ATA host managed drive. - TJE
                        if (device->drive_info.zonedType == ZONED_TYPE_NOT_ZONED)
                        {
                            device->drive_info.zonedType = ZONED_TYPE_HOST_MANAGED;
                        }
                    }
                }
            }
            if (readDeviceStatisticsLog)
            {
                memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                if (SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_DEVICE_STATISTICS, ATA_DEVICE_STATS_LOG_LIST, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                {
                    uint16_t iter = 9;
                    uint8_t numberOfEntries = logBuffer[8];
                    for (iter = 9; iter < (numberOfEntries + 9) && iter < 512; ++iter)
                    {
                        switch (logBuffer[iter])
                        {
                        case ATA_DEVICE_STATS_LOG_LIST:
                            break;
                        case ATA_DEVICE_STATS_LOG_GENERAL:
                            device->drive_info.softSATFlags.deviceStatsPages.generalStatisitcsSupported = true;
                            break;
                        case ATA_DEVICE_STATS_LOG_FREE_FALL:
                            break;
                        case ATA_DEVICE_STATS_LOG_ROTATING_MEDIA:
                            device->drive_info.softSATFlags.deviceStatsPages.rotatingMediaStatisticsPageSupported = true;
                            break;
                        case ATA_DEVICE_STATS_LOG_GEN_ERR:
                            device->drive_info.softSATFlags.deviceStatsPages.generalErrorStatisticsSupported = true;
                            break;
                        case ATA_DEVICE_STATS_LOG_TEMP:
                            device->drive_info.softSATFlags.deviceStatsPages.temperatureStatisticsSupported = true;
                            break;
                        case ATA_DEVICE_STATS_LOG_TRANSPORT:
                            break;
                        case ATA_DEVICE_STATS_LOG_SSD:
                            device->drive_info.softSATFlags.deviceStatsPages.solidStateDeviceStatisticsSupported = true;
                            break;
                        default:
                            break;
                        }
                    }
                    if (device->drive_info.softSATFlags.deviceStatsPages.generalStatisitcsSupported)
                    {
                        //need to read this page and check if the data and time timestamp statistic is supported
                        memset(logBuffer, 0, LEGACY_DRIVE_SEC_SIZE);
                        if (SUCCESS == send_ATA_Read_Log_Ext_Cmd(device, ATA_LOG_DEVICE_STATISTICS, ATA_DEVICE_STATS_LOG_GENERAL, logBuffer, LEGACY_DRIVE_SEC_SIZE, 0))
                        {
                            uint64_t qword0 = M_BytesTo8ByteValue(logBuffer[7], logBuffer[6], logBuffer[5], logBuffer[4], logBuffer[3], logBuffer[2], logBuffer[1], logBuffer[0]);
                            if (M_Byte2(qword0) == ATA_DEVICE_STATS_LOG_GENERAL && M_Word0(qword0) >= 0x0001)//validating we got the right page
                            {
                                uint64_t dateAndTime = M_BytesTo8ByteValue(logBuffer[63], logBuffer[62], logBuffer[61], logBuffer[60], logBuffer[59], logBuffer[58], logBuffer[57], logBuffer[56]);
                                if (dateAndTime & BIT63)
                                {
                                    device->drive_info.softSATFlags.deviceStatsPages.dateAndTimeTimestampSupported = true;
                                }
                            }
                        }
                    }
                }
            }
        }
    }
#ifdef _DEBUG
    printf("Drive type: %d\n",device->drive_info.drive_type);
    printf("Interface type: %d\n",device->drive_info.interface_type);
    printf("Media type: %d\n",device->drive_info.media_type);
    printf("SN: %s\n",device->drive_info.serialNumber);
    printf("%s <--\n",__FUNCTION__);
#endif
    return ret;
}

uint16_t ata_Is_Extended_Power_Conditions_Feature_Supported(uint16_t *pIdentify)
{
    ptAtaIdentifyData pIdent = C_CAST(ptAtaIdentifyData, pIdentify);
    // BIT7 according to ACS 3 rv 5 for EPC
    return (pIdent->Word119 & BIT7);
}

uint16_t ata_Is_One_Extended_Power_Conditions_Feature_Supported(uint16_t *pIdentify)
{
    ptAtaIdentifyData pIdent = C_CAST(ptAtaIdentifyData, pIdentify);
    return (pIdent->Word120 & BIT7);

}

void print_Verbose_ATA_Command_Information(ataPassthroughCommand *ataCommandOptions)
{
    printf("Sending SAT ATA Pass-Through Command:\n");
    //protocol
    printf("\tProtocol: ");
    switch (ataCommandOptions->commadProtocol)
    {
    case ATA_PROTOCOL_PIO:
        printf("PIO");
        break;
    case ATA_PROTOCOL_DMA:
        printf("DMA");
        break;
    case ATA_PROTOCOL_NO_DATA:
        printf("NON-Data");
        break;
    case ATA_PROTOCOL_DEV_RESET:
        printf("Device Reset");
        break;
    case ATA_PROTOCOL_DEV_DIAG:
        printf("Device Diagnostic");
        break;
    case ATA_PROTOCOL_DMA_QUE:
        printf("DMA Queued");
        break;
    case ATA_PROTOCOL_PACKET:
    case ATA_PROTOCOL_PACKET_DMA:
        printf("Packet");
        break;
    case ATA_PROTOCOL_DMA_FPDMA:
        printf("FPDMA");
        break;
    case ATA_PROTOCOL_SOFT_RESET:
        printf("Soft Reset");
        break;
    case ATA_PROTOCOL_HARD_RESET:
        printf("Hard Reset");
        break;
    case ATA_PROTOCOL_RET_INFO:
        printf("Return Response Information");
        break;
    case ATA_PROTOCOL_UDMA:
        printf("UDMA");
        break;
    default:
        break;
    }
    printf("\n");
    printf("\tData Direction: ");
    //Data Direction:
    switch (ataCommandOptions->commandDirection)
    {
    case XFER_NO_DATA:
        printf("No Data");
        break;
    case XFER_DATA_IN:
        printf("Data In");
        break;
    case XFER_DATA_OUT:
        printf("Data Out");
        break;
    default:
        printf("Unknown");
        break;
    }
    printf("\n");
    //TFRs:
    printf("\tTask File Registers:\n");
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[FeatureExt] = %02" PRIX8 "h\n", ataCommandOptions->tfr.Feature48);
    }
    printf("\t[Feature] = %02" PRIX8 "h\n", ataCommandOptions->tfr.ErrorFeature);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[CountExt] = %02" PRIX8 "h\n", ataCommandOptions->tfr.SectorCount48);
    }
    printf("\t[Count] = %02" PRIX8 "h\n", ataCommandOptions->tfr.SectorCount);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Lo Ext] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaLow48);
    }
    printf("\t[LBA Lo] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaLow);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Mid Ext] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaMid48);
    }
    printf("\t[LBA Mid] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaMid);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Hi Ext] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaHi48);
    }
    printf("\t[LBA Hi] = %02" PRIX8 "h\n", ataCommandOptions->tfr.LbaHi);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        //AUX and ICC registers
        printf("\t[ICC] = %02" PRIX8 "h\n", ataCommandOptions->tfr.icc);
        printf("\t[Aux (7:0)] = %02" PRIX8 "h\n", ataCommandOptions->tfr.aux1);
        printf("\t[Aux (15:8)] = %02" PRIX8 "h\n", ataCommandOptions->tfr.aux2);
        printf("\t[Aux (23:16)] = %02" PRIX8 "h\n", ataCommandOptions->tfr.aux3);
        printf("\t[Aux (31:24)] = %02" PRIX8 "h\n", ataCommandOptions->tfr.aux4);
    }
    printf("\t[DeviceHead] = %02" PRIX8 "h\n", ataCommandOptions->tfr.DeviceHead);
    printf("\t[Command] = %02" PRIX8"h\n", ataCommandOptions->tfr.CommandStatus);
    //printf("\t[Device Control] = %02"PRIX8"h\n", ataCommandOptions->tfr.DeviceControl);
    printf("\n");
}

//is this a read/write command that the rtfr output needs to know might report a bit specific to these commands
//ex: corrected data (old) or alignment error or address mark not found (old)
//NOTE: Streaming cmds not included in here!
//This is only meant for use printing out error bits at this time!
static bool is_User_Data_Access_Command(ataPassthroughCommand* ataCommandOptions)
{
    bool userDataAccess = false;
    if (ataCommandOptions)
    {
        switch (ataCommandOptions->tfr.CommandStatus)
        {
        case ATA_READ_SECT:
        case ATA_READ_SECT_NORETRY:
        case ATA_READ_SECT_EXT:
        case ATA_READ_DMA_EXT:
        case ATA_READ_DMA_QUE_EXT:
        case ATA_READ_READ_MULTIPLE_EXT:
        case ATA_WRITE_SECT:
        case ATA_WRITE_SECT_NORETRY:
        case ATA_WRITE_SECT_EXT:
        case ATA_WRITE_DMA_EXT:
        case ATA_WRITE_DMA_QUE_EXT:
        case ATA_WRITE_MULTIPLE_EXT:
        case ATA_WRITE_SECTV_RETRY://write & verify...old. ATA, ATA2, ATA3, then obsolete ever since then
        case ATA_WRITE_DMA_FUA_EXT:
        case ATA_WRITE_DMA_QUE_FUA_EXT:
        case ATA_READ_VERIFY_RETRY:
        case ATA_READ_VERIFY_NORETRY:
        case ATA_READ_VERIFY_EXT:
        case ATA_READ_FPDMA_QUEUED_CMD:
        case ATA_WRITE_FPDMA_QUEUED_CMD:
        case ATA_SEEK_CMD:
        case ATA_READ_MULTIPLE_CMD:
        case ATA_WRITE_MULTIPLE_CMD:
        case ATA_READ_DMA_QUEUED_CMD:
        case ATA_READ_DMA_RETRY_CMD:
        case ATA_READ_DMA_NORETRY:
        case ATA_WRITE_DMA_RETRY_CMD:
        case ATA_WRITE_DMA_NORETRY:
        case ATA_WRITE_DMA_QUEUED_CMD:
        case ATA_WRITE_MULTIPLE_FUA_EXT:
            userDataAccess = true;
            break;
        case ATA_READ_BUF_DMA:
            //case ATA_LEGACY_WRITE_SAME:
                //special case: opcode was reused from old write same to read buf DMA
                //check command fields to figure out which command this is.
            //write same was in ATA and ATA2 and obsolete in ATA 3 and retired until reuse for read buf DMA
            if (ataCommandOptions->commandDirection == XFER_DATA_OUT && ataCommandOptions->commadProtocol == ATA_PROTOCOL_PIO)//this seems like the easiest way to figure out which command it is -TJE
            {
                userDataAccess = true;
            }
            break;
        case ATA_NOP_CMD:
        case ATA_CFA_REQUEST_SENSE:
        case ATASET:
        case ATA_DATA_SET_MANAGEMENT_CMD:
        case ATA_DATA_SET_MANAGEMENT_XL_CMD:
        case ATA_DEV_RESET:
        case ATA_REQUEST_SENSE_DATA:
        case ATA_RECALIBRATE_CMD:
        case ATA_GET_PHYSICAL_ELEMENT_STATUS:
        case ATA_READ_LONG_RETRY_CMD:
        case ATA_READ_LONG_NORETRY:
        case ATA_READ_MAX_ADDRESS_EXT:
        case ATA_READ_STREAM_DMA_EXT:
        case ATA_READ_STREAM_EXT:
        case ATA_READ_LOG_EXT:
        case ATA_WRITE_LONG_RETRY_CMD:
        case ATA_WRITE_LONG_NORETRY:
        case ATA_SET_MAX_EXT:
        case ATA_CFA_WRITE_SECTORS_WITHOUT_ERASE:
        case ATA_WRITE_STREAM_DMA_EXT:
        case ATA_WRITE_STREAM_EXT:
        case ATA_WRITE_LOG_EXT_CMD:
        case ATA_ZEROS_EXT:
        case ATA_WRITE_UNCORRECTABLE_EXT:
        case ATA_READ_LOG_EXT_DMA:
        case ATA_ZONE_MANAGEMENT_IN:
        case ATA_FORMAT_TRACK_CMD:
        case ATA_CONFIGURE_STREAM:
        case ATA_WRITE_LOG_EXT_DMA:
        case ATA_TRUSTED_NON_DATA:
        case ATA_TRUSTED_RECEIVE:
        case ATA_TRUSTED_RECEIVE_DMA:
        case ATA_TRUSTED_SEND:
        case ATA_TRUSTED_SEND_DMA:
        case ATA_FPDMA_NON_DATA:
        case ATA_SEND_FPDMA:
        case ATA_RECEIVE_FPDMA:
        case ATA_SET_DATE_AND_TIME_EXT:
        case ATA_ACCESSABLE_MAX_ADDR:
        case ATA_REMOVE_AND_TRUNCATE:
        case ATA_RESTORE_AND_REBUILD:
        case ATA_CFA_TRANSLATE_SECTOR:
        case ATA_EXEC_DRV_DIAG:
        case ATA_INIT_DRV_PARAM:
        case ATA_DOWNLOAD_MICROCODE_CMD:
        case ATA_DOWNLOAD_MICROCODE_DMA:
        case ATA_LEGACY_ALT_STANDBY_IMMEDIATE:
        case ATA_LEGACY_ALT_IDLE_IMMEDIATE:
        case ATA_LEGACY_ALT_STANDBY:
        case ATA_LEGACY_ALT_IDLE:
        case ATA_LEGACY_ALT_CHECK_POWER_MODE:
        case ATA_LEGACY_ALT_SLEEP:
        case ATA_ZONE_MANAGEMENT_OUT:
        case ATAPI_COMMAND:
        case ATAPI_IDENTIFY:
        case ATA_SMART_CMD:
        case ATA_DCO:
        case ATA_SET_SECTOR_CONFIG_EXT:
        case ATA_SANITIZE:
        case ATA_NV_CACHE:
        case ATA_CFA_EXTENDED_IDENTIFY:
        case ATA_CFA_KEY_MANAGEMENT:
        case ATA_CFA_STREAMING_PERFORMANCE:
        case ATA_CFA_ERASE_SECTORS:
        case ATA_SET_MULTIPLE:
        case ATA_CFA_WRITE_MULTIPLE_WITHOUT_ERASE:
        case ATA_GET_MEDIA_STATUS:
        case ATA_ACK_MEDIA_CHANGE:
        case ATA_POST_BOOT:
        case ATA_PRE_BOOT:
        case ATA_DOOR_LOCK_CMD:
        case ATA_DOOR_UNLOCK_CMD:
        case ATA_STANDBY_IMMD:
        case ATA_IDLE_IMMEDIATE_CMD:
        case ATA_STANDBY_CMD:
        case ATA_IDLE_CMD:
        case ATA_READ_BUF:
        case ATA_CHECK_POWER_MODE_CMD:
        case ATA_SLEEP_CMD:
        case ATA_FLUSH_CACHE_CMD:
        case ATA_WRITE_BUF:
        case ATA_FLUSH_CACHE_EXT:
        case ATA_WRITE_BUF_DMA:
        case ATA_IDENTIFY:
        case ATA_MEDIA_EJECT:
        case ATA_IDENTIFY_DMA:
        case ATA_SET_FEATURE:
        case ATA_SECURITY_SET_PASS:
        case ATA_SECURITY_UNLOCK_CMD:
        case ATA_SECURITY_ERASE_PREP:
        case ATA_SECURITY_ERASE_UNIT_CMD:
        case ATA_SECURITY_FREEZE_LOCK_CMD://also CFA wear level, but both of these will be false
        case ATA_SECURITY_DISABLE_PASS:
        case ATA_LEGACY_TRUSTED_RECEIVE:
        case ATA_READ_MAX_ADDRESS:
        case ATA_SET_MAX:
        case ATA_LEGACY_TRUSTED_SEND:
        case ATA_SEEK_EXT://this is VU so not including with above commands
            break;
        }
    }
    return userDataAccess;
}

static bool is_Streaming_Command(ataPassthroughCommand* ataCommandOptions)
{
    bool isStreaming = false;
    if (ataCommandOptions)
    {
        switch (ataCommandOptions->tfr.CommandStatus)
        {
        case ATA_READ_STREAM_DMA_EXT:
        case ATA_READ_STREAM_EXT:
        case ATA_WRITE_STREAM_DMA_EXT:
        case ATA_WRITE_STREAM_EXT:
        case ATA_CONFIGURE_STREAM:
            isStreaming = true;
            break;
        default:
            break;
        }
    }
    return isStreaming;
}

//added interpretation of status and error fields to print out more info and make it easier to interpret results
//This is not perfect, but a good enhancement to the output.
//Note that not all combinations of bits are handled. Specifically some ATAPI specific meanings are not handled right now.
//Support for old commands and old bits may not be fully functional, but it should cover most cases.
//TODO: Better ATAPI support
//TODO: Use supported ATA versions from identify (not just most recent, but anything with a bit set) to help better identify some status and error outputs
//      ex: bad block for ATA1, corr for up to ata 3 (or so), etc
void print_Verbose_ATA_Command_Result_Information(ataPassthroughCommand *ataCommandOptions, tDevice *device)
{
    printf("\tReturn Task File Registers:\n");
    printf("\t[Error] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.error);
    if (ataCommandOptions->rtfr.status & ATA_STATUS_BIT_ERROR)//assuming NOT a packet command
    {
        //print out error bit meanings
        //bit7 means either bad block (really old - ATA-1) or interface CRC error
        if (ataCommandOptions->rtfr.error & BIT7)
        {
            // CRC error will only be possible to detect with SATA or UDMA transfers
            //NOTE: Since some translators only allow SAT set to DMA, need to make sure drive's mode is UDMA and protocol can be DMA. Not perfect and can be further improved
            if (is_SATA(device) || (device->drive_info.ata_Options.dmaMode == ATA_DMA_MODE_UDMA && (ataCommandOptions->commadProtocol == ATA_PROTOCOL_UDMA || ataCommandOptions->commadProtocol == ATA_PROTOCOL_DMA)))
            {
                printf("\t\tInterface CRC error\n");
            }
            else if (is_User_Data_Access_Command(ataCommandOptions))
            {
                printf("\t\tBad Block (?)\n");
            }
            else
            {
                printf("\t\tUnknown Error bit 7\n");
            }
        }
        //bit6 means either uncorrectable data or write protected (removable medium)
        if (ataCommandOptions->rtfr.error & BIT5)
        {
            if (is_Removable_Media(device))//todo: does this need checking if this was a write command???
            {
                printf("\t\tWrite Protected\n");
            }
            else
            {
                printf("\t\tUncorrectable Data\n");
            }
        }
        //bit5 means media change
        if (ataCommandOptions->rtfr.error & ATA_ERROR_BIT_MEDIA_CHANGE)//atapi only
        {
            printf("\t\tMedia Change\n");
        }
        //bit 4 means id not found
        if (ataCommandOptions->rtfr.error & ATA_ERROR_BIT_ID_NOT_FOUND)
        {
            printf("\t\tID Not Found\n");
        }
        //bit3 means media change request
        if (ataCommandOptions->rtfr.error & ATA_ERROR_BIT_MEDIA_CHANGE_REQUEST)//atapi only
        {
            printf("\t\tMedia Change\n");
        }
        //bit2 means abort
        if (ataCommandOptions->rtfr.error & ATA_ERROR_BIT_ABORT)
        {
            printf("\t\tAbort\n");
        }
        //Bit 1 can mean Track zero not found, end of media, no media
        if (ataCommandOptions->rtfr.error & BIT1)
        {
            if (ataCommandOptions->tfr.CommandStatus == ATA_RECALIBRATE_CMD)
            {
                printf("\t\tTrack 0 not found\n");
            }
            else if (ataCommandOptions->tfr.CommandStatus == ATA_NV_CACHE && ataCommandOptions->tfr.ErrorFeature == NV_ADD_LBAS_TO_NV_CACHE_PINNED_SET)
            {
                printf("\t\tInsufficient LBA Range Entries Remaining\n");
            }
            else if (is_Removable_Media(device))
            {
                printf("\t\tNo Media\n");
            }
            //atapi = end of media
            else
            {
                printf("\t\tUnknown Error Bit 1\n");
            }
        }
        //bit 0 can mean various things depending on the command that was issued
        if (ataCommandOptions->rtfr.error & BIT0)
        {
            //address mark not found or command completion time out (streaming)
            //address mark not found basically matched ID not found being set...or when it should be set (LBA/CHS user data access commands, but not seek)
            if (is_Streaming_Command(ataCommandOptions))
            {
                printf("\t\tCommand Completion Time out (Streaming)\n");
            }
            //more checks for specific commands here
            //nv cache commands
            else if (ataCommandOptions->tfr.CommandStatus == ATA_NV_CACHE && ataCommandOptions->tfr.ErrorFeature == NV_ADD_LBAS_TO_NV_CACHE_PINNED_SET)
            {
                printf("\t\tInsufficient NV Cache Space\n");
            }
            else if (ataCommandOptions->tfr.CommandStatus == ATA_NV_CACHE && ataCommandOptions->tfr.ErrorFeature == NV_REMOVE_LBAS_FROM_NV_CACHE_PINNED_SET)
            {
                printf("\t\tAttempted Partial Range Removal\n");
            }
            else if (is_User_Data_Access_Command(ataCommandOptions) && ataCommandOptions->rtfr.error & ATA_ERROR_BIT_ID_NOT_FOUND && ataCommandOptions->tfr.CommandStatus != ATA_SEEK_CMD)
            {
                //if this is also set, for a user data access, possibly the old address mark not found bit
                //not: does not apply to old seek commands
                printf("\t\tAddress Mark Not Found\n");
            }
            //TODO: atapi illegal length indicator and media error
            else
            {
                printf("\t\tUnknown Error Bit 0\n");
            }
        }

    }
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[Count Ext] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.secCntExt);
    }
    printf("\t[Count] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.secCnt);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Lo Ext] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaLowExt);
    }
    printf("\t[LBA Lo] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaLow);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Mid Ext] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaMidExt);
    }
    printf("\t[LBA Mid] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaMid);
    if (ataCommandOptions->commandType == ATA_CMD_TYPE_EXTENDED_TASKFILE || ataCommandOptions->commandType == ATA_CMD_TYPE_COMPLETE_TASKFILE)
    {
        printf("\t[LBA Hi Ext] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaHiExt);
    }
    printf("\t[LBA Hi] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.lbaHi);
    printf("\t[Device] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.device);
    printf("\t[Status] = %02" PRIX8 "h\n", ataCommandOptions->rtfr.status);
    //Bit 7 is busy (unlikely to actually see this returned)
    if (ataCommandOptions->commadProtocol != ATA_PROTOCOL_DMA_FPDMA && ataCommandOptions->commadProtocol != ATA_PROTOCOL_DMA_QUE && ataCommandOptions->rtfr.status & ATA_STATUS_BIT_BUSY)
    {
        printf("\t\tBusy\n");
    }
    //Bit 6 is ready
    if (ataCommandOptions->rtfr.status & ATA_STATUS_BIT_READY)
    {
        printf("\t\tReady\n");
    }
    //bit5 is device fault, or stream error
    //Stream error only for streaming feature commands and read/write continuos set to 1 in the command
    if ((ataCommandOptions->tfr.CommandStatus == ATA_WRITE_STREAM_DMA_EXT ||
        ataCommandOptions->tfr.CommandStatus == ATA_WRITE_STREAM_EXT ||
        ataCommandOptions->tfr.CommandStatus == ATA_READ_STREAM_DMA_EXT ||
        ataCommandOptions->tfr.CommandStatus == ATA_READ_STREAM_EXT)
        && ataCommandOptions->tfr.ErrorFeature & BIT6)//read or write continuous must be set!
    {
        printf("\t\tStream Error\n");
    }
    else if (ataCommandOptions->rtfr.status & ATA_STATUS_BIT_DEVICE_FAULT)
    {
        printf("\t\tDevice Fault\n");
    }
    //Bit 4 can be seek complete, service (dma queued), or deferred write error
    if (ataCommandOptions->rtfr.status & BIT4)
    {
        if (ataCommandOptions->commadProtocol == ATA_PROTOCOL_DMA_QUE)
        {
            printf("\t\tService\n");
        }
        else if (ataCommandOptions->tfr.CommandStatus == ATA_WRITE_STREAM_DMA_EXT ||
            ataCommandOptions->tfr.CommandStatus == ATA_WRITE_STREAM_EXT)
        {
            printf("\t\tDeferred Write Error\n");
        }
        else
        {
            printf("\t\tSeek Complete\n");
        }
    }
    if (ataCommandOptions->rtfr.status & ATA_STATUS_BIT_DATA_REQUEST)
    {
        printf("\t\tData Request\n");
    }
    //Bit 2 is either corrected data or alignment error. 
    //      corrected data only for read user data access
    //      alignment only for writes
    if (ataCommandOptions->rtfr.status & BIT2)
    {
        if (is_User_Data_Access_Command(ataCommandOptions))
        {
            //corr only for reads and alignment only for writes???
            if (ataCommandOptions->commandDirection == XFER_DATA_IN)
            {
                printf("\t\tCorrected Data\n");
            }
            else if (ataCommandOptions->commandDirection == XFER_DATA_OUT)
            {
                //todo: alignment error needs lps misalignment reporting to be supported and error reporting set to 01b or 10b and only on write commands
                printf("\t\tAlignment Error\n");
            }
            else
            {
                printf("\t\tUnknown Status bit 2 (CORR or ALIGNMENT?)\n");
            }
        }
        else
        {
            printf("\t\tUnknown Status bit 2 (CORR or ALIGNMENT?)\n");
        }
    }
    //TODO: Bit 1 is either index (flips with rev) or sense data available. Sense data reporting must at least be supported for this one to be useful
    if (ataCommandOptions->rtfr.status & BIT1)
    {
        if (device->drive_info.ata_Options.senseDataReportingEnabled)
        {
            printf("\t\tSense Data Available\n");
        }
        else
        {
            printf("\t\tUnknown Status bit 1\n");
        }
    }
    //Bit 0 is error...or for ATAPI it will be check condition Packet commands only
    if (ataCommandOptions->rtfr.status & ATA_STATUS_BIT_ERROR)//assuming not ATAPI
    {
        printf("\t\tError\n");
    }
    
    printf("\n");
}

uint8_t calculate_ATA_Checksum(uint8_t *ptrData)
{
    uint8_t checksum = 0;
    uint32_t counter = 0;
    if (!ptrData)
    {
        return BAD_PARAMETER;
    }  
    for (counter = 0; counter < 511; ++counter)
    {
        checksum = checksum + ptrData[counter];
    }
    return checksum; // (~checksum + 1);//return this? or just the checksum?
}

bool is_Checksum_Valid(uint8_t *ptrData, uint32_t dataSize, uint32_t *firstInvalidSector)
{
    bool isValid = false;
    if (!ptrData || !firstInvalidSector)
    {
        return false;
    }
    uint8_t checksumCalc = 0;
    for (uint32_t blockIter = 0; blockIter < (dataSize / LEGACY_DRIVE_SEC_SIZE); ++blockIter)
    {
        for (uint32_t counter = 0; counter <= 511; ++counter)
        {
            checksumCalc = checksumCalc + ptrData[counter + (blockIter * 512)];
        }
        if (checksumCalc == 0)
        {
            isValid = true;
        }
        else
        {
            *firstInvalidSector = blockIter;
            isValid = false;
            break;
        }
    }
    return isValid;
}

int set_ATA_Checksum_Into_Data_Buffer(uint8_t *ptrData, uint32_t dataSize)
{
    int ret = SUCCESS;
    if (!ptrData)
    {
        return BAD_PARAMETER;
    }
    uint8_t checksum = 0;
    for (uint32_t blockIter = 0; blockIter < (dataSize / LEGACY_DRIVE_SEC_SIZE); ++blockIter)
    {
        checksum = calculate_ATA_Checksum(&ptrData[blockIter]);
        ptrData[blockIter + 511] = (~checksum + 1);
    }
    return ret;
}

bool is_LBA_Mode_Supported(tDevice *device)
{
    bool lbaSupported = true;
    if (!(device->drive_info.IdentifyData.ata.Word049 & BIT9))
    {
        lbaSupported = false;
    }
    return lbaSupported;
}

bool is_CHS_Mode_Supported(tDevice *device)
{
    bool chsSupported = true;
    //Check words 1, 3, 6
    if (device->drive_info.IdentifyData.ata.Word001 == 0 ||
        device->drive_info.IdentifyData.ata.Word003 == 0 ||
        device->drive_info.IdentifyData.ata.Word006 == 0 )
    {
        chsSupported = false;
    }

    return chsSupported;
}

static bool is_Current_CHS_Info_Valid(tDevice *device)
{
    bool chsSupported = true;
    uint8_t* identifyPtr = (uint8_t*)&device->drive_info.IdentifyData.ata.Word000;
    uint32_t userAddressableCapacityCHS = M_BytesTo4ByteValue(identifyPtr[117], identifyPtr[116], identifyPtr[115], identifyPtr[114]);
    //Check words 1, 3, 6, 54, 55, 56, 58:57 for values
    if (!(device->drive_info.IdentifyData.ata.Word053 & BIT0) || //if this bit is set, then the current fields are valid. If not, they may or may not be valid
        device->drive_info.IdentifyData.ata.Word001 == 0 ||
        device->drive_info.IdentifyData.ata.Word003 == 0 ||
        device->drive_info.IdentifyData.ata.Word006 == 0 ||
        device->drive_info.IdentifyData.ata.Word054 == 0 ||
        device->drive_info.IdentifyData.ata.Word055 == 0 ||
        device->drive_info.IdentifyData.ata.Word056 == 0 ||
        userAddressableCapacityCHS == 0)
    {
        chsSupported = false;
    }

    return chsSupported;
}

//Code to test LBA to CHS conversion Below
//FILE * chsTest = fopen("chsToLBATest.txt", "w");
//if (chsTest)
//{
//    fprintf(chsTest, "%5s | %2s | %2s - LBA\n", "C", "H", "S");
//    uint32_t cyl = 0;
//    uint16_t head = 0, sector = 0;
//    for (cyl = 0; cyl < deviceList[deviceIter].drive_info.IdentifyData.ata.Word054; ++cyl)
//    {
//        for (head = 0; head < deviceList[deviceIter].drive_info.IdentifyData.ata.Word055; ++head)
//        {
//            for (sector = 1; sector <= deviceList[deviceIter].drive_info.IdentifyData.ata.Word056; ++sector)
//            {
//                uint32_t lba = 0;
//                convert_CHS_To_LBA(&deviceList[deviceIter], cyl, head, sector, &lba);
//                fprintf(chsTest, "%5" PRIu32 " | %2" PRIu16 " | %2" PRIu16 " - %" PRIu32 "\n", cyl, head, sector, lba);
//            }
//        }
//    }
//    fflush(chsTest);
//    fclose(chsTest);
//}
//
//FILE *lbaToCHSTest = fopen("lbaToCHSTest.txt", "w");
//if (lbaToCHSTest)
//{
//    fprintf(lbaToCHSTest, "%8s - %5s | %2s | %2s\n", "LBA", "C", "H", "S");
//    for (uint32_t lba = 0; lba < 12706470; ++lba)
//    {
//        uint16_t cylinder = 0;
//        uint8_t head = 0;
//        uint8_t sector = 0;
//        convert_LBA_To_CHS(&deviceList[deviceIter], lba, &cylinder, &head, &sector);
//        fprintf(lbaToCHSTest, "%8" PRIu32 " - %5" PRIu16 " | %2" PRIu8 " | %2" PRIu8 "\n", lba, cylinder, head, sector);
//    }
//    fflush(lbaToCHSTest);
//    fclose(lbaToCHSTest);
//}

//device parameter needed so we can see the current CHS configuration and translate properly...
int convert_CHS_To_LBA(tDevice *device, uint16_t cylinder, uint8_t head, uint16_t sector, uint32_t *lba)
{
    int ret = SUCCESS;
    if (lba)
    {
        if (is_CHS_Mode_Supported(device))
        {
            uint16_t headsPerCylinder = device->drive_info.IdentifyData.ata.Word055;//from current ID configuration
            uint16_t sectorsPerTrack = device->drive_info.IdentifyData.ata.Word056;//from current ID configuration
            *lba = UINT32_MAX;
            *lba = ((((C_CAST(uint32_t, cylinder)) * C_CAST(uint32_t, headsPerCylinder)) + C_CAST(uint32_t, head)) * C_CAST(uint32_t, sectorsPerTrack)) + C_CAST(uint32_t, sector) - UINT32_C(1);
        }
        else
        {
            ret = NOT_SUPPORTED;
        }
    }
    else
    {
        ret = BAD_PARAMETER;
    }
    return ret;
}

int convert_LBA_To_CHS(tDevice *device, uint32_t lba, uint16_t *cylinder, uint8_t *head, uint8_t *sector)
{
    int ret = SUCCESS;
    lba &= MAX_28_BIT_LBA;
    if (cylinder && head &&sector)
    {
        uint8_t* identifyPtr = (uint8_t*)&device->drive_info.IdentifyData.ata.Word000;
        //uint32_t lbaCapacity = M_BytesTo4ByteValue(identifyPtr[123], identifyPtr[122], identifyPtr[121], identifyPtr[120]);//28bit LBA value
        uint32_t userAddressableCapacityCHS = M_BytesTo4ByteValue(identifyPtr[117], identifyPtr[116], identifyPtr[115], identifyPtr[114]);//CHS max sector capacity
        //if (lba < lbaCapacity)
        //{
            if (is_CHS_Mode_Supported(device))
            {
                if (is_Current_CHS_Info_Valid(device))
                {
                    uint32_t headsPerCylinder = device->drive_info.IdentifyData.ata.Word055;
                    uint32_t sectorsPerTrack = device->drive_info.IdentifyData.ata.Word056;
                    *cylinder = C_CAST(uint16_t, lba / C_CAST(uint32_t, headsPerCylinder * sectorsPerTrack));
                    *head = C_CAST(uint8_t, (lba / sectorsPerTrack) % headsPerCylinder);
                    *sector = C_CAST(uint8_t, (lba % sectorsPerTrack) + UINT8_C(1));
                    //check that this isn't above the value of words 58:57
                    uint32_t currentSector = C_CAST(uint32_t, (*cylinder)) * C_CAST(uint32_t, (*head)) * C_CAST(uint32_t, (*sector));
                    if (currentSector > userAddressableCapacityCHS)
                    {
                        //change the return value, but leave the calculated values as they are
                        ret = NOT_SUPPORTED;
                    }
                }
                else
                {
                    uint32_t headsPerCylinder = device->drive_info.IdentifyData.ata.Word003;
                    uint32_t sectorsPerTrack = device->drive_info.IdentifyData.ata.Word006;
                    *cylinder = C_CAST(uint16_t, lba / C_CAST(uint32_t, headsPerCylinder * sectorsPerTrack));
                    *head = C_CAST(uint8_t, (lba / sectorsPerTrack) % headsPerCylinder);
                    *sector = C_CAST(uint8_t, (lba % sectorsPerTrack) + UINT8_C(1));
                    userAddressableCapacityCHS = C_CAST(uint32_t, device->drive_info.IdentifyData.ata.Word001) * C_CAST(uint32_t, device->drive_info.IdentifyData.ata.Word003) * C_CAST(uint32_t, device->drive_info.IdentifyData.ata.Word006);
                    //check that this isn't above the value of words 58:57
                    uint32_t currentSector = C_CAST(uint32_t, (*cylinder)) * C_CAST(uint32_t, (*head)) * C_CAST(uint32_t, (*sector));
                    if (currentSector > userAddressableCapacityCHS)
                    {
                        //change the return value, but leave the calculated values as they are
                        ret = NOT_SUPPORTED;
                    }
                }
            }
            else
            {
                ret = NOT_SUPPORTED;
            }
        //}
        //else
        //{
        //    ret = NOT_SUPPORTED;
        //}
    }
    else
    {
        ret = BAD_PARAMETER;
    }
    return ret;
}
