atapiio.cpp

EP9315开发板的Wince6.0的BSP包文件

            if (bStatus & ATA_STATUS_DATA_REQ){ 
                DEBUGMSG(ZONE_IO, (TEXT("ATAPI: ATA_STATUS_DATA_REQ J=: %x \r\n"),j));
                return TRUE;
            }
            StallExecution(DEFAULT_WAIT_STALL_TIME);            
        }
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:WaitForDRQ Status=%02X Error=%02X Reason=%02X\r\n"), GetAltStatus(), GetError(), GetReason()));
    } 
    //RetailPrint1("ATAPIPCI: ATA_STATUS_DATA_REQ (Sleep)i= %x \r\n",i);
    return(bStatus == ATA_STATUS_DATA_REQ); 
    
}


/*------------------------------------------------------------------------------------------*/
//                        
//                                          
//  Returns:    An interrupt reason for success; ATA_INTR_ERROR otherwise
//
//          - ATA_INTR_CMD  if Device ready to accept command packed
//          - ATA_INTR_READ if Device ready to transfer Data to Host
//          - ATA_INTR_WRITE if Device ready to read Data from Host 
//          - ATA_INTR_MSG   if Device ready to send message to Host
//          - ATA_INTR_READY if Device completed command processing
//      
//
//  ATAPI Interrupt Reason & Status Reg. Results
//
//                                 DRQ-IO-CoD
//#define ATA_INTR_CMD      5   //   1- 0 - 1 (5) ATA Device acknowledge command
//#define ATA_INTR_MSG      7   //   1- 1 - 1 (7) ATA Device ready to send MSG (Future) to host
//#define ATA_INTR_READ     6   //   1- 1 - 0 (6) ATA Device ready to transfer data to host
//#define ATA_INTR_WRITE    4   //   1- 0 - 0 (4) ATA Device ready to receive data from host
//#define ATA_INTR_READY    3   //   0- 1 - 1 (3) ATA Device Processing Completed
//#define ATA_INTR_ERROR    0   //   Return value in case of Device error
//#define ATA_INTR_DMA  8       //   DMA Interrupt

WORD CDisk::CheckIntrState()
{
    BYTE    bReason, bDRQ;

    WaitOnBusy(FALSE);   

    bReason = GetReason() & (ATA_IR_CoD | ATA_IR_IO);

    bDRQ = GetAltStatus() & ATA_STATUS_DATA_REQ;


    if (bDRQ)
        bReason |=4;

    if (bReason < 3)
        return((WORD) ATA_INTR_READY);

    return ((WORD) bReason);
}

/*------------------------------------------------------------------------------------------*/
 //
//  The smalest transfer unit between Ata device and host is one WORD. 
//  We have to save the last read but unused byte for the following 
//  transaction.

void  CDisk::ReadBuffer(PBYTE pBuffer,DWORD dwCount)
{
    //
    //  This is very unefficient way to solve word allignment violation.

    union {
        WORD us;
        BYTE  uc[2];
    }unisc;


    if (dwCount == 0)
        return;
        
    DEBUGMSG( ZONE_IO, (TEXT("ATAPI:ReadBuffer Entry Status: %x\r\n"),GetAltStatus()));

    // Check whether required byte was already read in previous transaction!
    // Value -1 in m_wNextByte means - no byte was read.

    if (m_wNextByte != 0xFFFF) {
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - Unaligned buffer on prevous read!!!\r\n")));
        // Update the first byte.
        *pBuffer++ = (BYTE) m_wNextByte;
        dwCount--; 
    }
    //
    // Check allignemt of pBuffer
    //
    if ((DWORD) pBuffer & 1) {
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - Unaligned buffer !!!\r\n")));
        while (dwCount> 1) 
        {
            unisc.us = ReadWord();
            *pBuffer++= unisc.uc[0];
            *pBuffer++= unisc.uc[1];
            dwCount-=2;
        }
    } else {
        ReadWordBuffer((PWORD)pBuffer,(DWORD)(dwCount)/sizeof(SHORT));
        pBuffer += dwCount;
        dwCount &= 1;       // If 1, we need to read the next byte yet
        pBuffer -= dwCount; // Adjust pBuffer if its value is odd
    }
    //
    //  Also we have to read one Word event if need only one byte.
    //  Save unused byte and use it as the first byte in the following SG buffer.
        
    if (dwCount == 1) {
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - reading one word!!!\r\n")));
        unisc.us = ReadWord();
        *pBuffer=   unisc.uc[0];
        m_wNextByte = (WORD)unisc.uc[1];    // Save byte for the next SG if 
    }
    else 
    {
       m_wNextByte=0xFFFF; 
    }

    DEBUGMSG( ZONE_IO, (TEXT("ATAPI:ReadBuffer Exit Status: %x\r\n"),GetAltStatus()));
}

