#include "VMEUtilities.h"

extern "C"{
#include <stdlib.h>
#include <string.h>
#include <time.h>
#include <jvme.h>
#include <tiLib.h>
#include <tsLib.h>
#include <sdLib.h>
#include <fa125Lib.h>
#include "math.h"
#include "time.h"
#include "sys/types.h"
#include <unistd.h>

extern int nfa125;
extern int fa125A32Base;
extern int tiA32Base;

DMA_MEM_ID vmeIN,vmeOUT;
extern unsigned int *dma_dabufp;
extern DMANODE *the_event;

}

extern int VERBOSE;

#define FA125_ADDR (5<<19)
#define TI_ADDR (21<<19)

int Thresholds[20][72];
int DAC_Values[20][72];
char DETECTOR[128];
int HOSTROC;
unsigned int NAboveThreshold[20][72];
map<int, map <int, vector < int > > > fRawData;

void MyReadoutCode();
void DecodeData(unsigned int);
void DecodeDataNEW(unsigned int);
extern unsigned long int EventCounter;

struct data_struct
{
	unsigned int new_type;
	unsigned int type;
	unsigned int slot_id_hd;
	unsigned int mod_id_hd;
	unsigned int slot_id_tr;
	unsigned int n_evts;
	unsigned int blk_num;
	unsigned int n_words;
	unsigned int evt_num_1;
	unsigned int time_now;
	unsigned int time_1;
	unsigned int time_2;
	unsigned int chan;
	unsigned int width;
	unsigned int valid_1;
	unsigned int adc_1;
	unsigned int valid_2;
	unsigned int adc_2;
	unsigned int over;
	unsigned int adc_sum;
	unsigned int pulse_num;
	unsigned int thres_bin;
	unsigned int quality;
	unsigned int integral;
	unsigned int time;
	unsigned int chan_a;
	unsigned int source_a;
	unsigned int chan_b;
	unsigned int source_b;
	unsigned int group;
	unsigned int time_coarse;
	unsigned int time_fine;
	unsigned int vmin;
	unsigned int vpeak;
	unsigned int scaler[18];/* data stream scalers */
};

struct data_structNEW 
{
	unsigned int new_type;
	unsigned int type;
	unsigned int slot_id_hd;
	unsigned int mod_id_hd;
	unsigned int slot_id_tr;
	unsigned int n_evts;
	unsigned int blk_num;
	unsigned int n_words;
	unsigned int evt_num_1;
	unsigned int time_now;
	unsigned int time_1;
	unsigned int time_2;
	unsigned int chan;
	unsigned int width;
	unsigned int npk;
	unsigned int le_time;
	unsigned int time_quality;
	unsigned int overflow_cnt;
	unsigned int pedestal;
	unsigned int fm_amplitude;
	unsigned int peak_amplitude;
	unsigned int peak_time;
	unsigned int valid_1;
	unsigned int adc_1;
	unsigned int valid_2;
	unsigned int adc_2;
	unsigned int over;
	unsigned int adc_sum;
	unsigned int pulse_num;
	unsigned int thres_bin;
	unsigned int quality;
	unsigned int integral;
	unsigned int time;
	unsigned int chan_a;
	unsigned int source_a;
	unsigned int chan_b;
	unsigned int source_b;
	unsigned int group;
	unsigned int time_coarse;  
	unsigned int time_fine;
	unsigned int vmin;
	unsigned int vpeak;
	unsigned int scaler[18];/* data stream scalers */
};


volatile struct data_structNEW fadc_data;

VMEUtilities::VMEUtilities(){
	GetHostName();
	NADCSAMPLES = 100;
	EventCounter = 0;
	fPulserOffset = 0;
	fPulseHeight = 1000000;
	// Set correct number of ADCs

	if (DETECTOR[0] == 'c'){
		//sprintf(DET,"CDC");
		if (HOSTROC == 1 || HOSTROC == 4) NADCS = 13;
		else NADCS = 12;
	} 
	else {
		//sprintf(DET,"FDC");
		if (HOSTROC == 2 || HOSTROC == 3 || HOSTROC == 5 || HOSTROC == 8 || HOSTROC == 11 || HOSTROC == 12) NADCS = 14;
		else NADCS = 15;
	}
	if (VERBOSE) cout << "VMEUtilities object created" << endl; 
}

