#include "..\inc\target.h"
#include "..\ucos_ii\ucos_ii.h"               /* uC/OS interface */

extern OS_EVENT *KeySem;

volatile char which_int=0;
void EInt4567Isr(void)
{
    which_int = rEXTINTPND;
    rEXTINTPND = 0xf;		//clear EXTINTPND reg.		
    rI_ISPC |= BIT_EINT4567;	//clear pending_bit

	Delay(500);		//延時若干個100us，消除抖動
	rPCONG &= 0x00ff;
	if( (rPDATG&0xf0) != 0xf0)
	{
	    switch(which_int)
	    {
			case 1:
			{
				OSMboxPost(KeySem, (void *)4);
			}
			    break;
			case 2:
			{
				OSMboxPost(KeySem, (void *)5);
			}
			    break;
			case 4:
			{
				OSMboxPost(KeySem, (void *)6);
			}
			    break;
			case 8:
			{
				OSMboxPost(KeySem, (void *)7);
			}
			    break;
			default :
				break;
	    }
	}

	while((rPDATG&0xf0) != 0xf0);		//按鍵沒有松開就一直等待
    rPCONG |= 0xff00;		//GPG4、5、6、7設為中斷引腳
}

/********************************************************************************************************
 * ARMTargetInit																						*
 *																										*
 * Description: This function initialize an ARM Target board											*
 *																										*
 * Argument   : none    																				*
 ********************************************************************************************************/

void ARMTargetInit(void) {
	
	//配置Cache
   	rSYSCFG=SYSCFG_8KB;				//使用8K字節的指令緩存
	rNCACHBE0=((unsigned int)(Non_Cache_End>>12)<<16)|(Non_Cache_Start>>12);
	
	Port_Init();					//初始化端口
	
	Led_Disp();
	
	ChangePllValue(52,3,1);			//設置CPU頻率為48M

	Uart_Init(0,115200);			//設置串口0的速率為115200bps
	
	Uart_Select(0);					//選擇串口0

	

	ARMInitInterrupts();			//初始化中斷,設置中斷服務程序
	
	Delay(0);						//調整延時

}


/********************************************************************************************************
 * ARMTargetStart																						*
 *																										*
 * Description: This function start the ARM target running												*
 *																										*
 * Argument   : none																					*
 ********************************************************************************************************/


void ARMTargetStart(void) {
	
	ARMInitTimers();				//配置時鐘0相關寄存器
	ARMInstallSystemTimer();		//時鐘0中斷使能
}


void ARMInitInterrupts(void)
{
	// Non-vectored,IRQ disable,FIQ disable    
	rINTCON=0x0;	  

	// All=IRQ mode
	rINTMOD=0x0;	  

	// All interrupt is masked.
	rINTMSK=BIT_GLOBAL;	  

    rPCONG = rPCONG | 0xff00;		//GPG4、5、6、7設為中斷引腳
    rPUPG = rPUPG & 0x0f;		//GPG4、5、6、7上拉電阻有效
	rEXTINT=0x0;	//低電平觸發

	rPCONG = rPCONG | 0x00c0;
	rPUPG = rPUPG & 0xf7;
	rEXTINT |= 0x4000;

	
	//set interrupt vector routine
//	pISR_RESET					//reserved
	pISR_UNDEF = (unsigned) DebugUNDEF;
	pISR_SWI = (unsigned) DebugSWI;
	pISR_PABORT = (unsigned) DebugPABORT;
	pISR_DABORT = (unsigned) DebugDABORT;
//	pISR_RESERVED = (unsigned) BreakPoint;		//not used
//	pISR_IRQ = (unsigned) 0;			//reserved
	pISR_FIQ = (unsigned) DebugFIQ;
	
	pISR_ADC= (unsigned) BreakPoint;
	pISR_RTC= (unsigned) BreakPoint;
	pISR_UTXD1= (unsigned) BreakPoint;
	pISR_UTXD0= (unsigned) BreakPoint;
	pISR_SIO= (unsigned) BreakPoint;
	pISR_IIC= (unsigned) BreakPoint;
	pISR_URXD1= (unsigned) BreakPoint;
	pISR_URXD0= (unsigned) BreakPoint;
	pISR_TIMER5= (unsigned) BreakPoint;
	pISR_TIMER4= (unsigned) BreakPoint;
	pISR_TIMER3= (unsigned) BreakPoint;
	pISR_TIMER2= (unsigned) BreakPoint;
	pISR_TIMER1= (unsigned) BreakPoint;
	pISR_TIMER0= (unsigned) BreakPoint;
	pISR_UERR01= (unsigned) BreakPoint;
	pISR_WDT= (unsigned) BreakPoint;
	pISR_BDMA1= (unsigned) BreakPoint;
	pISR_BDMA0= (unsigned) BreakPoint;
	pISR_ZDMA1= (unsigned) BreakPoint;
	pISR_ZDMA0= (unsigned) BreakPoint;
	pISR_TICK= (unsigned) BreakPoint;
	pISR_EINT4567= (unsigned) OSEINT4567ISR;
	pISR_EINT3= (unsigned) BreakPoint;
	pISR_EINT2= (unsigned) BreakPoint;
	pISR_EINT1= (unsigned) BreakPoint;
	pISR_EINT0= (unsigned) BreakPoint;

	pISR_TIMER0= (unsigned) OSTickISR;
	
}


int ARMRequestSystemTimer(void *tick, const unsigned char *str) 
{

	return 1;

}


//Initialize timer that is used OS.
void ARMInitTimers(void)
{
	//dead zone=0, pre0= 150
	rTCFG0= 0x00000095;
	//all interrupt, mux0= 1/16
	rTCFG1= 0x00000003;

	//set T0 count
	rTCNTB0= _CLOCK;

	//update T0
	rTCON= 0x00000002;
	
}


//start system timer0
void ARMStartTimer(void)
{
	//autoreload and start
	rTCON = 0x9;
}


// enable the interrupt.
void ARMInstallSystemTimer(void)
{
	//Non-vectored,IRQ enable,FIQ disable 
	rINTCON=0x1;

	//Non maksed TIMER0
	rINTMSK=~( BIT_TIMER0 | BIT_GLOBAL | BIT_EINT4567);	//Default value=0x7ffffff
}


void BreakPoint(void) {

	Uart_Printf("Enter BreakPoint");
	
	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}


void DebugUNDEF(void) {

	Uart_Printf("Enter DebugUNDEF");

	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}

void DebugSWI(void) {

	Uart_Printf("Enter DebugSWI");

	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}


void DebugPABORT(void) {

	Uart_Printf("Enter DebugPABORT");

	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}


void DebugDABORT(void) {

	Uart_Printf("Enter DebugDABORT");

	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}


void DebugFIQ(void) {

	Uart_Printf("Enter DebugFIQ");

	while(1) {
		Led_Set(0xf);
		Delay(1000);
		Led_Set(0x0);
		Delay(1000);
	}
}