/*----------------------------------------------------------------------------------
    #說明:中斷處理函數
    #接口函數
	----------------------------------  Bug  --------------------------------------

	----------------------------------  TODO list  --------------------------------------

	----------------------------------修正--------------------------------------
	2004-1-2	修正擴展中斷的清楚標志的錯誤。未測試
-------------------------------------------------------------------------------------*/
#include "..\startup\44b.h"
#include "isr.h"
#include "def.h"
#include "includes.h"

void (*InterruptHandlers[MAXHNDLRS])(void)={NULL,};
void (*ExInt4567Handlers[4])(void)={NULL,};

static unsigned int exIntMask=0;	//中斷注冊寄存器，是 1 的時候表示有中斷注冊了

void ExInt4567()	//外部中斷4567的共享函數
{
	int i,exinpnd=rEXTINPND,tmp=1;//temp bit
	exinpnd&=exIntMask;
	for(i=0;i<4;i++){
		if(exinpnd&tmp){
			if(ExInt4567Handlers[i])
				(*ExInt4567Handlers[i])();
			rEXTINPND=tmp;	//clear Extint bit
			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){
			return i-1;
		}
		tmp>>=1;
	}
	return -1;
}

void SetISR_Interrupt(int vector, void (*handler)(), int ExInt)
{
#if OS_CRITICAL_METHOD == 3
	OS_CPU_SR  cpu_sr;
#endif
	OS_ENTER_CRITICAL();

	if(vector>MAXHNDLRS || vector<0)
		return;

	if(vector==EINT4567_OFFSET){

		if(rI_ISPR&BIT_EINT4567)
			rI_ISPC=BIT_EINT4567;
		rINTMSK&=(~BIT_EINT4567);

		exIntMask|=(1<<ExInt);
		InterruptHandlers[vector] = ExInt4567;
		ExInt4567Handlers[ExInt] = handler;
	}
	else	{
		if(rI_ISPR&(1<<vector))
			rI_ISPC=(1<<vector);
		rINTMSK&=(~(1<<vector));

		InterruptHandlers[vector] = handler;
	}

	OS_EXIT_CRITICAL();
}

void ISR_IrqHandler()
{
	int IntOffset=GetISROffsetClr();	//得到中斷向量的偏移地址

	if(IntOffset<0)
		return;
	if(InterruptHandlers[IntOffset]==NULL)
		return;

	OSIntEnter();

	(*InterruptHandlers[IntOffset])(); // Call interrupt service routine
	rI_ISPC=(1<<IntOffset);

	OSIntExit();
}