int VMEUtilities::InitializeADCs(){
	if(vmeOpenDefaultWindows() != OK) {
		cout<<"vmeOpenDefaultWindows failed. Terminate right here."<<endl;
		return 0;
	}

	//First try to get the configuration from the CCDB, If it fails, set defaults 
	int db =  GetDACfromdatabase(HOSTROC, DETECTOR);

	if (!db) { 
		cout<<"Connection to CCDB failed == Set default sparsification threshold of 0"<<endl;
		for (unsigned int n=0;n<NADCS;n++){
			for (int k=0;k<72;k++){	    
				Thresholds[n][k] = 0;
				DAC_Values[n][k] = 0x9000; 
			}
		}
	}

	/* Setup Address and data modes for DMA transfers
	 *
	 *  vmeDmaConfig(addrType, dataType, sstMode);
	 *
	 *  addrType = 0 (A16)    1 (A24)    2 (A32)
	 *  dataType = 0 (D16)    1 (D32)    2 (BLK32) 3 (MBLK) 4 (2eVME) 5 (2eSST)
	 *  sstMode  = 0 (SST160) 1 (SST267) 2 (SST320)
	 */
	vmeDmaConfig(2,5,1);

	/* INIT dmaPList */

	dmaPFreeAll();
	vmeIN  = dmaPCreate("vmeIN",1024*1000*4,5,0);
	vmeOUT = dmaPCreate("vmeOUT",0,0,0);

	dmaPStatsAll();

	dmaPReInitAll();


	/*
	   vmeDmaConfig(2,5,1);
	   dmaPFreeAll();
	   vmeIN  = dmaPCreate("vmeIN",1024*4000,5,0);
	   vmeOUT = dmaPCreate("vmeOUT",0,0,0);
	   dmaPStatsAll();
	   dmaPReInitAll();

	   tiInit(TI_ADDR, TI_READOUT_EXT_POLL, 0);
	//tiInit(0,0,0);
	tiCheckAddresses();
	tiDisableDataReadout();  // do not read out TI
	tiDisableA32();          // do not read out TI   

	tiLoadTriggerTable(0);
	tiSetTriggerHoldoff(1,4,0);
	tiSetTriggerHoldoff(2,4,0);

	tiSetPrescale(0);
	tiSetBlockLevel(1);

	tiSetTriggerSource(TI_TRIGGER_PULSER);
	tiEnableTSInput(0x1);

	tiSetBusySource(TI_BUSY_LOOPBACK, 1);
	tiSetBlockBufferLevel(1);
	tiSetFiberDelay(1,2);
	tiSetSyncDelayWidth(1, 0x3f, 1);

	// setup clock, etc for single-crate system only
	tiClockReset();
	taskDelay(1);
	tiTrigLinkReset();
	taskDelay(1);
	tiEnableVXSSignals();
	taskDelay(1);
	tiSyncReset(0);
	taskDelay(1);
	if (VERBOSE) tiStatus(0);
	*/

	extern unsigned int fa125AddrList[FA125_MAX_BOARDS];

	int SLOT = 3; // First slot where there is an ADC
	int offset = 0;
	for (unsigned int k=0;k<NADCS;k++){
		fa125AddrList[k] = ((k+SLOT+offset)<<19);
		if (k+SLOT==10){
			offset = 2;
		}
	}

	int iFlag = 0;
	iFlag  = (1<<17); /* use fa125AddrList */
	/*
	   bits 2-1:  defines Trigger source
	   (0) 0 0  VXS (P0)
	   (1) 0 1  Internal Timer
	   (2) 1 0  Internal Multiplicity Sum
	   (3) 1 1  P2 Connector (Backplane)
	   bit    3:  NOT USED WITH THIS FIRMWARE VERSION
	   bits 5-4:  defines Clock Source
	   (0) 0 0  P2 Connector (Backplane)
	   (1) 0 1  VXS (P0)
	   (2) 1 0  Internal 125MHz Clock
	   */
	iFlag |= (1<<1);  /* Trigger Source */
	iFlag |= (1<<4);  /* Clock Source */
	iFlag |= (1<<18); /* Skip Firmware check */  
	int stat = fa125Init(0, 0, NADCS, iFlag);
	//int stat = fa125Init(3<<19, 1<<19, NADCS, iFlag);	

	if (stat != OK) {
		cout<<"ERROR: fa125Init failed, stop right here!!!"<<endl;
		return 0;
	}

	// the following needs to be done after initializing
	// only then fa125ScanMask() will work properly

	tiInit(0,0,0);
	sdInit(0);
	sdSetActiveVmeSlots(fa125ScanMask());
	cout << "Scan mask is " << fa125ScanMask() << endl;
	sdStatus();

	tiClockReset();
	taskDelay(2);
	tiTrigLinkReset();
	sleep(1);

	tiEnableVXSSignals();
	tiSyncReset(1);

	//sdInit(0);
	//sdSetActiveVmeSlots( fa125ScanMask());
	if (VERBOSE) sdStatus();

	fa125ResetToken(0);
	for (unsigned int k=0;k<NADCS;k++){
		int S = fa125Slot(k);
		fa125PowerOn(S);

		//fa125Reset(S, 0);

		cout<<"Set DAC values and Thresholds for all channels in ADC slot "<<S<<endl;
		for(int ichan=0; ichan<72; ichan++) {
			fa125SetOffset(S,ichan,DAC_Values[k][ichan]);
			//fa125SetThreshold(S, ichan, Thresholds[k][ichan]);
			fa125SetThreshold(S, ichan, 0);
		}
		fa125PrintThreshold(fa125Slot(k));
		//set threshold to zero
		if (0){
			fa125SetCommonThreshold(S, 0);
		}
		cout<<"Configure readout window size and location"<<endl;
		//int pmode = 8;
		//unsigned int PL = 150;   // look back PL samples
		//unsigned int PTW = NADCSAMPLES;  // window size in samples
		//unsigned int NSB = 5;    // sampels before threshold
		//unsigned int NSA = 60;   // sampels after threshold
		//unsigned int NP = 1;     // number of pulses in sample
		//fa125SetProcMode(S, pmode, PL, PTW, NSB, NSA, NP);

		fa125SetProcMode(S,"CDC_long", 150, 
				NADCSAMPLES, NADCSAMPLES, 4, 1, 4, 4);   

		// And new now set the Scale Factors
		// IBIT = 4 scale integral
		// ABIT = 3 scale amplitude
		// PBIT = 0 scale pedestal
		cout<<"Set Scale Factors"<<endl;
		fa125SetScaleFactors(S, 4, 3, 0);

		// And also new the thresholds for the timing alorighm
		// TH = 100
		// TL = 25
		cout<<"Set Common Timing Thresholds"<<endl;
		fa125SetCommonTimingThreshold(S, 25, 100);

		// enable all channels in module
		cout<<"Enable all Channels"<<endl;
		fa125SetChannelEnableMask(S,0xFFFFFF,0xFFFFFF,0xFFFFFF);

		fa125SetBlocklevel(S, 1);

		if (VERBOSE) fa125PrintTemps(S);
		//fa125Clear(S);  
		fa125Reset(S,0);
		taskDelay(1);
		fa125Enable(S);
		taskDelay(1);
		//fa125Status(S,0);
	}

	//  tiIntConnect(TI_INT_VEC, myReadoutCode, tiIntArg);
	//  TI_INT_VEC =  0xec defined in tiLib.h
	//  tiIntArg = 0 defined in tiLib.c
	//tiIntConnect(TI_INT_VEC, MyReadoutCode, 0);
	vmeCheckMutexHealth(10);
	fa125GStatus(0);

	/* Enable the TI and clear the trigger counter */
	//tiIntEnable(0);
	fa125ResetToken(0);
	taskDelay(1);
	return 1;
}

