intserve.c

44B0+8019系统

#include "intserve.h"

void IntServe_Reg( unsigned int irqaddr, unsigned int irq_serve )
{
    unsigned int p,q;
    p = irq_serve;
    q = irqaddr;
    *(unsigned int*)irqaddr = 0xEA000000 | ( ( p - q - 8 ) >> 2 );
}

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