intr.c

来自「Real-Time Digital Signal Processing Imp」· C语言 代码 · 共 34 行

/******************************************************************/
/* intr.c V0.00                                                   */
/* Copyright (c) Texas Instruments , Incorporated  1997           */
/******************************************************************/
/******************************************************************/
/* Define temp location for storing interrupt vector locations    */
/******************************************************************/
#include "intr.h"

#pragma CODE_SECTION(hook_interrupt, "DRV5510");
#pragma CODE_SECTION(unhook_interrupt, "DRV5510");


extern interrupt void _intr_handler();
extern int _vectors;	 //Start label of vector table

void hook_interrupt(unsigned int trap, Ip func)
{
	unsigned long _branch = 0x6a00ul;
	unsigned long _func = (unsigned long)func;
	unsigned long *_addr = (unsigned long *)(((unsigned long)&_vectors + (trap * 0x8)) >> 1);

	*_addr = (_branch << 16) | _func;
}

void unhook_interrupt(unsigned int trap)
{
	unsigned long _branch = 0x6a00ul;
	unsigned long _func = (unsigned long)_intr_handler;
	unsigned long *_addr = (unsigned long *)(((unsigned long)&_vectors + (trap * 0x8)) >> 1);

	*_addr = (_branch << 16) | _func;
}