/***********************************************************************************
* File              : ide_base.C
* Processor    : ADSP-BF533  
* IDDE          : VisualDSP++3.5
* Description  : define bunch of IDE driver functions including:
*                  
*                    Wait_Ready();
*                    Wait_ReadyBusy();
*                    Wait_DRQ();
*                    CheckforError();
*                    IdeStandby();
*                    IdeIdle();
*                    
***********************************************************************************/
#include "IDE/ide_base.h"
#include "type.h"


extern void Delay(unsigned int Value);

extern void IdeStandby(void);
extern void IdeIdle(void);
extern unsigned char IdeReadSector(unsigned char SectorNum,unsigned short CylinderNum,unsigned char DriverHead);
extern unsigned char IdeWriteSector(unsigned char SectorNum,unsigned short CylinderNum,unsigned char DriverHead);

/**********************************************************************************
* Function     : Wait_Ready 
* Description : Wait HD getting ready
* Input         : None
* Return       : 0-ready /error ID-HD error
***********************************************************************************/
BYTE  Wait_Ready(void)
{
   BYTE statbyte;
   BYTE flag = 0;
   
   while (!flag)
   {
 	  statbyte = *pStatus; 	     					// Read Status Register
 	  if (statbyte & IDE_ERROR)
 	  {
 	  	statbyte=*pErrorReg;						//Check HD error
 	  	return  statbyte;							//read error register if error and retrun error ID
 	  }
	  if (statbyte & IDE_DRDY) 
	  	flag = 1;     								//check ready or not, set flag
   }
   return 0;										
}
/**********************************************************************************
* Funciton     : Wait_ReadyBusy 
* Description : query HD busy or not.
* Input         : none
* Return       : 0-busy /error ID-HD error
***********************************************************************************/
BYTE Wait_ReadyBusy(void)
{
   BYTE statbyte;
   BYTE flag = 0;
   
   while (!flag)
   {
 	  statbyte = *pStatus; 	     // Read Status Register
 	  if (statbyte & IDE_ERROR)
 	  {
 	  	statbyte=*pErrorReg;
 	  	return  statbyte;
 	  }
	  if (((statbyte & IDE_DRDY)!=0 )&&((statbyte & IDE_BUSY)==0)) 
	  	flag = 1;     // Ready bit is in pos 6
   }
   return 0;
}

/**********************************************************************************
* Funciton     : Wait_DRQ
* Description : query HD data transfer ready or not
* Input         : none
* Return       : 0-ready /error ID-HD error
***********************************************************************************/
BYTE Wait_DRQ(void)
{
   BYTE statbyte;
   BYTE flag = 0;
   
   while (!flag)
   {
 	  statbyte = *pStatus; 	     // Read Status Register
 	  if (statbyte & IDE_ERROR)
 	  {
 	  	statbyte=*pErrorReg;
 	  	return  statbyte;
 	  }
	  if (statbyte & IDE_DRQ) 
	  	flag = 1;     // Ready bit is in pos 6
   }
   return 0x00;
}
/**********************************************************************************
* Funciton     : CheckforError
* Description : check HD error 
* Input         : none
* Return       : 0-no errors /error ID -yes
***********************************************************************************/
BYTE CheckforError(void)
{
 	  BYTE statbyte;
	  statbyte = *pStatus;	// Read Status Register
  	  if (statbyte & 0x01) 
  	  {
  	  	statbyte= *pErrorReg;
  	  	return statbyte; // Is LSB (error bit) is set then return 1
  	  }
	  else 
	  	return 0x00;
}
/**********************************************************************************
* Funciton     : IdeStandby
* Description : Set HD into standby mode
* Input         : none
* Return       : none
***********************************************************************************/
void IdeStandby(void)
{
	*pCommand = 0xe0;
}
/**********************************************************************************
* Funciton     : IdeIdle
* Description : Set HD into idle mode
* Input         : none
* Return       : none
***********************************************************************************/
void IdeIdle(void)
{
	*pCommand = 0x95;
}