dspint.c

以TI 公司的OMAP5910为例

//////////////////////////////////////////////////////////////////////////
//            Copyright (C) 2004, Eyoka @ Microunit
//                           All Rights Reserved
//________________________________________________________________________
//
// FILENAME:    dspint.c
// PROJECT:     High-Resolution Video System On OMAP
// MODULE:      DSP System
// DESCRIPTION: DSP Interrupt support.
// TARGET CPU:  DSP-C55xx of OMAP5910
// VERSION:     1.1
//________________________________________________________________________
//
// REVISE HISTORY
// DATE         VERSION AUTHOR  DESCRIPTION
// 2004-10-13   1.1     Eyoka   Modify small functions as inline.
// 2004-10-13   1.0     Eyoka   First release.
//////////////////////////////////////////////////////////////////////////

#include "dspint.h"


/////////////////////////////////////////////////////////////////////
// FUNCTIONS
/////////////////////////////////////////////////////////////////////

//___________________________________________________________________
// Function: INT_Enable
// Usage: Enable the specified event in the IER0/1 register flags.
// Parameters:
//    event			- INT#
// Return Values:
//    N/A
//___________________________________________________________________
//
void INT_Enable(WORD event)
{
	WORD bit;
	WORD mask;

	bit = event & 0x000F;
	mask = 1<<bit;

	if(event & 0x0010)
	{
		INT_IER1 |= mask;
	}
	else
	{
		INT_IER0 |= mask;
	}
}

//___________________________________________________________________
// Function: INT_Disable
// Usage: Disable the specified event in the IER0/1 register flags.
// Parameters:
//    event			- INT#
// Return Values:
//    N/A
//___________________________________________________________________
//
void INT_Disable(WORD event)
{
	WORD bit;
	WORD mask;

	bit = event & 0x000F;
	mask = ~(1<<bit);

	if(event & 0x0010)
	{
		INT_IER1 &= mask;
	}
	else
	{
		INT_IER0 &= mask;
	}
}

//___________________________________________________________________
// Function: INT_IVT_Insert
// Usage: Insert a new entry to Interrupt Vector Table.
// Parameters:
//    event			- INT#
//    addrISR		- BYTE address of the Interrupt Service Routine
// Return Values:
//    N/A
//___________________________________________________________________
//
void INT_IVT_Insert(WORD event, DWORD addrISR)
{
	WORD *pVector;
	DWORD code;
	DWORD base_addr;
	
	base_addr = (event&0x0010)? INT_IVPH : INT_IVPD;
	pVector = (WORD*)((base_addr<<7) + (event<<2));

	// vector content:
	// "B P24": 6A addr24
	code = 0x6A000000 | addrISR;
	*pVector = (WORD)(code>>16);
	*(pVector+1) = (WORD)code;
	// "NOP_16": 5E80
	*(pVector+2) = 0x5E80;
	*(pVector+3) = 0x5E80;
}


// the end
//////////////////////////////////////////////////////////////////////////