Subversion Repositories f9daq

#include <stdlib.h>

#include <stdio.h>

#include <stdint.h>

#include <string.h>

#include <unistd.h>

#include <ctype.h>

#include <zlib.h>

#include <vector>

#include <sys/time.h>

#include <sys/stat.h>

#include <signal.h>

#include <string>

#include "vme.h"

#include "dataio.h"

#include "SA02_DEF.h"

#include "sa02lib.h"

#include "H2D.h"

#define TRUE 1

#define FALSE 0

#define TIMEOUT 3

RUNINFO runinfo;

EVTREC evtrec;

//const int mux_map[4]={ 1,3,0,2};

const int mux_map[4]= { 2,0,3,1};

int verbose=0;

int timer_out;

struct sigaction oact;

int bltreadout=0;

int ctrl_c=0;

void SigInt (int sig) {

  ctrl_c = 1;

  timer_out=TRUE;

  sa02TimerOut = TRUE;

}

void sa02Timerast (int signumber) {

  timer_out = TRUE;

  sa02TimerOut = TRUE;

  sa02Printf("->>> TIMEOUT !!!\n");

}

void tmlnk (int tout) {

  timer_out = FALSE;

  struct sigaction act;

  struct itimerval tdelay;

  act.sa_handler = sa02Timerast;

  sigemptyset (&act.sa_mask);

  act.sa_flags = 0;

  tdelay.it_value.tv_sec = tout / 100;

  tdelay.it_value.tv_usec = 10000 * (tout % 100);

  tdelay.it_interval.tv_sec = 0;

  tdelay.it_interval.tv_usec = 0;

  if (sigaction (SIGALRM, &act, &oact) < 0) {

    perror ("sigaction(tmlnk)");

    exit (EXIT_FAILURE);

  }

  if (setitimer (ITIMER_REAL, &tdelay, NULL) < 0) {

    perror ("setitimer(tmlnk)");

    exit (EXIT_FAILURE);

  }

}

void tmulk () {

  struct itimerval tdelay;

  tdelay.it_value.tv_sec = 0;

  tdelay.it_value.tv_usec = 0;

  tdelay.it_interval.tv_sec = 0;

  tdelay.it_interval.tv_usec = 0;

  if (setitimer (ITIMER_REAL, &tdelay, NULL) < 0) {

    perror ("setitimer(tmulk)");

    exit (EXIT_FAILURE);

  }

  if (sigaction (SIGALRM, &oact, NULL) < 0) {

    perror ("sigaction(tmulk)");

    exit (EXIT_FAILURE);

  }

}

void sa02Tmlnk (int tout) {

  sa02TimerOut = FALSE;

  tmlnk (tout);

//  ResetTimer (p1h, P1_DAQ_TIMEOUT);

}

void sa02Tmulk () {

  tmulk();

}

