//IDE外設低層代碼
   //*************************************************************************
   //
   //                  P H I L I P S   P R O P R I E T A R Y
   //
   //           COPYRIGHT (c)   1999 BY PHILIPS SINGAPORE.
   //                     --  ALL RIGHTS RESERVED  --
   //
   // File Name:	    Hal4sys.C
   // Author:           Hilbert Zhang ZhenYu
   // Created:          Nov. 19, 99
   // Modified:
   // Revision: 		0.0.
   //
   //*************************************************************************
   //
   //*************************************************************************

#include  "config.h"                /* special function register declarations   */
#undef   GLOBAL_EXT
#include "SysCnfg.h"
#include "BasicTyp.H"
#include "Hal4Sys.h"


void bus_delay(void)
{
	unsigned char i,j;
	for(j=0;j<=1;j++)
	{
		i = D12_NOP;
//		D12_NOP = i;
	}
}
void Hal4Sys_Wait4US(void)
{	uint32 i;
    for(i=0;i<5;i++);
}


void Hal4Sys_WaitInUS(uint32 time)
{
   	uint32 i;
   for(i=0;i<time;i++);
}


void Hal4Sys_WaitInMS(uint32 time)				
{	
	uint32 i;
   for(i=0;i<time;i++);
}

/*  PIO mode for D12 access */

void Hal4Sys_D12CmdPortOutB( uint8 val)				//D12寫命令
{
	bus_delay();
	D12_command = val;
	
	
	//*((uint8  *)D12_command) = val;
}


void Hal4Sys_D12DataPortOutB( INT8 val)				//D12寫數據
{
	bus_delay();
	D12_data = val;
	//*((INT8 xdata *)D12_data) = val;
}


unsigned char Hal4Sys_D12DataPortInB( void)			//D12讀
{
	//return *((INT8 xdata *)D12_data);
	bus_delay();
	return D12_data;
}







/* EasyARM2200 */
/****************************************************************************
* 名稱：IDE_Read(unsigned int reg)(EasyARM2200)
* 功能：通過EasyARM2104 GPIO 讀取硬盤數據(一個16位的字)。 
* 入口參數：reg 寄存器名稱
* 出口參數：讀出的數據
****************************************************************************/
uint16 IDE_Read(uint32 reg)
{
	uint16 res ;
      
    IO2DIR = IO2DIR & MASK_P2;					// 定義輸出口其它為輸入(ATA_DATA為輸入)
    IO0SET |= IDE_WR +IDE_RD;										
    IO1SET = OUT_PUT_P1;						// 控所硬盤引腳信號輸出(輸出高電平) 
    IO1CLR = (~reg) & OUT_PUT_P1;				// 控所硬盤引腳信號輸出(輸出低電平)
    IO0CLR = IDE_RD;							// 讀信號腳置低
    res = (uint16)(IO2PIN >>16);	 				// 讀取數據
	IO0SET = IDE_RD;
    IO1SET = OUT_PUT_P1;						// 輸出控制信號置高  
    return res;
}

/* EasyARM2200 */
/****************************************************************************
* 名稱：IDE_Write(unsigned int reg, short data)
* 功能：通過EasyARM2104 GPIO 寫入硬盤數據(一個16位的字)。 
* 入口參數：reg 寄存器名稱
			data 寫入的數據
* 出口參數：無
****************************************************************************/
void IDE_Write(uint32 reg, uint16 data)
{	
	
	IO2DIR = IO2DIR | ATA_DATA;				// 定義輸出口(ATA_DATA為輸出),其它口不變
	IO1SET = OUT_PUT_P1;					// 控制硬盤引腳信號輸出(輸出高電平) 
 	IO0SET |= IDE_WR +IDE_RD;	
    IO1CLR = (~reg) & OUT_PUT_P1 ;			// 控制硬盤引腳信號輸出(輸出低電平)
    IO2CLR = (~data)<<16;
    IO0CLR = IDE_WR;						// 寫信號腳置低
    IO0SET = IDE_WR;						// 寫信號腳置高[與低>162ns]
    IO1SET = OUT_PUT_P1;					// 輸出控制信號置高
	IO2SET = ATA_DATA;
    IO2DIR &= MASK_P2;						// 使數據線為輸入,降低功耗  
}



void Hal4Sys_ATAPortOutB(uint32 Addr, uint8 Data)		//ATA寫一字節
{
	IDE_Write( Addr,  Data);
}


uint8 Hal4Sys_ATAPortInB(uint32 Addr)				     //ATA讀字節
{
	return (uint8)IDE_Read( Addr );
}


uint16 Hal4Sys_ATADataPortInW(void)				//ATA讀字16位
{
	return  IDE_Read( IDE_DATA );;
}


//Amend by Liu Ying Bin
INT16 Hal4Sys_SwapINT16(INT16 wData)
{
    return ( (wData<<8)|(wData>>8) );
}


uint32 Hal4Sys_SwapINT32(uint32 dData)
{
    dData = (dData&0xff)<<24|(dData&0xff00)<<8|(dData&0xff000000)>>24|(dData&0xff0000)>>8;
	return dData;
}


void Hal4Sys_ResetD12(void)								//D12復位
{
	uint32 i;
	//復位D12	
	IOCLR = USBRST;
	for(i=0;i<0x00000fff;i++);
	IOSET = USBRST;
	for(i=0;i<0x0003fff;i++);
}


void Hal4Sys_InitD12(void)
{
    Hal4Sys_ResetD12();
//    D12INT_EDGE = 0;        // Level trigle for D12INT_N
  //  D12INT_PRIORITY = 0;    // 0 Priority Level of D12INT_N
    //D12INT_ENABLE = 1;      // Enalbe External IRQ0 for D12INT_N
}