void VMEUtilities::PowerDown(){
	tiIntDisable();
	tiIntDisconnect(); 


	for (unsigned int k=0;k<NADCS;k++){
		int S = fa125Slot(k);
		fa125PrintTemps(S);
		fa125PowerOff(S);
	}

	dmaPFreeAll(); 
	vmeCloseDefaultWindows();     
	if (VERBOSE) cout << "All Module Power Down " << endl;
}

float VMEUtilities::TakeRandomTriggerData(unsigned int nTriggers){

	if (VERBOSE) cout<<clock()<<"   START OF LOOP"<<endl; 

	for (unsigned int n=0;n<NADCS;n++){
		for (int k=0;k<72;k++){	    
			NAboveThreshold[n][k] = 0;
		}
	}

	tiSetRandomTrigger(1,0x7);

	taskDelay(10);

	//  signal(SIGINT,sig_handler);

	clock_t t = clock();

	while (tiGetIntCount()< nTriggers){

		//cout<<"Event : "<<tiGetIntCount()<<endl;

	}// end of loop overall events

	t = clock() - t;

	taskDelay(1);

	tiDisableRandomTrigger();	

	return (((float)t)/CLOCKS_PER_SEC);

}

float VMEUtilities::TakePulserData(unsigned int nTriggers){

	if (VERBOSE) cout<<clock()<<"   START OF LOOP"<<endl;
	cout << "VMEUtilities == Taking " << nTriggers << " Trigger(s)" << endl;

	for (unsigned int n=0;n<NADCS;n++){
		for(int i=0; i<3 ; i++){
			fa125SetPulserAmplitude(fa125Slot(n),i,fPulseHeight);
		}	
		fa125SetPulserTriggerDelay(fa125Slot(n), fPulserOffset);
		for (int k=0;k<72;k++){
			NAboveThreshold[n][k] = 0;
		}
	}

	taskDelay(10);

	clock_t t = clock();

	int output = 2;
	for (unsigned int n=0;n<NADCS;n++){	
		fa125SoftPulser(fa125Slot(n), output);
	}
	MyReadoutCode();

	t = clock() - t;

	taskDelay(1);

	return (((float)t)/CLOCKS_PER_SEC);

}

void VMEUtilities::ChangePulserSettings(int NADCSamples, int windowOffset, int pulserOffset, int pulseHeight, int threshold){

	fPulserOffset = pulserOffset;
	fPulseHeight = pulseHeight;

	if (NADCSamples % 2 == 1) NADCSamples++; //must be even
	NADCSAMPLES = NADCSamples;

	for (unsigned int k=0;k<NADCS;k++){
		int S = fa125Slot(k);
		cout<<"Set DAC values and Thresholds for all channels in ADC slot "<<S<<endl;
		fa125SetCommonThreshold(S, threshold);

		//for(int ichan=0; ichan<72; ichan++) {
		//fa125SetOffset(S,ichan,DAC_Values[k][ichan]);
		//fa125SetThreshold(S, ichan, Thresholds[k][ichan]);
		//fa125SetThreshold(S, ichan, threshold);
		//}

		fa125PrintThreshold(fa125Slot(k));

		cout<<"Configure readout window size and location"<<endl;
		//int pmode = 8;
		//unsigned int PL = windowOffset;   // look back PL samples
		//unsigned int PTW = NADCSAMPLES;  // window size in samples
		//unsigned int NSB = 5;    // sampels before threshold
		//unsigned int NSA = 60;   // sampels after threshold
		//unsigned int NP = 1;     // number of pulses in sample
		//fa125SetProcMode(S, pmode, PL, PTW, NSB, NSA, NP);

		fa125SetProcMode(S,"CDC_long", windowOffset, 
				NADCSAMPLES, NADCSAMPLES, 4, 1, 4, 4);   

		// And new now set the Scale Factors
		// IBIT = 4 scale integral
		// ABIT = 3 scale amplitude
		// PBIT = 0 scale pedestal
		fa125SetScaleFactors(S, 4, 3, 0);

		// And also new the thresholds for the timing alorighm
		// TH = 100
		// TL = 25
		fa125SetCommonTimingThreshold(S, 25, 100);

		// enable all channels in module
		cout<<"Enable all Channels"<<endl;
		fa125SetChannelEnableMask(S,0xFFFFFF,0xFFFFFF,0xFFFFFF);

		fa125SetBlocklevel(S, 1);

		//if (VERBOSE) fa125PrintTemps(S);
		//fa125Clear(S);
		fa125Reset(S,0);
		taskDelay(1);
		fa125Enable(S);
		taskDelay(1);
		//fa125Status(S,0);
	}
}

