intserve.c

QX44B0的BIOS源代码

#include "intserve.h"

void IntServe_Reg( unsigned int irqaddr, unsigned int irq_serve )          //功能是将中断函数注册到中断向量表。
{
    unsigned int p,q;
    unsigned int kc;
    p = irq_serve;
    q = irqaddr;
    kc = 0xffffff & ((p -q-8)>>2);
    *(unsigned int*)irqaddr = 0xEA000000 |kc ;
}

void IntServe_Get( unsigned int irqaddr, unsigned int *irq_serve )
{
    *irq_serve = *(unsigned int*)irqaddr;
}