// calibrate RC offset parameters for CAEN TDCs


#include <iostream>
#include <fstream>

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

  extern int Nc1190;
  extern int tiA32Base;
  
  DMA_MEM_ID vmeIN,vmeOUT;
  extern unsigned int *dma_dabufp;
  extern DMANODE *the_event;
 
}
unsigned int scanmask=0;

unsigned int START;
unsigned int timelaps = 0;

using namespace std;

void myReadoutCode();
void decodethedata(UINT32 data);

#define TI_ADDR (21<<19)

int DEBUG = 0;

int BLOCKLEVEL = 1;
int BUFFERLEVEL = 1;

int TESTONLY = 1;
int Nevents = 10000;

int EventCounter = 0;

int NTDCS = 6;

int Channel17[4];
int Channel31[4];
int found17;
int found31;
int RCBits17[4];
int RCBits31[4];

int AllLoops[4];

double TheDiff = 9999.;
int TheMinimum = 0xfffff;

void initcounters(){

  for (int n=0;n<4;n++){
    Channel17[n] = 0;
    Channel31[n] = 0;
    RCBits17[n] = 0;
    RCBits31[n] = 0;
  }

  found17 = 0;
  found31 = 0;



}

int RCAdjust = 0;
int ThisOne = 0;

int  main(int argc, char *argv[])  {

  int stat;

  AllLoops[0] = 0;
  AllLoops[1] = 0;
  AllLoops[2] = 0;
  AllLoops[3] = 0;


  for (int k=0;k<argc;k++){
    
    if (!strcmp(argv[k],"-RC")){
      if (argc<(k+4)){
	cout<<"input error: -RC requiers 4 parameters"<<endl;
      }
      RCBits31[0] = atoi(argv[k+1]);
      RCBits31[1] = atoi(argv[k+2]);
      RCBits31[2] = atoi(argv[k+3]);
      RCBits31[3] = atoi(argv[k+4]);
      k+=4;
      RCAdjust = RCBits31[0] + (RCBits31[1]<<3) + (RCBits31[2]<<6) + (RCBits31[3]<<9);
    }
    if (!strcmp(argv[k],"-S")){
      ThisOne = 1;
    }
    if (!strcmp(argv[k],"-H")){
      RCAdjust = atoi(argv[++k]);
    }
  }



  /* Initalize the signal handler */
  signal(SIGINT,sig_handler);


  printf("\nJLAB TI Tests\n");
  printf("----------------------------\n");

  /*   remexSetCmsgServer("dafarm28"); */
  /*   remexInit(NULL,1); */

  vmeOpenDefaultWindows();
  vmeCheckMutexHealth(1);
  vmeDmaAllocLLBuffer();

  /* 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",0x80000,500,0);
  vmeOUT = dmaPCreate("vmeOUT",0,0,0);
    
  dmaPStatsAll();

  dmaPReInitAll();
  /*     gefVmeSetDebugFlags(vmeHdl,0x0); */
  /* Set the TI structure pointer */
  /*     tiInit((2<<19),TI_READOUT_EXT_POLL,0); */
  tiA32Base=0x09000000;
  tiInit(0,TI_READOUT_EXT_POLL,0);
  tiCheckAddresses();

  tiSetSyncEventInterval(10);

  tiSetEventFormat(3);

  tiDisableDataReadout();
  tiDisableA32();

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

  tiSetPrescale(0);
  tiSetBlockLevel(BLOCKLEVEL);

  stat = tiIntConnect(TI_INT_VEC, myReadoutCode, 0);
  if (stat != OK) 
    {
      printf("ERROR: tiIntConnect failed \n");
    } 
  else 
    {
      printf("INFO: Attached TI Interrupt\n");
    }

  /*     tiSetTriggerSource(TI_TRIGGER_TSINPUTS); */
  tiSetTriggerSource(TI_TRIGGER_PULSER);
  tiEnableTSInput(0x1);

  tiSetBusySource(TI_BUSY_FP_FTDC|TI_BUSY_LOOPBACK,1);

  tiSetBlockBufferLevel(BLOCKLEVEL);

  tiSetFiberDelay(1,2);
  tiSetSyncDelayWidth(1,0x3f,1);
    
  tiSetBlockLimit(0);


  // start initializing CAENTDCs

  tdc1190Init(0x11180000,0x80000,NTDCS,1);

  int itdc;
  int iexcept=0;

  unsigned int mcstaddr;
  tdc1190InitMCST(&mcstaddr);
  tdc1190GSetTriggerMatchingMode();
  tdc1190GSetEdgeResolution(25);

  tdc1190ConfigureGReadout(0);
  tdc1190GSetBLTEventNumber(BLOCKLEVEL);
  for(itdc=0; itdc<NTDCS; itdc++) 
    {
      scanmask |= 1<<itdc;
      tdc1190SetGeoAddress(itdc, itdc+3);
    }
  /* Disable some noisy channels */
/*   tdc1190DisableChannel(1,12); */
/*   tdc1190DisableChannel(1,13); */


  cout<<"RC adjustment set all values to zero"<<endl;
  int adjust = RCAdjust;
  for (int ii=0;ii<NTDCS;ii++){
    for (int k=0; k<4; k++){
      int val = tdc1190GetRCadjust(ii, k);
      cout<<"RC Value is at  "<<hex<<val<<dec<<endl;
      
      tdc1190SetRCadjust(ii, k, adjust);    
      val = tdc1190GetRCadjust(ii, k);
      
      cout<<k
	  <<" Set Value      = "<<hex<<adjust
	  <<"  ReadBack Value = "<<val<<dec<<endl;
      
    }
  }


  tdc1190GStatus(1);





  tiClockReset();
  taskDelay(1);
  tiTrigLinkReset();
  taskDelay(1);
  tiEnableVXSSignals();

  taskDelay(1);
  tiSyncReset(1);

  taskDelay(1);
    
  tiStatus(1);


  printf("Hit return to start Triggers...\n");
  getchar();
  
  //vmeBusUnlock();

  /* Enable the TI and clear the trigger counter */
  tiIntEnable(0);
 

  cout<<clock()<<"   START OF LOOP"<<endl; 
  START = clock();
  
  // 0x7 =  3906.25Hz
  // 0x6 =  7812.50Hz
  // 0x5 = 15625.00Hz
  // 0x4 = 31250.00Hz
  tiSetRandomTrigger(1,0x7); 
  //tiSetRandomTrigger(1,0xa);

  taskDelay(10);


  // THELOOP

  while (Nevents>0){
    
    //cout<<"Event : "<<tiGetIntCount()<<endl;
    
  }// end of loop overall events

  //END THE LOOP


  taskDelay(1);

  taskDelay(1);

  tiStatus(0);

  tiSoftTrig(1,0,0x700,0);
  tiDisableRandomTrigger();
  tiIntDisable();
  tiIntDisconnect(); 

  cout<<clock()<<"    END OF LOOP"<<endl;    
  unsigned int ENDL = clock();
  
  //tiIntDisable();
  cout<<"TOTAL TIME: "<<(ENDL-START)/CLOCKS_PER_SEC<<" seconds"<<endl;
    
  vmeDmaFreeLLBuffer();
  dmaPFreeAll();
  vmeCloseDefaultWindows();      

  cout<<"Total time used: "<<timelaps<<" s"<<endl;


  return 0;

}

