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

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

	----------------------------------修正--------------------------------------
	2004-1-2	修正擴(kuò)展中斷的清楚標(biāo)志的錯(cuò)誤。未測(cè)試
-------------------------------------------------------------------------------------*/
#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;	//中斷注冊(cè)寄存器，是 1 的時(shí)候表示有中斷注冊(cè)了

void ExInt4567()	//外部中斷4567的共享函數(shù)
{
	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()
{
	//計(jì)算中斷的偏移地址，高位優(yōu)先
	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();
}