#include "../CPLD.h"
#include "isp1161.h"


void Delay(unsigned long loops)
{
	unsigned long i;

	for (i = 0; i < loops; i++);
}

void main(void)
{
	unsigned short wChipID, wScratch;
	
	Set_PLL( (short)(CORECLK/CLKIN), (short)(CORECLK/SYSCLK));
	
	*pEBIU_AMBCTL0	= 0x7bb07bb0;
	*pEBIU_AMBCTL1	= 0x7bb07bb0;
	*pEBIU_AMGCTL	= 0x00ff;

	*pCtrlSetReg1 = 0x40; // ISP1161 exit Reset
	Delay(10000);

	*pISP1161_HC_CMD = READ_CHIP_ID;
	Delay(100);
	wChipID = *pISP1161_HC_DATA;

	*pISP1161_HC_CMD = WRITE_SCRATCH;
	Delay(100);
	*pISP1161_HC_DATA = 0x55AA;
	Delay(100);
	*pISP1161_HC_CMD = READ_SCRATCH;
	Delay(100);
	wScratch = *pISP1161_HC_DATA;

	if (wChipID == ISP1161_CHIP_ID && wScratch == 0x55AA)
	{
		printf("\nUSB Host ISP1161 has been probed!\n");
	}
	else
	{
		printf("\nUSB Host ISP1161 has not been probed!\n");
	}

	while (1);
}