#include "upio.h"

void InitSJAPio( void )
{
	// Enable PDC clock
	//*(AT91_REG*)(0xFFFF4050)=2; //0209 modified by arsene

	//enable PIO clock 0209
	//*(unsigned int*)(UPIO_BASE+UPIO_ECR) = 1;
	//*(unsigned int*)(UPIO_BASE+UPIO_CR) = 1;//reset
	//end 0209
	
	//set  RD, WR, RST, CS0, CS1 output 1
	UPIO_SetOutput(SJA_RD|SJA_WR|SJA_RST|SJA_CS0|SJA_CS1);
	//enable ALE, RD, WR, RST, CS0, CS1 & AD as output
	UPIO_CfgOutput(SJA_ALE|SJA_RD|SJA_WR|SJA_RST|SJA_CS0|SJA_CS1|UPIOEN0_7OUT);
}

void UPIO_SetData(unsigned char Data)
{
	UPIO_ClearOutput(UPIOEN0_7OUT);
	UPIO_SetOutput( Data);
	UPIO_CfgOutput(UPIOEN0_7OUT);
}

void UPIO_GetData(unsigned char *Data)
{
/*
	UPIO_Cfginput(((~UPIO_OutputStatus()) & 0xffffff00) | UPIOEN0_7OUT);
	*Data = UPIO_OutputDataStatus() & 0xff;
	UPIO_CfgOutput((UPIO_OutputStatus()& 0xffffff00) | UPIOEN0_7OUT);
	*/
	UPIO_Cfginput(UPIOEN0_7OUT);
	*Data = UPIO_OutputDataStatus() & 0xff;
//	UPIO_CfgOutput(UPIOEN0_7OUT);

}