void myReadoutCode(){

  int ii;
  unsigned int datascan;
  unsigned int nwords;

  DMANODE *outEvent;
  static int LoopCounter = 0;

  //cout<<"beginning of myReadoutCode() "<<EventCounter<<endl;


  GETEVENT(vmeIN,EventCounter);

  for(ii=0;ii<100;ii++) 
    {
      datascan = tdc1190GDready(0);
      if (datascan==scanmask) 
	break;
    }
  if(datascan==scanmask) 
    {
      //cout<<"Found DATA try to read ...."<<endl;

      vmeDmaConfig(2,3,2);
      //nwords = tdc1190CBLTReadBlock(0, dma_dabufp, 0x70000<<2, 2);
      nwords = tdc1190CBLTReadBlock(0, dma_dabufp, 7000, 2);
   
      if(nwords < 0) 
        {
          printf("ERROR: in transfer (event = %d), status = 0x%x\n", tiGetIntCount(),nwords);
          *dma_dabufp++ = LSWAP(0xda000bad);
        } 
      else 
        {
	  //  cout<<"DATA successfully read! "<<endl;
          dma_dabufp += nwords;
        }
    } 
  else 
    {
      printf("ERROR: Data not ready in event %d\n",tiGetIntCount());
      *dma_dabufp++ = LSWAP(0xda000bad);
    }
  
  //*dma_dabufp++ = LSWAP(0xd00dd00d); /* Event EOB */
  

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

  EventCounter++;
  found17 = 0;
  found31 = 0;

  //cout<<"Event "<<EventCounter<<endl;


  for (int Indx=0;Indx<eventLen;Indx++){

    unsigned int data = LSWAP(outEvent->data[Indx]);
    //unsigned int data = outEvent->data[Indx];
    
    decodethedata(data);
    //if(Indx>20) break;
  }

  //printf("%s: nwords = %d    eventLen = %d\n",__FUNCTION__,nwords,eventLen);

  int needToStop = 0;
  
  if (EventCounter==8000){
    EventCounter = 0;

    //double ratio17[4];
    double ratio31[4];

    for (int s=0;s<4;s++){
      //ratio17[s] = (double)Channel17[s] /4000.;
      ratio31[s] = (double)Channel31[s] /8000.;
    }
    //cout<<"Ratios 17:  "<<ratio17[0]<<"  "<<ratio17[1]
    //	<<"  "<<ratio17[2]<<"  "<<ratio17[3]<<endl;
    cout<<"Ratios 31:  "<<ratio31[0]<<"  "<<ratio31[1]
	<<"  "<<ratio31[2]<<"  "<<ratio31[3]<<hex<<"     RCAdjust 0x"<<RCAdjust<<dec<<endl;


    double Diff = 0;
    for (int i=0;i<4;i++){
      Diff += fabs(ratio31[i] - 0.25);
    }

    if (Diff<TheDiff){
      TheDiff = Diff;
      TheMinimum = RCAdjust;
    }


    LoopCounter++;
    if (LoopCounter>5){
      LoopCounter = 0;

      if (ThisOne){
	needToStop = 10;
      }

      
      RCAdjust++;
      if (RCAdjust > 0xfff){
	needToStop = 10;
      } else {
	for (int k=0; k<4; k++){
	  int val = tdc1190GetRCadjust(5, k);
	  //cout<<"RC Value is at  "<<hex<<val<<dec<<endl;
	  
	  tdc1190SetRCadjust(5, k, RCAdjust);    
	  val = tdc1190GetRCadjust(5, k);
	  
	  //cout<<k
	  //    <<" Set Value      = "<<hex<<adjust
	  //    <<"  ReadBack Value = "<<val<<dec<<endl;
	  
	}

      }
    }

    //cout<<"Hit return to continue! ";
    //getchar();
    initcounters();

  }
  
  
  dmaPFreeItem(outEvent);
  
  if (needToStop>1){
    Nevents = 0;
    tiDisableTriggerSource(0);
  }



  if (EventCounter >= Nevents){
    Nevents = 0;
    tiDisableTriggerSource(0);

    cout<<"Found the minum at RCAdjust = 0x"<<hex<<TheMinimum<<dec<<endl;
  }



}