void VMEUtilities::SetAllDAC(int DAC){
	for (unsigned int k=0;k<NADCS;k++){
		int S = fa125Slot(k);
		for(int ichan=0; ichan<72; ichan++) {
			fa125SetOffset(S,ichan,DAC);
			//fa125SetThreshold(S, Thresholds[k][ichan], ichan);
			//fa125SetThreshold(S, threshold, ichan);
		}
	}
}

void VMEUtilities::SetDACDefaults(){
	for (unsigned int k=0;k<NADCS;k++){
		int S = fa125Slot(k);
		for(int ichan=0; ichan<72; ichan++) {
			fa125SetOffset(S,ichan,DAC_Values[k][ichan]);
			//fa125SetThreshold(S, Thresholds[k][ichan], ichan);
			//fa125SetThreshold(S, threshold, ichan);
		}
	}
}

void VMEUtilities::GetHostName(){
	cout << "Getting Host Name " << endl;
	char username[128];
	char *val;
	//getlogin_r(username, 128);
	val = getenv("USER");
	strcpy(username,val);
	char hnam[128];
	gethostname(hnam,128);
	char s[128];
	strncpy(s,&hnam[6],128);
	HOSTROC = atoi(s);
	strncpy(DETECTOR,&hnam[3],3);
	DETECTOR[3] = '\0';
	cout<<"This code is run by user: "<<username<<endl;
	cout<<" HOST "<<s<<"   Detector: "<<DETECTOR<<endl;
	return;	
}

void MyReadoutCode(){

	DMANODE *outEvent;

	//memset(OT,0,20*72*4);
	int iread = 0;
	int timeout = 100000;
	int dCnt = 0;
	int ReadyCode = 0;

	EventCounter++;
	if ( EventCounter%1000 == 0){
		cout<<flush;
		cout<<endl<<"Event: "<<EventCounter<<"  "<<DETECTOR << " " << HOSTROC << endl;
	}

	GETEVENT(vmeIN,EventCounter);

	for(iread=0; iread<timeout; iread++) {
		if(fa125GBready()==fa125ScanMask())
			break;
	}

	if(iread==timeout) {
		cout<<"ADC read TIMEOUT event: "<<EventCounter<<"     Return Mask is "
			<< hex << ReadyCode<<"  should be "<< fa125ScanMask()<<dec<<endl;

		fa125GStatus(0);
		//fa125ResetToken(fa125Slot(0));

		cout<<"GBRADY TIMEOUT on Event "<<EventCounter
			<<" : NEXT EVENT (hit return)?..."<<endl;
		getchar();

	}
	else {
		dCnt = fa125ReadBlock(0,(volatile UINT32 *)dma_dabufp, 0xF0000, 0x2);
		if(dCnt<=0) {
			fa125ResetToken(fa125Slot(0));
			printf("No fa125 data or error.  dCnt = %d\n",dCnt);
		} else {
			dma_dabufp += dCnt;
		}
	}

	fa125ResetToken(fa125Slot(0));

	PUTEVENT(vmeOUT);
	outEvent = dmaPGetItem(vmeOUT);
	int eventLen = outEvent->length;

	int SLOTNUM = 0;
	int EVENT = -1;
	int CHANNEL = -1;
	int WSize = 0;
	int idx = 0;
	//int pedcnt = 0;
	int adc1, adc2;
	int DATAReady=0;
	int EventsInBlock=0;
	int TriggerTime_1=0;
	int TriggerTime_2=0;
	//int TrueSize=0;
	fRawData.clear();
	int Indx = 0;

	cout<<"EVENT LENGTH: "<<eventLen<<endl;

	for (Indx=0;Indx<eventLen;Indx++){
		unsigned int data = (unsigned int)LSWAP(outEvent->data[Indx]);
		DecodeDataNEW(data);
	} // end of loop over all data

	cout<<"EVENT LENGTH: "<<eventLen<<endl;

	dmaPFreeItem(outEvent);

}

