// GSTM.cpp: implementation of the GSTM class.
//
//////////////////////////////////////////////////////////////////////

#include "stdafx.h"
#include "GSTM.h"

//////////////////////////////////////////////////////////////////////
// Construction/Destruction
//////////////////////////////////////////////////////////////////////

// default constructor
GSTM::GSTM() : _crate(0), _gstmbase(0x90000000)
{
	setup(0);
}

// destructor
GSTM::~GSTM()
{

}

// constructor with a crate and VME base address
GSTM::GSTM(unsigned int crate,unsigned int vmebase)
{
	_crate=crate;
	_gstmbase=vmebase;
	printf("in constructor, calling setup\n");
	setup(crate);
}

// set up this GSTM
void GSTM::setup(unsigned int crate, unsigned int vmebase)
{
	_crate=crate;
	_gstmbase=vmebase;
	// first set up the VME part
	printf("setting up VME\n");
	a32super.setup(_crate);
	printf("Done setting up VME crate\n");

}

// reset the GSTM
void GSTM::reset()
{
	unsigned int offset,cmd;
	  // start by writing 0 to the control and mode registers.
  offset=GSTM_CTRL;
  cmd=0x0;
  a32super.write32(_gstmbase+offset,cmd); 
  offset=GSTM_MODE;
  cmd=0x0;
  a32super.write32(_gstmbase+offset,cmd); 
  // reset the module, which requires
  //several writes, all of them are sticky.
  offset=GSTM_CTRL;
  unsigned int mask0=a32super.read32(_gstmbase+offset);
  // global reset:
  cmd=setBit(mask0,CTRL_RESET,1);
  a32super.write32(_gstmbase+offset,cmd); 
  mask0=a32super.read32(_gstmbase+offset);
  // wait a little while
  Sleep(50);
  cmd=setBit(mask0,CTRL_RESET,0);
  a32super.write32(_gstmbase+offset,cmd);
  mask0=a32super.read32(_gstmbase+offset);
  // reset the error status bit
  cmd=setBit(mask0,CTRL_CLR_ERROR,1);
  a32super.write32(_gstmbase+offset,cmd);
  mask0=a32super.read32(_gstmbase+offset);
  cmd=setBit(mask0,CTRL_CLR_ERROR,0);
  a32super.write32(_gstmbase+offset,cmd);
  mask0=a32super.read32(_gstmbase+offset);
  // Clear the FIFOs
  cmd=setBit(mask0,CTRL_CLR_FIFO,1);
  a32super.write32(_gstmbase+offset,cmd);
  mask0=a32super.read32(_gstmbase+offset);
  cmd=setBit(mask0,CTRL_CLR_FIFO,0);
  a32super.write32(_gstmbase+offset,cmd);
  mask0=a32super.read32(_gstmbase+offset);
}

//Method to send standard events

void GSTM::sendStandardEvent()
{
	int data_nevts, i,j,k;
	int evtsize = 128;
	unsigned int data1;

	printf("How many events? Will be multiplied by 2\n");
	scanf("%d",&data_nevts);
	//Set data to fifo
	for (k=0;k<data_nevts;k++) 
	{
		reset();
		//Enable T1 port 
		enableBit(MODE_ENABLE_T1);
		//Enable 20 bit mode
		enableBit(MODE_M20SEL);
		//Enable port control
		enableBit(CTRL_CTRL_T1);
		//Set data to fifo
		for (i=0;i<2;i++) //This loop controls the number of events per loop
						  // 2 is the maximum that will fit in the broken fifo's
		{
			for (j=0;j<evtsize;j++) 
			{
				data1=0x00400100+(0x0202*j);
				if (j==0) data1 = setBit(data1,16,1);
				setRegister(GSTM_T11,data1);
			}
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) 
			{
				if (j==7) data1 = setBit(data1,17,1); //This is the end of event character
				setRegister(GSTM_T11,data1);
			}
		}
				setRegister(GSTM_T11,0x00f00001);	//This line seems to be required or 
													//else the fic fifo fills with errors
													//after the event
			
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Start transmission
		enableBit(CTRL_START_TRANS);
		//enable port control
		enableBit(CTRL_CTRL_T1);
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Stop sending
		stopSending();
		
	}

}

//This method sends an event twice the size of the standard event 
//by putting the end of event character at the end of the second event
//It was used to confirm that our GSTM has a broken FIFO

