Subversion Repositories tosnet

/*****************************************************************************
* Filename:          /drivers/tosnet_v1_00_a/src/tosnet.c
* Version:           3.20.a
* Description:       tosnet Driver Source File
* Date:              Mon Feb 15 11:56:16 2010 (by Create and Import Peripheral Wizard)
*****************************************************************************/
 
 
#define NODE_ID_BITS 0xf
#define NODE_ID_OFFSET 8
#define NODE_ADDRESS_BITS 0xf
#define NODE_ADDRESS_OFFSET 12
#define REG_ENABLE_BITS 0xff 
#define REG_ENABLE_OFFSET 16
#define SYSTEM_HALT_BITS 0x1
#define SYSTEM_HALT_OFFSET 4
#define ONLINE_BITS 0x1
#define ONLINE_OFFSET 2
#define IS_MASTER_BITS 0x1
#define IS_MASTER_OFFSET 3
#define ASYNC_VALID_BITS 0x1
#define ASYNC_VALID_OFFSET 7
#define ASYNC_NODE_ID_BITS 0xf
#define ASYNC_NODE_ID_OFFSET 28
#define ASYNC_BE_BITS 0x3
#define ASYNC_BE_OFFSET 26
#define ASYNC_FULL_BITS 0x1
#define ASYNC_FULL_OFFSET 5
 
/***************************** Include Files *******************************/
 
#include "tosnet.h"
 
/************************** Function Definitions ***************************/
 
XStatus TosNet_Initialize(TosNet *instancePtr, unsigned int *MemBaseAddress, unsigned int *RegBaseAddress)
{
	instancePtr->MemBaseAddress = (volatile unsigned int*) MemBaseAddress;
	instancePtr->RegBaseAddress = (volatile unsigned int*) RegBaseAddress;
 
	(instancePtr->RegBaseAddress)[0] = 0x00000003;
	(instancePtr->RegBaseAddress)[0] = 0x0;
 
	return XST_SUCCESS;
}
 
unsigned int TosNet_GetNodeID(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> NODE_ID_OFFSET) & NODE_ID_BITS);
}
 
unsigned int TosNet_GetNodeAddress(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> NODE_ADDRESS_OFFSET) & NODE_ADDRESS_BITS);
}
 
unsigned int TosNet_GetRegEnable(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> REG_ENABLE_OFFSET) & REG_ENABLE_BITS);
}
 
int TosNet_IsOnline(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> ONLINE_OFFSET) & ONLINE_BITS);
}
 
int TosNet_IsMaster(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> IS_MASTER_OFFSET) & IS_MASTER_BITS);
}
 
int TosNet_SystemHalted(TosNet *instancePtr)
{
	return (((instancePtr->RegBaseAddress)[0] >> SYSTEM_HALT_OFFSET) & SYSTEM_HALT_BITS);
}
 
void TosNet_CommitIn(TosNet *instancePtr)
{
	unsigned int regTemp = (instancePtr->RegBaseAddress)[0] & 0xfffffffc;
	(instancePtr->RegBaseAddress)[0] = regTemp + 1;
	(instancePtr->RegBaseAddress)[0] = regTemp;
 
	return;
}
 
void TosNet_CommitOut(TosNet *instancePtr)
{
	unsigned int regTemp = (instancePtr->RegBaseAddress)[0] & 0xfffffffc;
	(instancePtr->RegBaseAddress)[0] = regTemp + 2;
	(instancePtr->RegBaseAddress)[0] = regTemp;
 
	return;
}
 
unsigned int TosNet_GetPacketCounter(TosNet *instancePtr)
{
	return (instancePtr->RegBaseAddress)[1];
}
 
unsigned int TosNet_GetErrorCounter(TosNet *instancePtr)
{
	return (instancePtr->RegBaseAddress)[2];
}
 
unsigned int TosNet_GetResetCounter(TosNet *instancePtr)
{
	return (instancePtr->RegBaseAddress)[3];
}
 
inline volatile unsigned int *TosNet_CalcInAddress(TosNet *instancePtr, unsigned int nodeId, unsigned int regId, unsigned int index)
{
	return (instancePtr->MemBaseAddress) + (nodeId << 6) + (regId << 3) + (1 << 2) + index;
}
 
inline volatile unsigned int *TosNet_CalcOutAddress(TosNet *instancePtr, unsigned int nodeId, unsigned int regId, unsigned int index)
{
	return (instancePtr->MemBaseAddress) + (nodeId << 6) + (regId << 3) + index;
}
 
int TosNet_AsyncDataReady(TosNet *instancePtr)
{
	return ((((instancePtr->RegBaseAddress)[0]) >> ASYNC_VALID_OFFSET) & ASYNC_VALID_BITS);
}
 
int TosNet_ReadAsync(TosNet *instancePtr, unsigned char *readBuffer, unsigned int maxBytes, unsigned int *nodeId)
{
	int currentNode = ((((instancePtr->RegBaseAddress)[0]) >> ASYNC_NODE_ID_OFFSET) & ASYNC_NODE_ID_BITS);
	unsigned int dataBuffer, beBuffer, byteCount = 0, n, done = 0;
 
	while(TosNet_AsyncDataReady(instancePtr) && (currentNode == (((instancePtr->RegBaseAddress)[0] >> ASYNC_NODE_ID_OFFSET) & ASYNC_NODE_ID_BITS)) && (byteCount < maxBytes) && (done == 0))
	{
		beBuffer = (((instancePtr->RegBaseAddress)[0] >> ASYNC_BE_OFFSET) & ASYNC_BE_BITS);
		dataBuffer = (instancePtr->RegBaseAddress)[4];		//This performs the read, and triggers the core to read out the next value from the FIFO
 
		if(beBuffer < 3)
		{
			done = 1;
		}
 
		for(n=0; n<(beBuffer+1); n++)
		{
			readBuffer[byteCount++] = ((unsigned char*)(&dataBuffer))[n];
			if(byteCount == maxBytes)
			{
				break;
			}
		}
	}
 
	*nodeId = currentNode;
 
	return byteCount;
}
 
 
int TosNet_WriteAsync(TosNet *instancePtr, unsigned char *writeBuffer, unsigned int writeBytes, unsigned nodeId)
{
	unsigned int dataBuffer, beBuffer, n, byteCount = 0;
	unsigned int regTemp = ((instancePtr->RegBaseAddress)[0] & 0x03ffffff) + ((nodeId & ASYNC_NODE_ID_BITS) << ASYNC_NODE_ID_OFFSET);
 
	while(!(((instancePtr->RegBaseAddress)[0] >> ASYNC_FULL_OFFSET) & ASYNC_FULL_BITS) && (byteCount < writeBytes))
	{
		dataBuffer = 0;
		beBuffer = 0;
 
		for(n=0; n<4; n++)
		{
			dataBuffer += (unsigned int)(writeBuffer[byteCount++] << (8*(3-n)));
			beBuffer++;
			if(byteCount == writeBytes)
			{
				break;
			}
		}
 
		(instancePtr->RegBaseAddress)[0] = regTemp + (((beBuffer-1) & ASYNC_BE_BITS) << ASYNC_BE_OFFSET);
		(instancePtr->RegBaseAddress)[4] = dataBuffer;		//This performs the write, and triggers the core to write the value into the FIFO
	}
 
	return byteCount;
}