void DecodeData(unsigned int data)
{
	// Clear the raw data
	// fRawData[slot_id_ev_hd][fadc_data.chan].clear();

	/* for new data format - 10/23/13 - EJ */

	static unsigned int type_last = 15;/* initialize to type FILLER WORD */
	static unsigned int time_last = 0;
	static unsigned int scaler_index = 0;
	static unsigned int num_scalers = 1;

	static unsigned int slot_id_ev_hd = 0;
	static unsigned int slot_id_dnv = 0;
	static unsigned int slot_id_fill = 0;

	static int nsamples=0;

	int i_print =0;

	if( scaler_index )/* scaler data word */
	{
		fadc_data.type = 16;/* scaler data words as type 16 */
		fadc_data.new_type = 0;
		if( scaler_index < num_scalers )
		{
			fadc_data.scaler[scaler_index - 1] = data;
			if( i_print )
				printf("%8X - SCALER(%d) = %d\n", data, (scaler_index - 1), data);
			scaler_index++;
		}
		else/* last scaler word */
		{
			fadc_data.scaler[scaler_index - 1] = data;
			if( i_print )
				printf("%8X - SCALER(%d) = %d\n", data, (scaler_index - 1), data);
			scaler_index = 0;
			num_scalers = 1;
		}  
	}
	else/* non-scaler word */
	{
		if( data & 0x80000000 )/* data type defining word */
		{
			fadc_data.new_type = 1;
			fadc_data.type = (data & 0x78000000) >> 27;
		}
		else/* data type continuation word */
		{
			fadc_data.new_type = 0;
			fadc_data.type = type_last;
		}

		switch( fadc_data.type )
		{
			case 0:/* BLOCK HEADER */
				fadc_data.slot_id_hd = (data & 0x7C00000) >> 22;
				fadc_data.mod_id_hd =  (data &  0x3C0000) >> 18;
				fadc_data.n_evts =  (data & 0x000FF);
				fadc_data.blk_num = (data & 0x3FF00) >> 8;
				if( i_print )
					printf("%8X - BLOCK HEADER - slot = %d  id = %d  n_evts = %d  n_blk = %d\n",
							data, fadc_data.slot_id_hd, fadc_data.mod_id_hd, fadc_data.n_evts, fadc_data.blk_num);
				break;

			case 1:/* BLOCK TRAILER */
				fadc_data.slot_id_tr = (data & 0x7C00000) >> 22;
				fadc_data.n_words = (data & 0x3FFFFF);
				if( i_print )
					printf("%8X - BLOCK TRAILER - slot = %d   n_words = %d\n",
							data, fadc_data.slot_id_tr, fadc_data.n_words);
				break;
			case 2:/* EVENT HEADER */
				if( fadc_data.new_type )
				{
					slot_id_ev_hd        = (data & 0x7C00000) >> 22;
					fadc_data.evt_num_1 =  (data & 0x03FFFFF);
					if( i_print )
						printf("%8X - EVENT HEADER - slot = %d  evt_num = %d\n",
								data, slot_id_ev_hd, fadc_data.evt_num_1);
				}
				break;

			case 3:/* TRIGGER TIME */
				if( fadc_data.new_type )
				{
					fadc_data.time_1 = (data & 0xFFFFFF);
					if( i_print )
						printf("%8X - TRIGGER TIME 1 - time = 0x%08x\n", data, fadc_data.time_1);
					fadc_data.time_now = 1;
					time_last = 1;
				}
				else
				{
					if( time_last == 1 )
					{
						fadc_data.time_2 = (data & 0xFFFFFF);
						if( i_print )
							printf("%8X - TRIGGER TIME 2 - time = 0x%08x\n", data, fadc_data.time_2);
						fadc_data.time_now = 2;
					}
					else
						if( i_print )
							printf("%8X - TRIGGER TIME - (ERROR)\n", data);

					time_last = fadc_data.time_now;
				}
				break;
			case 4:/* WINDOW RAW DATA */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x7F00000) >> 20;
					fadc_data.width = (data & 0xFFF);
					//fRawData[slot_id_ev_hd][fadc_data.chan].clear();
					if( i_print )
						printf("%8X - WINDOW RAW DATA - chan = %2d   width = %d\n",
								data, fadc_data.chan, fadc_data.width);
					nsamples=0;
				}
				else
				{
					fadc_data.valid_1 = 1;
					fadc_data.valid_2 = 1;
					fadc_data.adc_1 = (data & 0x1FFF0000) >> 16;
					if( data & 0x20000000 )
						fadc_data.valid_1 = 0;
					fadc_data.adc_2 = (data & 0x1FFF);
					if( data & 0x2000 )
						fadc_data.valid_2 = 0;
					if( i_print )
						printf("%8X - RAW SAMPLES (%3d) - valid = %d  adc = %4d (%03X)  valid = %d  adc = %4d (%03X)\n",
								data, nsamples,fadc_data.valid_1, fadc_data.adc_1, fadc_data.adc_1,
								fadc_data.valid_2, fadc_data.adc_2, fadc_data.adc_2);
					fRawData[slot_id_ev_hd][fadc_data.chan].push_back(fadc_data.adc_1);
					fRawData[slot_id_ev_hd][fadc_data.chan].push_back(fadc_data.adc_2);
					nsamples += 2;
				}
				break;

			case 5:/* WINDOW SUM */
				fadc_data.over = 0;
				fadc_data.chan = (data & 0x7800000) >> 23;
				fadc_data.adc_sum = (data & 0x3FFFFF);
				if( data & 0x400000 )
					fadc_data.over = 1;
				if( i_print )
					printf("%8X - WINDOW SUM - chan = %d   over = %d   adc_sum = 0x%08x\n",
							data, fadc_data.chan, fadc_data.over, fadc_data.adc_sum);
				break;

			case 6:/* PULSE RAW DATA */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x07F00000) >> 20;
					fadc_data.pulse_num = 0;
					/*            fadc_data.chan = (data & 0x7800000) >> 23; */
					/*            fadc_data.pulse_num = (data & 0x600000) >> 21; */
					fadc_data.thres_bin = (data & 0x3FF);
					if( i_print )
						printf("%8X - PULSE RAW DATA - chan = %d   pulse # = %d   threshold bin = %d\n",
								data, fadc_data.chan, fadc_data.pulse_num, fadc_data.thres_bin);
				}
				else
				{
					fadc_data.valid_1 = 1;
					fadc_data.valid_2 = 1;
					fadc_data.adc_1 = (data & 0x1FFF0000) >> 16;
					if( data & 0x20000000 )
						fadc_data.valid_1 = 0;
					fadc_data.adc_2 = (data & 0x1FFF);
					if( data & 0x2000 )
						fadc_data.valid_2 = 0;
					if( i_print )
						printf("%8X - PULSE RAW SAMPLES - valid = %d  adc = %d   valid = %d  adc = %d\n",
								data, fadc_data.valid_1, fadc_data.adc_1,
								fadc_data.valid_2, fadc_data.adc_2);
				}
				break;

			case 7:/* PULSE INTEGRAL */
				fadc_data.chan = (data & 0x07F00000) >> 20;
				fadc_data.pulse_num = 0;
				fadc_data.quality = (data & 0x180000) >> 19;
				fadc_data.integral = (data & 0x7FFFF);
				if( i_print )
					printf("%8X - PULSE INTEGRAL - chan = %d   pulse # = %d   quality = %d   integral = %d\n",
							data, fadc_data.chan, fadc_data.pulse_num,
							fadc_data.quality, fadc_data.integral);
				break;

			case 8:/* PULSE TIME */
				fadc_data.chan = (data & 0x07F00000) >> 20;
				fadc_data.pulse_num = 0;
				/*        fadc_data.chan = (data & 0x7800000) >> 23; */
				/*        fadc_data.pulse_num = (data & 0x600000) >> 21; */
				fadc_data.quality = (data & 0x180000) >> 19;
				fadc_data.time = (data & 0xFFFF);
				fadc_data.time_coarse = (data & 0xFFC0) >> 6;
				fadc_data.time_fine = (data & 0x3F);
				if( i_print )
					printf("%8X - PULSE TIME - chan = %d  pulse # = %d  qual = %d  t = %d (c = %d  f = %d)\n",
							data, fadc_data.chan, fadc_data.pulse_num, fadc_data.quality,
							fadc_data.time, fadc_data.time_coarse, fadc_data.time_fine);
				break;

			case 9:/* STREAMING RAW DATA */
				if( fadc_data.new_type )
				{
					fadc_data.chan_a = (data & 0x3C00000) >> 22;
					fadc_data.source_a = (data & 0x4000000) >> 26;
					fadc_data.chan_b = (data & 0x1E0000) >> 17;
					fadc_data.source_b = (data & 0x200000) >> 21;
					if( i_print )
						printf("%8X - STREAMING RAW DATA - ena A = %d  chan A = %d   ena B = %d  chan B = %d\n",
								data, fadc_data.source_a, fadc_data.chan_a,
								fadc_data.source_b, fadc_data.chan_b);
				}
				else
				{
					fadc_data.valid_1 = 1;
					fadc_data.valid_2 = 1;
					fadc_data.adc_1 = (data & 0x1FFF0000) >> 16;
					if( data & 0x20000000 )
						fadc_data.valid_1 = 0;
					fadc_data.adc_2 = (data & 0x1FFF);
					if( data & 0x2000 )
						fadc_data.valid_2 = 0;
					fadc_data.group = (data & 0x40000000) >> 30;
					if( fadc_data.group )
					{
						if( i_print )
							printf("%8X - RAW SAMPLES B - valid = %d  adc = %d   valid = %d  adc = %d\n",
									data, fadc_data.valid_1, fadc_data.adc_1,
									fadc_data.valid_2, fadc_data.adc_2);
					}
					else
						if( i_print )
							printf("%8X - RAW SAMPLES A - valid = %d  adc = %d   valid = %d  adc = %d\n",
									data, fadc_data.valid_1, fadc_data.adc_1,
									fadc_data.valid_2, fadc_data.adc_2);
				}
				break;

			case 10:/* PULSE PARAMETERS */
				/*        fadc_data.chan = (data & 0x7800000) >> 23; */
				/*                        fadc_data.pulse_num = (data & 0x600000) >> 21; */
				fadc_data.chan = (data & 0x07F00000) >> 20;
				fadc_data.pulse_num = 0;
				fadc_data.vmin = (data & 0x1FF000) >> 12;
				fadc_data.vpeak = (data & 0xFFF);
				if( i_print )
					printf("%8X - PULSE V - chan = %d   pulse # = %d   vmin = %d   vpeak = %d\n",
							data, fadc_data.chan, fadc_data.pulse_num,
							fadc_data.vmin, fadc_data.vpeak);
				break;

			case 11:/* UNDEFINED TYPE */
				if( i_print )
					printf("%8X - UNDEFINED TYPE = %d\n", data, fadc_data.type);
				break;

			case 12:/* SCALER HEADER */
				num_scalers = data & 0x3F;/* number of scaler words to follow */
				scaler_index = 1;/* identify next word as a scaler value */
				if( i_print )
					printf("%8X - SCALER HEADER = %d  (NUM SCALERS = %d)\n",
							data, fadc_data.type, num_scalers);
				break;

			case 13:/* END OF EVENT */
				if( i_print )
					printf("%8X - END OF EVENT = %d\n", data, fadc_data.type);
				break;

			case 14:/* DATA NOT VALID (no data available) */
				slot_id_dnv = (data & 0x7C00000) >> 22;
				if( i_print )
					printf("%8X - DATA NOT VALID = %d  slot = %d\n", data, fadc_data.type, slot_id_dnv);
				break;

			case 15:/* FILLER WORD */
				slot_id_fill = (data & 0x7C00000) >> 22;
				if( i_print )
					printf("%8X - FILLER WORD = %d  slot = %d\n", data, fadc_data.type, slot_id_fill);
				break;
		}

		type_last = fadc_data.type;    /* save type of current data word */

	}

}