int help() {

  printf ("*********************************************************************************:\n");

  printf ("Usage: Performs single/multiple read or write access to SA02 via Belle PTS multipurpose IO board:\n\n");

  printf ("Arguments: \n");

  printf ("-i input parameter filename // can be specified multiple times  \n");

  printf ("-v verbosity \n");

  printf ("-g bltreadout \n");

  printf ("-o output filename \n");

  printf ("-f output filename - append data to file\n");

  printf ("-w write command (FE TP DLY0 MUX MUXASIC VTH0 VTH1 TPLVL0 TPLVL1 GREG CREG CMON TMON0 TMON1 DMON) \n");

  printf ("-a vme base address 0x32100000 \n");

  printf ("-c asic chip number (0..3) \n");

  printf ("-x asic channel number (0..36) \n");

  printf ("-t sleep time bewteen events (sec) \n");

  printf ("-d data\n");

  printf ("-b dataoff - scan over the asic channels instead of the parameter, data step is the channel step, chip and channel are initial chip and  channel. Should apper after -p or-w\n");

  printf ("-s data step or in case of -b the channel step \n");

  printf ("-r number of readouts for each event\n");

  printf ("-n number of events\n");

  printf ("-h <command> at each event execute external command after readouts are done");

  printf ("-q  set status register bit TPENB of the CAEN1495 IO before event loop\n");

  printf ("-e send software trigger before reading the data\n");

  printf ("-p asicparameter ( PHASECMPS GAIN SHAPINGTIME COMPARATOR VRDRIVE MONITOR ID)\n");

  printf ("-p asicparameter ( DECAYTIME OFFSET FINEADJ_UNIPOL FINEADJ_DIFF TPENB KILL)\n\n");

  printf ("-u value ... send test SEU software trigger \n");

  printf ("-z value ... finish the execution of the program in <value> s \n");

  printf ("-m fixeddata : test fixed data, if error occurs, abort \n");

  printf ("-l board number   \n");

  printf ("*********************************************************************************:\n");

  printf ("Examples:\n\n");

  printf ("Threshold scan:\n");

  printf ("100 events TMON0 reading and 10 readings of the data for each event:\n");

  printf ("./sa02_ctrl  -a 0x32100000  -w TMON0 -n 100 -r 10 -t 10000 -v 1\n\n");

  printf ("scan 9 points TPLVL0 inital data 111 stepsize 11, send 1 test pulse, read data :\n");

  printf ("./sa02_ctrl  -a 0x32100000  -w TPLVL0 -d 111 -s 11 -n 9 -e 1 -r 1 -v 1\n\n");

  printf ("Initialize the board from input.param, Read 10000 events of data. the result is saved in the output.dat\n");

  printf ("./sa02_ctrl  -a 0x32100000  -i input.param -n 10000 -r 1 -o output.dat \n\n");

  printf ("Initialize the board from input.param, Read 10000 events of data. scan TPENB from 0 to 144 channels, send test pulse before the data acquisition,\n ");

  printf ("set TPENB to b after the acquisition, the result is saved in the output.dat\n");

  printf ("./sa02_ctrl  -a 0x32100000  -i input.param -p TPENB -d 1 -b 0 -s 1 -n 144 -c 0 -x 0 -e 1 -r 10000 -o output.dat \n\n");

  return 0;

}

int module_header(int recid,uint32_t *data,int len) {

  data[0] = recid;

  data[1] = (len >0)? len : 0 ;

  return data[1]+2;

}

//-------------------------------------------------------------------------

int PrintData(uint32_t *rdata, int count) {

  for (int j=0; j<count; j++) {

    uint32_t recid   = rdata[j++];

    uint32_t len     = rdata[j++];

    printf(" recid=0x%0x len=%d pos=%d(maxpos %d) val=",recid, len, j, count);

    if (len>2) printf("\n");

    for (uint32_t i=0; i<len; i++) {

      if (j< count) printf("0x%0x\t", rdata[j]);

      if (i%4==3) printf("\n");

      j++;

    }

    printf("\n");

    if (len) j--;

  }

  return 0;

}