void decodethedata(UINT32 data)
{
  static int tdc = 0;
  UINT32 datatype = 0;
  static int evCount=0, geo=0; /* Global Header */
  int eventID=0, bunchID=0; /* TDC Header */
  int isTrailing=0, chan=0, measurement=0; /* TDC Measurement */
  int wordCount=0; /* TDC Trailer */
  int errorFlags=0; /* TDC Error */
  int triggerTime=0; /* Global Trigger Time Tag */
  int status=0, trigLost=0, outBufferOverflow=0, tdcError=0; /* Global Trailer */
  static UINT32 call_count=0;
  int tdcNum;

  call_count++;

  //printf("%5d: ",call_count);

  datatype = (data & 0xF8000000)>>27;

  //cout<<data<<endl;

  switch(datatype)
    {
    case 0:  /* TDC Measurement */
      isTrailing  = (data & (1<<26))>>26;
      chan        = (data & 0x03e00000)>>21;
      measurement = (data & 0x001fffff);
      tdcNum = geo - 3;

      if ((tdcNum==5) && (chan==16) && (!found17)){
	int bit  = measurement & 0x3;
	Channel17[bit]++;
	found17 = 1;
      }
      if ((tdcNum==5) && (chan==31) && (!found31)){
	int bit  = measurement & 0x3;
	Channel31[bit]++;
	found31 = 1;
      }

      if (DEBUG){
	printf("%8X - TDC MEASUREMENT - %s  tdc=%d  chan=%2d  time=0x%08x\n", 
	       data,
	       isTrailing?"T":"L",
	       tdcNum, chan, measurement);
      }
      break;

    case 1:  /* TDC Header */
      tdc     = (data & 0x03000000)>>24;
      eventID = (data & 0x00fff000)>>12;
      bunchID = (data & 0x00000fff);
      if (DEBUG>1){
	printf("%8X - TDC HEADER  - tdc=%d  eventID=%d  bunchID=%d\n", 
	       data, tdc, eventID, bunchID);
      }
      break;

    case 3:  /* TDC Trailer */
      tdc       = (data & 0x03000000)>>24;
      eventID   = (data & 0x00fff000)>>12;
      wordCount = (data & 0x00000fff);
      if (DEBUG>2){
	printf("%8X - TDC TRAILER - tdc=%d  eventID=%d  wordCount=%d\n", 
	       data, tdc, eventID, wordCount);
      }
      break;

    case 4:  /* TDC Error */
      tdc        = (data & 0x03000000)>>24;
      errorFlags = (data & 0x00007fff);
      if (DEBUG>3){
	printf("%8X - TDC ERROR - 0x%05x\n", data, errorFlags);
      }
      break;
    case 8:  /* Global Header */
      evCount = (data & 0x07ffffe0)>>5;
      geo     = (data & 0x0000001f);
      if (DEBUG>4){
	printf("%8X - GLOBAL HEADER  - geo = %d  evCount = %d\n",
	       data, geo, evCount);
      }
      break;

    case 16: /* Global Trailer */
      status    = (data & 0x07000000)>>24;
      wordCount = (data & 0x001fffe0)>>5;
      geo       = (data & 0x0000001f);
      trigLost          = status & 0x1;
      outBufferOverflow = status & 0x2;
      tdcError          = status & 0x4;
      if (DEBUG>5){
	printf("%8X - GLOBAL TRAILER - geo = %d  status = %d %s%s%s  wordCount = %d\n",
	       data, geo, status, 
	       trigLost?"T":"", 
	       outBufferOverflow?"O":"", 
	       tdcError?"E":"", 
	       wordCount);
      }
      break;

    case 17: /* Global Trigger Time Tag */
      triggerTime = (data & 0x07ffffff);
      if (DEBUG>6){
	printf("%8X - GLOBAL TRIGGER TIME TAG - time = %08x\n", 
	       data, triggerTime);
      }
      break;

    case 24: /* Filler */
      if (DEBUG)
	printf("%8X - FILLER\n", data);
      
      break;

    default:
      if (DEBUG>7){
	printf("%8X: UNKNOWN DATA TYPE %d (0x%x)\n",
	       data, datatype, datatype);
      }
      
    }

}