/* Routines for configuring the LRS1881M ADC and LRS1877 TDC */

#include <stdio.h>
#include <string.h>
#include <signal.h>
#include <time.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <unistd.h>

#include <sigLib.h>
#include <vme.h>
#include <sfi.h>

#define BYPASS       0x0
#define PRIMARY_LINK 0x800
#define END_LINK     0x1000
#define MIDDLE_LINK  0x1800

/* This enum was copied from translation.h in the PrimEx code */
enum MODULE_TYPE_t{
	MODULE_NONE,
	MODULE_UNKNOWN,
	MODULE_LRS1881M,
	MODULE_LRS1877,
	MODULE_TS2,

	NUM_MODULE_TYPES
};
#define MAX_SLOTS 25
int MODULE_TYPE[MAX_SLOTS];
int Nmodules=0;
int SlotHi=0, SlotLo=0, SlotsContiguous=0;
char myhostname[256];

extern volatile struct sfiStruct sfi;

/*----------------------------------
/* Set1881SparsificationThresholds
/*----------------------------------*/
int Set1881SparsificationThresholds(char *myhostname,int slot)
{
	char fname[512];
	FILE *file=NULL;
	char buff[1024], *ptr;
	int nbytes=0;
	unsigned long thresholds[64];
	int nthresholds=0;
	int i,status;

	/* Enable SFI Sequencer (what does this do again?) */
	*sfi.sequencerEnable = 1;

	/* Try opening file */
	sprintf(fname,"/usr/local/primex/online/config/sparsification_%s_slot%d.dat",myhostname,slot);
	file = fopen(fname,"r");
	if(!file){
		printf("missing file \"%s\"\n",fname);
		return -1;
	}
	
	/* Read in entire file contents and remove comments */
	nbytes = fread(buff,1,1023,file);
	fclose(file);
	if(nbytes>1020){
		printf("File too long \"%s\"\n", fname);
		return -2;
	}
	buff[nbytes]=0; /* ensure a terminating null for string operations */
	while(ptr=strstr(buff,"#")){
		char *ptr2;
		if(ptr2=strstr(ptr,"\n")){
			strcpy(ptr,++ptr2);
		}else{
			*ptr = 0;
		}
	}
	
	/* Loop over entries and copy thresholds into local array */
	ptr = strtok(buff,"\n");
	while(ptr){
		if(nthresholds<64)thresholds[nthresholds++] = atoi(ptr);
		ptr = strtok(NULL,"\n");
	}
	if(nthresholds != 64)printf("ERROR: ");
	printf("%d entires found in \"%s\"\n",nthresholds,fname);
	if(nthresholds>64)nthresholds=64;
	
	/* Program sparsification thresholds */
	for(i=0;i<nthresholds;i++){
		unsigned long addr;
		unsigned long tmp;

		addr = 0xC0000000+i;
		status = fpwc(slot, addr, thresholds[i]);
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */

		status = fprc(slot, addr, &tmp);
		if(status != 0){
			sfi_error_decode(0); /* clear any error on sequencer */
		}else{
			if(tmp!=thresholds[i])printf(" slot%d addr=0x%x wrote:%d  read:%d\n",slot,addr,thresholds[i],tmp);
		}
	}

	return 0;
}

/*----------------
/* SetSparsificationON
/*----------------*/
int SetSparsificationON(void)
{
	/* Turn on sparsification for all LRS1881M ADC modules */
	/* (Note: this can only be undone by module reset) */
	int slot, status;
	unsigned long csr0, csr1;

	/* Enable SFI Sequencer (what does this do again?) */
	*sfi.sequencerEnable = 1;

	for(slot=0;slot<MAX_SLOTS;slot++){
		if(MODULE_TYPE[slot] != MODULE_LRS1881M)continue;
		
		/* For crates with modules in contiguous slots, we do a multi-block */
		/* read via a RAM list. The modules must be programmed as to where */
		/* they are (first, middle, end) in this case. */
		csr0 = 0x00000104;
		if(SlotsContiguous){
			if(slot==SlotHi)csr0 |= PRIMARY_LINK;
			else if(slot==SlotLo)csr0 |= END_LINK;
			else csr0 |= MIDDLE_LINK;
		}
		
		/* The ADC in primexroc5 slot20 needs a later gate which it gets from the front panel */
		csr1 = 0x40000043;
		if(strcmp(myhostname,"primexroc5")==0 && slot==20){
			printf("Enabling gate on front panel from primexroc5/slot20\n");
			csr1 = 0x40000041;
		}

		status = fpwc(slot, 0x00000000, csr0);/* CSR0 -- enable gate */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
		status = fpwc(slot, 0x00000001, csr1);/* CSR1 -- Use TR6 and 13bit mode */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
		status = fpwc(slot, 0x00000007, 0x00000002);/* CSR7 -- respond to broadcasts */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
	}
	
	printf("\n---- Sparsification enabled ----\n\n");
	
	return 0;
}

