#include "44b.h"
#include "isr.h"
#include "def.h"

void (*InterruptHandlers[MAXHNDLRS])(void);
void (*ExInt4567Handlers[4])(void);

void ExInt4567()	//外部中斷4567的共享函數
{
	int i,exinpnd=rEXTINPND,tmp=1;//temp bit
	for(i=0;i<4;i++){
		if(exinpnd&tmp){
			rEXTINPND=tmp;	//clear Extint bit
			rI_ISPC=(1<<4);	//clear i_ispc
			(*ExInt4567Handlers[i])();
			break;
		}
		tmp<<=1;
	}
}

int GetISROffsetClr()
{
	//計算中斷的偏移地址，高位優先
	int i,ispr=rI_ISPR,tmp=1<<(MAXHNDLRS-1);//temp bit
	for(i=MAXHNDLRS;i>0;i--){
		if(ispr&tmp){
			rI_ISPC=tmp;
			return i-1;
		}
		tmp>>=1;
	}
	return -1;
}

void SetISR_Interrupt(int vector, void (*handler)(), int ExInt)
{
	if(vector==EINT4567_OFFSET){
		InterruptHandlers[vector] = ExInt4567;
		ExInt4567Handlers[ExInt] = handler;
	}
	else	{
		InterruptHandlers[vector] = handler;
	}
}

void ISR_IrqHandler()
{
	int IntOffset;
    IntOffset=GetISROffsetClr();	//得到中斷向量的偏移地址
	(*InterruptHandlers[IntOffset])(); // Call interrupt service routine

}

void Open_INT_GLOBAL()
{ rINTCON=0x5;//Non-vectored,IRQ enable,FIQ disable
  rINTMSK=~BIT_GLOBAL;//Can not use rINTMSK&=~BIT_GLOBAL, why?
}

void Open_INT(U32 BIT_INT)
{ 
  rINTMSK&=~BIT_INT;
  if(rI_ISPR &BIT_INT)
	rI_ISPC|=BIT_INT;
}

void Close_INT(U32 BIT_INT)
{  
   rINTMSK|=BIT_INT;	
}