//-------------------------------------------------------------------------

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

  // intercept routine

  if (signal (SIGINT, SigInt) == SIG_ERR) {

    perror ("sigignore");

  }

  uint32_t fixeddata =0;

  int testfixeddata =0;

  uint32_t data    =0;

  uint32_t dataoff =0;

  uint32_t address =0;

  uint32_t cmd     =0;

  uint32_t chip    =0;

  uint32_t asicpar =0;

  uint32_t asicshft=0;

  uint32_t dstep   =0;

  uint32_t sendswtrg  =0;

  uint32_t tpenb   =0;

  uint32_t sendseutrg  =0;

  int aborttimeout =0;

  int append   =0;

  int remap    =0;

  int dt0      =0;

  int neve     =0;

  int towrite  =0;

  int toread   =0;

  int ch       =0;

  int output   =0;

  int externalcmd   =0;

  int getstatus   =0;

  int writeevent   =1;

  int c;

  char filename[0xFF]="";

  char externalcommand[0xFF]="";

  int sa02BoardMask = 0xF;

  opterr = 0;

  std::vector<std::pair<std::string,uint32_t> > inputfiles;

  while ((c = getopt (argc, argv, "a:b:c:d:e:f:g:h:i:j:k:l:m:n:o:p:q:r:s:t:u:v:z:x:w:y:")) != -1)

    switch (c) {

      case 'i':

        inputfiles.push_back(make_pair(std::string(optarg), sa02BoardMask));

        break;       // input file

      case 'f':

        append=1;    // append the data to the file filename

      case 'o':

        sprintf(filename,"%s", optarg );

        break;       // output

      case 'z':

        aborttimeout=atoi (optarg);    // abort timeout in s

        break;

      case 'h':

        sprintf(externalcommand,"%s", optarg );

        externalcmd=1;

        break;       // output

      case 'm':

        fixeddata =  strtoul (optarg,NULL,0);

        testfixeddata=1;

        break;             // address

      case 'a':

        address =  strtoul (optarg,NULL,0);

        break;             // address

      case 'r':

        toread =  strtoul (optarg,NULL,0);

        break;             // number of readings per event

      case 'v':

        verbose =  strtoul (optarg,NULL,0);

        break;             // verbosity

      case 't':

        dt0 =  strtoul (optarg,NULL,0);

        break;                // sec sleep between events

      case 's':

        dstep =  strtoul (optarg,NULL,0);

        break;                // step size in data or channel increase

      case 'g':

        bltreadout =  strtoul (optarg,NULL,0);

        break;                // bltreadout

      case 'l':

        sa02BoardMask =  strtoul (optarg,NULL,0);

        if ( sa02BoardMask > 0xF) {

          printf("Error! Board Mask 0..15 . Set to 0.");

          sa02BoardMask = 0xF;

        }

        break;                // board mask

      case 'j':

        sa02BoardType =  strtoul (optarg,NULL,0);

        if ( sa02BoardType > 3) {

          printf("Error! Board type sa02 0 / sa03 1 / FEB1_0 2 / FEB1_1 3 . Set to 3");

          sa02BoardType = 3;

        }

        break;                // board number

      case 'n':

        neve =  atoi (optarg);

        break;                          // number of events or number of scan points

      case 'e':

        sendswtrg =  strtoul (optarg,NULL,0);

        break;         // send sotware trigger before reading out the data

      case 'u':

        sendseutrg =  strtoul (optarg,NULL,0);

        break;         // send software SEU trigger before reading out the data

      case 'w':

        towrite=1;

        if (strcmp(optarg,"MUXASIC")==0)  remap=1;

        cmd =sa02GetCmdCode(optarg);

        break;         // write command

      case 'p':

        towrite=2;

        cmd = sa02GetAsicCode(optarg, &asicpar, &asicshft);

        break;  // asic parameter

      case 'b':

        towrite=3;

        dataoff  = strtoul (optarg,NULL,0);

        break;    // scan channels instead of parameter; the value is the off value of the channel

      case 'c':

        chip  = strtoul (optarg,NULL,0);

        break;                // chip number  or initial channel number in the case of -b option

      case 'x':

        ch  = strtoul (optarg,NULL,0);

        break;                 // channel number or initial channel in the case of -b option

      case 'd':

        data  = strtoul (optarg,NULL,0);

        if (remap) {

          data = mux_map[data];

          printf("MUX %d\n",data);

        }

        break;                 // data or initial data in the case of scan

      case 'q':

        tpenb  = strtoul (optarg,NULL,0);

        break;                 // set TPENB bit of the CAEN1495 IO

      case 'y':

        writeevent  = strtoul (optarg,NULL,0);

        break;                 // write event data

      case 'k':

        getstatus  = strtoul (optarg,NULL,0);

        break;                 //  print board status

      case '?':

        if (optopt == 'c')

          fprintf (stderr, "Option -%c requires an argument.\n", optopt);

        else if (isprint (optopt))

          fprintf (stderr, "Unknown option `-%c'.\n", optopt);

        else

          fprintf (stderr,

                   "Unknown option character `\\x%x'.\n",

                   optopt);

        return 1;

      default:

        abort ();

    }

  for (int i=optind; i<argc; i++) data = strtoul (argv[i],NULL,0);

  if (argc <2) {

    help();

    exit(-1);

  }

  // printf ("[neve=%d] a=0x%08x cmd= 0x%08x Data 0x%0x ",neve,address, cmd,data);

  //VME_START(CAEN_V1718);

  VME_START(ZYNQ_XILLINUX);

  int daqmode =3;

  int trglen = 1000;

  Sa02DaqMode (daqmode);

  Sa02SelectTriggerWithMaskAndLength (sendswtrg, sa02BoardMask , trglen);

  for (unsigned int i=0; i<inputfiles.size(); i++) {

    sa02LoadParametersFromFile(inputfiles[i].first.c_str(), inputfiles[i].second);

  }

  if (getstatus){

    char saddress[0xFF];

    double sdata[20];

    for (int board=0;board<4;board++){

      if (sa02BoardMask &(1<<board)) {

        printf("sa02Status => board %d\n",board);

        sa02Status(board, saddress,sdata);

      }

    }

  }

  if (sendseutrg)  Sa02SEUTrigger();

