cmmd_atapi.c

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

/************************************************************************

Source file name : cmmd_atapi.c

Description: Implementation of the ATA Command Interface intermediate module
            following the API Design Document v0.9.0 of the ATAPI driver.
             

COPYRIGHT (C) STMicroelectronics  2000

************************************************************************/

/*Includes-------------------------------------------------------------*/
#include <string.h>
#include "stlite.h"
#include "statapi.h"
#include "hal_atapi.h"
#include "ata.h"


/*Private Types--------------------------------------------------------*/

/*Private Constants----------------------------------------------------*/
/*Private Variables----------------------------------------------------*/

/*Private Macros-------------------------------------------------------*/
#define PACKET_TIMEOUT      0x00100000

#define TAG_BIT_MASK   0xF8
#define  REL_BIT_MASK  0x04
#define  IO_BIT_MASK   0x02 
#define  CD_BIT_MASK   0x01
#define  SERV_BIT_MASK   0x10
#define  PACKET_INT_TIMEOUT   500000

/*Private functions prototypes-----------------------------------------*/
static void GetPktStatus(ata_ControlBlock_t *Ata_p,STATAPI_PktStatus_t *Stat_p);
/*Functions------------------------------------------------------------*/
/************************************************************************
Name: ata_packet_NoData

Description: executes a non data packet. 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_NoData(ata_ControlBlock_t *Ata_p, ata_Cmd_t *Cmd_p)
{
    DU8 Status,Reason,LowCyl,HighCyl;
    U32 TimeOut,i;
    
    
     
   /* 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(WaitForBit(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(WaitForBit(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]);  
     }
     
        
   #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); 
    
    if( (Status & (BSY_BIT_MASK | DRQ_BIT_MASK |SERV_BIT_MASK| ERR_BIT_MASK))
        | (Reason & REL_BIT_MASK))
    {
       Ata_p->LastExtendedErrorCode= 0x55;
       GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
       return TRUE; 
    }
    
    
    GetPktStatus(Ata_p,Cmd_p->Stat.PktStat);
    Ata_p->LastExtendedErrorCode= 0x00;
    return FALSE;
}

/************************************************************************
Name: ata_packet_PioIn

Description: executes a command with data transfer from the device 
             to the host 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_PioIn(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 and 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,((U16 *)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);
        Error= TRUE;
        break;
     }
   
    #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);
        Error= TRUE;
        break;
     }
   #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;
       }