daadiolib.c

来自「Vxworks的培训教程,大家分享下啊,」· C语言 代码 · 共 45 行

#include "daadioLib.h"
#include "vme.h"
#include "iv.h"

DAADIO daadio;

void pioISR();

STATUS daadioInit (baseAddr, intLevel, intNumber)
	char *	baseAddr;
	int 	intLevel;
	int		intNumber;
	{
	int		lockKey;

	/* Convert short I/O base address to local CPU address and store in
	   <baseAddr> member of daadio structure  */
	if (sysBusToLocalAdrs (VME_AM_SUP_SHORT_IO, baseAddr, &daadio.baseAddr) ==
		ERROR)
		return (ERROR);
	
	daadio.pIntLevSel = (UINT8 *) daadio.baseAddr + DAADIO_INT_LEV_SEL_OFF;
	daadio.pIntVecSel = (UINT8 *) daadio.baseAddr + DAADIO_INT_VEC_SEL_OFF;
	daadio.pIntModSel = (UINT8 *) daadio.baseAddr + DAADIO_INT_MOD_SEL_OFF;
	daadio.pIntSrcMod = (UINT8 *) daadio.baseAddr + DAADIO_INT_SRC_MOD_OFF;

	if (intLevel)
		{
		*daadio.pIntLevSel = intLevel << 4;
		*daadio.pIntVecSel = intNumber;

		lockKey = intLock();
		*daadio.pIntModSel = daadio.intModSel = 0;
		intUnlock (lockKey);

		if (intConnect (INUM_TO_IVEC(intNumber), pioISR, 0) == ERROR)
			return (ERROR);
		if (sysIntEnable (intLevel) == ERROR)
			return (ERROR);
		}
	daadio.initialized = TRUE;

	return (OK);
	}