cmmd_atapi.c

STi5518机顶盒ATAPI源代码！绝对超值！

        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);    
        
        /* Command packet transfer....                          
           check status must have BSY=0 DRQ-1
        */      
    
        if((Status & (BSY_BIT_MASK | DRQ_BIT_MASK))!= DRQ_BIT_MASK)
        {
            Ata_p->LastExtendedErrorCode= 0x52;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }

        /* Transfer the packet in PIO mode */
        for(i = 0; i < Ata_p->Handles[Ata_p->DeviceSelected].PktSize; i++) 
        {
            hal_RegOutWord(Ata_p->HalHndl, ((U16 *)Cmd_p->Pkt)[i]);
        }

        WAIT400NS;  
    
        /* --------------- Transfer Loop--------------- */
        *Cmd_p->BytesRW=0;
        Data_p =(U16*) Cmd_p->DataBuffer;   
    
        if(WaitForBitPkt(Ata_p->HalHndl,ATA_REG_ALTSTAT,BSY_BIT_MASK,0))
        {
            Ata_p->LastExtendedErrorCode= 0x54;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error= TRUE;
            break;
        }

        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT); 
        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);    
        
        if( (Status & (BSY_BIT_MASK | DRQ_BIT_MASK)) == 0)
        {
            /* end of transfer lets quit*/
            Ata_p->LastExtendedErrorCode= 0x00;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=FALSE;
            break;
        }
        
        if( (Status & (BSY_BIT_MASK | DRQ_BIT_MASK)) != DRQ_BIT_MASK)
        {
            Ata_p->LastExtendedErrorCode= 0x55;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        if( (Reason & (TAG_BIT_MASK | REL_BIT_MASK))
            || (Reason &  CD_BIT_MASK))
        {
            
            Ata_p->LastExtendedErrorCode= 0x5C;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        if( (Reason & IO_BIT_MASK )==0)
        {
            /* Wrong direction, we expect a IO = 1 */ 
            Ata_p->LastExtendedErrorCode= 0x5D;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        /* Data Transfer Loop....
           get the byte count and check for zero
        */
        ByteCount= (HighCyl<<8) | LowCyl;
        if(ByteCount<1)
        {
            Ata_p->LastExtendedErrorCode= 0x60;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        
        /* Data Transfer Loop....
           Check for buffer overrun
        */
        if((*Cmd_p->BytesRW)+ByteCount > Cmd_p->BufferSize )
        {
            Ata_p->LastExtendedErrorCode= 0x59;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }     
        WordCount = ( ByteCount >> 1 ) + ( ByteCount & 0x0001 );
        
        /* Data Transfer ....                      */
        
        *Cmd_p->BytesRW+= (WordCount << 1);
        
        /* Data Transfer .... */
        Error = hal_DmaDataBlock(Ata_p->HalHndl,
                                 Cmd_p->DevCtrl, Cmd_p->DevHead,
                                 Data_p, WordCount,
                                 Cmd_p->BufferSize, Cmd_p->BytesRW,
                                 TRUE, &CrcError);
        if (Error == FALSE)
            Data_p += WordCount;
        
        /* On CRC errors, we do a retry (up to max), not abort */
        if (CrcError == TRUE)
            Error = FALSE;
                
        WAIT400NS;
    } 
    /* End of transfer loop */
    
    if(Error == FALSE)
    {
        
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT); 
        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);   
        
        /* Final Status check */            
        if( Status  & (BSY_BIT_MASK | DRQ_BIT_MASK | ERR_BIT_MASK))
        {
            Ata_p->LastExtendedErrorCode= 0x58;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }
        Ata_p->LastExtendedErrorCode= 0x00;    
        
    }
    
    /*read the output registers and store them in the pkt status structure*/
    GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
    return Error;    
}   