#define MAXSIZE 10000

  int maxsize = MAXSIZE;

  uint32_t *rdata = new uint32_t[maxsize];

  FILE * fp=NULL;

//  uint32_t hdr[10];

  int nbtotal=0;

  if (strlen(filename)>0) {

    if (verbose) printf("Data in the file:%s\n", filename);

    if (append) fp=fopen(filename,"ab");

    else fp=fopen(filename,"wb");

    output=1;

    // run header

    runinfo.id= RUNINFO_ID; // run record ID

    runinfo.len= sizeof(runinfo);

    runinfo.cmd= cmd;

    runinfo.x0 = data;

    runinfo.dx = dstep;

    runinfo.nx = neve;

    runinfo.chip= chip;

    runinfo.ch  = ch;

    runinfo.neve= toread;

    runinfo.writemode= towrite;

    sa02Printf("RUNINFO x0=%d nx=%d dx=%d\n", runinfo.x0,runinfo.dx,runinfo.nx);

    nbtotal+=fwrite(&runinfo, 1,sizeof(runinfo),fp); //gzip

  } else {

    if (verbose) printf("Data are not written to the file!\n");

  }

//  hdr[0]= 0x1; // event record ID

  if (!neve & (towrite || toread) ) neve=1;

  time_t t,told,tstart;

  time(&t);

  tstart=t;

  int ncount=0;

  int nerrors=0;

  int readerror=0;

  uint32_t response[2]= {0,0};

  Sa02TestPulseEnable(address, tpenb);

  ///////////////////////////////////////////////////////////////

  int h2=0;

  if(neve>1) {

    H2DInit(h2, "h2d","Sa02 Chip Scan", 144, 0,1,neve,data, dstep);

    H2DSetTitleX(h2,"channel");

    H2DSetTitleY(h2,"Scan");

  }

  for (int i=0; i<neve; i++) {

    int nb = sizeof(uint32_t);

    int count=0;

    switch (towrite) {

      case 1: {

        rdata[count+2]= data;

        rdata[count+3]= sa02Cmd(address,cmd, data, chip, ch , 2, response);

        count+=module_header(cmd,&rdata[count],2 );

        break;

      }

      case 2: {

        uint32_t datal = asicpar & (data << asicshft);

        rdata[count+2] =  data;

        rdata[count+3] =  sa02AsicWrite(address, cmd, datal, chip, ch, asicpar,asicshft);

        count+=module_header(cmd ,&rdata[count],2); // recid cmd

        break;

      }

      case 3: {

        rdata[count+2] =  chip*36+ch;

        rdata[count+3] =  sa02AsicWrite(address, cmd, data, chip, ch, asicpar,asicshft);  // switch on the channel

        count+=module_header(cmd ,&rdata[count],2); // recid cmd

        break;

      }

    }

//    const int dsize = ( FEB_DATA_STOP - FEB_DATA_START) / FEB_DATA_INC;

    const int dsize = 144*4;

    Sa02SetNeve(toread);

    sa02Reset();

    for ( int j=0; j< toread; j++) {

      int eventerror =  0;

      if ((count+2+dsize) >= maxsize) {

        int oldsize = maxsize;

        maxsize*=2;

        printf("Increasing data buffer to %d elements\n", maxsize);

        uint32_t *tmpdata = rdata;

        rdata = new uint32_t[maxsize];

        //memcpy(tmpdata,rdata, oldsize*sizeof(uint32_t));

        for (int ki=0; ki<oldsize; ki++) rdata[ki]=tmpdata[ki];

        delete tmpdata;

      }

      Sa02TestPulseEnable(address, tpenb);

      if (sendswtrg)  Sa02SoftwareTrigger();

      nb  = sa02Read(sa02BoardMask, &rdata[count+2] );

      if (neve>1) {

        for (int ich=0; ich<144*4; ich++){

          int xch = (143 - ich%144) + ich/144*144;

          H2DFillBin(h2, xch,i,rdata[count+2+ich]);

        }

      }

      if (testfixeddata && nb>0) {

        int len = nb / sizeof(uint32_t);

        for (int ir=0; ir<len; ir++) {

          if ( rdata[count+2+ir]!=fixeddata ) {

            time(&t);

            printf("INSERT INTO fixederror VALUES ( '%d', '%d','%d','%d','0x%08x','0x%08x' ) \n", int(t), int(t-tstart), i*toread+j, ir, rdata[count+2+ir], fixeddata );

            eventerror++;

          }

        }

      }

      if (eventerror) {

        readerror++;

        if (readerror==3) {

          ctrl_c = 1;

          system("date >> firmware.lock");

        }

      } else {

        readerror= 0;

      }

      if (nb>=0) count+=module_header(0x3,&rdata[count],nb/sizeof(uint32_t));  // recid 0x3

      if (ctrl_c) break;

      if (timer_out) j--;

      time(&t);

      if (t!=told ) printf("%d events in %2.2f min (%d s) TIMEOUTS=%d %s",ncount, (double)(t-tstart)/60.,int(t-tstart), nerrors, ctime(&t));

      if (aborttimeout && (t-tstart)>aborttimeout) {

        printf("Abort timeout reached ....\n");

        ctrl_c=1;

        break;

      }

      told=t;

      if (nb<0) {

        nerrors++;

        j--;

      } else ncount++;

    }

    if (externalcmd) {

      char ecmd[256];

      sprintf(ecmd,"%s %u %u %u %u",externalcommand,(unsigned int)  tstart,data, rdata[2], rdata[3]);

      if (verbose) printf("Executing external command %s\n",ecmd);

      system(ecmd);

    }

    if (output && writeevent) {

      evtrec.id=EVTREC_ID;

      evtrec.len=count*sizeof(uint32_t)+ sizeof(evtrec);

      evtrec.time=time(NULL);

      evtrec.nev=i;

      nb = fwrite( &evtrec,  1,  sizeof(evtrec),fp); //gzip

      if (count) nb+=fwrite(&rdata[0],1,count*sizeof(uint32_t),fp); //gzip

      if (nb!= (int) evtrec.len) printf("Error writing! %d!=%d\n",nb,evtrec.len);

      nbtotal+= nb;

    }

    if (verbose==1)  {

      printf("[%d/%d] %u \t", i,count, (unsigned int) time(NULL));

      PrintData(rdata,count);

    }

    if (dt0) sleep(dt0);

    if (towrite ==3) {

      sa02AsicWrite(address, cmd, dataoff, chip, ch, asicpar, asicshft);

      ch += dstep;

      if (ch>35) {

        ch-=36;

        chip++;

      }

    } else {

      data += dstep;

    }

    if (ctrl_c) {

      if (!testfixeddata) printf("Ctrl+C Program interrupted ....\n");

      break;

    }

  }

  if (output) {

    if (neve>1) H2DWrite2File(h2,fp);

    fclose(fp);

  }

  if (verbose>1)  {

    printf("%d bytes written to file %s\n", nbtotal, filename);

  }

  VME_STOP();

  time(&t);

  if (toread && !testfixeddata) printf("%d events in %2.2f min  (%d s) TIMEOUTS=%d  %s",ncount, (double)(t-tstart)/60.,int(t-tstart), nerrors, ctime(&t));

  return 0;

}