void GSTM::sendDoubleEvent()
{
	int data_nevts, i,j,k;
	int evtsize = 128;
	unsigned int data1;

	printf("How many events? Will be multiplied by 2\n");
	scanf("%d",&data_nevts);
	//Set data to fifo
	for (k=0;k<data_nevts;k++) 
	{
		reset();
		//Enable T1 port - we are sure about this one
		enableBit(MODE_ENABLE_T1);
		//Enable 20 bit mode
		enableBit(MODE_M20SEL);
		//Enable port control
		enableBit(CTRL_CTRL_T1);
		//Set data to fifo
		for (i=0;i<3;i++) //This loop controls the size of the event (3 standard events)
		{
			for (j=0;j<evtsize;j++) 
			{
				data1=0x00400100+(0x0202*j);
				if (j==0) data1 = setBit(data1,16,1);
				setRegister(GSTM_T11,data1);
			}
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) 
			{
				if ((j==7)&&(i==2)) data1 = setBit(data1,17,1); //This is the end of event character
				setRegister(GSTM_T11,data1);
			}
		}
				setRegister(GSTM_T11,0x0ff00001);	//This line seems to be required or 
													//else the fic fifo fills with errors
													//after the event
			
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Start transmission
		enableBit(CTRL_START_TRANS);
		//enable port control
		enableBit(CTRL_CTRL_T1);
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		stopSending();
		
	}

}

//Loop method
//**************Does not work at present*****************************
void GSTM::LoopEvents()
{
	int data_nevts, i,j,k;
	int evtsize = 128;
	unsigned int data1;

	printf("How many events? Will be multiplied by 2\n");
	scanf("%d",&data_nevts);
	//Set data to fifo
	for (k=0;k<data_nevts;k++) 
	{
		reset();
		//Enable T1 port - we are sure about this one
		enableBit(MODE_ENABLE_T1);
		//Enable 20 bit mode
		enableBit(MODE_M20SEL);
		//Enable port control
		enableBit(CTRL_CTRL_T1);
		//Set data to fifo
		for (i=0;i<2;i++) //This loop controls the number of events per loop
						  // 2 is the maximum that will fit in the broken fifo's
		{
			for (j=0;j<evtsize;j++) 
			{
				data1=0x00400100+(0x0202*j);
				if (j==0) data1 = setBit(data1,16,1);
				setRegister(GSTM_T11,data1);
			}
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x40a5a5;
			for (j=0;j<8;j++) setRegister(GSTM_T11,data1);
			data1=0x405a5a;
			for (j=0;j<8;j++) 
			{
				if (j==7) data1 = setBit(data1,17,1); //This is the end of event character
				setRegister(GSTM_T11,data1);
			}
		}
				setRegister(GSTM_T11,0x0ff00001);	//This line seems to be required or 
													//else the fic fifo fills with errors
													//after the event
			
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Start transmission
		enableBit(CTRL_LOOP_TRANS);
		//enable port control
		enableBit(CTRL_CTRL_T1);
		printf("Enter 1 to stop");
		scanf("%d",&data_nevts);
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		enableBit(CTRL_STOP_TRANS);
		disableBit(CTRL_LOOP_TRANS);
		stopSending();
		
	}


}

//Method to restart transmission in an attempt to speed testing
//*********************Does not work!!!************************
void GSTM::restartLoop()
{
	int data_nevts, i,j,k;
	int evtsize = 160;
	unsigned int data2[160];

	printf("How many events? Will be multiplied by 2\n");
	scanf("%d",&data_nevts);
	//Set data to fifo
		reset();
		//Enable T1 port 
		enableBit(MODE_ENABLE_T1);
		//Enable 20 bit mode
		enableBit(MODE_M20SEL);
		//Enable port control
		enableBit(CTRL_CTRL_T1);
		//Set data to fifo
		for (i=0;i<2;i++) //This loop controls the number of events per loop
						  // 2 is the maximum that will fit in the broken fifo's
		{
			for (j=0;j<128;j++) 
			{
				data2[j]=0x00400100+(0x0202*j);
				if (j==0) data2[j] = setBit(data2[j],16,1);
			}
			for (j=128;j<136;j++) 	data2[j]=0x40a5a5;
			for (j=136;j<144;j++)	data2[j]=0x405a5a;;
			for (j=144;j<152;j++)	data2[j]=0x40a5a5;
			for (j=0;j<8;j++) 
			{
				if (j==7) data2[j] = setBit(data2[j],17,1);	//This is the end of event character
				if ((j==5)&&(i=1)) data2[j] = setBit(data2[j],26,1);	//Stop bit for GSTM
				data2[j]=0x405a5a;
			}
		}
		for (k=0;k<evtsize;k++)
			setRegister(GSTM_T11,data2[j]);
		setRegister(GSTM_T11,0x00f00001);	//This line seems to be required or 
													//else the fic fifo fills with errors
													//after the event
			
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Start transmission
		enableBit(CTRL_START_TRANS);
		//enable port control
		enableBit(CTRL_CTRL_T1);
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Stop sending
		stopSending();
	for (k=1;k<data_nevts;k++) 
	{
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Restart transmission
		enableBit(CTRL_RESTART_TRANS);
		//enable port control
		enableBit(CTRL_CTRL_T1);
		//Disable port control
		disableBit(CTRL_CTRL_T1);
		//Stop sending
		stopSending();
	}
}


//Stop sending
void GSTM::stopSending()
{
	disableBit(CTRL_START_TRANS);
	//enable port control
	enableBit(CTRL_CTRL_T1);
}