/************************************************************************
Name: ata_packet_DmaOut

Description: executes a command with data transfer from the host 
             to the device via DMA.
             The device is already selected, no parameters check
             is performed. 
              
Parameters: Two params:
            Ata_p : Pointer to the ATA control block
            Cmd_p : Pointer to a command structure
Return:     TRUE:  Extended error is set
            FALSE: No error         
            
************************************************************************/
BOOL ata_packet_DmaOut(ata_ControlBlock_t *Ata_p, ata_Cmd_t *Cmd_p)
{
    DU8 Status,Reason,LowCyl,HighCyl;
    U32 TimeOut,i;
    BOOL Error=FALSE, CrcError = FALSE;
    U32 WordCount,ByteCount;    
    U16 *Data_p;
    U8 Retries = 4;
    
    while ((Error==FALSE) && (Retries > 0))
    { 
        /* First we write the registers */     
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_FEATURE, Cmd_p->Feature);
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_SECCOUNT, Cmd_p->SecCount);
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_SECNUM, Cmd_p->SecNum);
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_CYLLOW, Cmd_p->CylLow);
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_CYLHIGH, Cmd_p->CylHigh);
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_DEVHEAD, Cmd_p->DevHead);
    
        if(WaitForBitPkt(Ata_p->HalHndl,ATA_REG_ALTSTAT,DRDY_BIT_MASK,DRDY_BIT_MASK))
        {
            Ata_p->LastExtendedErrorCode= 0x5B;  
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);           
            return TRUE;
        }

        /* Finally write the command */
        hal_RegOutByte(Ata_p->HalHndl,ATA_REG_COMMAND, Cmd_p->CommandCode);
    
        WAIT400NS;
    
        /* Now Check the Status */
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_ALTSTAT);
    
        /* Command packet transfer...*/
        /* Check for protocol failures, the device should 
           have BSY=1 now, but a number of strange things can happen:
           1) the device may not set BSY=1 or DRQ=1 for a while
           2) the device may go directly to DRQ status,
           3) the device may reject the command (maybe is not really
              an  ATAPI device or has some error)
        */
        TimeOut= PACKET_TIMEOUT;
    
        while(TRUE)
        {
            if(Status & BSY_BIT_MASK)
            {
                break; /* BSY=1 that's OK! */
            }
            else
            {
                if( Status & DRQ_BIT_MASK )  
                {
                    break;  /* BSY=0 & DRQ=1 That's OK */
                }
                if( Status & ERR_BIT_MASK)
                {
                    /* Error,that's not OK */
                    break;
                } 
            }
            if(TimeOut==0)
            {
                /* Error */
                break;
            }
        
            TimeOut--;
            Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_ALTSTAT);
        }
    
        /* Command packet transfer....                          */
        /* Poll Alternate Status for BSY=0                      */
        if(WaitForBitPkt(Ata_p->HalHndl,ATA_REG_ALTSTAT,BSY_BIT_MASK,0))
        {
            Ata_p->LastExtendedErrorCode= 0x51;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }
    
        /* Command packet transfer....                          */
        /* Check for protocol failures.. clear interrupts       */         
        hal_ClearInterrupt(Ata_p->HalHndl);
      
        /* Command packet transfer....                          
           Read the primary status register abd other ATAPI registers            
        */      
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT); 
        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);    
    
         /* Command packet transfer....                          
            check status must have BSY=0 DRQ-1
         */      
        if((Status & (BSY_BIT_MASK | DRQ_BIT_MASK))!= DRQ_BIT_MASK)
        {
            Ata_p->LastExtendedErrorCode= 0x52;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }
    
        /* Transfer the packet - PIO mode */
        for(i=0;i<Ata_p->Handles[Ata_p->DeviceSelected].PktSize;i++) 
        {
            hal_RegOutWord(Ata_p->HalHndl,Cmd_p->Pkt[i]);  
        }
    
        WAIT400NS;  
    
        /* --------------- Transfer Loop--------------- */
        *Cmd_p->BytesRW=0;
        Data_p =(U16*) Cmd_p->DataBuffer;   
    
        if(WaitForBitPkt(Ata_p->HalHndl, ATA_REG_ALTSTAT, BSY_BIT_MASK, 0))
        {
            Ata_p->LastExtendedErrorCode= 0x54;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }
        
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT); 
        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);    
        
        if( (Status & (BSY_BIT_MASK | DRQ_BIT_MASK)) == 0)
        {
            /* end of transfer lets quit*/
            Ata_p->LastExtendedErrorCode= 0x00;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=FALSE;
            break;
        }
        
        if( (Status & (BSY_BIT_MASK | DRQ_BIT_MASK)) != DRQ_BIT_MASK)
        {
            Ata_p->LastExtendedErrorCode= 0x55;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        if( (Reason & (TAG_BIT_MASK | REL_BIT_MASK))
            || (Reason &  CD_BIT_MASK))
        {
            
            Ata_p->LastExtendedErrorCode= 0x5C;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        if( (Reason & IO_BIT_MASK )==0)
        {
            /* Wrong direction, we expect a IO = 1 */ 
            Ata_p->LastExtendedErrorCode= 0x5D;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        /* Data Transfer Loop....
           get the byte count and check for zero
        */
        ByteCount= (HighCyl<<8) | LowCyl;
        if(ByteCount<1)
        {
            Ata_p->LastExtendedErrorCode= 0x60;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }
        
        /* Data Transfer Loop....
           Check for buffer overrun
        */
        if((*Cmd_p->BytesRW)+ByteCount > Cmd_p->BufferSize )
        {
            Ata_p->LastExtendedErrorCode= 0x59;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            Error=TRUE;
            break;
        }     
        WordCount = ( ByteCount >> 1 ) + ( ByteCount & 0x0001 );
        
        /* Data Transfer .... */
        Error = hal_DmaDataBlock(Ata_p->HalHndl,
                                 Cmd_p->DevCtrl, Cmd_p->DevHead,
                                 Data_p, WordCount,
                                 Cmd_p->BufferSize, Cmd_p->BytesRW,
                                 TRUE, &CrcError);

        if (Error == FALSE)
        {
            *Cmd_p->BytesRW+= (WordCount << 1);       
            Data_p+=WordCount;
        }
        
        /* Retry on CRC error, not abort */
        if (CrcError == TRUE)
            Error = FALSE;

        WAIT400NS;
    } 
    
    if(Error == FALSE)
    {
        
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT); 
        LowCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLLOW);    
        HighCyl= hal_RegInByte(Ata_p->HalHndl,ATA_REG_CYLHIGH);   
        
        /* Final Status check */            
        
        if( Status  & (BSY_BIT_MASK | DRQ_BIT_MASK | ERR_BIT_MASK))
        {
            Ata_p->LastExtendedErrorCode= 0x58;
            GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
            return TRUE;
        }
        Ata_p->LastExtendedErrorCode= 0x00;
        
    }
    
    /*read the output registers and store them in the pkt status structure*/
    GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
    return Error;    
} 

/************************************************************************
Name: GetPktStatus

Description: Retrieves the command block registers and store them in the
             structure previosly allocated
              
Parameters: Two params:
            Ata_p : Pointer to the ATA control block
            Cmd_p : Pointer to a command status structure
            
       
************************************************************************/

void GetPktStatus(ata_ControlBlock_t *Ata_p,STATAPI_PktStatus_t *Stat_p)
{
      
    Stat_p->Status = hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);
    
    Stat_p->InterruptReason = hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT);    
    
    Stat_p->Error = hal_RegInByte(Ata_p->HalHndl,ATA_REG_ERROR);           
    
}
/*end of cmmd_ata.c --------------------------------------------------*/