#include "def.h"
#include "utils.h"

#define	BAUD_RATE	115200

static void SwiHandler(void)
{
	puts("Swi Interrupt detected\n");
		while(1);
}

static void DataAbortHandler(void) 
{
	puts("Data Abort detected\n");
	while (1);
}

static void FetchAbortHandler(void)
{
	puts("Prefetch Abort detected\n");
	while (1);
}

static void UndefHandler() 
{
	puts("Halt on Undefined instruction\n");
	while (1);
}

#ifndef	INTERRUPT_SUPPORT
static void IrqHandler(void)
{
	puts("Halt on IRQ!\n");
	while(1);
}
#endif

static void FiqHandler(void)
{
	puts("Halt on FIQ!\n");
	while(1);
}

extern U32 SysRstVector;
extern U32 UdfInsVector;
extern U32 SwiSvcVector;
extern U32 InsAbtVector;
extern U32 DatAbtVector;
extern U32 ReservedVector;
extern U32 IrqSvcVector;
extern U32 FiqSvcVector;

static __inline void VectorInit(void)
{
	UdfInsVector = (U32)UndefHandler;
	SwiSvcVector = (U32)SwiHandler;
	InsAbtVector = (U32)FetchAbortHandler;
	DatAbtVector = (U32)DataAbortHandler;
#ifndef	INTERRUPT_SUPPORT
	IrqSvcVector = (U32)IrqHandler;
#endif
	FiqSvcVector = (U32)FiqHandler;
}

void LedDisp(void)
{
	LedSet(0x08);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x04);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x02);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x01);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x02);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x04);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x08);		//LED點亮/熄滅狀態設置
	Delay(150);
	LedSet(0x00);		//LED點亮/熄滅狀態設置
}

TIME_STRUC SysTime;
char *WeekDay[7] = {"MON", "TUES", "WED", "THURS","FRI", "SAT", "SUN"};

void Main(void)
{
	BoardInitStart();
	
	SystemClockInit();
	
	TimerInit(1000);
	
	MemCfgInit();
	
	PortInit();
	
	VectorInit();
	CacheDisable();
	CacheFlush();
	CacheEnable();
	
	BoardInitEnd();
		
	Beep(2000, 200);
	LedDisp();		//LED來回閃爍顯示
	
	SerialSwitch(0);
	
	SerialChgBaud(BAUD_RATE);
	
	printf("Serial baud : %d\n", BAUD_RATE);
	printf("CPU clock is %dHz, Master clock is %dHz\n", GetCpuClock(), GetMasterClock());
	RtcGetTime(&SysTime);
	printf("Current date is %x-%x-%x [%s]\n", SysTime.year, SysTime.month, SysTime.day, WeekDay[(SysTime.weekday-1U)%7U]);
	printf("Current time is %2x:%2x:%2x\n", SysTime.hour, SysTime.min, SysTime.sec);
	
	while(1)
	{
		U16 i, sel;		
		
		putch('\n');
	
		for(i=0; cmd_menu[i].test_func; i++)
		{
			printf("%d : %s\n", i, cmd_menu[i].string);
		}
		
		while(!kbhit())
			LedSet(GetKeyStatus());
		
		sel = getchar();
		sel -= '0';
		
		if(sel<i)
			(*cmd_menu[sel].test_func)();
	}
}

#define	DFT_DOWNLOAD_ADDR	0x0c400000

U32 download_addr, download_len;

//中斷入口內容不可確定,不要用中斷
void LoadFromUart(void)
{
	int i, size;
	unsigned short dnCS, CheckSum;
	unsigned char *buf;
	unsigned char RxTmp[8];
	void (*fun)(void);
	
	download_addr = DFT_DOWNLOAD_ADDR;
	
	buf = (unsigned char *)download_addr;
	
	printf("Now download file from uart0 to 0x%x...\n", download_addr);
	
	i = 0;
	while(i<4)
		RxTmp[i++] = getch();
    
    i = 0;
    size = *(unsigned long *)RxTmp - 4;
	while(i<size)
		buf[i++] = getch();
	
	download_len = size-2;	
	
	dnCS = (buf[size-1]<<8)|buf[size-2];
	CheckSum = 0;
	for(size -= 3; size>=0; size--)
		CheckSum += buf[size];
	if(dnCS!=CheckSum) {
		puts("\nCheckSum error!\n");
		download_len = 0;
	} else {
		printf("\nReceived %x bytes success\n", download_len);
		puts("Do you want to run it?");
		if(getyorn()) {
			fun = (void (*)(void))download_addr;		
			CacheDisable();
			CacheFlush();
			(*fun)();
		}
	}
	
	return;
}