/*------------------------------------------------------------------------------------------*/
//
//  The smalest transfer unit between Ata device and the host is one WORD. 
//  We have to save the last read but unused byte for the following 
//  transaction.

void  CDisk::WriteBuffer(PBYTE pBuffer, DWORD dwCount)
{
    //
    //  This is very inefficient way to solve word allignment violation.
    union {
        WORD us;
        BYTE  uc[2];
    }unisc;
    
    if (dwCount == 0)
        return;
        
    DEBUGMSG( ZONE_IO, (TEXT("ATAPI:WriteBuffer Entry Status: %x\r\n"),GetAltStatus()));

    // Check whether one byte left from the  previous transaction!
    // Value -1 in m_wNextByte means - no byteleft.

    if (m_wNextByte != 0xFFFF) {
        // Update the first byte
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - Unaligned buffer on prevous read!!!\r\n")));
        unisc.uc[0] = (BYTE) m_wNextByte;
        unisc.uc[1] = *pBuffer++;
        dwCount--; 
        WriteWord(unisc.us);

		//Fix for CETK Storage_API Test #4009 failed in PIO mode.
        m_wNextByte = 0xFFFF;
    }
    //
    // Check allignemt of pBuffer
    //
    if ((DWORD) pBuffer & 1) {
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - Unaligned buffer !!!\r\n")));
        while (dwCount> 1)  {
            unisc.uc[0] = *pBuffer++;
            unisc.uc[1] = *pBuffer++;
            WriteWord(unisc.us);
            dwCount-=2;
        }
    } else {
        WriteWordBuffer((PWORD)pBuffer,(DWORD)(dwCount)/sizeof(SHORT));
        pBuffer += dwCount;
        dwCount &= 1;       // If 1, we need to write the next byte yet
        pBuffer -= dwCount; // Adjust pBuffer if its value is odd

    }
    //
    //  Also we have to transfer one Word event if need only one byte.
    //  Save unused byte and use it as the first byte in the following SG buffer.
        
    if (dwCount == 1) {
        DEBUGMSG( ZONE_WARNING, (TEXT("ATAPI:ReadBuffer - reading one word!!!\r\n")));
        m_wNextByte = (WORD) *pBuffer;  // Save byte for the next SG if 
    }
    
    DEBUGMSG( ZONE_IO, (TEXT("ATAPI:WriteBuffer Exit Status: %x\r\n"),GetAltStatus()));
}


/*------------------------------------------------------------------------------------------*/
#define IDE_COMMAND_SET_FEATURE                 0xEF

BOOL CDisk::SetTransferMode(BYTE bMode)
 {
    BYTE bError, bStatus;

    //* * * CAMSDB040504 - Try forceing the IDE/ATA mode to
    //* * * a UDMA mode. (START)
    //bMode = 0x41;
    //DEBUGMSG( 1, (TEXT("ATAPI:SetTransferMode(...) FORCING mode to Mode=%02X\r\n"), bMode));
    //* * * CAMSDB040504 - Try forceing the IDE/ATA mode to
    //* * * a UDMA mode. (START)
 
    SelectDevice();

    WaitForDisc(WAIT_TYPE_NOT_BUSY, 1000);
    WaitForDisc(WAIT_TYPE_READY, 10000);
    WaitOnBusy(TRUE);
    
    SelectDevice();

    WriteFeature(ATA_SET_TRANSFER_MODE);
    WriteSectorCount( bMode);
    WriteSectorNumber(0);
    WriteLowCount(0);
    WriteHighCount(0);
    WriteCommand( IDE_COMMAND_SET_FEATURE);

    SelectDevice();
    WaitOnBusy(TRUE);
    //
    //  Set Default PIO mode 
    //
    SelectDevice();
    WaitForDisc(WAIT_TYPE_NOT_BUSY, 2000);

    bStatus = GetBaseStatus();
    bError = GetError();
    DEBUGMSG( 1, (TEXT("ATAPI:SetTransferMode Mode=%02X Status=%02X Error=%02X\r\n"), bMode, bStatus, bError));
    if ((bStatus & 0x1) && (bError & 0x4)) {
        ResetController(FALSE);
        return FALSE;
    }

    //* * * CAMSDB04/05/04 - Re-print capabilities after forced mode above (START)
    //DEBUGMSG( 1, (TEXT("* * * ATAPI:Doing AnalyzeDeviceCapabilities() again START.\r\n")));
    //AnalyzeDeviceCapabilities();
    //DEBUGMSG( 1, (TEXT("* * * ATAPI:Doing AnalyzeDeviceCapabilities() again END.\r\n")));
    //* * * CAMSDB04/05/04 - Re-print capabilities after forced mode above (END)

    return TRUE;
}