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

extern OS_EVENT *Key_Mbox;
extern OS_EVENT *OK_Mbox;

/********************************************************************************************************
 * 外部中斷4、5、6、7的中斷處理 																		*
 ********************************************************************************************************/
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(Key_Mbox, (void *)4);
			}
			    break;
			case 2:
			{
				OSMboxPost(Key_Mbox, (void *)5);
			}
			    break;
			case 4:
			{
				OSMboxPost(OK_Mbox, (void *)6);
			}
			    break;
			case 8:
			{
				OSMboxPost(Key_Mbox, (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();					//初始化端口
	
	Delay( 200 ) ;		//delay some time
	Led_Set( 0x0f );		//LED全亮
	Delay( 500 ) ;		//delay some time
	Led_Set( 0x00 );		//LED全亮
	
	ChangePllValue( 58, 3, 1 ) ;			//設置CPU頻率為66M

	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;	  

	//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)
{
	rTCON = 0x9;		//autoreload and start
}

/********************************************************************************************************
 * 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
	rINTMSK=~( BIT_TIMER0 | BIT_GLOBAL );	//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 ) ;
	}
}
//*******************************************************************************************************