/*----------------
/* WriteModuleMapToFile
/*----------------*/
int WriteModuleMapToFile(char *myhostname)
{
	char filename[512];
	FILE *file=NULL;
	int slot;
	
	sprintf(filename,"/usr/local/primex/online/config/%s_modules.map", myhostname);
	file = fopen(filename, "w");
	if(!file){
		printf("Unable to open \"%s\" for writing!\n", filename);
		return -1;
	}
	printf("Writing module map to \"%s\"\n",filename);
	
	for(slot=0;slot<MAX_SLOTS;slot++){
		fprintf(file,"%2d ", slot);
		switch(MODULE_TYPE[slot]){
			case MODULE_LRS1881M:fprintf(file,"ADC1881\n", slot); break;
			case MODULE_LRS1877 :fprintf(file,"TDC1877\n", slot); break;
			default             :fprintf(file,"UNKNOWN\n", slot); break;
		}
	}
	
	fclose(file);
	
	return 0;
}

/*----------------
/* Set1877TimeWindow
/*----------------*/
int Set1877TimeWindow(int microseconds)
{
	/* Set the time window for all LRS1877 TDC modules */
	int slot, status, scale;
	float fscale;
	unsigned long csr0;
	
	/* Enable SFI Sequencer (what does this do again?) */
	*sfi.sequencerEnable = 1;
	
	fscale = (float)microseconds/32.0*(float)0x1000;
	scale = (int)fscale;
	if(scale<1)scale=1;
	if(scale>0xFFF)scale=0xFFF;
	
	printf("Setting time window to %f microseconds (input=%d)\n"
		,32.768*(float)scale/(float)0xFFF, microseconds);
	
	for(slot=0;slot<MAX_SLOTS;slot++){
		if(MODULE_TYPE[slot] != MODULE_LRS1877)continue;
		
		/* For crates with modules in contiguous slots, we do a multi-block */
		/* read via a RAM list. The modules must be programmed as to where */
		/* they are (first, middle, end) in this case. */
		csr0 = 0x00000100;
		if(SlotsContiguous){
			if(slot==SlotHi)csr0 |= PRIMARY_LINK;
			else if(slot==SlotLo)csr0 |= END_LINK;
			else csr0 |= MIDDLE_LINK;
		}

		status = fpwc(slot, 0x00000000, csr0);/* CSR0 -- Enable priming, Set multi-block position */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
		status = fpwc(slot, 0x00000001, 0x40000003);/* CSR1 -- 0x2=Use TR6, 0x0=Use Front panel gate */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
		status = fpwc(slot, 0x00000007, 0x00000002);/* CSR7 -- respond to broadcasts */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
		/* here we set the LIFO bits(lowest 4) to 0 which means */
		/* use full 16-hit LIFO */
		status = fpwc(slot, 0x00000012, scale<<4);/* CSR18 -- time window and LIFO */
		if(status != 0)sfi_error_decode(0); /* clear any error on sequencer */
	}
	
	printf("\n---- TDC time window set ----\n\n");
}

/*----------------
/* SetSFITTLOutputs
/*----------------*/
void SetNGFTTLOutputs(int bits)
{
	/* SFI memory starts at 0xe00000 */
	unsigned long *ptr = (unsigned long*)(0xe00000 + 0x1000);
	unsigned long *myptr;
	int err;
	err = sysBusToLocalAdrs(VME_AM_STD_SUP_DATA, ptr, &myptr);
	*myptr = (bits & 0x0000000F)<<0;
}

/*----------------
/* ClearSFITTLOutputs
/*----------------*/
void ClearNGFTTLOutputs(int bits)
{
	/* SFI memory starts at 0xe00000 */
	unsigned long *ptr = (unsigned long*)(0xe00000 + 0x1000);
	unsigned long *myptr;
	int err;
	err = sysBusToLocalAdrs(VME_AM_STD_SUP_DATA, ptr, &myptr);
	*myptr = (bits & 0x0000000F)<<16;
}

/*----------------
/* StrobeSFITTLOutputs
/*----------------*/
void StrobeNGFTTLOutputs(int bits)
{
	SetNGFTTLOutputs(bits);
	ClearNGFTTLOutputs(bits);
}