cmmd_atapi.c

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

       /* 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);

        hal_RegInBlock(Ata_p->HalHndl,Data_p,ByteCount,
                           Cmd_p->UseDMA);
        Data_p+=WordCount;

       
        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_PioOut

Description: executes a command with data transfer from the host 
             to the device via PIO.
             The device is already selected, no parameters check
             is performed. We totally trust on the caller 
              
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_PioOut(ata_ControlBlock_t *Ata_p, ata_Cmd_t *Cmd_p)
{
    DU8 Status,Reason,LowCyl,HighCyl;
    U32 TimeOut,i;
    BOOL Error=FALSE;
    U32 WordCount,ByteCount;    
    U16 *Data_p;     
   /* 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
     */   
       
     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;   

   while (Error==FALSE)     
   { 
     #if ATAPI_USING_INTERRUPTS
     if(hal_AwaitInt(Ata_p->HalHndl,PACKET_INT_TIMEOUT))
     {
          Ata_p->LastExtendedErrorCode= 0x53;
          GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
          return TRUE;
     }
   
    #else
     WAIT400NS;
     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;
     }
    #endif /* ATAPI_USING_INTERRUPTS */
   
     
       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 ....                      */
        hal_RegOutBlock(Ata_p->HalHndl,Data_p,ByteCount,
                           Cmd_p->UseDMA);
        *Cmd_p->BytesRW+= (WordCount << 1);
        Data_p+=WordCount;
      

        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: ata_packet_PioIn

Description: executes a command with data transfer from the device 
             to the host 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_DmaIn(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 and other ATAPI registers            
        */      
        Status= hal_RegInByte(Ata_p->HalHndl,ATA_REG_STATUS);    
        Reason= hal_RegInByte(Ata_p->HalHndl,ATA_REG_SECCOUNT);