void DecodeDataNEW(unsigned int data)
{
	/* for new data format - 10/23/13 - EJ */

	static unsigned int type_last = 15;/* initialize to type FILLER WORD */
	static unsigned int time_last = 0;
	static unsigned int scaler_index = 0;
	static unsigned int num_scalers = 1;

	static unsigned int slot_id_ev_hd = 0;
	static unsigned int slot_id_dnv = 0;
	static unsigned int slot_id_fill = 0;

	static int nsamples=0;
	static int ipk=0;
	/*   static int goto_raw=0; */

	int i_print = 0;

	if( scaler_index )/* scaler data word */
	{
		fadc_data.type = 16;/* scaler data words as type 16 */
		fadc_data.new_type = 0;
		if( scaler_index < num_scalers )
		{ 
			fadc_data.scaler[scaler_index - 1] = data;
			if( i_print ) 
				printf("%8X - SCALER(%d) = %d\n", data, (scaler_index - 1), data);
			scaler_index++;
		}
		else/* last scaler word */
		{ 
			fadc_data.scaler[scaler_index - 1] = data;
			if( i_print ) 
				printf("%8X - SCALER(%d) = %d\n", data, (scaler_index - 1), data);
			scaler_index = 0;
			num_scalers = 1;
		} 
	}
	else/* non-scaler word */
	{
		if( data & 0x80000000 )/* data type defining word */
		{
			fadc_data.new_type = 1;
			fadc_data.type = (data & 0x78000000) >> 27;
		}
		else/* data type continuation word */
		{
			fadc_data.new_type = 0;
			fadc_data.type = type_last;
		}

		switch( fadc_data.type )
		{
			case 0:/* BLOCK HEADER */
				fadc_data.slot_id_hd = (data & 0x7C00000) >> 22;
				fadc_data.mod_id_hd =  (data &  0x3C0000) >> 18;
				fadc_data.n_evts =  (data & 0x000FF);
				fadc_data.blk_num = (data & 0x7F00) >> 8;
				if( i_print ) 
					printf("%8X - BLOCK HEADER - slot = %d  id = %d  n_evts = %d  n_blk = %d\n",
							data, fadc_data.slot_id_hd, fadc_data.mod_id_hd, fadc_data.n_evts, fadc_data.blk_num);
				break;

			case 1:/* BLOCK TRAILER */
				fadc_data.slot_id_tr = (data & 0x7C00000) >> 22;
				fadc_data.n_words = (data & 0x3FFFFF);
				if( i_print ) 
					printf("%8X - BLOCK TRAILER - slot = %d   n_words = %d\n",
							data, fadc_data.slot_id_tr, fadc_data.n_words);
				break;

			case 2:/* EVENT HEADER */
				if( fadc_data.new_type )
				{
					slot_id_ev_hd        = (data & 0x7C00000) >> 22;
					fadc_data.evt_num_1 =  (data & 0x03FFFFF);
					if( i_print ) 
						printf("%8X - EVENT HEADER - slot = %d  evt_num = %d\n", 
								data, slot_id_ev_hd, fadc_data.evt_num_1);
				}    
				break;

			case 3:/* TRIGGER TIME */
				if( fadc_data.new_type )
				{
					fadc_data.time_1 = (data & 0xFFFFFF);
					if( i_print ) 
						printf("%8X - TRIGGER TIME 1 - time = 0x%08x\n", data, fadc_data.time_1);
					fadc_data.time_now = 1;
					time_last = 1;
				}    
				else
				{
					if( time_last == 1 )
					{
						fadc_data.time_2 = (data & 0xFFFFFF);
						if( i_print ) 
							printf("%8X - TRIGGER TIME 2 - time = 0x%08x\n", data, fadc_data.time_2);
						fadc_data.time_now = 2;
					}    
					else
						if( i_print ) 
							printf("%8X - TRIGGER TIME - (ERROR)\n", data);

					time_last = fadc_data.time_now;
				}    
				break;

			case 4:/* WINDOW RAW DATA */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x7F00000) >> 20;
					fadc_data.width = (data & 0xFFF);
					if( i_print ) 
						printf("%8X - WINDOW RAW DATA - chan = %2d   width = %d\n", 
								data, fadc_data.chan, fadc_data.width);
					nsamples=0;
				}    
				else
				{
					fadc_data.valid_1 = 1;
					fadc_data.valid_2 = 1;
					fadc_data.adc_1 = (data & 0x1FFF0000) >> 16;
					if( data & 0x20000000 )
						fadc_data.valid_1 = 0;
					fadc_data.adc_2 = (data & 0x1FFF);
					if( data & 0x2000 )
						fadc_data.valid_2 = 0;
					if( i_print ) 
						printf("%8X - RAW SAMPLES (%3d) - valid = %d  adc = %4d (%03X)  valid = %d  adc = %4d (%03X)\n", 
								data, nsamples,fadc_data.valid_1, fadc_data.adc_1, fadc_data.adc_1, 
								fadc_data.valid_2, fadc_data.adc_2, fadc_data.adc_2);
					fRawData[slot_id_ev_hd][fadc_data.chan].push_back(fadc_data.adc_1);
					fRawData[slot_id_ev_hd][fadc_data.chan].push_back(fadc_data.adc_2);
					nsamples += 2;
				}    
				break;

			case 5:/* PULSE DATA, CDC */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x7F00000) >> 20;
					fadc_data.npk  = (data & 0xF8000)>>15;
					fadc_data.le_time = (data & 0x7FF0)>>4;
					fadc_data.time_quality = (data & (1<<3))>>3;
					fadc_data.overflow_cnt = (data & 0x7);
					if( i_print ) 
						printf("%8X - PULSE DATA (CDC IT) - chan = %2d  LE time = %d  Q = %d  OVF = %d\n", 
								data, fadc_data.chan, fadc_data.le_time,
								fadc_data.time_quality, fadc_data.overflow_cnt);
				}    
				else
				{
					fadc_data.pedestal = (data & 0x7F800000)>>23;
					fadc_data.integral = (data & 0x007FFE00)>>9;
					fadc_data.fm_amplitude = (data & 0x000001FF);
					if( i_print ) 
						printf("%8X - PULSE DATA (CDC IT) - ped = %d  integral = %d  firstmax ampl = %d\n", 
								data, fadc_data.pedestal, fadc_data.integral, fadc_data.fm_amplitude);
				}    
				break;

			case 6:/* PULSE DATA, FDC - Integral and Time */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x7F00000) >> 20;
					fadc_data.npk  = (data & 0xF8000)>>15;
					fadc_data.le_time = (data & 0x7FF0)>>4;
					fadc_data.time_quality = (data & (1<<3))>>3;
					fadc_data.overflow_cnt = (data & 0x7);
					ipk = 0;
					if( i_print ) 
						printf("%8X - PULSE DATA (FDC IT) - chan = %2d  NPK = %d  LE time = %d  Q = %d  OVF = %d\n", 
								data, fadc_data.chan, fadc_data.npk, fadc_data.le_time,
								fadc_data.time_quality, fadc_data.overflow_cnt);
				}    
				else
				{
					ipk++;
					fadc_data.pedestal = (data & 0x7F800000)>>23;
					fadc_data.integral = (data & 0x007FFE00)>>9;
					fadc_data.fm_amplitude = (data & 0x000001FF);
					if( i_print ) 
						printf("%8X - PULSE DATA (FDC IT) %d - ped = %d  integral = %d  firstmax ampl = %d\n", 
								data, ipk, fadc_data.pedestal, fadc_data.integral, fadc_data.fm_amplitude);
				}    
				break;

			case 9:/* PULSE DATA, FDC - Peak Ampl and Time */
				if( fadc_data.new_type )
				{
					fadc_data.chan = (data & 0x7F00000) >> 20;
					fadc_data.le_time = (data & 0x7FF0)>>4;
					fadc_data.time_quality = (data & (1<<3))>>3;
					fadc_data.overflow_cnt = (data & 0x7);
					ipk = 0;
					if( i_print ) 
						printf("%8X - PULSE DATA (FDC AT) - chan = %2d  NPK = %d  LE time = %d  Q = %d  OVF = %d\n", 
								data, fadc_data.chan, fadc_data.npk, fadc_data.le_time,
								fadc_data.time_quality, fadc_data.overflow_cnt);
				}    
				else
				{
					ipk++;
					fadc_data.peak_amplitude = (data & 0x7ff80000)>>19;
					fadc_data.peak_time = (data & 0x0007f800)>>11;
					fadc_data.pedestal = (data & 0x000007ff);
					if( i_print ) 
						printf("%8X - PULSE DATA (FDC AT) %d - Ampl = %d  Time = %d  Pedestal = %d\n", 
								data, ipk, fadc_data.peak_amplitude, fadc_data.peak_time, fadc_data.pedestal);
				}    
				break;

			case 7:
			case 8:
			case 10:
			case 11:
			case 12:/* UNDEFINED TYPE */
				if( i_print ) 
					printf("%8X - UNDEFINED TYPE = %d\n", data, fadc_data.type);
				break;

			case 13:/* END OF EVENT */
				if( i_print ) 
					printf("%8X - END OF EVENT = %d\n", data, fadc_data.type);
				break;

			case 14:/* DATA NOT VALID (no data available) */
				slot_id_dnv = (data & 0x7C00000) >> 22; 
				if( i_print )
					printf("%8X - DATA NOT VALID = %d  slot = %d\n", data, fadc_data.type, slot_id_dnv);
				break;

			case 15:/* FILLER WORD */
				slot_id_fill = (data & 0x7C00000) >> 22; 
				if( i_print ) 
					printf("%8X - FILLER WORD = %d  slot = %d\n", data, fadc_data.type, slot_id_fill);
				break;
		}

		type_last = fadc_data.type;    /* save type of current data word */

	}

}